mirror of
https://github.com/DCC-EX/CommandStation-EX.git
synced 2025-07-30 19:03:44 +02:00
Compare commits
58 Commits
v5.2.54-De
...
devel_fozz
Author | SHA1 | Date | |
---|---|---|---|
|
ec42c09e06 | ||
|
30236f9b36 | ||
|
4ed2ee9adc | ||
|
06a353cfa0 | ||
|
dfe9e6b69f | ||
|
4d84eccac3 | ||
|
edb02a00ce | ||
|
5db19a0fb8 | ||
|
b62661c337 | ||
|
048ba3fd1e | ||
|
c8c3697fa0 | ||
|
8c3c5dfe33 | ||
|
92288603bf | ||
|
80c8b3ef62 | ||
|
127f3acce5 | ||
|
690c629e6d | ||
|
e328ea5c5d | ||
|
ed853eef1d | ||
|
05e77c924e | ||
|
923b031d06 | ||
|
7e29011d63 | ||
|
c5c5609fc6 | ||
|
9c263062e4 | ||
|
f39fd89fbd | ||
|
4e57a80265 | ||
|
27dc8059d7 | ||
|
dc2eae499f | ||
|
c518dcdc0b | ||
|
e6047f6693 | ||
|
96c4757cc6 | ||
|
60e564df51 | ||
|
a8b4e39733 | ||
|
d705626f4a | ||
|
c97284c15f | ||
|
df1f365c1e | ||
|
023c004842 | ||
|
2481f1c5d6 | ||
|
7dadecb5df | ||
|
6ef312b510 | ||
|
97f9fb4813 | ||
|
3d6c935308 | ||
|
fba9a30813 | ||
|
5f65fd5944 | ||
|
a26610bc7f | ||
|
264a53dacf | ||
|
0c96d4ffc2 | ||
|
843fa42692 | ||
|
b17dc5a0dd | ||
|
449a5f1670 | ||
|
06b8995861 | ||
|
2172d2e175 | ||
|
86291cbec4 | ||
|
66791b19f5 | ||
|
6689a1d35f | ||
|
91818ed80c | ||
|
86310aea4f | ||
|
a610e83f6e | ||
|
1449dc7bac |
@@ -248,6 +248,10 @@ void CommandDistributor::broadcastLoco(byte slot) {
|
|||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void CommandDistributor::broadcastForgetLoco(int16_t loco) {
|
||||||
|
broadcastReply(COMMAND_TYPE, F("<l %d 0 1 0>\n<- %d>\n"), loco,loco);
|
||||||
|
}
|
||||||
|
|
||||||
void CommandDistributor::broadcastPower() {
|
void CommandDistributor::broadcastPower() {
|
||||||
char pstr[] = "? x";
|
char pstr[] = "? x";
|
||||||
for(byte t=0; t<TrackManager::MAX_TRACKS; t++)
|
for(byte t=0; t<TrackManager::MAX_TRACKS; t++)
|
||||||
|
@@ -47,6 +47,7 @@ private:
|
|||||||
public :
|
public :
|
||||||
static void parse(byte clientId,byte* buffer, RingStream * ring);
|
static void parse(byte clientId,byte* buffer, RingStream * ring);
|
||||||
static void broadcastLoco(byte slot);
|
static void broadcastLoco(byte slot);
|
||||||
|
static void broadcastForgetLoco(int16_t loco);
|
||||||
static void broadcastSensor(int16_t id, bool value);
|
static void broadcastSensor(int16_t id, bool value);
|
||||||
static void broadcastTurnout(int16_t id, bool isClosed);
|
static void broadcastTurnout(int16_t id, bool isClosed);
|
||||||
static void broadcastTurntable(int16_t id, uint8_t position, bool moving);
|
static void broadcastTurntable(int16_t id, uint8_t position, bool moving);
|
||||||
|
@@ -141,44 +141,73 @@ void setup()
|
|||||||
CommandDistributor::broadcastPower();
|
CommandDistributor::broadcastPower();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void looptimer(unsigned long timeout, const FSH* message)
|
||||||
|
{
|
||||||
|
static unsigned long lasttimestamp = 0;
|
||||||
|
unsigned long now = micros();
|
||||||
|
if (timeout != 0) {
|
||||||
|
unsigned long diff = now - lasttimestamp;
|
||||||
|
if (diff > timeout) {
|
||||||
|
DIAG(message);
|
||||||
|
DIAG(F("DeltaT=%L"), diff);
|
||||||
|
lasttimestamp = micros();
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
lasttimestamp = now;
|
||||||
|
}
|
||||||
|
|
||||||
void loop()
|
void loop()
|
||||||
{
|
{
|
||||||
// The main sketch has responsibilities during loop()
|
// The main sketch has responsibilities during loop()
|
||||||
|
|
||||||
// Responsibility 1: Handle DCC background processes
|
// Responsibility 1: Handle DCC background processes
|
||||||
// (loco reminders and power checks)
|
// (loco reminders and power checks)
|
||||||
|
looptimer(0, F(""));
|
||||||
DCC::loop();
|
DCC::loop();
|
||||||
|
looptimer(5000, F("DCC")); // got warnings up to 3884 during prog track read
|
||||||
|
|
||||||
// Responsibility 2: handle any incoming commands on USB connection
|
// Responsibility 2: handle any incoming commands on USB connection
|
||||||
SerialManager::loop();
|
SerialManager::loop();
|
||||||
|
looptimer(2000, F("Serial")); // got warnings up to 1900 during start
|
||||||
|
|
||||||
// Responsibility 3: Optionally handle any incoming WiFi traffic
|
// Responsibility 3: Optionally handle any incoming WiFi traffic
|
||||||
#ifndef ARDUINO_ARCH_ESP32
|
#ifndef ARDUINO_ARCH_ESP32
|
||||||
#if WIFI_ON
|
#if WIFI_ON
|
||||||
WifiInterface::loop();
|
WifiInterface::loop();
|
||||||
|
looptimer(9000, F("Wifi")); // got warnings up to 8000
|
||||||
|
|
||||||
#endif //WIFI_ON
|
#endif //WIFI_ON
|
||||||
#else //ARDUINO_ARCH_ESP32
|
#else //ARDUINO_ARCH_ESP32
|
||||||
#ifndef WIFI_TASK_ON_CORE0
|
#ifndef WIFI_TASK_ON_CORE0
|
||||||
WifiESP::loop();
|
WifiESP::loop();
|
||||||
|
looptimer(1000, F("WifiESP"));
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
#endif //ARDUINO_ARCH_ESP32
|
#endif //ARDUINO_ARCH_ESP32
|
||||||
#if ETHERNET_ON
|
#if ETHERNET_ON
|
||||||
EthernetInterface::loop();
|
EthernetInterface::loop();
|
||||||
|
looptimer(10000, F("Ethernet"));
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
RMFT::loop(); // ignored if no automation
|
RMFT::loop(); // ignored if no automation
|
||||||
|
looptimer(1000, F("RMFT"));
|
||||||
|
|
||||||
#if defined(LCN_SERIAL)
|
#if defined(LCN_SERIAL)
|
||||||
LCN::loop();
|
LCN::loop();
|
||||||
|
looptimer(1000, F("LCN"));
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// Display refresh
|
// Display refresh
|
||||||
DisplayInterface::loop();
|
DisplayInterface::loop();
|
||||||
|
looptimer(2000, F("Display")); // got warnings around 1150
|
||||||
|
|
||||||
// Handle/update IO devices.
|
// Handle/update IO devices.
|
||||||
IODevice::loop();
|
IODevice::loop();
|
||||||
|
looptimer(1000, F("IODevice"));
|
||||||
|
|
||||||
Sensor::checkAll(); // Update and print changes
|
Sensor::checkAll(); // Update and print changes
|
||||||
|
looptimer(1000, F("Sensor"));
|
||||||
|
|
||||||
// Report any decrease in memory (will automatically trigger on first call)
|
// Report any decrease in memory (will automatically trigger on first call)
|
||||||
static int ramLowWatermark = __INT_MAX__; // replaced on first loop
|
static int ramLowWatermark = __INT_MAX__; // replaced on first loop
|
||||||
|
20
DCC.cpp
20
DCC.cpp
@@ -271,6 +271,20 @@ uint32_t DCC::getFunctionMap(int cab) {
|
|||||||
return (reg<0)?0:speedTable[reg].functions;
|
return (reg<0)?0:speedTable[reg].functions;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// saves DC frequency (0..3) in spare functions 29,30,31
|
||||||
|
void DCC::setDCFreq(int cab,byte freq) {
|
||||||
|
if (cab==0 || freq>3) return;
|
||||||
|
auto reg=lookupSpeedTable(cab,true);
|
||||||
|
// drop and replace F29,30,31 (top 3 bits)
|
||||||
|
auto newFunctions=speedTable[reg].functions & 0x1FFFFFFFUL;
|
||||||
|
if (freq==1) newFunctions |= (1UL<<29); // F29
|
||||||
|
else if (freq==2) newFunctions |= (1UL<<30); // F30
|
||||||
|
else if (freq==3) newFunctions |= (1UL<<31); // F31
|
||||||
|
if (newFunctions==speedTable[reg].functions) return; // no change
|
||||||
|
speedTable[reg].functions=newFunctions;
|
||||||
|
CommandDistributor::broadcastLoco(reg);
|
||||||
|
}
|
||||||
|
|
||||||
void DCC::setAccessory(int address, byte port, bool gate, byte onoff /*= 2*/) {
|
void DCC::setAccessory(int address, byte port, bool gate, byte onoff /*= 2*/) {
|
||||||
// onoff is tristate:
|
// onoff is tristate:
|
||||||
// 0 => send off packet
|
// 0 => send off packet
|
||||||
@@ -728,11 +742,15 @@ void DCC::forgetLoco(int cab) { // removes any speed reminders for this loco
|
|||||||
if (reg>=0) {
|
if (reg>=0) {
|
||||||
speedTable[reg].loco=0;
|
speedTable[reg].loco=0;
|
||||||
setThrottle2(cab,1); // ESTOP if this loco still on track
|
setThrottle2(cab,1); // ESTOP if this loco still on track
|
||||||
|
CommandDistributor::broadcastForgetLoco(cab);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
void DCC::forgetAllLocos() { // removes all speed reminders
|
void DCC::forgetAllLocos() { // removes all speed reminders
|
||||||
setThrottle2(0,1); // ESTOP all locos still on track
|
setThrottle2(0,1); // ESTOP all locos still on track
|
||||||
for (int i=0;i<MAX_LOCOS;i++) speedTable[i].loco=0;
|
for (int i=0;i<MAX_LOCOS;i++) {
|
||||||
|
if (speedTable[i].loco) CommandDistributor::broadcastForgetLoco(speedTable[i].loco);
|
||||||
|
speedTable[i].loco=0;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
byte DCC::loopStatus=0;
|
byte DCC::loopStatus=0;
|
||||||
|
1
DCC.h
1
DCC.h
@@ -70,6 +70,7 @@ public:
|
|||||||
static void changeFn(int cab, int16_t functionNumber);
|
static void changeFn(int cab, int16_t functionNumber);
|
||||||
static int8_t getFn(int cab, int16_t functionNumber);
|
static int8_t getFn(int cab, int16_t functionNumber);
|
||||||
static uint32_t getFunctionMap(int cab);
|
static uint32_t getFunctionMap(int cab);
|
||||||
|
static void setDCFreq(int cab,byte freq);
|
||||||
static void updateGroupflags(byte &flags, int16_t functionNumber);
|
static void updateGroupflags(byte &flags, int16_t functionNumber);
|
||||||
static void setAccessory(int address, byte port, bool gate, byte onoff = 2);
|
static void setAccessory(int address, byte port, bool gate, byte onoff = 2);
|
||||||
static bool setExtendedAccessory(int16_t address, int16_t value, byte repeats=3);
|
static bool setExtendedAccessory(int16_t address, int16_t value, byte repeats=3);
|
||||||
|
12
DCCACK.cpp
12
DCCACK.cpp
@@ -27,8 +27,8 @@
|
|||||||
#include "DCCWaveform.h"
|
#include "DCCWaveform.h"
|
||||||
#include "TrackManager.h"
|
#include "TrackManager.h"
|
||||||
|
|
||||||
unsigned int DCCACK::minAckPulseDuration = 2000; // micros
|
unsigned long DCCACK::minAckPulseDuration = 2000; // micros
|
||||||
unsigned int DCCACK::maxAckPulseDuration = 20000; // micros
|
unsigned long DCCACK::maxAckPulseDuration = 20000; // micros
|
||||||
|
|
||||||
MotorDriver * DCCACK::progDriver=NULL;
|
MotorDriver * DCCACK::progDriver=NULL;
|
||||||
ackOp const * DCCACK::ackManagerProg;
|
ackOp const * DCCACK::ackManagerProg;
|
||||||
@@ -50,8 +50,8 @@ volatile uint8_t DCCACK::numAckSamples=0;
|
|||||||
uint8_t DCCACK::trailingEdgeCounter=0;
|
uint8_t DCCACK::trailingEdgeCounter=0;
|
||||||
|
|
||||||
|
|
||||||
unsigned int DCCACK::ackPulseDuration; // micros
|
unsigned long DCCACK::ackPulseDuration; // micros
|
||||||
unsigned long DCCACK::ackPulseStart; // micros
|
unsigned long DCCACK::ackPulseStart; // micros
|
||||||
volatile bool DCCACK::ackDetected;
|
volatile bool DCCACK::ackDetected;
|
||||||
unsigned long DCCACK::ackCheckStart; // millis
|
unsigned long DCCACK::ackCheckStart; // millis
|
||||||
volatile bool DCCACK::ackPending;
|
volatile bool DCCACK::ackPending;
|
||||||
@@ -127,7 +127,7 @@ bool DCCACK::checkResets(uint8_t numResets) {
|
|||||||
void DCCACK::setAckBaseline() {
|
void DCCACK::setAckBaseline() {
|
||||||
int baseline=progDriver->getCurrentRaw();
|
int baseline=progDriver->getCurrentRaw();
|
||||||
ackThreshold= baseline + progDriver->mA2raw(ackLimitmA);
|
ackThreshold= baseline + progDriver->mA2raw(ackLimitmA);
|
||||||
if (Diag::ACK) DIAG(F("ACK baseline=%d/%dmA Threshold=%d/%dmA Duration between %uus and %uus"),
|
if (Diag::ACK) DIAG(F("ACK baseline=%d/%dmA Threshold=%d/%dmA Duration between %lus and %lus"),
|
||||||
baseline,progDriver->raw2mA(baseline),
|
baseline,progDriver->raw2mA(baseline),
|
||||||
ackThreshold,progDriver->raw2mA(ackThreshold),
|
ackThreshold,progDriver->raw2mA(ackThreshold),
|
||||||
minAckPulseDuration, maxAckPulseDuration);
|
minAckPulseDuration, maxAckPulseDuration);
|
||||||
@@ -146,7 +146,7 @@ void DCCACK::setAckPending() {
|
|||||||
|
|
||||||
byte DCCACK::getAck() {
|
byte DCCACK::getAck() {
|
||||||
if (ackPending) return (2); // still waiting
|
if (ackPending) return (2); // still waiting
|
||||||
if (Diag::ACK) DIAG(F("%S after %dmS max=%d/%dmA pulse=%uuS samples=%d gaps=%d"),ackDetected?F("ACK"):F("NO-ACK"), ackCheckDuration,
|
if (Diag::ACK) DIAG(F("%S after %dmS max=%d/%dmA pulse=%luS samples=%d gaps=%d"),ackDetected?F("ACK"):F("NO-ACK"), ackCheckDuration,
|
||||||
ackMaxCurrent,progDriver->raw2mA(ackMaxCurrent), ackPulseDuration, numAckSamples, numAckGaps);
|
ackMaxCurrent,progDriver->raw2mA(ackMaxCurrent), ackPulseDuration, numAckSamples, numAckGaps);
|
||||||
if (ackDetected) return (1); // Yes we had an ack
|
if (ackDetected) return (1); // Yes we had an ack
|
||||||
return(0); // pending set off but not detected means no ACK.
|
return(0); // pending set off but not detected means no ACK.
|
||||||
|
10
DCCACK.h
10
DCCACK.h
@@ -79,10 +79,10 @@ class DCCACK {
|
|||||||
static inline void setAckLimit(int mA) {
|
static inline void setAckLimit(int mA) {
|
||||||
ackLimitmA = mA;
|
ackLimitmA = mA;
|
||||||
}
|
}
|
||||||
static inline void setMinAckPulseDuration(unsigned int i) {
|
static inline void setMinAckPulseDuration(unsigned long i) {
|
||||||
minAckPulseDuration = i;
|
minAckPulseDuration = i;
|
||||||
}
|
}
|
||||||
static inline void setMaxAckPulseDuration(unsigned int i) {
|
static inline void setMaxAckPulseDuration(unsigned long i) {
|
||||||
maxAckPulseDuration = i;
|
maxAckPulseDuration = i;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -126,11 +126,11 @@ class DCCACK {
|
|||||||
static unsigned long ackCheckStart; // millis
|
static unsigned long ackCheckStart; // millis
|
||||||
static unsigned int ackCheckDuration; // millis
|
static unsigned int ackCheckDuration; // millis
|
||||||
|
|
||||||
static unsigned int ackPulseDuration; // micros
|
static unsigned long ackPulseDuration; // micros
|
||||||
static unsigned long ackPulseStart; // micros
|
static unsigned long ackPulseStart; // micros
|
||||||
|
|
||||||
static unsigned int minAckPulseDuration ; // micros
|
static unsigned long minAckPulseDuration ; // micros
|
||||||
static unsigned int maxAckPulseDuration ; // micros
|
static unsigned long maxAckPulseDuration ; // micros
|
||||||
static MotorDriver* progDriver;
|
static MotorDriver* progDriver;
|
||||||
static volatile uint8_t numAckGaps;
|
static volatile uint8_t numAckGaps;
|
||||||
static volatile uint8_t numAckSamples;
|
static volatile uint8_t numAckSamples;
|
||||||
|
@@ -2,7 +2,7 @@
|
|||||||
* © 2022 Paul M Antoine
|
* © 2022 Paul M Antoine
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021 Herb Morton
|
* © 2021-2024 Herb Morton
|
||||||
* © 2020-2023 Harald Barth
|
* © 2020-2023 Harald Barth
|
||||||
* © 2020-2021 M Steve Todd
|
* © 2020-2021 M Steve Todd
|
||||||
* © 2020-2021 Fred Decker
|
* © 2020-2021 Fred Decker
|
||||||
@@ -563,6 +563,7 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
|||||||
}
|
}
|
||||||
#ifndef DISABLE_PROG
|
#ifndef DISABLE_PROG
|
||||||
else if (p[0]=="PROG"_hk) { // <0 PROG>
|
else if (p[0]=="PROG"_hk) { // <0 PROG>
|
||||||
|
TrackManager::setJoin(false);
|
||||||
TrackManager::progTrackBoosted=false; // Prog track boost mode will not outlive prog track off
|
TrackManager::progTrackBoosted=false; // Prog track boost mode will not outlive prog track off
|
||||||
TrackManager::setTrackPower(TRACK_MODE_PROG, POWERMODE::OFF);
|
TrackManager::setTrackPower(TRACK_MODE_PROG, POWERMODE::OFF);
|
||||||
}
|
}
|
||||||
@@ -641,6 +642,13 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
|||||||
|
|
||||||
case 'F': // New command to call the new Loco Function API <F cab func 1|0>
|
case 'F': // New command to call the new Loco Function API <F cab func 1|0>
|
||||||
if(params!=3) break;
|
if(params!=3) break;
|
||||||
|
|
||||||
|
if (p[1]=="DCFREQ"_hk) { // <F cab DCFREQ 0..3>
|
||||||
|
if (p[2]<0 || p[2]>3) break;
|
||||||
|
DCC::setDCFreq(p[0],p[2]);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
if (Diag::CMD)
|
if (Diag::CMD)
|
||||||
DIAG(F("Setting loco %d F%d %S"), p[0], p[1], p[2] ? F("ON") : F("OFF"));
|
DIAG(F("Setting loco %d F%d %S"), p[0], p[1], p[2] ? F("ON") : F("OFF"));
|
||||||
if (DCC::setFn(p[0], p[1], p[2] == 1)) return;
|
if (DCC::setFn(p[0], p[1], p[2] == 1)) return;
|
||||||
@@ -1073,15 +1081,24 @@ bool DCCEXParser::parseC(Print *stream, int16_t params, int16_t p[]) {
|
|||||||
#ifndef DISABLE_PROG
|
#ifndef DISABLE_PROG
|
||||||
case "ACK"_hk: // <D ACK ON/OFF> <D ACK [LIMIT|MIN|MAX|RETRY] Value>
|
case "ACK"_hk: // <D ACK ON/OFF> <D ACK [LIMIT|MIN|MAX|RETRY] Value>
|
||||||
if (params >= 3) {
|
if (params >= 3) {
|
||||||
|
long duration;
|
||||||
if (p[1] == "LIMIT"_hk) {
|
if (p[1] == "LIMIT"_hk) {
|
||||||
DCCACK::setAckLimit(p[2]);
|
DCCACK::setAckLimit(p[2]);
|
||||||
LCD(1, F("Ack Limit=%dmA"), p[2]); // <D ACK LIMIT 42>
|
LCD(1, F("Ack Limit=%dmA"), p[2]); // <D ACK LIMIT 42>
|
||||||
} else if (p[1] == "MIN"_hk) {
|
} else if (p[1] == "MIN"_hk) {
|
||||||
DCCACK::setMinAckPulseDuration(p[2]);
|
if (params == 4 && p[3] == "MS"_hk)
|
||||||
LCD(0, F("Ack Min=%uus"), p[2]); // <D ACK MIN 1500>
|
duration = p[2] * 1000L;
|
||||||
|
else
|
||||||
|
duration = p[2];
|
||||||
|
DCCACK::setMinAckPulseDuration(duration);
|
||||||
|
LCD(0, F("Ack Min=%lus"), duration); // <D ACK MIN 1500>
|
||||||
} else if (p[1] == "MAX"_hk) {
|
} else if (p[1] == "MAX"_hk) {
|
||||||
DCCACK::setMaxAckPulseDuration(p[2]);
|
if (params == 4 && p[3] == "MS"_hk) // <D ACK MAX 80 MS>
|
||||||
LCD(0, F("Ack Max=%uus"), p[2]); // <D ACK MAX 9000>
|
duration = p[2] * 1000L;
|
||||||
|
else
|
||||||
|
duration = p[2];
|
||||||
|
DCCACK::setMaxAckPulseDuration(duration);
|
||||||
|
LCD(0, F("Ack Max=%lus"), duration); // <D ACK MAX 9000>
|
||||||
} else if (p[1] == "RETRY"_hk) {
|
} else if (p[1] == "RETRY"_hk) {
|
||||||
if (p[2] >255) p[2]=3;
|
if (p[2] >255) p[2]=3;
|
||||||
LCD(0, F("Ack Retry=%d Sum=%d"), p[2], DCCACK::setAckRetry(p[2])); // <D ACK RETRY 2>
|
LCD(0, F("Ack Retry=%d Sum=%d"), p[2], DCCACK::setAckRetry(p[2])); // <D ACK RETRY 2>
|
||||||
|
@@ -185,8 +185,10 @@ int DCCTimer::freeMemory() {
|
|||||||
}
|
}
|
||||||
|
|
||||||
void DCCTimer::reset() {
|
void DCCTimer::reset() {
|
||||||
wdt_enable( WDTO_15MS); // set Arduino watchdog timer for 15ms
|
// 250ms chosen to circumwent bootloader bug which
|
||||||
delay(50); // wait for the prescaller time to expire
|
// hangs at too short timepout (like 15ms)
|
||||||
|
wdt_enable( WDTO_250MS); // set Arduino watchdog timer for 250ms
|
||||||
|
delay(500); // wait for it to happen
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@@ -76,8 +76,13 @@ int DCCTimer::freeMemory() {
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////
|
||||||
|
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
#ifdef ARDUINO_ARCH_ESP32
|
||||||
|
|
||||||
|
#include "esp_idf_version.h"
|
||||||
|
#if ESP_IDF_VERSION_MAJOR > 4
|
||||||
|
#error "DCC-EX does not support compiling with IDF version 5.0 or later. Downgrade your ESP32 library to a version that contains IDE version 4. Arduino ESP32 library 3.0.0 is too new. Downgrade to one of 2.0.9 to 2.0.17"
|
||||||
|
#endif
|
||||||
|
|
||||||
#include "DIAG.h"
|
#include "DIAG.h"
|
||||||
#include <driver/adc.h>
|
#include <driver/adc.h>
|
||||||
#include <soc/sens_reg.h>
|
#include <soc/sens_reg.h>
|
||||||
@@ -292,7 +297,12 @@ void DCCTimer::DCCEXInrushControlOn(uint8_t pin, int duty, bool inverted) {
|
|||||||
int ADCee::init(uint8_t pin) {
|
int ADCee::init(uint8_t pin) {
|
||||||
pinMode(pin, ANALOG);
|
pinMode(pin, ANALOG);
|
||||||
adc1_config_width(ADC_WIDTH_BIT_12);
|
adc1_config_width(ADC_WIDTH_BIT_12);
|
||||||
|
// Espressif deprecated ADC_ATTEN_DB_11 somewhere between 2.0.9 and 2.0.17
|
||||||
|
#ifdef ADC_ATTEN_11db
|
||||||
|
adc1_config_channel_atten(pinToADC1Channel(pin),ADC_ATTEN_11db);
|
||||||
|
#else
|
||||||
adc1_config_channel_atten(pinToADC1Channel(pin),ADC_ATTEN_DB_11);
|
adc1_config_channel_atten(pinToADC1Channel(pin),ADC_ATTEN_DB_11);
|
||||||
|
#endif
|
||||||
return adc1_get_raw(pinToADC1Channel(pin));
|
return adc1_get_raw(pinToADC1Channel(pin));
|
||||||
}
|
}
|
||||||
int16_t ADCee::ADCmax() {
|
int16_t ADCee::ADCmax() {
|
||||||
|
@@ -36,7 +36,20 @@
|
|||||||
#include "DIAG.h"
|
#include "DIAG.h"
|
||||||
#include <wiring_private.h>
|
#include <wiring_private.h>
|
||||||
|
|
||||||
#if defined(ARDUINO_NUCLEO_F401RE) || defined(ARDUINO_NUCLEO_F411RE)
|
#if defined(ARDUINO_NUCLEO_F401RE)
|
||||||
|
// Nucleo-64 boards don't have additional serial ports defined by default
|
||||||
|
// Serial1 is available on the F401RE, but not hugely convenient.
|
||||||
|
// Rx pin on PB7 is useful, but all the Tx pins map to Arduino digital pins, specifically:
|
||||||
|
// PA9 == D8
|
||||||
|
// PB6 == D10
|
||||||
|
// of which D8 is needed by the standard and EX8874 motor shields. D10 would be used if a second
|
||||||
|
// EX8874 is stacked. So only disable this if using a second motor shield.
|
||||||
|
HardwareSerial Serial1(PB7, PB6); // Rx=PB7, Tx=PB6 -- CN7 pin 17 and CN10 pin 17
|
||||||
|
// Serial2 is defined to use USART2 by default, but is in fact used as the diag console
|
||||||
|
// via the debugger on the Nucleo-64. It is therefore unavailable for other DCC-EX uses like WiFi, DFPlayer, etc.
|
||||||
|
// Let's define Serial6 as an additional serial port (the only other option for the F401RE)
|
||||||
|
HardwareSerial Serial6(PA12, PA11); // Rx=PA12, Tx=PA11 -- CN10 pins 12 and 14 - F401RE
|
||||||
|
#elif defined(ARDUINO_NUCLEO_F411RE)
|
||||||
// Nucleo-64 boards don't have additional serial ports defined by default
|
// Nucleo-64 boards don't have additional serial ports defined by default
|
||||||
HardwareSerial Serial1(PB7, PA15); // Rx=PB7, Tx=PA15 -- CN7 pins 17 and 21 - F411RE
|
HardwareSerial Serial1(PB7, PA15); // Rx=PB7, Tx=PA15 -- CN7 pins 17 and 21 - F411RE
|
||||||
// Serial2 is defined to use USART2 by default, but is in fact used as the diag console
|
// Serial2 is defined to use USART2 by default, but is in fact used as the diag console
|
||||||
@@ -54,7 +67,7 @@ HardwareSerial Serial3(PC11, PC10); // Rx=PC11, Tx=PC10 -- USART3 - F446RE
|
|||||||
HardwareSerial Serial5(PD2, PC12); // Rx=PD2, Tx=PC12 -- UART5 - F446RE
|
HardwareSerial Serial5(PD2, PC12); // Rx=PD2, Tx=PC12 -- UART5 - F446RE
|
||||||
// On the F446RE, Serial4 and Serial6 also use pins we can't readily map while using the Arduino pins
|
// On the F446RE, Serial4 and Serial6 also use pins we can't readily map while using the Arduino pins
|
||||||
#elif defined(ARDUINO_NUCLEO_F412ZG) || defined(ARDUINO_NUCLEO_F413ZH) || defined(ARDUINO_NUCLEO_F446ZE) || \
|
#elif defined(ARDUINO_NUCLEO_F412ZG) || defined(ARDUINO_NUCLEO_F413ZH) || defined(ARDUINO_NUCLEO_F446ZE) || \
|
||||||
defined(ARDUINO_NUCLEO_F429ZI) || defined(ARDUINO_NUCLEO_F439ZI)
|
defined(ARDUINO_NUCLEO_F429ZI) || defined(ARDUINO_NUCLEO_F439ZI) || defined(ARDUINO_NUCLEO_F4X9ZI)
|
||||||
// Nucleo-144 boards don't have Serial1 defined by default
|
// Nucleo-144 boards don't have Serial1 defined by default
|
||||||
HardwareSerial Serial6(PG9, PG14); // Rx=PG9, Tx=PG14 -- USART6
|
HardwareSerial Serial6(PG9, PG14); // Rx=PG9, Tx=PG14 -- USART6
|
||||||
HardwareSerial Serial5(PD2, PC12); // Rx=PD2, Tx=PC12 -- UART5
|
HardwareSerial Serial5(PD2, PC12); // Rx=PD2, Tx=PC12 -- UART5
|
||||||
|
85
EXRAIL2.cpp
85
EXRAIL2.cpp
@@ -1,4 +1,5 @@
|
|||||||
/*
|
/*
|
||||||
|
* © 2024 Paul M. Antoine
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2021-2023 Harald Barth
|
* © 2021-2023 Harald Barth
|
||||||
* © 2020-2023 Chris Harlow
|
* © 2020-2023 Chris Harlow
|
||||||
@@ -227,7 +228,6 @@ LookList* RMFT2::LookListLoader(OPCODE op1, OPCODE op2, OPCODE op3) {
|
|||||||
case OPCODE_AT:
|
case OPCODE_AT:
|
||||||
case OPCODE_ATTIMEOUT2:
|
case OPCODE_ATTIMEOUT2:
|
||||||
case OPCODE_AFTER:
|
case OPCODE_AFTER:
|
||||||
case OPCODE_AFTEROVERLOAD:
|
|
||||||
case OPCODE_IF:
|
case OPCODE_IF:
|
||||||
case OPCODE_IFNOT: {
|
case OPCODE_IFNOT: {
|
||||||
int16_t pin = (int16_t)operand;
|
int16_t pin = (int16_t)operand;
|
||||||
@@ -628,14 +628,16 @@ void RMFT2::loop2() {
|
|||||||
skipIf=blinkState!=at_timeout;
|
skipIf=blinkState!=at_timeout;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case OPCODE_AFTER: // waits for sensor to hit and then remain off for 0.5 seconds. (must come after an AT operation)
|
case OPCODE_AFTER: // waits for sensor to hit and then remain off for x mS.
|
||||||
|
// Note, this must come after an AT operation, which is
|
||||||
|
// automatically inserted by the AFTER macro.
|
||||||
if (readSensor(operand)) {
|
if (readSensor(operand)) {
|
||||||
// reset timer to half a second and keep waiting
|
// reset timer and keep waiting
|
||||||
waitAfter=millis();
|
waitAfter=millis();
|
||||||
delayMe(50);
|
delayMe(50);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
if (millis()-waitAfter < 500 ) return;
|
if (millis()-waitAfter < getOperand(1) ) return;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case OPCODE_AFTEROVERLOAD: // waits for the power to be turned back on - either by power routine or button
|
case OPCODE_AFTEROVERLOAD: // waits for the power to be turned back on - either by power routine or button
|
||||||
@@ -716,41 +718,7 @@ void RMFT2::loop2() {
|
|||||||
|
|
||||||
case OPCODE_SETFREQ:
|
case OPCODE_SETFREQ:
|
||||||
// Frequency is default 0, or 1, 2,3
|
// Frequency is default 0, or 1, 2,3
|
||||||
//if (loco) DCC::setFn(loco,operand,true);
|
DCC::setDCFreq(loco,operand);
|
||||||
switch (operand) {
|
|
||||||
case 0: // default - all F-s off
|
|
||||||
if (loco) {
|
|
||||||
DCC::setFn(loco,29,false);
|
|
||||||
DCC::setFn(loco,30,false);
|
|
||||||
DCC::setFn(loco,31,false);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 1:
|
|
||||||
if (loco) {
|
|
||||||
DCC::setFn(loco,29,true);
|
|
||||||
DCC::setFn(loco,30,false);
|
|
||||||
DCC::setFn(loco,31,false);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
if (loco) {
|
|
||||||
DCC::setFn(loco,29,false);
|
|
||||||
DCC::setFn(loco,30,true);
|
|
||||||
DCC::setFn(loco,31,false);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
if (loco) {
|
|
||||||
DCC::setFn(loco,29,false);
|
|
||||||
DCC::setFn(loco,30,false);
|
|
||||||
DCC::setFn(loco,31,true);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
; // do nothing
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case OPCODE_RESUME:
|
case OPCODE_RESUME:
|
||||||
@@ -1000,6 +968,14 @@ void RMFT2::loop2() {
|
|||||||
if ((compileFeatures & FEATURE_LCC) && LCCSerial)
|
if ((compileFeatures & FEATURE_LCC) && LCCSerial)
|
||||||
StringFormatter::send(LCCSerial,F("<L x%h>"),(uint16_t)operand);
|
StringFormatter::send(LCCSerial,F("<L x%h>"),(uint16_t)operand);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case OPCODE_ACON: // MERG adapter
|
||||||
|
case OPCODE_ACOF:
|
||||||
|
if ((compileFeatures & FEATURE_LCC) && LCCSerial)
|
||||||
|
StringFormatter::send(LCCSerial,F("<L x%c%h%h>"),
|
||||||
|
opcode==OPCODE_ACON?'0':'1',
|
||||||
|
(uint16_t)operand,getOperand(progCounter,1));
|
||||||
|
break;
|
||||||
|
|
||||||
case OPCODE_LCCX: // long form LCC
|
case OPCODE_LCCX: // long form LCC
|
||||||
if ((compileFeatures & FEATURE_LCC) && LCCSerial)
|
if ((compileFeatures & FEATURE_LCC) && LCCSerial)
|
||||||
@@ -1088,6 +1064,8 @@ void RMFT2::loop2() {
|
|||||||
case OPCODE_PINTURNOUT: // Turnout definition ignored at runtime
|
case OPCODE_PINTURNOUT: // Turnout definition ignored at runtime
|
||||||
case OPCODE_ONCLOSE: // Turnout event catchers ignored here
|
case OPCODE_ONCLOSE: // Turnout event catchers ignored here
|
||||||
case OPCODE_ONLCC: // LCC event catchers ignored here
|
case OPCODE_ONLCC: // LCC event catchers ignored here
|
||||||
|
case OPCODE_ONACON: // MERG event catchers ignored here
|
||||||
|
case OPCODE_ONACOF: // MERG event catchers ignored here
|
||||||
case OPCODE_ONTHROW:
|
case OPCODE_ONTHROW:
|
||||||
case OPCODE_ONACTIVATE: // Activate event catchers ignored here
|
case OPCODE_ONACTIVATE: // Activate event catchers ignored here
|
||||||
case OPCODE_ONDEACTIVATE:
|
case OPCODE_ONDEACTIVATE:
|
||||||
@@ -1143,20 +1121,25 @@ void RMFT2::kill(const FSH * reason, int operand) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
int16_t RMFT2::getSignalSlot(int16_t id) {
|
int16_t RMFT2::getSignalSlot(int16_t id) {
|
||||||
for (int sigslot=0;;sigslot++) {
|
|
||||||
int16_t sighandle=GETHIGHFLASHW(RMFT2::SignalDefinitions,sigslot*8);
|
if (id > 0) {
|
||||||
if (sighandle==0) { // end of signal list
|
int sigslot = 0;
|
||||||
DIAG(F("EXRAIL Signal %d not defined"), id);
|
int16_t sighandle = 0;
|
||||||
return -1;
|
// Trundle down the signal list until we reach the end
|
||||||
}
|
while ((sighandle = GETHIGHFLASHW(RMFT2::SignalDefinitions, sigslot * 8)) != 0)
|
||||||
VPIN sigid = sighandle & SIGNAL_ID_MASK;
|
{
|
||||||
// sigid is the signal id used in RED/AMBER/GREEN macro
|
// sigid is the signal id used in RED/AMBER/GREEN macro
|
||||||
// for a LED signal it will be same as redpin
|
// for a LED signal it will be same as redpin
|
||||||
// but for a servo signal it will also have SERVO_SIGNAL_FLAG set.
|
// but for a servo signal it will also have SERVO_SIGNAL_FLAG set.
|
||||||
|
VPIN sigid = sighandle & SIGNAL_ID_MASK;
|
||||||
if (sigid != id) continue; // keep looking
|
if (sigid == (VPIN)id) // cast to keep compiler happy but id is positive
|
||||||
return sigslot; // relative slot in signals table
|
return sigslot; // found it
|
||||||
}
|
sigslot++; // keep looking
|
||||||
|
};
|
||||||
|
}
|
||||||
|
// If we got here, we did not find the signal
|
||||||
|
DIAG(F("EXRAIL Signal %d not defined"), id);
|
||||||
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* static */ void RMFT2::doSignal(int16_t id,char rag) {
|
/* static */ void RMFT2::doSignal(int16_t id,char rag) {
|
||||||
|
@@ -69,6 +69,8 @@ enum OPCODE : byte {OPCODE_THROW,OPCODE_CLOSE,OPCODE_TOGGLE_TURNOUT,
|
|||||||
OPCODE_TTADDPOSITION,OPCODE_DCCTURNTABLE,OPCODE_EXTTTURNTABLE,
|
OPCODE_TTADDPOSITION,OPCODE_DCCTURNTABLE,OPCODE_EXTTTURNTABLE,
|
||||||
OPCODE_ONROTATE,OPCODE_ROTATE,OPCODE_WAITFORTT,
|
OPCODE_ONROTATE,OPCODE_ROTATE,OPCODE_WAITFORTT,
|
||||||
OPCODE_LCC,OPCODE_LCCX,OPCODE_ONLCC,
|
OPCODE_LCC,OPCODE_LCCX,OPCODE_ONLCC,
|
||||||
|
OPCODE_ACON, OPCODE_ACOF,
|
||||||
|
OPCODE_ONACON, OPCODE_ONACOF,
|
||||||
OPCODE_ONOVERLOAD,
|
OPCODE_ONOVERLOAD,
|
||||||
OPCODE_ROUTE_ACTIVE,OPCODE_ROUTE_INACTIVE,OPCODE_ROUTE_HIDDEN,
|
OPCODE_ROUTE_ACTIVE,OPCODE_ROUTE_INACTIVE,OPCODE_ROUTE_HIDDEN,
|
||||||
OPCODE_ROUTE_DISABLED,
|
OPCODE_ROUTE_DISABLED,
|
||||||
@@ -187,6 +189,7 @@ class LookList {
|
|||||||
static const FSH * getTurntablePositionDescription(int16_t turntableId, uint8_t positionId);
|
static const FSH * getTurntablePositionDescription(int16_t turntableId, uint8_t positionId);
|
||||||
static void startNonRecursiveTask(const FSH* reason, int16_t id,int pc);
|
static void startNonRecursiveTask(const FSH* reason, int16_t id,int pc);
|
||||||
static bool readSensor(uint16_t sensorId);
|
static bool readSensor(uint16_t sensorId);
|
||||||
|
static bool isSignal(int16_t id,char rag);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
static void ComandFilter(Print * stream, byte & opcode, byte & paramCount, int16_t p[]);
|
static void ComandFilter(Print * stream, byte & opcode, byte & paramCount, int16_t p[]);
|
||||||
@@ -196,7 +199,6 @@ private:
|
|||||||
static bool getFlag(VPIN id,byte mask);
|
static bool getFlag(VPIN id,byte mask);
|
||||||
static int16_t progtrackLocoId;
|
static int16_t progtrackLocoId;
|
||||||
static void doSignal(int16_t id,char rag);
|
static void doSignal(int16_t id,char rag);
|
||||||
static bool isSignal(int16_t id,char rag);
|
|
||||||
static int16_t getSignalSlot(int16_t id);
|
static int16_t getSignalSlot(int16_t id);
|
||||||
static void setTurnoutHiddenState(Turnout * t);
|
static void setTurnoutHiddenState(Turnout * t);
|
||||||
#ifndef IO_NO_HAL
|
#ifndef IO_NO_HAL
|
||||||
|
@@ -99,6 +99,10 @@
|
|||||||
#undef LCCX
|
#undef LCCX
|
||||||
#undef LCN
|
#undef LCN
|
||||||
#undef MOVETT
|
#undef MOVETT
|
||||||
|
#undef ACON
|
||||||
|
#undef ACOF
|
||||||
|
#undef ONACON
|
||||||
|
#undef ONACOF
|
||||||
#undef MESSAGE
|
#undef MESSAGE
|
||||||
#undef ONACTIVATE
|
#undef ONACTIVATE
|
||||||
#undef ONACTIVATEL
|
#undef ONACTIVATEL
|
||||||
@@ -191,7 +195,7 @@
|
|||||||
#ifndef RMFT2_UNDEF_ONLY
|
#ifndef RMFT2_UNDEF_ONLY
|
||||||
#define ACTIVATE(addr,subaddr)
|
#define ACTIVATE(addr,subaddr)
|
||||||
#define ACTIVATEL(addr)
|
#define ACTIVATEL(addr)
|
||||||
#define AFTER(sensor_id)
|
#define AFTER(sensor_id,timer...)
|
||||||
#define AFTEROVERLOAD(track_id)
|
#define AFTEROVERLOAD(track_id)
|
||||||
#define ALIAS(name,value...)
|
#define ALIAS(name,value...)
|
||||||
#define AMBER(signal_id)
|
#define AMBER(signal_id)
|
||||||
@@ -265,6 +269,10 @@
|
|||||||
#define LCN(msg)
|
#define LCN(msg)
|
||||||
#define MESSAGE(msg)
|
#define MESSAGE(msg)
|
||||||
#define MOVETT(id,steps,activity)
|
#define MOVETT(id,steps,activity)
|
||||||
|
#define ACON(eventid)
|
||||||
|
#define ACOF(eventid)
|
||||||
|
#define ONACON(eventid)
|
||||||
|
#define ONACOF(eventid)
|
||||||
#define ONACTIVATE(addr,subaddr)
|
#define ONACTIVATE(addr,subaddr)
|
||||||
#define ONACTIVATEL(linear)
|
#define ONACTIVATEL(linear)
|
||||||
#define ONAMBER(signal_id)
|
#define ONAMBER(signal_id)
|
||||||
@@ -326,7 +334,7 @@
|
|||||||
#define SET_TRACK(track,mode)
|
#define SET_TRACK(track,mode)
|
||||||
#define SET_POWER(track,onoff)
|
#define SET_POWER(track,onoff)
|
||||||
#define SETLOCO(loco)
|
#define SETLOCO(loco)
|
||||||
#define SETFREQ(loco,freq)
|
#define SETFREQ(freq)
|
||||||
#define SIGNAL(redpin,amberpin,greenpin)
|
#define SIGNAL(redpin,amberpin,greenpin)
|
||||||
#define SIGNALH(redpin,amberpin,greenpin)
|
#define SIGNALH(redpin,amberpin,greenpin)
|
||||||
#define SPEED(speed)
|
#define SPEED(speed)
|
||||||
|
@@ -61,47 +61,85 @@ void RMFT2::ComandFilter(Print * stream, byte & opcode, byte & paramCount, int16
|
|||||||
case 'L':
|
case 'L':
|
||||||
// This entire code block is compiled out if LLC macros not used
|
// This entire code block is compiled out if LLC macros not used
|
||||||
if (!(compileFeatures & FEATURE_LCC)) return;
|
if (!(compileFeatures & FEATURE_LCC)) return;
|
||||||
|
static int lccProgCounter=0;
|
||||||
|
static int lccEventIndex=0;
|
||||||
|
|
||||||
if (paramCount==0) { //<L> LCC adapter introducing self
|
if (paramCount==0) { //<L> LCC adapter introducing self
|
||||||
LCCSerial=stream; // now we know where to send events we raise
|
LCCSerial=stream; // now we know where to send events we raise
|
||||||
|
opcode=0; // flag command as intercepted
|
||||||
|
|
||||||
// loop through all possible sent events
|
// loop through all possible sent/waited events
|
||||||
for (int progCounter=0;; SKIPOP) {
|
for (int progCounter=lccProgCounter;; SKIPOP) {
|
||||||
byte opcode=GET_OPCODE;
|
byte exrailOpcode=GET_OPCODE;
|
||||||
if (opcode==OPCODE_ENDEXRAIL) break;
|
switch (exrailOpcode) {
|
||||||
if (opcode==OPCODE_LCC) StringFormatter::send(stream,F("<LS x%h>\n"),getOperand(progCounter,0));
|
case OPCODE_ENDEXRAIL:
|
||||||
if (opcode==OPCODE_LCCX) { // long form LCC
|
stream->print(F("<LR>\n")); // ready to roll
|
||||||
StringFormatter::send(stream,F("<LS x%h%h%h%h>\n"),
|
lccProgCounter=0; // allow a second pass
|
||||||
|
lccEventIndex=0;
|
||||||
|
return;
|
||||||
|
|
||||||
|
case OPCODE_LCC:
|
||||||
|
StringFormatter::send(stream,F("<LS x%h>\n"),getOperand(progCounter,0));
|
||||||
|
SKIPOP;
|
||||||
|
lccProgCounter=progCounter;
|
||||||
|
return;
|
||||||
|
|
||||||
|
case OPCODE_LCCX: // long form LCC
|
||||||
|
StringFormatter::send(stream,F("<LS x%h%h%h%h>\n"),
|
||||||
getOperand(progCounter,1),
|
getOperand(progCounter,1),
|
||||||
getOperand(progCounter,2),
|
getOperand(progCounter,2),
|
||||||
getOperand(progCounter,3),
|
getOperand(progCounter,3),
|
||||||
getOperand(progCounter,0)
|
getOperand(progCounter,0)
|
||||||
);
|
);
|
||||||
}}
|
SKIPOP;SKIPOP;SKIPOP;SKIPOP;
|
||||||
|
lccProgCounter=progCounter;
|
||||||
|
return;
|
||||||
|
|
||||||
|
case OPCODE_ACON: // CBUS ACON
|
||||||
|
case OPCODE_ACOF: // CBUS ACOF
|
||||||
|
StringFormatter::send(stream,F("<LS x%c%h%h>\n"),
|
||||||
|
exrailOpcode==OPCODE_ACOF?'1':'0',
|
||||||
|
getOperand(progCounter,0),getOperand(progCounter,1));
|
||||||
|
SKIPOP;SKIPOP;
|
||||||
|
lccProgCounter=progCounter;
|
||||||
|
return;
|
||||||
|
|
||||||
// we stream the hex events we wish to listen to
|
// we stream the hex events we wish to listen to
|
||||||
// and at the same time build the event index looku.
|
// and at the same time build the event index looku.
|
||||||
|
|
||||||
|
case OPCODE_ONLCC:
|
||||||
int eventIndex=0;
|
|
||||||
for (int progCounter=0;; SKIPOP) {
|
|
||||||
byte opcode=GET_OPCODE;
|
|
||||||
if (opcode==OPCODE_ENDEXRAIL) break;
|
|
||||||
if (opcode==OPCODE_ONLCC) {
|
|
||||||
onLCCLookup[eventIndex]=progCounter; // TODO skip...
|
|
||||||
StringFormatter::send(stream,F("<LL %d x%h%h%h:%h>\n"),
|
StringFormatter::send(stream,F("<LL %d x%h%h%h:%h>\n"),
|
||||||
eventIndex,
|
lccEventIndex,
|
||||||
getOperand(progCounter,1),
|
getOperand(progCounter,1),
|
||||||
getOperand(progCounter,2),
|
getOperand(progCounter,2),
|
||||||
getOperand(progCounter,3),
|
getOperand(progCounter,3),
|
||||||
getOperand(progCounter,0)
|
getOperand(progCounter,0)
|
||||||
);
|
);
|
||||||
eventIndex++;
|
SKIPOP;SKIPOP;SKIPOP;SKIPOP;
|
||||||
}
|
// start on handler at next
|
||||||
|
onLCCLookup[lccEventIndex]=progCounter;
|
||||||
|
lccEventIndex++;
|
||||||
|
lccProgCounter=progCounter;
|
||||||
|
return;
|
||||||
|
|
||||||
|
case OPCODE_ONACON:
|
||||||
|
case OPCODE_ONACOF:
|
||||||
|
StringFormatter::send(stream,F("<LL %d x%c%h%h>\n"),
|
||||||
|
lccEventIndex,
|
||||||
|
exrailOpcode==OPCODE_ONACOF?'1':'0',
|
||||||
|
getOperand(progCounter,0),getOperand(progCounter,1)
|
||||||
|
);
|
||||||
|
SKIPOP;SKIPOP;
|
||||||
|
// start on handler at next
|
||||||
|
onLCCLookup[lccEventIndex]=progCounter;
|
||||||
|
lccEventIndex++;
|
||||||
|
lccProgCounter=progCounter;
|
||||||
|
return;
|
||||||
|
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
StringFormatter::send(stream,F("<LR>\n")); // Ready to rumble
|
|
||||||
opcode=0;
|
|
||||||
break;
|
|
||||||
}
|
}
|
||||||
if (paramCount==1) { // <L eventid> LCC event arrived from adapter
|
if (paramCount==1) { // <L eventid> LCC event arrived from adapter
|
||||||
int16_t eventid=p[0];
|
int16_t eventid=p[0];
|
||||||
|
@@ -75,7 +75,7 @@
|
|||||||
// Pass 1 Implements aliases
|
// Pass 1 Implements aliases
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
#undef ALIAS
|
#undef ALIAS
|
||||||
#define ALIAS(name,value...) const int name= 1##value##0 ==10 ? -__COUNTER__ : value##0/10;
|
#define ALIAS(name,value...) const int name= #value[0] ? value+0: -__COUNTER__ ;
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
|
|
||||||
// Pass 1d Detect sequence duplicates.
|
// Pass 1d Detect sequence duplicates.
|
||||||
@@ -189,6 +189,14 @@ bool exrailHalSetup() {
|
|||||||
#define LCCX(senderid,eventid) | FEATURE_LCC
|
#define LCCX(senderid,eventid) | FEATURE_LCC
|
||||||
#undef ONLCC
|
#undef ONLCC
|
||||||
#define ONLCC(senderid,eventid) | FEATURE_LCC
|
#define ONLCC(senderid,eventid) | FEATURE_LCC
|
||||||
|
#undef ACON
|
||||||
|
#define ACON(eventid) | FEATURE_LCC
|
||||||
|
#undef ACOF
|
||||||
|
#define ACOF(eventid) | FEATURE_LCC
|
||||||
|
#undef ONACON
|
||||||
|
#define ONACON(eventid) | FEATURE_LCC
|
||||||
|
#undef ONACOF
|
||||||
|
#define ONACOF(eventid) | FEATURE_LCC
|
||||||
#undef ROUTE_ACTIVE
|
#undef ROUTE_ACTIVE
|
||||||
#define ROUTE_ACTIVE(id) | FEATURE_ROUTESTATE
|
#define ROUTE_ACTIVE(id) | FEATURE_ROUTESTATE
|
||||||
#undef ROUTE_INACTIVE
|
#undef ROUTE_INACTIVE
|
||||||
@@ -429,10 +437,14 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
|||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
0,0,0,0 };
|
0,0,0,0 };
|
||||||
|
|
||||||
// Pass 9 ONLCC counter and lookup array
|
// Pass 9 ONLCC/ ONMERG counter and lookup array
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
#undef ONLCC
|
#undef ONLCC
|
||||||
#define ONLCC(sender,event) +1
|
#define ONLCC(sender,event) +1
|
||||||
|
#undef ONACON
|
||||||
|
#define ONACON(event) +1
|
||||||
|
#undef ONACOF
|
||||||
|
#define ONACOF(event) +1
|
||||||
|
|
||||||
const int RMFT2::countLCCLookup=0
|
const int RMFT2::countLCCLookup=0
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
@@ -451,7 +463,7 @@ int RMFT2::onLCCLookup[RMFT2::countLCCLookup];
|
|||||||
|
|
||||||
#define ACTIVATE(addr,subaddr) OPCODE_DCCACTIVATE,V(addr<<3 | subaddr<<1 | 1),
|
#define ACTIVATE(addr,subaddr) OPCODE_DCCACTIVATE,V(addr<<3 | subaddr<<1 | 1),
|
||||||
#define ACTIVATEL(addr) OPCODE_DCCACTIVATE,V((addr+3)<<1 | 1),
|
#define ACTIVATEL(addr) OPCODE_DCCACTIVATE,V((addr+3)<<1 | 1),
|
||||||
#define AFTER(sensor_id) OPCODE_AT,V(sensor_id),OPCODE_AFTER,V(sensor_id),
|
#define AFTER(sensor_id,timer...) OPCODE_AT,V(sensor_id),OPCODE_AFTER,V(sensor_id),OPCODE_PAD,V(#timer[0]?timer+0:500),
|
||||||
#define AFTEROVERLOAD(track_id) OPCODE_AFTEROVERLOAD,V(TRACK_NUMBER_##track_id),
|
#define AFTEROVERLOAD(track_id) OPCODE_AFTEROVERLOAD,V(TRACK_NUMBER_##track_id),
|
||||||
#define ALIAS(name,value...)
|
#define ALIAS(name,value...)
|
||||||
#define AMBER(signal_id) OPCODE_AMBER,V(signal_id),
|
#define AMBER(signal_id) OPCODE_AMBER,V(signal_id),
|
||||||
@@ -529,6 +541,10 @@ int RMFT2::onLCCLookup[RMFT2::countLCCLookup];
|
|||||||
OPCODE_PAD,V((((uint64_t)sender)>>32)&0xFFFF),\
|
OPCODE_PAD,V((((uint64_t)sender)>>32)&0xFFFF),\
|
||||||
OPCODE_PAD,V((((uint64_t)sender)>>16)&0xFFFF),\
|
OPCODE_PAD,V((((uint64_t)sender)>>16)&0xFFFF),\
|
||||||
OPCODE_PAD,V((((uint64_t)sender)>>0)&0xFFFF),
|
OPCODE_PAD,V((((uint64_t)sender)>>0)&0xFFFF),
|
||||||
|
#define ACON(eventid) OPCODE_ACON,V(((uint32_t)eventid >>16) & 0xFFFF),OPCODE_PAD,V(eventid & 0xFFFF),
|
||||||
|
#define ACOF(eventid) OPCODE_ACOF,V(((uint32_t)eventid >>16) & 0xFFFF),OPCODE_PAD,V(eventid & 0xFFFF),
|
||||||
|
#define ONACON(eventid) OPCODE_ONACON,V((uint32_t)(eventid) >>16),OPCODE_PAD,V(eventid & 0xFFFF),
|
||||||
|
#define ONACOF(eventid) OPCODE_ONACOF,V((uint32_t)(eventid) >>16),OPCODE_PAD,V(eventid & 0xFFFF),
|
||||||
#define LCD(id,msg) PRINT(msg)
|
#define LCD(id,msg) PRINT(msg)
|
||||||
#define SCREEN(display,id,msg) PRINT(msg)
|
#define SCREEN(display,id,msg) PRINT(msg)
|
||||||
#define STEALTH(code...) PRINT(dummy)
|
#define STEALTH(code...) PRINT(dummy)
|
||||||
@@ -604,7 +620,7 @@ int RMFT2::onLCCLookup[RMFT2::countLCCLookup];
|
|||||||
#define SET_TRACK(track,mode) OPCODE_SET_TRACK,V(TRACK_MODE_##mode <<8 | TRACK_NUMBER_##track),
|
#define SET_TRACK(track,mode) OPCODE_SET_TRACK,V(TRACK_MODE_##mode <<8 | TRACK_NUMBER_##track),
|
||||||
#define SET_POWER(track,onoff) OPCODE_SET_POWER,V(TRACK_POWER_##onoff),OPCODE_PAD, V(TRACK_NUMBER_##track),
|
#define SET_POWER(track,onoff) OPCODE_SET_POWER,V(TRACK_POWER_##onoff),OPCODE_PAD, V(TRACK_NUMBER_##track),
|
||||||
#define SETLOCO(loco) OPCODE_SETLOCO,V(loco),
|
#define SETLOCO(loco) OPCODE_SETLOCO,V(loco),
|
||||||
#define SETFREQ(loco,freq) OPCODE_SETLOCO,V(loco), OPCODE_SETFREQ,V(freq),
|
#define SETFREQ(freq) OPCODE_SETFREQ,V(freq),
|
||||||
#define SIGNAL(redpin,amberpin,greenpin)
|
#define SIGNAL(redpin,amberpin,greenpin)
|
||||||
#define SIGNALH(redpin,amberpin,greenpin)
|
#define SIGNALH(redpin,amberpin,greenpin)
|
||||||
#define SPEED(speed) OPCODE_SPEED,V(speed),
|
#define SPEED(speed) OPCODE_SPEED,V(speed),
|
||||||
|
@@ -29,77 +29,98 @@
|
|||||||
#include "CommandDistributor.h"
|
#include "CommandDistributor.h"
|
||||||
#include "WiThrottle.h"
|
#include "WiThrottle.h"
|
||||||
#include "DCCTimer.h"
|
#include "DCCTimer.h"
|
||||||
|
#if __has_include ( "MDNS_Generic.h")
|
||||||
|
#include "MDNS_Generic.h"
|
||||||
|
#define DO_MDNS
|
||||||
|
EthernetUDP udp;
|
||||||
|
MDNS mdns(udp);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
extern void looptimer(unsigned long timeout, const FSH* message);
|
||||||
|
|
||||||
|
bool EthernetInterface::connected=false;
|
||||||
|
EthernetServer * EthernetInterface::server= nullptr;
|
||||||
|
EthernetClient EthernetInterface::clients[MAX_SOCK_NUM]; // accept up to MAX_SOCK_NUM client connections at the same time; This depends on the chipset used on the Shield
|
||||||
|
uint8_t EthernetInterface::buffer[MAX_ETH_BUFFER+1]; // buffer used by TCP for the recv
|
||||||
|
RingStream * EthernetInterface::outboundRing = nullptr;
|
||||||
|
|
||||||
EthernetInterface * EthernetInterface::singleton=NULL;
|
|
||||||
/**
|
/**
|
||||||
* @brief Setup Ethernet Connection
|
* @brief Setup Ethernet Connection
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
void EthernetInterface::setup()
|
|
||||||
|
void EthernetInterface::setup() // STM32 VERSION
|
||||||
{
|
{
|
||||||
if (singleton!=NULL) {
|
DIAG(F("Ethernet begin"
|
||||||
DIAG(F("Prog Error!"));
|
#ifdef DO_MDNS
|
||||||
return;
|
" with mDNS"
|
||||||
}
|
#endif
|
||||||
if ((singleton=new EthernetInterface()))
|
));
|
||||||
return;
|
|
||||||
DIAG(F("Ethernet not initialized"));
|
#ifdef STM32_ETHERNET
|
||||||
};
|
// Set a HOSTNAME for the DHCP request - a nice to have, but hard it seems on LWIP for STM32
|
||||||
|
// The default is "lwip", which is **always** set in STM32Ethernet/src/utility/ethernetif.cpp
|
||||||
|
// for some reason. One can edit it to instead read:
|
||||||
#ifdef IP_ADDRESS
|
// #if LWIP_NETIF_HOSTNAME
|
||||||
static IPAddress myIP(IP_ADDRESS);
|
// /* Initialize interface hostname */
|
||||||
|
// if (netif->hostname == NULL)
|
||||||
|
// netif->hostname = "lwip";
|
||||||
|
// #endif /* LWIP_NETIF_HOSTNAME */
|
||||||
|
// Which seems more useful! We should propose the patch... so the following line actually works!
|
||||||
|
netif_set_hostname(&gnetif, WIFI_HOSTNAME); // Should probably be passed in the contructor...
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief Aquire IP Address from DHCP and start server
|
|
||||||
*
|
|
||||||
* @return true
|
|
||||||
* @return false
|
|
||||||
*/
|
|
||||||
EthernetInterface::EthernetInterface()
|
|
||||||
{
|
|
||||||
byte mac[6];
|
byte mac[6];
|
||||||
DCCTimer::getSimulatedMacAddress(mac);
|
DCCTimer::getSimulatedMacAddress(mac);
|
||||||
connected=false;
|
#define _MAC_ mac
|
||||||
|
|
||||||
#ifdef IP_ADDRESS
|
|
||||||
Ethernet.begin(mac, myIP);
|
|
||||||
#else
|
|
||||||
if (Ethernet.begin(mac) == 0)
|
|
||||||
{
|
|
||||||
DIAG(F("Ethernet.begin FAILED"));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
if (Ethernet.hardwareStatus() == EthernetNoHardware) {
|
|
||||||
DIAG(F("Ethernet shield not found or W5100"));
|
|
||||||
}
|
|
||||||
|
|
||||||
unsigned long startmilli = millis();
|
#ifdef IP_ADDRESS
|
||||||
while ((millis() - startmilli) < 5500) { // Loop to give time to check for cable connection
|
static IPAddress myIP(IP_ADDRESS);
|
||||||
if (Ethernet.linkStatus() == LinkON)
|
Ethernet.begin(_MAC_,myIP);
|
||||||
break;
|
setup(false);
|
||||||
DIAG(F("Ethernet waiting for link (1sec) "));
|
#else
|
||||||
delay(1000);
|
if (Ethernet.begin(_MAC_)==0)
|
||||||
}
|
{
|
||||||
// now we either do have link of we have a W5100
|
LCD(4,F("IP: No DHCP"));
|
||||||
// where we do not know if we have link. That's
|
return;
|
||||||
// the reason to now run checkLink.
|
}
|
||||||
// CheckLinks sets up outboundRing if it does
|
#endif
|
||||||
// not exist yet as well.
|
|
||||||
checkLink();
|
auto ip = Ethernet.localIP(); // look what IP was obtained (dynamic or static)
|
||||||
|
if (!ip) {
|
||||||
|
LCD(4,F("IP: None"));
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
server = new EthernetServer(IP_PORT); // Ethernet Server listening on default port IP_PORT
|
||||||
|
server->begin();
|
||||||
|
|
||||||
|
// Arrange display of IP address and port
|
||||||
|
#ifdef LCD_DRIVER
|
||||||
|
const byte lcdData[]={LCD_DRIVER};
|
||||||
|
const bool wideDisplay=lcdData[1]>=24; // data[1] is cols.
|
||||||
|
#else
|
||||||
|
const bool wideDisplay=true;
|
||||||
|
#endif
|
||||||
|
if (wideDisplay) {
|
||||||
|
// OLEDS or just usb diag is ok on one line.
|
||||||
|
LCD(4,F("IP %d.%d.%d.%d:%d"), ip[0], ip[1], ip[2], ip[3], IP_PORT);
|
||||||
|
}
|
||||||
|
else { // LCDs generally too narrow, so take 2 lines
|
||||||
|
LCD(4,F("IP %d.%d.%d.%d"), ip[0], ip[1], ip[2], ip[3]);
|
||||||
|
LCD(5,F("Port %d"), IP_PORT);
|
||||||
|
}
|
||||||
|
|
||||||
|
outboundRing=new RingStream(OUTBOUND_RING_SIZE);
|
||||||
|
#ifdef DO_MDNS
|
||||||
|
mdns.begin(Ethernet.localIP(), WIFI_HOSTNAME); // hostname
|
||||||
|
mdns.addServiceRecord(WIFI_HOSTNAME "._withrottle", IP_PORT, MDNSServiceTCP);
|
||||||
|
// Not sure if we need to run it once, but just in case!
|
||||||
|
mdns.run();
|
||||||
|
#endif
|
||||||
|
connected=true;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief Cleanup any resources
|
|
||||||
*
|
|
||||||
* @return none
|
|
||||||
*/
|
|
||||||
EthernetInterface::~EthernetInterface() {
|
|
||||||
delete server;
|
|
||||||
delete outboundRing;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Main loop for the EthernetInterface
|
* @brief Main loop for the EthernetInterface
|
||||||
@@ -107,134 +128,138 @@ EthernetInterface::~EthernetInterface() {
|
|||||||
*/
|
*/
|
||||||
void EthernetInterface::loop()
|
void EthernetInterface::loop()
|
||||||
{
|
{
|
||||||
if (!singleton || (!singleton->checkLink()))
|
if (!connected) return;
|
||||||
return;
|
looptimer(5000, F("E.loop"));
|
||||||
|
|
||||||
|
static bool warnedAboutLink=false;
|
||||||
|
if (Ethernet.linkStatus() == LinkOFF){
|
||||||
|
if (warnedAboutLink) return;
|
||||||
|
DIAG(F("Ethernet link OFF"));
|
||||||
|
warnedAboutLink=true;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
looptimer(5000, F("E.loop warn"));
|
||||||
|
|
||||||
|
// link status must be ok here
|
||||||
|
if (warnedAboutLink) {
|
||||||
|
DIAG(F("Ethernet link RESTORED"));
|
||||||
|
warnedAboutLink=false;
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef DO_MDNS
|
||||||
|
// Always do this because we don't want traffic to intefere with being found!
|
||||||
|
mdns.run();
|
||||||
|
looptimer(5000, F("E.mdns"));
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
//
|
||||||
switch (Ethernet.maintain()) {
|
switch (Ethernet.maintain()) {
|
||||||
case 1:
|
case 1:
|
||||||
//renewed fail
|
//renewed fail
|
||||||
DIAG(F("Ethernet Error: renewed fail"));
|
DIAG(F("Ethernet Error: renewed fail"));
|
||||||
singleton=NULL;
|
connected=false;
|
||||||
return;
|
return;
|
||||||
case 3:
|
case 3:
|
||||||
//rebind fail
|
//rebind fail
|
||||||
DIAG(F("Ethernet Error: rebind fail"));
|
DIAG(F("Ethernet Error: rebind fail"));
|
||||||
singleton=NULL;
|
connected=false;
|
||||||
return;
|
return;
|
||||||
default:
|
default:
|
||||||
//nothing happened
|
//nothing happened
|
||||||
|
//DIAG(F("maintained"));
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
singleton->loop2();
|
looptimer(5000, F("E.maintain"));
|
||||||
}
|
|
||||||
|
// get client from the server
|
||||||
/**
|
#if defined (STM32_ETHERNET)
|
||||||
* @brief Checks ethernet link cable status and detects when it connects / disconnects
|
// STM32Ethernet doesn't use accept(), just available()
|
||||||
*
|
auto client = server->available();
|
||||||
* @return true when cable is connected, false otherwise
|
if (client) {
|
||||||
*/
|
// check for new client
|
||||||
bool EthernetInterface::checkLink() {
|
byte socket;
|
||||||
if (Ethernet.linkStatus() != LinkOFF) { // check for not linkOFF instead of linkON as the W5100 does return LinkUnknown
|
bool sockFound = false;
|
||||||
//if we are not connected yet, setup a new server
|
for (socket = 0; socket < MAX_SOCK_NUM; socket++)
|
||||||
if(!connected) {
|
{
|
||||||
DIAG(F("Ethernet cable connected"));
|
if (client == clients[socket])
|
||||||
connected=true;
|
{
|
||||||
#ifdef IP_ADDRESS
|
sockFound = true;
|
||||||
Ethernet.setLocalIP(myIP); // for static IP, set it again
|
break;
|
||||||
#endif
|
}
|
||||||
IPAddress ip = Ethernet.localIP(); // look what IP was obtained (dynamic or static)
|
}
|
||||||
server = new EthernetServer(IP_PORT); // Ethernet Server listening on default port IP_PORT
|
if (!sockFound)
|
||||||
server->begin();
|
{ // new client
|
||||||
LCD(4,F("IP: %d.%d.%d.%d"), ip[0], ip[1], ip[2], ip[3]);
|
|
||||||
LCD(5,F("Port:%d"), IP_PORT);
|
|
||||||
// only create a outboundRing it none exists, this may happen if the cable
|
|
||||||
// gets disconnected and connected again
|
|
||||||
if(!outboundRing)
|
|
||||||
outboundRing=new RingStream(OUTBOUND_RING_SIZE);
|
|
||||||
}
|
|
||||||
return true;
|
|
||||||
} else { // connected
|
|
||||||
DIAG(F("Ethernet cable disconnected"));
|
|
||||||
connected=false;
|
|
||||||
//clean up any client
|
|
||||||
for (byte socket = 0; socket < MAX_SOCK_NUM; socket++) {
|
|
||||||
if(clients[socket].connected())
|
|
||||||
clients[socket].stop();
|
|
||||||
}
|
|
||||||
// tear down server
|
|
||||||
delete server;
|
|
||||||
server = nullptr;
|
|
||||||
LCD(4,F("IP: None"));
|
|
||||||
}
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
void EthernetInterface::loop2() {
|
|
||||||
if (!outboundRing) { // no idea to call loop2() if we can't handle outgoing data in it
|
|
||||||
if (Diag::ETHERNET) DIAG(F("No outboundRing"));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
// get client from the server
|
|
||||||
EthernetClient client = server->accept();
|
|
||||||
|
|
||||||
// check for new client
|
|
||||||
if (client)
|
|
||||||
{
|
|
||||||
if (Diag::ETHERNET) DIAG(F("Ethernet: New client "));
|
|
||||||
byte socket;
|
|
||||||
for (socket = 0; socket < MAX_SOCK_NUM; socket++)
|
for (socket = 0; socket < MAX_SOCK_NUM; socket++)
|
||||||
{
|
{
|
||||||
if (!clients[socket])
|
if (!clients[socket])
|
||||||
{
|
{
|
||||||
// On accept() the EthernetServer doesn't track the client anymore
|
clients[socket] = client;
|
||||||
// so we store it in our client array
|
sockFound=true;
|
||||||
if (Diag::ETHERNET) DIAG(F("Socket %d"),socket);
|
if (Diag::ETHERNET)
|
||||||
clients[socket] = client;
|
DIAG(F("Ethernet: New client socket %d"), socket);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
if (socket==MAX_SOCK_NUM) DIAG(F("new Ethernet OVERFLOW"));
|
}
|
||||||
|
if (!sockFound) DIAG(F("new Ethernet OVERFLOW"));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#else
|
||||||
|
auto client = server->accept();
|
||||||
|
if (client) clients[client.getSocketNumber()]=client;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
// check for incoming data from all possible clients
|
// check for incoming data from all possible clients
|
||||||
for (byte socket = 0; socket < MAX_SOCK_NUM; socket++)
|
for (byte socket = 0; socket < MAX_SOCK_NUM; socket++)
|
||||||
{
|
{
|
||||||
if (clients[socket]) {
|
if (!clients[socket]) continue; // socket is not in use
|
||||||
|
|
||||||
int available=clients[socket].available();
|
// read any bytes from this client
|
||||||
if (available > 0) {
|
auto count = clients[socket].read(buffer, MAX_ETH_BUFFER);
|
||||||
if (Diag::ETHERNET) DIAG(F("Ethernet: available socket=%d,avail=%d"), socket, available);
|
|
||||||
// read bytes from a client
|
if (count<0) continue; // -1 indicates nothing to read
|
||||||
int count = clients[socket].read(buffer, MAX_ETH_BUFFER);
|
|
||||||
buffer[count] = '\0'; // terminate the string properly
|
if (count > 0) { // we have incoming data
|
||||||
if (Diag::ETHERNET) DIAG(F(",count=%d:%e"), socket,buffer);
|
buffer[count] = '\0'; // terminate the string properly
|
||||||
// execute with data going directly back
|
if (Diag::ETHERNET) DIAG(F("Ethernet s=%d, c=%d b=:%e"), socket, count, buffer);
|
||||||
CommandDistributor::parse(socket,buffer,outboundRing);
|
// execute with data going directly back
|
||||||
return; // limit the amount of processing that takes place within 1 loop() cycle.
|
CommandDistributor::parse(socket,buffer,outboundRing);
|
||||||
}
|
//looptimer(5000, F("Ethloop2 parse"));
|
||||||
}
|
return; // limit the amount of processing that takes place within 1 loop() cycle.
|
||||||
}
|
}
|
||||||
|
|
||||||
// stop any clients which disconnect
|
// count=0 The client has disconnected
|
||||||
for (int socket = 0; socket<MAX_SOCK_NUM; socket++) {
|
clients[socket].stop();
|
||||||
if (clients[socket] && !clients[socket].connected()) {
|
CommandDistributor::forget(socket);
|
||||||
clients[socket].stop();
|
if (Diag::ETHERNET) DIAG(F("Ethernet: disconnect %d "), socket);
|
||||||
CommandDistributor::forget(socket);
|
}
|
||||||
if (Diag::ETHERNET) DIAG(F("Ethernet: disconnect %d "), socket);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
WiThrottle::loop(outboundRing);
|
WiThrottle::loop(outboundRing);
|
||||||
|
|
||||||
// handle at most 1 outbound transmission
|
// handle at most 1 outbound transmission
|
||||||
int socketOut=outboundRing->read();
|
auto socketOut=outboundRing->read();
|
||||||
|
if (socketOut<0) return; // no outbound pending
|
||||||
|
|
||||||
if (socketOut >= MAX_SOCK_NUM) {
|
if (socketOut >= MAX_SOCK_NUM) {
|
||||||
DIAG(F("Ethernet outboundRing socket=%d error"), socketOut);
|
// This is a catastrophic code failure and unrecoverable.
|
||||||
} else if (socketOut >= 0) {
|
DIAG(F("Ethernet outboundRing s=%d error"), socketOut);
|
||||||
int count=outboundRing->count();
|
connected=false;
|
||||||
if (Diag::ETHERNET) DIAG(F("Ethernet reply socket=%d, count=:%d"), socketOut,count);
|
return;
|
||||||
for(;count>0;count--) clients[socketOut].write(outboundRing->read());
|
}
|
||||||
clients[socketOut].flush(); //maybe
|
|
||||||
|
auto count=outboundRing->count();
|
||||||
|
{
|
||||||
|
char tmpbuf[count+1]; // one extra for '\0'
|
||||||
|
for(int i=0;i<count;i++) {
|
||||||
|
tmpbuf[i] = outboundRing->read();
|
||||||
|
}
|
||||||
|
tmpbuf[count]=0;
|
||||||
|
if (Diag::ETHERNET) DIAG(F("Ethernet reply s=%d, c=%d, b:%e"),
|
||||||
|
socketOut,count,tmpbuf);
|
||||||
|
clients[socketOut].write(tmpbuf,count);
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
@@ -35,6 +35,14 @@
|
|||||||
#if defined (ARDUINO_TEENSY41)
|
#if defined (ARDUINO_TEENSY41)
|
||||||
#include <NativeEthernet.h> //TEENSY Ethernet Treiber
|
#include <NativeEthernet.h> //TEENSY Ethernet Treiber
|
||||||
#include <NativeEthernetUdp.h>
|
#include <NativeEthernetUdp.h>
|
||||||
|
#elif defined (ARDUINO_NUCLEO_F429ZI) || defined (ARDUINO_NUCLEO_F439ZI) || defined (ARDUINO_NUCLEO_F4X9ZI)
|
||||||
|
#include <LwIP.h>
|
||||||
|
// #include "STM32lwipopts.h"
|
||||||
|
#include <STM32Ethernet.h>
|
||||||
|
#include <lwip/netif.h>
|
||||||
|
extern "C" struct netif gnetif;
|
||||||
|
#define STM32_ETHERNET
|
||||||
|
#define MAX_SOCK_NUM 8
|
||||||
#else
|
#else
|
||||||
#include "Ethernet.h"
|
#include "Ethernet.h"
|
||||||
#endif
|
#endif
|
||||||
@@ -45,7 +53,7 @@
|
|||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#define MAX_ETH_BUFFER 512
|
#define MAX_ETH_BUFFER 128
|
||||||
#define OUTBOUND_RING_SIZE 2048
|
#define OUTBOUND_RING_SIZE 2048
|
||||||
|
|
||||||
class EthernetInterface {
|
class EthernetInterface {
|
||||||
@@ -56,16 +64,11 @@ class EthernetInterface {
|
|||||||
static void loop();
|
static void loop();
|
||||||
|
|
||||||
private:
|
private:
|
||||||
static EthernetInterface * singleton;
|
static bool connected;
|
||||||
bool connected;
|
static EthernetServer * server;
|
||||||
EthernetInterface();
|
static EthernetClient clients[MAX_SOCK_NUM]; // accept up to MAX_SOCK_NUM client connections at the same time; This depends on the chipset used on the Shield
|
||||||
~EthernetInterface();
|
static uint8_t buffer[MAX_ETH_BUFFER+1]; // buffer used by TCP for the recv
|
||||||
void loop2();
|
static RingStream * outboundRing;
|
||||||
bool checkLink();
|
|
||||||
EthernetServer * server = NULL;
|
|
||||||
EthernetClient clients[MAX_SOCK_NUM]; // accept up to MAX_SOCK_NUM client connections at the same time; This depends on the chipset used on the Shield
|
|
||||||
uint8_t buffer[MAX_ETH_BUFFER+1]; // buffer used by TCP for the recv
|
|
||||||
RingStream * outboundRing = NULL;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
@@ -1 +1 @@
|
|||||||
#define GITHUB_SHA "devel-202404211704Z"
|
#define GITHUB_SHA "devel-fozzie-202408172108Z"
|
||||||
|
@@ -547,6 +547,6 @@ protected:
|
|||||||
#include "IO_duinoNodes.h"
|
#include "IO_duinoNodes.h"
|
||||||
#include "IO_EXIOExpander.h"
|
#include "IO_EXIOExpander.h"
|
||||||
#include "IO_trainbrains.h"
|
#include "IO_trainbrains.h"
|
||||||
|
#include "IO_EncoderThrottle.h"
|
||||||
|
|
||||||
#endif // iodevice_h
|
#endif // iodevice_h
|
||||||
|
144
IO_EncoderThrottle.cpp
Normal file
144
IO_EncoderThrottle.cpp
Normal file
@@ -0,0 +1,144 @@
|
|||||||
|
/*
|
||||||
|
* © 2024, Chris Harlow. All rights reserved.
|
||||||
|
*
|
||||||
|
* This file is part of EX-CommandStation
|
||||||
|
*
|
||||||
|
* This is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* It is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
* GNU General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The IO_EncoderThrottle device driver uses a rotary encoder connected to vpins
|
||||||
|
* to drive a loco.
|
||||||
|
* Loco id is selected by writeAnalog.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "IODevice.h"
|
||||||
|
#include "DIAG.h"
|
||||||
|
#include "DCC.h"
|
||||||
|
|
||||||
|
const byte _DIR_CW = 0x10; // Clockwise step
|
||||||
|
const byte _DIR_CCW = 0x20; // Counter-clockwise step
|
||||||
|
|
||||||
|
const byte transition_table[5][4]= {
|
||||||
|
{0,1,3,0}, // 0: 00
|
||||||
|
{1,1,1,2 | _DIR_CW}, // 1: 00->01
|
||||||
|
{2,2,0,2}, // 2: 00->01->11
|
||||||
|
{3,3,3,4 | _DIR_CCW}, // 3: 00->10
|
||||||
|
{4,0,4,4} // 4: 00->10->11
|
||||||
|
};
|
||||||
|
|
||||||
|
const byte _STATE_MASK = 0x07;
|
||||||
|
const byte _DIR_MASK = 0x30;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void EncoderThrottle::create(VPIN firstVpin, int dtPin, int clkPin, int clickPin, byte notch) {
|
||||||
|
if (checkNoOverlap(firstVpin)) new EncoderThrottle(firstVpin, dtPin,clkPin,clickPin,notch);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Constructor
|
||||||
|
EncoderThrottle::EncoderThrottle(VPIN firstVpin, int dtPin, int clkPin, int clickPin, byte notch){
|
||||||
|
_firstVpin = firstVpin;
|
||||||
|
_nPins = 1;
|
||||||
|
_I2CAddress = 0;
|
||||||
|
_dtPin=dtPin;
|
||||||
|
_clkPin=clkPin;
|
||||||
|
_clickPin=clickPin;
|
||||||
|
_notch=notch;
|
||||||
|
_locoid=0;
|
||||||
|
_stopState=xrSTOP;
|
||||||
|
_rocoState=0;
|
||||||
|
_prevpinstate=4; // not 01..11
|
||||||
|
IODevice::configureInput(dtPin,true);
|
||||||
|
IODevice::configureInput(clkPin,true);
|
||||||
|
IODevice::configureInput(clickPin,true);
|
||||||
|
addDevice(this);
|
||||||
|
_display();
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void EncoderThrottle::_loop(unsigned long currentMicros) {
|
||||||
|
if (_locoid==0) return; // not in use
|
||||||
|
|
||||||
|
// Clicking down on the roco, stops the loco and sets the direction as unknown.
|
||||||
|
if (IODevice::read(_clickPin)) {
|
||||||
|
if (_stopState==xrSTOP) return; // debounced multiple stops
|
||||||
|
DCC::setThrottle(_locoid,1,DCC::getThrottleDirection(_locoid));
|
||||||
|
_stopState=xrSTOP;
|
||||||
|
DIAG(F("DRIVE %d STOP"),_locoid);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// read roco pins and detect state change
|
||||||
|
byte pinstate = (IODevice::read(_dtPin) << 1) | IODevice::read(_clkPin);
|
||||||
|
if (pinstate==_prevpinstate) return;
|
||||||
|
_prevpinstate=pinstate;
|
||||||
|
|
||||||
|
_rocoState = transition_table[_rocoState & _STATE_MASK][pinstate];
|
||||||
|
if ((_rocoState & _DIR_MASK) == 0) return; // no value change
|
||||||
|
|
||||||
|
int change=(_rocoState & _DIR_CW)?+1:-1;
|
||||||
|
// handle roco change -1 or +1 (clockwise)
|
||||||
|
|
||||||
|
if (_stopState==xrSTOP) {
|
||||||
|
// first move after button press sets the direction. (clockwise=fwd)
|
||||||
|
_stopState=change>0?xrFWD:xrREV;
|
||||||
|
}
|
||||||
|
|
||||||
|
// when going fwd, clockwise increases speed.
|
||||||
|
// but when reversing, anticlockwise increases speed.
|
||||||
|
// This is similar to a center-zero pot control but with
|
||||||
|
// the added safety that you cant panic-spin into the other
|
||||||
|
// direction.
|
||||||
|
if (_stopState==xrREV) change=-change;
|
||||||
|
// manage limits
|
||||||
|
int oldspeed=DCC::getThrottleSpeed(_locoid);
|
||||||
|
if (oldspeed==1)oldspeed=0; // break out of estop
|
||||||
|
int newspeed=change>0 ? (min((oldspeed+_notch),126)) : (max(0,(oldspeed-_notch)));
|
||||||
|
if (newspeed==1) newspeed=0; // normal decelereated stop.
|
||||||
|
if (oldspeed!=newspeed) {
|
||||||
|
DIAG(F("DRIVE %d notch %S %d %S"),_locoid,
|
||||||
|
change>0?F("UP"):F("DOWN"),_notch,
|
||||||
|
_stopState==xrFWD?F("FWD"):F("REV"));
|
||||||
|
DCC::setThrottle(_locoid,newspeed,_stopState==xrFWD);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// Selocoid as analog value to start drive
|
||||||
|
// use <z vpin locoid [notch]>
|
||||||
|
void EncoderThrottle::_writeAnalogue(VPIN vpin, int value, uint8_t param1, uint16_t param2) {
|
||||||
|
(void) param2;
|
||||||
|
_locoid=value;
|
||||||
|
if (param1>0) _notch=param1;
|
||||||
|
_rocoState=0;
|
||||||
|
|
||||||
|
// If loco is moving, we inherit direction from it.
|
||||||
|
_stopState=xrSTOP;
|
||||||
|
if (_locoid>0) {
|
||||||
|
auto speedbyte=DCC::getThrottleSpeedByte(_locoid);
|
||||||
|
if ((speedbyte & 0x7f) >1) {
|
||||||
|
// loco is moving
|
||||||
|
_stopState= (speedbyte & 0x80)?xrFWD:xrREV;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
_display();
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void EncoderThrottle::_display() {
|
||||||
|
DIAG(F("DRIVE vpin %d loco %d notch %d"),_firstVpin,_locoid,_notch);
|
||||||
|
}
|
||||||
|
|
53
IO_EncoderThrottle.h
Normal file
53
IO_EncoderThrottle.h
Normal file
@@ -0,0 +1,53 @@
|
|||||||
|
/*
|
||||||
|
* © 2024, Chris Harlow. All rights reserved.
|
||||||
|
*
|
||||||
|
* This file is part of EX-CommandStation
|
||||||
|
*
|
||||||
|
* This is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* It is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
* GNU General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The IO_EncoderThrottle device driver uses a rotary encoder connected to vpins
|
||||||
|
* to drive a loco.
|
||||||
|
* Loco id is selected by writeAnalog.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef IO_EncoderThrottle_H
|
||||||
|
#define IO_EncoderThrottle_H
|
||||||
|
#include "IODevice.h"
|
||||||
|
|
||||||
|
class EncoderThrottle : public IODevice {
|
||||||
|
public:
|
||||||
|
|
||||||
|
static void create(VPIN firstVpin, int dtPin, int clkPin, int clickPin, byte notch=10);
|
||||||
|
|
||||||
|
private:
|
||||||
|
int _dtPin,_clkPin,_clickPin, _locoid, _notch,_prevpinstate;
|
||||||
|
enum {xrSTOP,xrFWD,xrREV} _stopState;
|
||||||
|
byte _rocoState;
|
||||||
|
|
||||||
|
// Constructor
|
||||||
|
EncoderThrottle(VPIN firstVpin, int dtPin, int clkPin, int clickPin, byte notch);
|
||||||
|
|
||||||
|
void _loop(unsigned long currentMicros) override ;
|
||||||
|
|
||||||
|
// Selocoid as analog value to start drive
|
||||||
|
// use <z vpin locoid [notch]>
|
||||||
|
void _writeAnalogue(VPIN vpin, int value, uint8_t param1, uint16_t param2) override;
|
||||||
|
|
||||||
|
void _display() override ;
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
@@ -26,7 +26,7 @@
|
|||||||
Thus "MAIN"_hk generates exactly the same run time vakue
|
Thus "MAIN"_hk generates exactly the same run time vakue
|
||||||
as const int16_t HASH_KEYWORD_MAIN=11339
|
as const int16_t HASH_KEYWORD_MAIN=11339
|
||||||
*/
|
*/
|
||||||
#ifndef KeywordHAsher_h
|
#ifndef KeywordHasher_h
|
||||||
#define KeywordHasher_h
|
#define KeywordHasher_h
|
||||||
|
|
||||||
#include <Arduino.h>
|
#include <Arduino.h>
|
||||||
|
@@ -1,5 +1,6 @@
|
|||||||
/*
|
/*
|
||||||
* © 2022-2024 Paul M Antoine
|
* © 2022-2024 Paul M Antoine
|
||||||
|
* © 2024 Herb Morton
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2020-2023 Harald Barth
|
* © 2020-2023 Harald Barth
|
||||||
@@ -98,7 +99,7 @@ MotorDriver::MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, i
|
|||||||
if (HAVE_PORTH(fastSignalPin.inout == &PORTH)) {
|
if (HAVE_PORTH(fastSignalPin.inout == &PORTH)) {
|
||||||
DIAG(F("Found PORTH pin %d"),signalPin);
|
DIAG(F("Found PORTH pin %d"),signalPin);
|
||||||
fastSignalPin.shadowinout = fastSignalPin.inout;
|
fastSignalPin.shadowinout = fastSignalPin.inout;
|
||||||
fastSignalPin.inout = &shadowPORTF;
|
fastSignalPin.inout = &shadowPORTH;
|
||||||
}
|
}
|
||||||
|
|
||||||
signalPin2=signal_pin2;
|
signalPin2=signal_pin2;
|
||||||
@@ -638,6 +639,10 @@ void MotorDriver::checkPowerOverload(bool useProgLimit, byte trackno) {
|
|||||||
}
|
}
|
||||||
throttleInrush(false);
|
throttleInrush(false);
|
||||||
setPower(POWERMODE::ON);
|
setPower(POWERMODE::ON);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (goodtime > POWER_SAMPLE_ALERT_GOOD/2) {
|
||||||
|
throttleInrush(false);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
@@ -97,6 +97,18 @@
|
|||||||
new MotorDriver(25/* 3*/, 19/*12*/, UNUSED_PIN, 13/*9*/, 35/*A2*/, 1.27, 5000, 36 /*A4*/), \
|
new MotorDriver(25/* 3*/, 19/*12*/, UNUSED_PIN, 13/*9*/, 35/*A2*/, 1.27, 5000, 36 /*A4*/), \
|
||||||
new MotorDriver(23/*11*/, 18/*13*/, UNUSED_PIN, 12/*8*/, 34/*A3*/, 1.27, 5000, 39 /*A5*/)
|
new MotorDriver(23/*11*/, 18/*13*/, UNUSED_PIN, 12/*8*/, 34/*A3*/, 1.27, 5000, 39 /*A5*/)
|
||||||
|
|
||||||
|
// EX-CSB1 with integrated motor driver definition
|
||||||
|
#define EXCSB1 F("EXCSB1"),\
|
||||||
|
new MotorDriver(25, 0, UNUSED_PIN, -14, 34, 2.23, 5000, 19), \
|
||||||
|
new MotorDriver(27, 15, UNUSED_PIN, -2, 35, 2.23, 5000, 23)
|
||||||
|
|
||||||
|
// EX-CSB1 with EX-8874 stacked on top for 4 outputs
|
||||||
|
#define EXCSB1_WITH_EX8874 F("EXCSB1_WITH_EX8874"),\
|
||||||
|
new MotorDriver(25, 0, UNUSED_PIN, -14, 34, 2.23, 5000, 19), \
|
||||||
|
new MotorDriver(27, 15, UNUSED_PIN, -2, 35, 2.23, 5000, 23), \
|
||||||
|
new MotorDriver(26, 5, UNUSED_PIN, 13, 36, 1.52, 5000, 18), \
|
||||||
|
new MotorDriver(16, 4, UNUSED_PIN, 12, 39, 1.52, 5000, 17)
|
||||||
|
|
||||||
#else
|
#else
|
||||||
// STANDARD shield on any Arduino Uno or Mega compatible with the original specification.
|
// STANDARD shield on any Arduino Uno or Mega compatible with the original specification.
|
||||||
#define STANDARD_MOTOR_SHIELD F("STANDARD_MOTOR_SHIELD"), \
|
#define STANDARD_MOTOR_SHIELD F("STANDARD_MOTOR_SHIELD"), \
|
||||||
|
@@ -139,6 +139,7 @@ void StringFormatter::send2(Print * stream,const FSH* format, va_list args) {
|
|||||||
case 'd': printPadded(stream,va_arg(args, int), formatWidth, formatLeft); break;
|
case 'd': printPadded(stream,va_arg(args, int), formatWidth, formatLeft); break;
|
||||||
case 'u': printPadded(stream,va_arg(args, unsigned int), formatWidth, formatLeft); break;
|
case 'u': printPadded(stream,va_arg(args, unsigned int), formatWidth, formatLeft); break;
|
||||||
case 'l': printPadded(stream,va_arg(args, long), formatWidth, formatLeft); break;
|
case 'l': printPadded(stream,va_arg(args, long), formatWidth, formatLeft); break;
|
||||||
|
case 'L': stream->print(va_arg(args, unsigned long), DEC); break;
|
||||||
case 'b': stream->print(va_arg(args, int), BIN); break;
|
case 'b': stream->print(va_arg(args, int), BIN); break;
|
||||||
case 'o': stream->print(va_arg(args, int), OCT); break;
|
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 int)va_arg(args, unsigned int), HEX); break;
|
||||||
|
@@ -1,6 +1,8 @@
|
|||||||
/*
|
/*
|
||||||
* © 2022 Chris Harlow
|
* © 2022 Chris Harlow
|
||||||
* © 2022-2024 Harald Barth
|
* © 2022-2024 Harald Barth
|
||||||
|
* © 2023-2024 Paul M. Antoine
|
||||||
|
* © 2024 Herb Morton
|
||||||
* © 2023 Colin Murdoch
|
* © 2023 Colin Murdoch
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
@@ -35,7 +37,7 @@
|
|||||||
|
|
||||||
#define APPLY_BY_MODE(findmode,function) \
|
#define APPLY_BY_MODE(findmode,function) \
|
||||||
FOR_EACH_TRACK(t) \
|
FOR_EACH_TRACK(t) \
|
||||||
if (track[t]->getMode()==findmode) \
|
if (track[t]->getMode() & findmode) \
|
||||||
track[t]->function;
|
track[t]->function;
|
||||||
|
|
||||||
MotorDriver * TrackManager::track[MAX_TRACKS] = { NULL };
|
MotorDriver * TrackManager::track[MAX_TRACKS] = { NULL };
|
||||||
@@ -149,6 +151,8 @@ void TrackManager::setDCCSignal( bool on) {
|
|||||||
HAVE_PORTD(shadowPORTD=PORTD);
|
HAVE_PORTD(shadowPORTD=PORTD);
|
||||||
HAVE_PORTE(shadowPORTE=PORTE);
|
HAVE_PORTE(shadowPORTE=PORTE);
|
||||||
HAVE_PORTF(shadowPORTF=PORTF);
|
HAVE_PORTF(shadowPORTF=PORTF);
|
||||||
|
HAVE_PORTG(shadowPORTF=PORTG);
|
||||||
|
HAVE_PORTH(shadowPORTF=PORTH);
|
||||||
APPLY_BY_MODE(TRACK_MODE_MAIN,setSignal(on));
|
APPLY_BY_MODE(TRACK_MODE_MAIN,setSignal(on));
|
||||||
HAVE_PORTA(PORTA=shadowPORTA);
|
HAVE_PORTA(PORTA=shadowPORTA);
|
||||||
HAVE_PORTB(PORTB=shadowPORTB);
|
HAVE_PORTB(PORTB=shadowPORTB);
|
||||||
@@ -156,6 +160,8 @@ void TrackManager::setDCCSignal( bool on) {
|
|||||||
HAVE_PORTD(PORTD=shadowPORTD);
|
HAVE_PORTD(PORTD=shadowPORTD);
|
||||||
HAVE_PORTE(PORTE=shadowPORTE);
|
HAVE_PORTE(PORTE=shadowPORTE);
|
||||||
HAVE_PORTF(PORTF=shadowPORTF);
|
HAVE_PORTF(PORTF=shadowPORTF);
|
||||||
|
HAVE_PORTG(shadowPORTF=PORTG);
|
||||||
|
HAVE_PORTH(shadowPORTF=PORTH);
|
||||||
}
|
}
|
||||||
|
|
||||||
// setPROGSignal(), called from interrupt context
|
// setPROGSignal(), called from interrupt context
|
||||||
@@ -167,6 +173,8 @@ void TrackManager::setPROGSignal( bool on) {
|
|||||||
HAVE_PORTD(shadowPORTD=PORTD);
|
HAVE_PORTD(shadowPORTD=PORTD);
|
||||||
HAVE_PORTE(shadowPORTE=PORTE);
|
HAVE_PORTE(shadowPORTE=PORTE);
|
||||||
HAVE_PORTF(shadowPORTF=PORTF);
|
HAVE_PORTF(shadowPORTF=PORTF);
|
||||||
|
HAVE_PORTG(shadowPORTF=PORTG);
|
||||||
|
HAVE_PORTH(shadowPORTF=PORTH);
|
||||||
APPLY_BY_MODE(TRACK_MODE_PROG,setSignal(on));
|
APPLY_BY_MODE(TRACK_MODE_PROG,setSignal(on));
|
||||||
HAVE_PORTA(PORTA=shadowPORTA);
|
HAVE_PORTA(PORTA=shadowPORTA);
|
||||||
HAVE_PORTB(PORTB=shadowPORTB);
|
HAVE_PORTB(PORTB=shadowPORTB);
|
||||||
@@ -174,6 +182,8 @@ void TrackManager::setPROGSignal( bool on) {
|
|||||||
HAVE_PORTD(PORTD=shadowPORTD);
|
HAVE_PORTD(PORTD=shadowPORTD);
|
||||||
HAVE_PORTE(PORTE=shadowPORTE);
|
HAVE_PORTE(PORTE=shadowPORTE);
|
||||||
HAVE_PORTF(PORTF=shadowPORTF);
|
HAVE_PORTF(PORTF=shadowPORTF);
|
||||||
|
HAVE_PORTG(shadowPORTF=PORTG);
|
||||||
|
HAVE_PORTH(shadowPORTF=PORTH);
|
||||||
}
|
}
|
||||||
|
|
||||||
// setDCSignal(), called from normal context
|
// setDCSignal(), called from normal context
|
||||||
@@ -398,7 +408,7 @@ bool TrackManager::parseEqualSign(Print *stream, int16_t params, int16_t p[])
|
|||||||
if (params==2 && p[1]=="AUTO"_hk) // <= id AUTO>
|
if (params==2 && p[1]=="AUTO"_hk) // <= id AUTO>
|
||||||
return setTrackMode(p[0], track[p[0]]->getMode() | TRACK_MODE_AUTOINV);
|
return setTrackMode(p[0], track[p[0]]->getMode() | TRACK_MODE_AUTOINV);
|
||||||
|
|
||||||
if (params==2 && p[1]=="INV"_hk) // <= id AUTO>
|
if (params==2 && p[1]=="INV"_hk) // <= id INV>
|
||||||
return setTrackMode(p[0], track[p[0]]->getMode() | TRACK_MODE_INV);
|
return setTrackMode(p[0], track[p[0]]->getMode() | TRACK_MODE_INV);
|
||||||
|
|
||||||
if (params==3 && p[1]=="DC"_hk && p[2]>0) // <= id DC cab>
|
if (params==3 && p[1]=="DC"_hk && p[2]>0) // <= id DC cab>
|
||||||
@@ -631,23 +641,25 @@ void TrackManager::setJoinRelayPin(byte joinRelayPin) {
|
|||||||
|
|
||||||
void TrackManager::setJoin(bool joined) {
|
void TrackManager::setJoin(bool joined) {
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
#ifdef ARDUINO_ARCH_ESP32
|
||||||
if (joined) {
|
if (joined) { // if we go into joined mode (PROG acts as MAIN)
|
||||||
FOR_EACH_TRACK(t) {
|
FOR_EACH_TRACK(t) {
|
||||||
if (track[t]->getMode() & TRACK_MODE_PROG) {
|
if (track[t]->getMode() & TRACK_MODE_PROG) { // find PROG track
|
||||||
tempProgTrack = t;
|
tempProgTrack = t; // remember PROG track
|
||||||
setTrackMode(t, TRACK_MODE_MAIN);
|
setTrackMode(t, TRACK_MODE_MAIN);
|
||||||
break;
|
track[t]->setPower(POWERMODE::ON); // if joined, always on
|
||||||
|
break; // there is only one prog track, done
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
if (tempProgTrack != MAX_TRACKS+1) {
|
if (tempProgTrack != MAX_TRACKS+1) {
|
||||||
// as setTrackMode with TRACK_MODE_PROG defaults to
|
// setTrackMode defaults to power off, so we
|
||||||
// power off, we will take the current power state
|
// need to preserve that state.
|
||||||
// of our track and then preserve that state.
|
POWERMODE tPTmode = track[tempProgTrack]->getPower(); // get current power status of this track
|
||||||
POWERMODE tPTmode = track[tempProgTrack]->getPower(); //get current power status of this track
|
setTrackMode(tempProgTrack, TRACK_MODE_PROG); // set track mode back to prog
|
||||||
setTrackMode(tempProgTrack, TRACK_MODE_PROG);
|
track[tempProgTrack]->setPower(tPTmode); // set power status as it was before
|
||||||
track[tempProgTrack]->setPower(tPTmode); //set track status as it was before
|
|
||||||
tempProgTrack = MAX_TRACKS+1;
|
tempProgTrack = MAX_TRACKS+1;
|
||||||
|
} else {
|
||||||
|
DIAG(F("Unjoin but no remembered prog track"));
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
@@ -147,6 +147,12 @@ bool WifiESP::setup(const char *SSid,
|
|||||||
// enableCoreWDT(1);
|
// enableCoreWDT(1);
|
||||||
// disableCoreWDT(0);
|
// disableCoreWDT(0);
|
||||||
|
|
||||||
|
#ifdef WIFI_LED
|
||||||
|
// Turn off Wifi LED
|
||||||
|
pinMode(WIFI_LED, OUTPUT);
|
||||||
|
digitalWrite(WIFI_LED, 0);
|
||||||
|
#endif
|
||||||
|
|
||||||
// clean start
|
// clean start
|
||||||
WiFi.mode(WIFI_STA);
|
WiFi.mode(WIFI_STA);
|
||||||
WiFi.disconnect(true);
|
WiFi.disconnect(true);
|
||||||
@@ -247,6 +253,13 @@ bool WifiESP::setup(const char *SSid,
|
|||||||
// no idea to go on
|
// no idea to go on
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
#ifdef WIFI_LED
|
||||||
|
else{
|
||||||
|
// Turn on Wifi connected LED
|
||||||
|
digitalWrite(WIFI_LED, 1);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
// Now Wifi is up, register the mDNS service
|
// Now Wifi is up, register the mDNS service
|
||||||
if(!MDNS.begin(hostname)) {
|
if(!MDNS.begin(hostname)) {
|
||||||
|
@@ -1,4 +1,5 @@
|
|||||||
/*
|
/*
|
||||||
|
* © 2022-2024 Paul M. Antoine
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2020-2022 Harald Barth
|
* © 2020-2022 Harald Barth
|
||||||
* © 2020-2022 Chris Harlow
|
* © 2020-2022 Chris Harlow
|
||||||
@@ -70,7 +71,7 @@ Stream * WifiInterface::wifiStream;
|
|||||||
#define SERIAL3 Serial5
|
#define SERIAL3 Serial5
|
||||||
#elif defined(ARDUINO_NUCLEO_F413ZH) || defined(ARDUINO_NUCLEO_F429ZI) \
|
#elif defined(ARDUINO_NUCLEO_F413ZH) || defined(ARDUINO_NUCLEO_F429ZI) \
|
||||||
|| defined(ARDUINO_NUCLEO_F446ZE) || defined(ARDUINO_NUCLEO_F412ZG) \
|
|| defined(ARDUINO_NUCLEO_F446ZE) || defined(ARDUINO_NUCLEO_F412ZG) \
|
||||||
|| defined(ARDUINO_NUCLEO_F439ZI)
|
|| defined(ARDUINO_NUCLEO_F439ZI) || defined(ARDUINO_NUCLEO_F4X9ZI)
|
||||||
#define NUM_SERIAL 2
|
#define NUM_SERIAL 2
|
||||||
#define SERIAL1 Serial6
|
#define SERIAL1 Serial6
|
||||||
#else
|
#else
|
||||||
|
@@ -307,11 +307,21 @@ The configuration file for DCC-EX Command Station
|
|||||||
//
|
//
|
||||||
//#define SERIAL_BT_COMMANDS
|
//#define SERIAL_BT_COMMANDS
|
||||||
|
|
||||||
// BOOSTER PIN INPUT ON ESP32
|
// BOOSTER PIN INPUT ON ESP32 CS
|
||||||
// On ESP32 you have the possibility to define a pin as booster input
|
// On ESP32 you have the possibility to define a pin as booster input
|
||||||
// Arduio pin D2 is GPIO 26 on ESPDuino32
|
|
||||||
//
|
//
|
||||||
|
// Arduino pin D2 is GPIO 26 is Booster Input on ESPDuino32
|
||||||
//#define BOOSTER_INPUT 26
|
//#define BOOSTER_INPUT 26
|
||||||
|
//
|
||||||
|
// GPIO 32 is Booster Input on EX-CSB1
|
||||||
|
//#define BOOSTER_INPUT 32
|
||||||
|
|
||||||
|
// ESP32 LED Wifi Indicator
|
||||||
|
// GPIO 2 on ESPduino32
|
||||||
|
//#define WIFI_LED 2
|
||||||
|
//
|
||||||
|
// GPIO 33 on EX-CSB1
|
||||||
|
//#define WIFI_LED 33
|
||||||
|
|
||||||
// SABERTOOTH
|
// SABERTOOTH
|
||||||
//
|
//
|
||||||
|
@@ -104,10 +104,35 @@ lib_deps =
|
|||||||
${env.lib_deps}
|
${env.lib_deps}
|
||||||
arduino-libraries/Ethernet
|
arduino-libraries/Ethernet
|
||||||
SPI
|
SPI
|
||||||
|
MDNS_Generic
|
||||||
|
|
||||||
|
lib_ignore = WiFi101
|
||||||
|
WiFi101_Generic
|
||||||
|
WiFiEspAT
|
||||||
|
WiFiMulti_Generic
|
||||||
|
WiFiNINA_Generic
|
||||||
|
|
||||||
monitor_speed = 115200
|
monitor_speed = 115200
|
||||||
monitor_echo = yes
|
monitor_echo = yes
|
||||||
build_flags =
|
build_flags =
|
||||||
|
|
||||||
|
[env:mega2560-eth]
|
||||||
|
platform = atmelavr
|
||||||
|
board = megaatmega2560
|
||||||
|
framework = arduino
|
||||||
|
lib_deps =
|
||||||
|
${env.lib_deps}
|
||||||
|
arduino-libraries/Ethernet
|
||||||
|
MDNS_Generic
|
||||||
|
SPI
|
||||||
|
lib_ignore = WiFi101
|
||||||
|
WiFi101_Generic
|
||||||
|
WiFiEspAT
|
||||||
|
WiFiMulti_Generic
|
||||||
|
WiFiNINA_Generic
|
||||||
|
monitor_speed = 115200
|
||||||
|
monitor_echo = yes
|
||||||
|
|
||||||
[env:mega328]
|
[env:mega328]
|
||||||
platform = atmelavr
|
platform = atmelavr
|
||||||
board = uno
|
board = uno
|
||||||
@@ -164,7 +189,11 @@ monitor_echo = yes
|
|||||||
build_flags = -mcall-prologues
|
build_flags = -mcall-prologues
|
||||||
|
|
||||||
[env:ESP32]
|
[env:ESP32]
|
||||||
platform = espressif32
|
; Lock version to 6.7.0 as that is
|
||||||
|
; Arduino v2.0.16 (based on IDF v4.4.7)
|
||||||
|
; which is the latest version based
|
||||||
|
; on IDF v4. We can not use IDF v5.
|
||||||
|
platform = espressif32 @ 6.7.0
|
||||||
board = esp32dev
|
board = esp32dev
|
||||||
framework = arduino
|
framework = arduino
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
@@ -242,6 +271,24 @@ monitor_echo = yes
|
|||||||
|
|
||||||
; Experimental - Ethernet work still in progress
|
; Experimental - Ethernet work still in progress
|
||||||
;
|
;
|
||||||
|
[env:Nucleo-F429ZI]
|
||||||
|
platform = ststm32
|
||||||
|
board = nucleo_f429zi
|
||||||
|
framework = arduino
|
||||||
|
lib_deps = ${env.lib_deps}
|
||||||
|
stm32duino/STM32Ethernet @ ^1.3.0
|
||||||
|
stm32duino/STM32duino LwIP @ ^2.1.2
|
||||||
|
MDNS_Generic
|
||||||
|
lib_ignore = WiFi101
|
||||||
|
WiFi101_Generic
|
||||||
|
WiFiEspAT
|
||||||
|
WiFiMulti_Generic
|
||||||
|
WiFiNINA_Generic
|
||||||
|
build_flags = -std=c++17 -Os -g2 -Wunused-variable
|
||||||
|
monitor_speed = 115200
|
||||||
|
monitor_echo = yes
|
||||||
|
upload_protocol = stlink
|
||||||
|
|
||||||
; [env:Nucleo-F429ZI]
|
; [env:Nucleo-F429ZI]
|
||||||
; platform = ststm32
|
; platform = ststm32
|
||||||
; board = nucleo_f429zi
|
; board = nucleo_f429zi
|
||||||
|
33
version.h
33
version.h
@@ -3,7 +3,38 @@
|
|||||||
|
|
||||||
#include "StringFormatter.h"
|
#include "StringFormatter.h"
|
||||||
|
|
||||||
#define VERSION "5.2.54"
|
#define VERSION "5.2.74"
|
||||||
|
// 5.2.74 - Bugfix: ESP32 turn on the joined prog (as main) again after a prog operation
|
||||||
|
// 5.2.73 - Bugfix: STM32 further fixes to shadowPORT entries in TrackManager.cpp for PORTG and PORTH
|
||||||
|
// 5.2.72 - Bugfix: added shadowPORT entries in TrackManager.cpp for PORTG and PORTH on STM32, fixed typo in MotorDriver.cpp
|
||||||
|
// 5.2.71 - Broadcasts of loco forgets.
|
||||||
|
// 5.2.70 - IO_RocoDriver renamed to IO_EncoderThrottle.
|
||||||
|
// - and included in IODEvice.h (circular dependency removed)
|
||||||
|
// 5.2.69 - IO_RocoDriver. Direct drive train with rotary encoder hw.
|
||||||
|
// 5.2.68 - Revert function map to signed (from 5.2.66) to avoid
|
||||||
|
// incompatibilities with ED etc for F31 frequency flag.
|
||||||
|
// 5.2.67 - EXRAIL AFTER optional debounce time variable (default 500mS)
|
||||||
|
// - AFTER(42) == AFTER(42,500) sets time sensor must
|
||||||
|
// - be continuously off.
|
||||||
|
// 5.2.66 - <F cab DCFREQ 0..3>
|
||||||
|
// - EXRAIL SETFREQ drop loco param (breaking since 5.2.28)
|
||||||
|
// 5.2.65 - Speedup Exrail SETFREQ
|
||||||
|
// 5.2.64 - Bugfix: <0 PROG> updated to undo JOIN
|
||||||
|
// 5.2.63 - Implement WIFI_LED for ESP32, ESPduino32 and EX-CSB1, that is turned on when STA mode connects or AP mode is up
|
||||||
|
// - Add BOOSTER_INPUT definitions for ESPduino32 and EX-CSB1 to config.example.h
|
||||||
|
// - Add WIFI_LED definitions for ESPduino32 and EX-CSB1 to config.example.h
|
||||||
|
// 5.2.62 - Allow acks way longer than standard
|
||||||
|
// 5.2.61 - Merg CBUS ACON/ACOF/ONACON/ONACOF Adapter interface.
|
||||||
|
// - LCC Adapter interface throttled startup,
|
||||||
|
// (Breaking change with Adapter base code)
|
||||||
|
// 5.2.60 - Bugfix: Opcode AFTEROVERLOAD does not have an argument that is a pin and needs to be initialized
|
||||||
|
// - Remove inrush throttle after half good time so that we go to mode overload if problem persists
|
||||||
|
// 5.2.59 - STM32 bugfix correct Serial1 definition for Nucleo-F401RE
|
||||||
|
// - STM32 add support for ARDUINO_NUCLEO_F4X9ZI type to span F429/F439 in upcoming STM32duino release v2.8 as a result of our PR
|
||||||
|
// 5.2.58 - EXRAIL ALIAS allows named pins
|
||||||
|
// 5.2.57 - Bugfix autoreverse: Apply mode by binart bit match and not by equality
|
||||||
|
// 5.2.56 - Bugfix and refactor for EXRAIL getSignalSlot
|
||||||
|
// 5.2.55 - Move EXRAIL isSignal() to public to allow use in STEALTH call
|
||||||
// 5.2.54 - Bugfix for EXRAIL signal handling for active high
|
// 5.2.54 - Bugfix for EXRAIL signal handling for active high
|
||||||
// 5.2.53 - Bugfix for EX-Fastclock, call I2CManager.begin() before checking I2C address
|
// 5.2.53 - Bugfix for EX-Fastclock, call I2CManager.begin() before checking I2C address
|
||||||
// 5.2.52 - Bugfix for ADCee() to handle ADC2 and ADC3 channel inputs on F446ZE and others
|
// 5.2.52 - Bugfix for ADCee() to handle ADC2 and ADC3 channel inputs on F446ZE and others
|
||||||
|
Reference in New Issue
Block a user