From 3d7a9500cfba08cc27f4211bbbeecb1b822612ac Mon Sep 17 00:00:00 2001
From: Harald Barth <haba@kth.se>
Date: Fri, 3 Jul 2020 00:19:59 +0200
Subject: [PATCH] First test on Uno

---
 CVReader.ino    | 13 +++++++++----
 Config.h        |  5 ++---
 DCCEXParser.cpp |  4 ++++
 Hardware.cpp    |  6 +++---
 4 files changed, 18 insertions(+), 10 deletions(-)

diff --git a/CVReader.ino b/CVReader.ino
index 9ba6724..9b2edd8 100644
--- a/CVReader.ino
+++ b/CVReader.ino
@@ -22,10 +22,10 @@ void myFilter(Print & stream, byte & opcode, byte & paramCount, int p[]) {
              DCC::setFn(p[0],p[1],p[2]==1); 
              opcode=0;  // tell parser to ignore this command
              break; 
-       case '#':   // Diagnose parser <#....>
-            DIAG(F("# paramCount=%d\n"),paramCount);
+       case '$':   // Diagnose parser <$....>
+            DIAG(F("$ paramCount=%d\n"),paramCount);
             for (int i=0;i<paramCount;i++) DIAG(F("p[%d]=%d (0x%x)\n"),i,p[i],p[i]);
-            opcode=0; // Normal parser wont understand #, 
+            opcode=0; // Normal parser wont understand $, 
             break;
        default:  // drop through and parser will use the command unaltered.   
             break;  
@@ -50,7 +50,8 @@ DCCEXParser  serialParser;
 
 // Try monitoring the memory
 #include "freeMemory.h"
-int minMemory=32767;
+//int minMemory=32767;
+int minMemory=2048;
 
 void setup() {
 
@@ -68,8 +69,10 @@ void setup() {
    //         and a 9600 baud rate. 
    //  setup(serial, F(router name), F(password) , port)
    //            
+#ifdef WIFI
     Serial1.begin(115200);
     WifiInterface::setup(Serial1, F("BTHub5-M6PT"), F("49de8d4862"),3532); // (3532 is 0xDCC decimal... )
+#endif
     
    //  This is just for demonstration purposes 
    DIAG(F("\n===== CVReader demonstrating DCC::getLocoId() call ==========\n"));
@@ -95,7 +98,9 @@ void loop() {
   serialParser.loop(Serial);
 
   // Responsibility 3: Optionally handle any incoming WiFi traffic
+#ifdef WIFI
   WifiInterface::loop(Serial1);
+#endif
 
   // Your additional code e.g. Report any decrease in memory
   int freeNow=freeMemory();
diff --git a/Config.h b/Config.h
index 439048b..aaf1d9e 100644
--- a/Config.h
+++ b/Config.h
@@ -7,16 +7,15 @@ const byte MAIN_POWER_PIN = 3;
 const byte MAIN_SIGNAL_PIN = 12;
 const byte MAIN_SIGNAL_PIN_ALT = 0;  // for hardware that flipflops signal pins 
 const byte MAIN_SENSE_PIN = A0;   
-const byte MAIN_SENSE_FACTOR=1; //  analgRead(MAIN_SENSE_PIN) * MAIN_SENSE_FACTOR = milliamps 
 const byte MAIN_BRAKE_PIN = 9;
+const float MAIN_SENSE_FACTOR=1.717; //  analgRead(MAIN_SENSE_PIN) * MAIN_SENSE_FACTOR = milliamps 
 
 const byte PROG_POWER_PIN = 11;
 const byte PROG_SIGNAL_PIN = 13;
 const byte PROG_SIGNAL_PIN_ALT = 0;  // for hardware that flipflops signal pins 
 const byte PROG_SENSE_PIN = A1;
 const byte PROG_BRAKE_PIN = 8;
-
-const float PROG_SENSE_FACTOR=1; //  analgRead(PROG_SENSE_PIN) * PROG_SENSE_FACTOR = milliamps 
+const float PROG_SENSE_FACTOR=1.717; //  analgRead(PROG_SENSE_PIN) * PROG_SENSE_FACTOR = milliamps 
 
 // Allocations with memory implications..!
 // Base system takes approx 900 bytes + 8 per loco. Turnouts, Sensors etc are dynamically created
diff --git a/DCCEXParser.cpp b/DCCEXParser.cpp
index b8bc54e..f96cec8 100644
--- a/DCCEXParser.cpp
+++ b/DCCEXParser.cpp
@@ -232,6 +232,10 @@ void DCCEXParser::parse(Print & stream, const byte *com, bool banAsync) {
         DCC::setDebug(p[0]==1);
         DIAG(F("\nDCC DEBUG MODE %d"),p[0]==1);
         return;
+
+    case '#':     // NUMBER OF LOCOSLOTS <#>
+	StringFormatter::send(stream,F("<# %d>"), MAX_LOCOS);
+	return;
         
      default:  //anything else will drop out to <X>
         break;
diff --git a/Hardware.cpp b/Hardware.cpp
index e9eb218..04bf3d5 100644
--- a/Hardware.cpp
+++ b/Hardware.cpp
@@ -40,14 +40,14 @@ void Hardware::setSignal(bool isMainTrack, bool high) {
 }
 
 int Hardware::getCurrentMilliamps(bool isMainTrack) {
-  int pin = isMainTrack ? MAIN_SENSE_PIN : PROG_SENSE_PIN;
+  byte  pin = isMainTrack ? MAIN_SENSE_PIN : PROG_SENSE_PIN;
   float factor = isMainTrack ? MAIN_SENSE_FACTOR : PROG_SENSE_FACTOR;
-  
+
   // IMPORTANT:  This function can be called in Interrupt() time within the 56uS timer
   //             The default analogRead takes ~100uS which is catastrphic
   //             so analogReadFast is used here. (-2uS) 
   int rawCurrent = analogReadFast(pin);
-  
+
   return (int)(rawCurrent * factor);
 }