DCCEXParser.cpp

@@ -467,7 +467,7 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
         bool prog=false;
         bool join=false;
         if (params > 1) break;
-        if (params==0) { // All
+        if (params==0 || MotorDriver::commonFaultPin) { // <1> or tracks can not be handled individually
             main=true;
             prog=true;
         }
@@ -500,7 +500,7 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
         bool main=false;
         bool prog=false;
         if (params > 1) break;
-        if (params==0) { // All
+        if (params==0 || MotorDriver::commonFaultPin) { // <0> or tracks can not be handled individually
 	  main=true;
 	  prog=true;
         }

GITHUB_SHA.h

@@ -1 +1 @@
-#define GITHUB_SHA "devel-202306210849Z"
+#define GITHUB_SHA "devel-202306182208Z"

MotorDriver.cpp

@@ -27,7 +27,7 @@
 #include "DCCTimer.h"
 #include "DIAG.h"
 
-unsigned long MotorDriver::globalOverloadStart = 0;
+bool MotorDriver::commonFaultPin=false;
 
 volatile portreg_t shadowPORTA;
 volatile portreg_t shadowPORTB;
@@ -159,7 +159,11 @@ MotorDriver::MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, i
     //   senseFactorInternal, raw2mA(1000),mA2raw(1000));
   }
 
+  // prepare values for current detection
+  sampleDelay = 0;
+  lastSampleTaken = millis();
   progTripValue = mA2raw(TRIP_CURRENT_PROG); 
+
 }
 
 bool MotorDriver::isPWMCapable() {
@@ -168,7 +172,6 @@ bool MotorDriver::isPWMCapable() {
 
 
 void MotorDriver::setPower(POWERMODE mode) {
-  if (powerMode == mode) return;
   bool on=mode==POWERMODE::ON;
   if (on) {
     // when switching a track On, we need to check the crrentOffset with the pin OFF
@@ -369,112 +372,63 @@ void  MotorDriver::getFastPin(const FSH* type,int pin, bool input, FASTPIN & res
 }
 
 void MotorDriver::checkPowerOverload(bool useProgLimit, byte trackno) {
+  if (millis() - lastSampleTaken  < sampleDelay) return;
+  lastSampleTaken = millis();
   int tripValue= useProgLimit?progTripValue:getRawCurrentTripValue();
-
+  
+  // Trackname for diag messages later
   switch (powerMode) {
     case POWERMODE::OFF:
-      if (overloadNow) {
+      sampleDelay = POWER_SAMPLE_OFF_WAIT;
-	// reset overload condition as we have just turned off power
-	// DIAG(F("OVERLOAD POFF OFF"));
-	overloadNow=false;
-	setLastPowerChange();
-      }
-      if (microsSinceLastPowerChange() > POWER_SAMPLE_ALL_GOOD) {
-	power_sample_overload_wait = POWER_SAMPLE_OVERLOAD_WAIT;
-      }
       break;
     case POWERMODE::ON:
       // Check current
       lastCurrent=getCurrentRaw();
       if (lastCurrent < 0) {
-	// We have a fault pin condition to take care of
+	  // We have a fault pin condition to take care of
-	if (!overloadNow) {
+	  lastCurrent = -lastCurrent;
-	  // turn on overload condition as fault pin has gone active
+	  setPower(POWERMODE::OVERLOAD); // Turn off, decide later how fast to turn on again
-	  // DIAG(F("OVERLOAD FPIN ON"));
+	  if (commonFaultPin) {
-	  overloadNow=true;
+	      if (lastCurrent < tripValue) {
-	  setLastPowerChangeOverload();
+		      setPower(POWERMODE::ON); // maybe other track
-	}
+	      }
-	lastCurrent = -lastCurrent;
+	      // Write this after the fact as we want to turn on as fast as possible
-	{
+	      // because we don't know which output actually triggered the fault pin
-	  if (lastCurrent < tripValue) {
+	      DIAG(F("COMMON FAULT PIN ACTIVE: POWERTOGGLE TRACK %c"), trackno + 'A');
-	    if (power_sample_overload_wait <= (POWER_SAMPLE_OVERLOAD_WAIT * 10) &&    // almost virgin
-		microsSinceLastPowerChange() < POWER_SAMPLE_IGNORE_FAULT_LOW) {
-	      // Ignore 50ms fault pin if no current
-	      DIAG(F("TRACK %c FAULT PIN (50ms ignore)"), trackno + 'A');
-	      break;
-	    }
-	    lastCurrent = tripValue; // exaggerate so condition below (*) is true
 	  } else {
-	    if (power_sample_overload_wait <= POWER_SAMPLE_OVERLOAD_WAIT &&   // virgin
+	    DIAG(F("TRACK %c FAULT PIN ACTIVE - OVERLOAD"), trackno + 'A');
-		microsSinceLastPowerChange() < POWER_SAMPLE_IGNORE_FAULT_HIGH) {
+	      if (lastCurrent < tripValue) {
-              // Ignore 5ms fault pin if we see current
+		  lastCurrent = tripValue; // exaggerate
-	      DIAG(F("TRACK %c FAULT PIN (5ms ignore)"), trackno + 'A');
+	      }
-	      break;
-	    }
 	  }
-	  DIAG(F("TRACK %c FAULT PIN"), trackno + 'A');
-	}
       }
-      // // //
+      if (lastCurrent < tripValue) {
-      // above we looked at fault pin, below we look at current
+        sampleDelay = POWER_SAMPLE_ON_WAIT;
-      // // //
+	if(power_good_counter<100)
-      if (lastCurrent < tripValue) { // see above (*)
+	  power_good_counter++;
-	if (overloadNow) {
+	else
-	  // current is below trip value, turn off overload condition
+	  if (power_sample_overload_wait>POWER_SAMPLE_OVERLOAD_WAIT) power_sample_overload_wait=POWER_SAMPLE_OVERLOAD_WAIT;
-	  // DIAG(F("OVERLOAD PON OFF"));
-	  overloadNow=false;
-	  setLastPowerChange();
-	}
-	if (microsSinceLastPowerChange() > POWER_SAMPLE_ALL_GOOD) {
-	  power_sample_overload_wait = POWER_SAMPLE_OVERLOAD_WAIT;
-	}
       } else {
-	// too much current
+        setPower(POWERMODE::OVERLOAD);
-	if (!overloadNow) {
+        unsigned int mA=raw2mA(lastCurrent);
-	  // current is over trip value, turn on overload condition
+        unsigned int maxmA=raw2mA(tripValue);
-	  // DIAG(F("OVERLOAD PON ON"));
+	      power_good_counter=0;
-	  overloadNow=true;
+        sampleDelay = power_sample_overload_wait;
-	  setLastPowerChange();
+        DIAG(F("TRACK %c POWER OVERLOAD %dmA (limit %dmA) shutdown for %dms"), trackno + 'A', mA, maxmA, sampleDelay);
-	}
+	if (power_sample_overload_wait >= 10000)
-	unsigned long uSecs = microsSinceLastPowerChange();
+	    power_sample_overload_wait = 10000;
-	if (power_sample_overload_wait > POWER_SAMPLE_OVERLOAD_WAIT ||    // not virgin
+	else
-	    uSecs > POWER_SAMPLE_OFF_DELAY) {
+	    power_sample_overload_wait *= 2;
-	  // Overload has existed longer than delay (typ. 10ms)
-	  setPower(POWERMODE::OVERLOAD);
-	  if (overloadNow) {
-	    // the setPower just turned off, so overload is now gone
-	    // DIAG(F("OVERLOAD PON OFF"));
-	    overloadNow=false;
-	    setLastPowerChangeOverload();
-	  }
-	  unsigned int mA=raw2mA(lastCurrent);
-	  unsigned int maxmA=raw2mA(tripValue);
-	  DIAG(F("TRACK %c POWER OVERLOAD %4dmA (max %4dmA) detected after %4M. Pause %4M"),
-	       trackno + 'A', mA, maxmA, uSecs, power_sample_overload_wait);
-	}
       }
       break;
-  case POWERMODE::OVERLOAD:
+    case POWERMODE::OVERLOAD:
-  {
+      // Try setting it back on after the OVERLOAD_WAIT
-    // Try setting it back on after the OVERLOAD_WAIT
-    unsigned long mslpc = (commonFaultPin ? (micros() - globalOverloadStart) : microsSinceLastPowerChange());
-    if (mslpc > power_sample_overload_wait) {
-      // adjust next wait time
-      power_sample_overload_wait *= 2;
-      if (power_sample_overload_wait > POWER_SAMPLE_RETRY_MAX)
-	power_sample_overload_wait = POWER_SAMPLE_RETRY_MAX;
-      // power on test
       setPower(POWERMODE::ON);
-      // here we change power but not the overloadNow as that was
+      sampleDelay = POWER_SAMPLE_ON_WAIT;
-      // already changed to false when we entered POWERMODE::OVERLOAD
+      // Debug code....
-      // so we need to set the lastPowerChange anyway.
+      DIAG(F("TRACK %c POWER RESTORE (check %dms)"), trackno + 'A', sampleDelay);
-      overloadNow=false;
+      break;
-      setLastPowerChange();
+    default:
-      DIAG(F("TRACK %c POWER RESTORE (after %4M)"), trackno + 'A', mslpc);
+      sampleDelay = 999; // cant get here..meaningless statement to avoid compiler warning.
-    }
-  }
-  break;
-  default:
-    break;
   }
 }

MotorDriver.h

@@ -175,10 +175,7 @@ class MotorDriver {
     bool isPWMCapable();
     bool canMeasureCurrent();
     bool trackPWM = false; // this track uses PWM timer to generate the DCC waveform
-    bool commonFaultPin = false; // This is a stupid motor shield which has only a common fault pin for both outputs
+    static bool commonFaultPin; // This is a stupid motor shield which has only a common fault pin for both outputs
-    inline byte setCommonFaultPin() {
-      return commonFaultPin = true;
-    }
     inline byte getFaultPin() {
 	return faultPin;
     }
@@ -189,27 +186,6 @@ class MotorDriver {
     inline void setTrackLetter(char c) {
       trackLetter = c;
     };
-    // this returns how much time has passed since the last power change. If it
-    // was really long ago (approx > 52min) advance counter approx 35 min so that
-    // we are at 18 minutes again. Times for 32 bit unsigned long.
-    inline unsigned long microsSinceLastPowerChange() {
-      unsigned long now = micros();
-      unsigned long diff = now - lastPowerChange;
-      if (diff > (1UL << (7 *sizeof(unsigned long)))) // 2^(4*7)us = 268.4 seconds
-        lastPowerChange = now - 30000000UL;           // 30 seconds ago
-      return diff;
-    };
-    inline void setLastPowerChange() {
-      lastPowerChange = micros();
-    };
-    // as setLastPowerChange but sets the global timestamp as well which
-    // is only used to sync power restore in case of common Fault pin.
-    inline void setLastPowerChangeOverload() {
-      if (commonFaultPin)
-	globalOverloadStart = lastPowerChange = micros();
-      else
-	setLastPowerChange();
-    };
 #ifdef ANALOG_READ_INTERRUPT
     bool sampleCurrentFromHW();
     void startCurrentFromHW();
@@ -241,10 +217,8 @@ class MotorDriver {
     int rawCurrentTripValue;
     // current sampling
     POWERMODE powerMode;
-    bool overloadNow = false;
+    unsigned long lastSampleTaken;
-    unsigned long lastPowerChange;            // timestamp in microseconds
+    unsigned int sampleDelay;
-    // used to sync restore time when common Fault pin detected
-    static unsigned long globalOverloadStart; // timestamp in microseconds
     int progTripValue;
     int  lastCurrent;
 #ifdef ANALOG_READ_INTERRUPT
@@ -254,19 +228,10 @@ class MotorDriver {
     int maxmA;
     int tripmA;
 
-    // Times for overload management. Unit: microseconds.
+    // Wait times for power management. Unit: milliseconds
-    // Base for wait time until power is turned on again
+    static const int  POWER_SAMPLE_ON_WAIT = 100;
-    static const unsigned long POWER_SAMPLE_OVERLOAD_WAIT =       100UL;
+    static const int  POWER_SAMPLE_OFF_WAIT = 1000;
-    // Time after we consider all faults old and forgotten
+    static const int  POWER_SAMPLE_OVERLOAD_WAIT = 20;
-    static const unsigned long POWER_SAMPLE_ALL_GOOD =        5000000UL;
-    // How long to ignore fault pin if current is under limit
-    static const unsigned long POWER_SAMPLE_IGNORE_FAULT_LOW =  50000UL;
-    // How long to ignore fault pin if current is higher than limit
-    static const unsigned long POWER_SAMPLE_IGNORE_FAULT_HIGH =  5000UL;
-    // How long to wait between overcurrent and turning off
-    static const unsigned long POWER_SAMPLE_OFF_DELAY =         10000UL;
-    // Upper limit for retry period
-    static const unsigned long POWER_SAMPLE_RETRY_MAX =      10000000UL;
     
     // Trip current for programming track, 250mA. Change only if you really
     // need to be non-NMRA-compliant because of decoders that are not either.

StringFormatter.cpp

@@ -117,24 +117,6 @@ void StringFormatter::send2(Print * stream,const FSH* format, va_list args) {
       case 'o': stream->print(va_arg(args, int), OCT); break;
       case 'x': stream->print((unsigned int)va_arg(args, unsigned int), HEX); break;
       case 'X': stream->print((unsigned long)va_arg(args, unsigned long), HEX); break;
-      case 'M':
-      { // this prints a unsigned long microseconds time in readable format
-	unsigned long time = va_arg(args, long);
-	if (time >= 2000) {
-	  time = time / 1000;
-	  if (time >= 2000) {
-	    printPadded(stream, time/1000, formatWidth, formatLeft);
-	    stream->print(F("sec"));
-	  } else {
-	    printPadded(stream,time, formatWidth, formatLeft);
-	    stream->print(F("msec"));
-	  }
-	} else {
-	  printPadded(stream,time, formatWidth, formatLeft);
-	  stream->print(F("usec"));
-	}
-      }
-      break;
       //case 'f': stream->print(va_arg(args, double), 2); break;
       //format width prefix
       case '-': 

TrackManager.cpp

@@ -123,17 +123,9 @@ void TrackManager::Setup(const FSH * shieldname,
     setTrackMode(1,TRACK_MODE_MAIN);
 #endif
   
-  // Fault pin config for odd motor boards (example pololu)
+  // TODO Fault pin config for odd motor boards (example pololu)
-  FOR_EACH_TRACK(t) {
+  // MotorDriver::commonFaultPin = ((mainDriver->getFaultPin() == progDriver->getFaultPin())
-    for (byte s=t+1;s<=lastTrack;s++) {
+  //				 && (mainDriver->getFaultPin() != UNUSED_PIN));
-      if (track[t]->getFaultPin() != UNUSED_PIN &&
-	  track[t]->getFaultPin() == track[s]->getFaultPin()) {
-	track[t]->setCommonFaultPin();
-	track[s]->setCommonFaultPin();
-	DIAG(F("Common Fault pin tracks %c and %c"), t+'A', s+'A');
-      }
-    }
-  }
   DCC::begin(shieldname);   
 }
 

version.h

@@ -4,9 +4,7 @@
 #include "StringFormatter.h"
 
 
-#define VERSION "4.2.57"
+#define VERSION "4.2.56"
-// 4.2.57 - New overload handling (faster and handles commonFaultPin again)
-//        - Optimize analog read STM32
 // 4.2.56 - Update IO_RotaryEncoder.h:
 //        - Improved I2C communication, non-blocking reads
 //        - Enable sending positions to the encoder from EXRAIL via SERVO()