From 0a3d2e75950ddcaa8ce7d8d952abb2cf5d2bc98d Mon Sep 17 00:00:00 2001
From: Harald Barth <haba@kth.se>
Date: Sat, 4 Jul 2020 21:53:44 +0200
Subject: [PATCH] Implement # command

---
 CVReader.ino    | 6 +++---
 DCCEXParser.cpp | 4 ++++
 2 files changed, 7 insertions(+), 3 deletions(-)

diff --git a/CVReader.ino b/CVReader.ino
index be69908..913e1b4 100644
--- a/CVReader.ino
+++ b/CVReader.ino
@@ -43,10 +43,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;  
diff --git a/DCCEXParser.cpp b/DCCEXParser.cpp
index ff16c57..f0991c9 100644
--- a/DCCEXParser.cpp
+++ b/DCCEXParser.cpp
@@ -250,6 +250,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;