Sensors show their status at change (as in classic)

DCCEXParser.cpp

@@ -96,6 +96,7 @@ void DCCEXParser::loop(Stream &stream)
             buffer[bufferLength++] = ch;
         }
     }
+    Sensor::checkAll(&stream); // Update and print changes
 }
 
 int DCCEXParser::splitValues(int result[MAX_PARAMS], const byte *cmd)
@@ -359,11 +360,8 @@ void DCCEXParser::parse(Print *stream, byte *com, bool blocking)
         return;
 
     case 'Q': // SENSORS <Q>
-        Sensor::checkAll();
+        Sensor::checkAll(NULL);    // Update, don't print changes
-        for (Sensor *tt = Sensor::firstSensor; tt != NULL; tt = tt->nextSensor)
+        Sensor::printAll(stream);  // Print all
-        {
-            StringFormatter::send(stream, F("<%c %d>"), tt->active ? 'Q' : 'q', tt->data.snum);
-        }
         return;
 
     case 's': // <s>

Sensors.cpp

@@ -65,27 +65,49 @@ decide to ignore the <q ID> return and only react to <Q ID> triggers.
 
 **********************************************************************/
 
-
+#include "StringFormatter.h"
 #include "Sensors.h"
 #include "EEStore.h"
 
 
+///////////////////////////////////////////////////////////////////////////////
+//
+// checks all defined sensors and prints _changed_ sensor states
+// to stream unless stream is NULL in which case only internal
+// state is updated
+//
 ///////////////////////////////////////////////////////////////////////////////
 
-void Sensor::checkAll(){
+void Sensor::checkAll(Print *stream){
   
   for(Sensor * tt=firstSensor;tt!=NULL;tt=tt->nextSensor){
     tt->signal=tt->signal*(1.0-SENSOR_DECAY)+digitalRead(tt->data.pin)*SENSOR_DECAY;
 
     if(!tt->active && tt->signal<0.5){
       tt->active=true;
+      if (stream != NULL) StringFormatter::send(stream, F("<Q %d>"), tt->data.snum);
     } else if(tt->active && tt->signal>0.9){
       tt->active=false;
+      if (stream != NULL) StringFormatter::send(stream, F("<q %d>"), tt->data.snum);
     }
   } // loop over all sensors
 
 } // Sensor::checkAll
 
+///////////////////////////////////////////////////////////////////////////////
+//
+// prints all sensor states to stream
+//
+///////////////////////////////////////////////////////////////////////////////
+
+void Sensor::printAll(Print *stream){
+
+  for(Sensor * tt=firstSensor;tt!=NULL;tt=tt->nextSensor){
+    if (stream != NULL)
+      StringFormatter::send(stream, F("<%c %d>"), tt->active ? 'Q' : 'q', tt->data.snum);
+  } // loop over all sensors
+} // Sensor::printAll
+
 ///////////////////////////////////////////////////////////////////////////////
 
 Sensor *Sensor::create(int snum, int pin, int pullUp){

Sensors.h

@@ -40,7 +40,8 @@ struct Sensor{
   static Sensor *create(int, int, int);
   static Sensor* get(int);  
   static bool remove(int);  
-  static void checkAll();   
+  static void checkAll(Print *);
+  static void printAll(Print *);
 }; // Sensor
 
 #endif