mirror of
https://github.com/DCC-EX/CommandStation-EX.git
synced 2024-11-24 16:46:13 +01:00
Compare commits
345 Commits
42f1dc2345
...
ecc8d8f7d0
Author | SHA1 | Date | |
---|---|---|---|
|
ecc8d8f7d0 | ||
|
27a5f76a8d | ||
|
754bd99381 | ||
|
650e411a4f | ||
|
0978bb0c11 | ||
|
6eb7051fd6 | ||
|
5726844c83 | ||
|
0214a55b23 | ||
|
7db4a9575a | ||
|
8b8e9e4919 | ||
|
ce84974967 | ||
|
034c441c34 | ||
|
d5978b1578 | ||
|
ea4f90d5fc | ||
|
1181fd855d | ||
|
a092e06a6f | ||
|
68fd56e7fc | ||
|
370dae0ab8 | ||
|
bef4b2ec35 | ||
|
fe618d0b85 | ||
|
2ff1619ad1 | ||
|
7afd4443d6 | ||
|
52cfc18754 | ||
|
ed0cfee091 | ||
|
25bbfa4c68 | ||
|
2a46b96083 | ||
|
17c004aecf | ||
|
9e3ae21bb8 | ||
|
624656ebc9 | ||
|
5a7f278b1e | ||
|
9333beda49 | ||
|
aacb980dc8 | ||
|
11b9fd4ef5 | ||
|
d07718be8c | ||
|
d57b5ba537 | ||
|
dab02ec659 | ||
|
6ad5326f1d | ||
|
39e1363ce0 | ||
|
c9d4f5e94d | ||
|
8052090e0f | ||
|
dfe3e9d42c | ||
|
5d810a620b | ||
|
550ad58c4d | ||
|
7a305e179c | ||
|
8437b0e7aa | ||
|
46289fa78c | ||
|
ebbeea5fbb | ||
|
a8321fff42 | ||
|
a16790f585 | ||
|
da6a3c442f | ||
|
4fcd81a118 | ||
|
eb450dbd89 | ||
|
a0562fdf5c | ||
|
7ee2c29a52 | ||
|
dba5d35aa2 | ||
|
be10be5a1a | ||
|
dca023ffd7 | ||
|
4eef9581fe | ||
|
bd02d1c15b | ||
|
004d7b6631 | ||
|
21ce87eb3e | ||
|
ab393047c1 | ||
|
1f5f7754c1 | ||
|
6adff43f4b | ||
|
1ac104704e | ||
|
2f8e915b1e | ||
|
152f9850bb | ||
|
3094c52bf8 | ||
|
86f4567556 | ||
|
dd890e65bf | ||
|
1e48c59cd8 | ||
|
004d10ee58 | ||
|
e734661d1b | ||
|
bcb250bacf | ||
|
798241927f | ||
|
df2f09f4d2 | ||
|
f40d57d8bd | ||
|
9fa213e198 | ||
|
44d8154223 | ||
|
01919b33df | ||
|
b3cafd126e | ||
|
a0c1ad182c | ||
|
dbf053858b | ||
|
232ac993ec | ||
|
26ddd27ecf | ||
|
6cad794411 | ||
|
b0d8510127 | ||
|
3bfdd16288 | ||
|
df4a501e8a | ||
|
2202cb0c5e | ||
|
1425da20b5 | ||
|
b823a647ac | ||
|
2c64f10da8 | ||
|
25426d076d | ||
|
3453da0671 | ||
|
c55fa9f9d2 | ||
|
210d96a3e3 | ||
|
fb226311e5 | ||
|
6392c74ead | ||
|
25f8852af6 | ||
|
9842ea8a42 | ||
|
fa0aa27d46 | ||
|
42f3c7c128 | ||
|
6cd7002e91 | ||
|
57d4655d54 | ||
|
ff9c558b61 | ||
|
b277d204f0 | ||
|
c4febd1d0f | ||
|
98f8022268 | ||
|
1491da4813 | ||
|
4b2c0702a4 | ||
|
e27cceeb74 | ||
|
085762e800 | ||
|
247763ac00 | ||
|
e327e0ae8d | ||
|
9f38dae8ba | ||
|
2db2b0ecc6 | ||
|
fd58a749ef | ||
|
3bddf4dfd1 | ||
|
e0e965f81c | ||
|
f2be3aeac3 | ||
|
a74d85e895 | ||
|
df2e651217 | ||
|
36d139268d | ||
|
e3ac3a8ddf | ||
|
415e756020 | ||
|
f754fe2fbf | ||
|
399030d8ae | ||
|
4c7e11ddc1 | ||
|
495bbf66bf | ||
|
2950ef010a | ||
|
c2eb5f23b4 | ||
|
94648ead28 | ||
|
ec0499e9da | ||
|
9b75026eef | ||
|
6036ff9b15 | ||
|
6476a7aac2 | ||
|
0edf34bfe2 | ||
|
aa1f25fc72 | ||
|
b44bebc1c6 | ||
|
1a17cdb62f | ||
|
7ce1618a9c | ||
|
4192c1f5a3 | ||
|
c2fcdddd1f | ||
|
f19db3aa5c | ||
|
e6a40e622c | ||
|
b3251e89d7 | ||
|
ae2bbbf668 | ||
|
96a46f36c2 | ||
|
10c59028e1 | ||
|
ab1356d070 | ||
|
70d4c016ef | ||
|
efe96d1d84 | ||
|
5d17f247de | ||
|
7c41ec7c25 | ||
|
9c5e48c3d5 | ||
|
2eb0f48994 | ||
|
1bdb05a471 | ||
|
c2fa76c76a | ||
|
35fd912c60 | ||
|
dfba6c6fc1 | ||
|
f3cb263aaa | ||
|
ec6e730559 | ||
|
196a27a27a | ||
|
99b6ca025a | ||
|
db555e8820 | ||
|
0d679ad993 | ||
|
dd80260781 | ||
|
08f41415dc | ||
|
2f65d4347e | ||
|
995c6f8ede | ||
|
4331ddfdf0 | ||
|
2b8b995307 | ||
|
2af01e3c42 | ||
|
73b45ba9b8 | ||
|
247cea6dc1 | ||
|
c932325120 | ||
|
988011475c | ||
|
0be9af2270 | ||
|
c3eb6b8d8a | ||
|
08c00d275d | ||
|
1888073dc2 | ||
|
6dd175f63b | ||
|
ae54a747bb | ||
|
955ff4f96d | ||
|
0cf81d589e | ||
|
d5dad767a4 | ||
|
56fcb4e5f7 | ||
|
7783837545 | ||
|
0266936875 | ||
|
befb41ce98 | ||
|
f83be05220 | ||
|
cade89ba16 | ||
|
277825c530 | ||
|
95fe7aafe0 | ||
|
f99deb4276 | ||
|
f5d4dcb97c | ||
|
8a69403dda | ||
|
e81d1cc93a | ||
|
82929245ed | ||
|
db0e0cbf8b | ||
|
803b996e0b | ||
|
5607ff7167 | ||
|
58e62aaa81 | ||
|
5a9adea2b6 | ||
|
bf136d49e0 | ||
|
50313ebbd2 | ||
|
72bfc6abc7 | ||
|
342d9263d1 | ||
|
20d66fad4e | ||
|
be4235e792 | ||
|
c22d789513 | ||
|
951a6637f0 | ||
|
fdbcbdf418 | ||
|
9478c3263d | ||
|
16f94ecbdc | ||
|
b80d7bd517 | ||
|
8786285624 | ||
|
132b0773ef | ||
|
99521f8a3f | ||
|
1a3d295564 | ||
|
3b6789ef01 | ||
|
c472f48d93 | ||
|
94e9c2021b | ||
|
9aad2e3206 | ||
|
ecc366cbd1 | ||
|
f4e3ca7c81 | ||
|
991bda63e0 | ||
|
5164bd143c | ||
|
3759fc2a1a | ||
|
df7b890758 | ||
|
6d802f3a73 | ||
|
9d953c70b8 | ||
|
6781e44fdd | ||
|
a3c9800aba | ||
|
efdbfcb030 | ||
|
28d9843133 | ||
|
fcf05206b4 | ||
|
cc3aba1feb | ||
|
4eaad2d05b | ||
|
72d131035e | ||
|
2d1e695ac7 | ||
|
e780c40b34 | ||
|
7addb13785 | ||
|
b6f8889e8c | ||
|
33306219c8 | ||
|
d857c4f2e4 | ||
|
70fae16ab3 | ||
|
f465020e93 | ||
|
235bcc9ff0 | ||
|
d2cc60812d | ||
|
75f274e3b7 | ||
|
ff53b90034 | ||
|
1daa0a9ba9 | ||
|
294b9693c5 | ||
|
16e44eb11a | ||
|
e51f8e9c0a | ||
|
4bad334875 | ||
|
32491854ff | ||
|
3e95372816 | ||
|
05b0fc3d2e | ||
|
bb7cdc5422 | ||
|
6199cecd42 | ||
|
1aae0aed0a | ||
|
1d29be9de6 | ||
|
bfa33a9df7 | ||
|
49c0a1a55a | ||
|
9b7d1ae858 | ||
|
c11d8f6359 | ||
|
3868bb19ac | ||
|
7589917638 | ||
|
e7d9626a72 | ||
|
fe035f4096 | ||
|
4d236446b0 | ||
|
a100d709ce | ||
|
0d82370380 | ||
|
ff6034dff2 | ||
|
5d0de6b807 | ||
|
2e518fcac2 | ||
|
be273454bc | ||
|
751b46b6bb | ||
|
91bc9df44e | ||
|
72ceb63913 | ||
|
d2c7e7fb8d | ||
|
61db37c7ea | ||
|
3a3071f35b | ||
|
ef3d36ae25 | ||
|
c3d2e5b222 | ||
|
9f212c27bf | ||
|
de06c0ae3e | ||
|
18a992bf08 | ||
|
de6e91a778 | ||
|
b18df1405c | ||
|
305e0902f4 | ||
|
95c1b1da31 | ||
|
4f43a413b5 | ||
|
4f56837d28 | ||
|
cc2846d932 | ||
|
83325ebf78 | ||
|
91d36ae909 | ||
|
98af5c45ed | ||
|
d3eceb6d6c | ||
|
79eaaa85fa | ||
|
0f5b8adb6b | ||
|
da8faa808b | ||
|
31ecba08d8 | ||
|
7311f2ce64 | ||
|
7e4f9eb0e1 | ||
|
1f5eafbcca | ||
|
7e16ec7088 | ||
|
912646f8ff | ||
|
dd309a3705 | ||
|
5376c9f410 | ||
|
b1d110ecbf | ||
|
5b7801ca6c | ||
|
aca9c9c941 | ||
|
6f94cd71ab | ||
|
1827a11f83 | ||
|
0023ce3356 | ||
|
7b9f3ae08d | ||
|
5e50731a78 | ||
|
df6c511d1d | ||
|
4bfd4b1a12 | ||
|
4a3f3d0f34 | ||
|
f0d1909d9f | ||
|
daf6799ac1 | ||
|
b7a010f904 | ||
|
d1518b8af0 | ||
|
39a85903ce | ||
|
d72474cd8f | ||
|
941e74beaf | ||
|
e618b91900 | ||
|
dcab5a0e72 | ||
|
1901d9547e | ||
|
7388d14bab | ||
|
2da28ad2db | ||
|
06bd80438e | ||
|
cd15eed005 | ||
|
23d0158804 | ||
|
2e9e614ad5 | ||
|
64b1de08be | ||
|
34c3d10767 | ||
|
f2eb64fd21 | ||
|
a80b16acba | ||
|
b1f5e9f48c |
2
.gitignore
vendored
2
.gitignore
vendored
|
@ -13,3 +13,5 @@ myFilter.cpp
|
||||||
my*.h
|
my*.h
|
||||||
!my*.example.h
|
!my*.example.h
|
||||||
compile_commands.json
|
compile_commands.json
|
||||||
|
newcode.txt.old
|
||||||
|
UserAddin.txt
|
||||||
|
|
|
@ -2,6 +2,7 @@
|
||||||
* © 2022 Harald Barth
|
* © 2022 Harald Barth
|
||||||
* © 2020-2021 Chris Harlow
|
* © 2020-2021 Chris Harlow
|
||||||
* © 2020 Gregor Baues
|
* © 2020 Gregor Baues
|
||||||
|
* © 2022 Colin Murdoch
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -160,6 +161,10 @@ void CommandDistributor::broadcastTurnout(int16_t id, bool isClosed ) {
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void CommandDistributor::broadcastTurntable(int16_t id, uint8_t position, bool moving) {
|
||||||
|
broadcastReply(COMMAND_TYPE, F("<I %d %d %d>\n"), id, position, moving);
|
||||||
|
}
|
||||||
|
|
||||||
void CommandDistributor::broadcastClockTime(int16_t time, int8_t rate) {
|
void CommandDistributor::broadcastClockTime(int16_t time, int8_t rate) {
|
||||||
// The JMRI clock command is of the form : PFT65871<;>4
|
// The JMRI clock command is of the form : PFT65871<;>4
|
||||||
// The CS broadcast is of the form "<jC mmmm nn" where mmmm is time minutes and dd speed
|
// The CS broadcast is of the form "<jC mmmm nn" where mmmm is time minutes and dd speed
|
||||||
|
@ -167,7 +172,7 @@ void CommandDistributor::broadcastClockTime(int16_t time, int8_t rate) {
|
||||||
// be safe for both types.
|
// be safe for both types.
|
||||||
broadcastReply(COMMAND_TYPE, F("<jC %d %d>\n"),time, rate);
|
broadcastReply(COMMAND_TYPE, F("<jC %d %d>\n"),time, rate);
|
||||||
#ifdef CD_HANDLE_RING
|
#ifdef CD_HANDLE_RING
|
||||||
broadcastReply(WITHROTTLE_TYPE, F("PFT%d<;>%d\n"), time*60, rate);
|
broadcastReply(WITHROTTLE_TYPE, F("PFT%l<;>%d\n"), (int32_t)time*60, rate);
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -204,6 +209,39 @@ int16_t CommandDistributor::retClockTime() {
|
||||||
void CommandDistributor::broadcastLoco(byte slot) {
|
void CommandDistributor::broadcastLoco(byte slot) {
|
||||||
DCC::LOCO * sp=&DCC::speedTable[slot];
|
DCC::LOCO * sp=&DCC::speedTable[slot];
|
||||||
broadcastReply(COMMAND_TYPE, F("<l %d %d %d %l>\n"), sp->loco,slot,sp->speedCode,sp->functions);
|
broadcastReply(COMMAND_TYPE, F("<l %d %d %d %l>\n"), sp->loco,slot,sp->speedCode,sp->functions);
|
||||||
|
#ifdef SABERTOOTH
|
||||||
|
if (Serial2 && sp->loco == SABERTOOTH) {
|
||||||
|
static uint8_t rampingmode = 0;
|
||||||
|
bool direction = (sp->speedCode & 0x80) !=0; // true for forward
|
||||||
|
int32_t speed = sp->speedCode & 0x7f;
|
||||||
|
if (speed == 1) { // emergency stop
|
||||||
|
if (rampingmode != 1) {
|
||||||
|
rampingmode = 1;
|
||||||
|
Serial2.print("R1: 0\r\n");
|
||||||
|
Serial2.print("R2: 0\r\n");
|
||||||
|
}
|
||||||
|
Serial2.print("MD: 0\r\n");
|
||||||
|
} else {
|
||||||
|
if (speed != 0) {
|
||||||
|
// speed is here 2 to 127
|
||||||
|
speed = (speed - 1) * 1625 / 100;
|
||||||
|
speed = speed * (direction ? 1 : -1);
|
||||||
|
// speed is here -2047 to 2047
|
||||||
|
}
|
||||||
|
if (rampingmode != 2) {
|
||||||
|
rampingmode = 2;
|
||||||
|
Serial2.print("R1: 2047\r\n");
|
||||||
|
Serial2.print("R2: 2047\r\n");
|
||||||
|
}
|
||||||
|
Serial2.print("M1: ");
|
||||||
|
Serial2.print(speed);
|
||||||
|
Serial2.print("\r\n");
|
||||||
|
Serial2.print("M2: ");
|
||||||
|
Serial2.print(speed);
|
||||||
|
Serial2.print("\r\n");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#endif
|
||||||
#ifdef CD_HANDLE_RING
|
#ifdef CD_HANDLE_RING
|
||||||
WiThrottle::markForBroadcast(sp->loco);
|
WiThrottle::markForBroadcast(sp->loco);
|
||||||
#endif
|
#endif
|
||||||
|
@ -227,13 +265,10 @@ void CommandDistributor::broadcastPower() {
|
||||||
LCD(2,F("Power %S%S"),state=='1'?F("On"):F("Off"),reason);
|
LCD(2,F("Power %S%S"),state=='1'?F("On"):F("Off"),reason);
|
||||||
}
|
}
|
||||||
|
|
||||||
void CommandDistributor::broadcastText(const FSH * msg) {
|
void CommandDistributor::broadcastRaw(clientType type, char * msg) {
|
||||||
broadcastReply(COMMAND_TYPE, F("<I %S>\n"),msg);
|
broadcastReply(type, F("%s"),msg);
|
||||||
#ifdef CD_HANDLE_RING
|
|
||||||
broadcastReply(WITHROTTLE_TYPE, F("Hm%S\n"), msg);
|
|
||||||
#endif
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void CommandDistributor::broadcastTrackState(const FSH* format,byte trackLetter,int16_t dcAddr) {
|
void CommandDistributor::broadcastTrackState(const FSH* format,byte trackLetter, int16_t dcAddr) {
|
||||||
broadcastReply(COMMAND_TYPE, format,trackLetter,dcAddr);
|
broadcastReply(COMMAND_TYPE, format,trackLetter, dcAddr);
|
||||||
}
|
}
|
||||||
|
|
|
@ -2,6 +2,8 @@
|
||||||
* © 2022 Harald Barth
|
* © 2022 Harald Barth
|
||||||
* © 2020-2021 Chris Harlow
|
* © 2020-2021 Chris Harlow
|
||||||
* © 2020 Gregor Baues
|
* © 2020 Gregor Baues
|
||||||
|
* © 2022 Colin Murdoch
|
||||||
|
*
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -33,8 +35,9 @@
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
class CommandDistributor {
|
class CommandDistributor {
|
||||||
private:
|
public:
|
||||||
enum clientType: byte {NONE_TYPE,COMMAND_TYPE,WITHROTTLE_TYPE};
|
enum clientType: byte {NONE_TYPE,COMMAND_TYPE,WITHROTTLE_TYPE};
|
||||||
|
private:
|
||||||
static void broadcastToClients(clientType type);
|
static void broadcastToClients(clientType type);
|
||||||
static StringBuffer * broadcastBufferWriter;
|
static StringBuffer * broadcastBufferWriter;
|
||||||
#ifdef CD_HANDLE_RING
|
#ifdef CD_HANDLE_RING
|
||||||
|
@ -46,12 +49,13 @@ public :
|
||||||
static void broadcastLoco(byte slot);
|
static void broadcastLoco(byte slot);
|
||||||
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 broadcastClockTime(int16_t time, int8_t rate);
|
static void broadcastClockTime(int16_t time, int8_t rate);
|
||||||
static void setClockTime(int16_t time, int8_t rate, byte opt);
|
static void setClockTime(int16_t time, int8_t rate, byte opt);
|
||||||
static int16_t retClockTime();
|
static int16_t retClockTime();
|
||||||
static void broadcastPower();
|
static void broadcastPower();
|
||||||
static void broadcastText(const FSH * msg);
|
static void broadcastRaw(clientType type,char * msg);
|
||||||
static void broadcastTrackState(const FSH* format,byte trackLetter,int16_t dcAddr);
|
static void broadcastTrackState(const FSH* format,byte trackLetter, int16_t dcAddr);
|
||||||
template<typename... Targs> static void broadcastReply(clientType type, Targs... msg);
|
template<typename... Targs> static void broadcastReply(clientType type, Targs... msg);
|
||||||
static void forget(byte clientId);
|
static void forget(byte clientId);
|
||||||
|
|
||||||
|
|
|
@ -30,6 +30,7 @@
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2020-2021 Chris Harlow, Harald Barth, David Cutting,
|
* © 2020-2021 Chris Harlow, Harald Barth, David Cutting,
|
||||||
* Fred Decker, Gregor Baues, Anthony W - Dayton
|
* Fred Decker, Gregor Baues, Anthony W - Dayton
|
||||||
|
* © 2023 Nathan Kellenicki
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -78,6 +79,12 @@ void setup()
|
||||||
// Initialise HAL layer before reading EEprom or setting up MotorDrivers
|
// Initialise HAL layer before reading EEprom or setting up MotorDrivers
|
||||||
IODevice::begin();
|
IODevice::begin();
|
||||||
|
|
||||||
|
// As the setup of a motor shield may require a read of the current sense input from the ADC,
|
||||||
|
// let's make sure to initialise the ADCee class!
|
||||||
|
ADCee::begin();
|
||||||
|
// Set up MotorDrivers early to initialize all pins
|
||||||
|
TrackManager::Setup(MOTOR_SHIELD_TYPE);
|
||||||
|
|
||||||
DISPLAY_START (
|
DISPLAY_START (
|
||||||
// This block is still executed for DIAGS if display not in use
|
// This block is still executed for DIAGS if display not in use
|
||||||
LCD(0,F("DCC-EX v%S"),F(VERSION));
|
LCD(0,F("DCC-EX v%S"),F(VERSION));
|
||||||
|
@ -89,26 +96,19 @@ void setup()
|
||||||
// Start Ethernet if it exists
|
// Start Ethernet if it exists
|
||||||
#ifndef ARDUINO_ARCH_ESP32
|
#ifndef ARDUINO_ARCH_ESP32
|
||||||
#if WIFI_ON
|
#if WIFI_ON
|
||||||
WifiInterface::setup(WIFI_SERIAL_LINK_SPEED, F(WIFI_SSID), F(WIFI_PASSWORD), F(WIFI_HOSTNAME), IP_PORT, WIFI_CHANNEL);
|
WifiInterface::setup(WIFI_SERIAL_LINK_SPEED, F(WIFI_SSID), F(WIFI_PASSWORD), F(WIFI_HOSTNAME), IP_PORT, WIFI_CHANNEL, WIFI_FORCE_AP);
|
||||||
#endif // WIFI_ON
|
#endif // WIFI_ON
|
||||||
#else
|
#else
|
||||||
// ESP32 needs wifi on always
|
// ESP32 needs wifi on always
|
||||||
WifiESP::setup(WIFI_SSID, WIFI_PASSWORD, WIFI_HOSTNAME, IP_PORT, WIFI_CHANNEL);
|
WifiESP::setup(WIFI_SSID, WIFI_PASSWORD, WIFI_HOSTNAME, IP_PORT, WIFI_CHANNEL, WIFI_FORCE_AP);
|
||||||
#endif // ARDUINO_ARCH_ESP32
|
#endif // ARDUINO_ARCH_ESP32
|
||||||
|
|
||||||
#if ETHERNET_ON
|
#if ETHERNET_ON
|
||||||
EthernetInterface::setup();
|
EthernetInterface::setup();
|
||||||
#endif // ETHERNET_ON
|
#endif // ETHERNET_ON
|
||||||
|
|
||||||
// As the setup of a motor shield may require a read of the current sense input from the ADC,
|
|
||||||
// let's make sure to initialise the ADCee class!
|
|
||||||
ADCee::begin();
|
|
||||||
// Responsibility 3: Start the DCC engine.
|
// Responsibility 3: Start the DCC engine.
|
||||||
// Note: this provides DCC with two motor drivers, main and prog, which handle the motor shield(s)
|
DCC::begin();
|
||||||
// Standard supported devices have pre-configured macros but custome hardware installations require
|
|
||||||
// detailed pin mappings and may also require modified subclasses of the MotorDriver to implement specialist logic.
|
|
||||||
// STANDARD_MOTOR_SHIELD, POLOLU_MOTOR_SHIELD, FIREBOX_MK1, FIREBOX_MK1S are pre defined in MotorShields.h
|
|
||||||
TrackManager::Setup(MOTOR_SHIELD_TYPE);
|
|
||||||
|
|
||||||
// Start RMFT aka EX-RAIL (ignored if no automnation)
|
// Start RMFT aka EX-RAIL (ignored if no automnation)
|
||||||
RMFT::begin();
|
RMFT::begin();
|
||||||
|
|
5
DCC.cpp
5
DCC.cpp
|
@ -60,8 +60,7 @@ const byte FN_GROUP_5=0x10;
|
||||||
FSH* DCC::shieldName=NULL;
|
FSH* DCC::shieldName=NULL;
|
||||||
byte DCC::globalSpeedsteps=128;
|
byte DCC::globalSpeedsteps=128;
|
||||||
|
|
||||||
void DCC::begin(const FSH * motorShieldName) {
|
void DCC::begin() {
|
||||||
shieldName=(FSH *)motorShieldName;
|
|
||||||
StringFormatter::send(&USB_SERIAL,F("<iDCC-EX V-%S / %S / %S G-%S>\n"), F(VERSION), F(ARDUINO_TYPE), shieldName, F(GITHUB_SHA));
|
StringFormatter::send(&USB_SERIAL,F("<iDCC-EX V-%S / %S / %S G-%S>\n"), F(VERSION), F(ARDUINO_TYPE), shieldName, F(GITHUB_SHA));
|
||||||
#ifndef DISABLE_EEPROM
|
#ifndef DISABLE_EEPROM
|
||||||
// Load stuff from EEprom
|
// Load stuff from EEprom
|
||||||
|
@ -693,7 +692,7 @@ void DCC::updateLocoReminder(int loco, byte speedCode) {
|
||||||
|
|
||||||
if (loco==0) {
|
if (loco==0) {
|
||||||
// broadcast stop/estop but dont change direction
|
// broadcast stop/estop but dont change direction
|
||||||
for (int reg = 0; reg < highestUsedReg; reg++) {
|
for (int reg = 0; reg <= highestUsedReg; reg++) {
|
||||||
if (speedTable[reg].loco==0) continue;
|
if (speedTable[reg].loco==0) continue;
|
||||||
byte newspeed=(speedTable[reg].speedCode & 0x80) | (speedCode & 0x7f);
|
byte newspeed=(speedTable[reg].speedCode & 0x80) | (speedCode & 0x7f);
|
||||||
if (speedTable[reg].speedCode != newspeed) {
|
if (speedTable[reg].speedCode != newspeed) {
|
||||||
|
|
5
DCC.h
5
DCC.h
|
@ -51,7 +51,10 @@ const byte MAX_LOCOS = 30;
|
||||||
class DCC
|
class DCC
|
||||||
{
|
{
|
||||||
public:
|
public:
|
||||||
static void begin(const FSH * motorShieldName);
|
static inline void setShieldName(const FSH * motorShieldName) {
|
||||||
|
shieldName=(FSH *)motorShieldName;
|
||||||
|
};
|
||||||
|
static void begin();
|
||||||
static void loop();
|
static void loop();
|
||||||
|
|
||||||
// Public DCC API functions
|
// Public DCC API functions
|
||||||
|
|
|
@ -152,7 +152,7 @@ byte DCCACK::getAck() {
|
||||||
return(0); // pending set off but not detected means no ACK.
|
return(0); // pending set off but not detected means no ACK.
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
void DCCACK::loop() {
|
void DCCACK::loop() {
|
||||||
while (ackManagerProg) {
|
while (ackManagerProg) {
|
||||||
byte opcode=GETFLASH(ackManagerProg);
|
byte opcode=GETFLASH(ackManagerProg);
|
||||||
|
@ -351,7 +351,7 @@ void DCCACK::callback(int value) {
|
||||||
|
|
||||||
switch (callbackState) {
|
switch (callbackState) {
|
||||||
case AFTER_READ:
|
case AFTER_READ:
|
||||||
if (ackManagerRejoin && autoPowerOff) {
|
if (ackManagerRejoin && !autoPowerOff) {
|
||||||
progDriver->setPower(POWERMODE::OFF);
|
progDriver->setPower(POWERMODE::OFF);
|
||||||
callbackStart=millis();
|
callbackStart=millis();
|
||||||
callbackState=WAITING_30;
|
callbackState=WAITING_30;
|
||||||
|
@ -414,7 +414,7 @@ void DCCACK::callback(int value) {
|
||||||
(ackManagerCallback)( value);
|
(ackManagerCallback)( value);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
void DCCACK::checkAck(byte sentResetsSincePacket) {
|
void DCCACK::checkAck(byte sentResetsSincePacket) {
|
||||||
if (!ackPending) return;
|
if (!ackPending) return;
|
||||||
|
|
478
DCCEXParser.cpp
478
DCCEXParser.cpp
|
@ -3,10 +3,11 @@
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021 Herb Morton
|
* © 2021 Herb Morton
|
||||||
* © 2020-2022 Harald Barth
|
* © 2020-2023 Harald Barth
|
||||||
* © 2020-2021 M Steve Todd
|
* © 2020-2021 M Steve Todd
|
||||||
* © 2020-2021 Fred Decker
|
* © 2020-2021 Fred Decker
|
||||||
* © 2020-2021 Chris Harlow
|
* © 2020-2021 Chris Harlow
|
||||||
|
* © 2022 Colin Murdoch
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -24,6 +25,79 @@
|
||||||
* You should have received a copy of the GNU General Public License
|
* You should have received a copy of the GNU General Public License
|
||||||
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
List of single character OPCODEs in use for reference.
|
||||||
|
|
||||||
|
When determining a new OPCODE for a new feature, refer to this list as the source of truth.
|
||||||
|
|
||||||
|
Once a new OPCODE is decided upon, update this list.
|
||||||
|
|
||||||
|
Character, Usage
|
||||||
|
/, |EX-R| interactive commands
|
||||||
|
-, Remove from reminder table
|
||||||
|
=, |TM| configuration
|
||||||
|
!, Emergency stop
|
||||||
|
@, Reserved for future use - LCD messages to JMRI
|
||||||
|
#, Request number of supported cabs/locos; heartbeat
|
||||||
|
+, WiFi AT commands
|
||||||
|
?, Reserved for future use
|
||||||
|
0, Track power off
|
||||||
|
1, Track power on
|
||||||
|
a, DCC accessory control
|
||||||
|
A,
|
||||||
|
b, Write CV bit on main
|
||||||
|
B, Write CV bit
|
||||||
|
c, Request current command
|
||||||
|
C,
|
||||||
|
d,
|
||||||
|
D, Diagnostic commands
|
||||||
|
e, Erase EEPROM
|
||||||
|
E, Store configuration in EEPROM
|
||||||
|
f, Loco decoder function control (deprecated)
|
||||||
|
F, Loco decoder function control
|
||||||
|
g,
|
||||||
|
G,
|
||||||
|
h,
|
||||||
|
H, Turnout state broadcast
|
||||||
|
i, Server details string
|
||||||
|
I, Turntable object command, control, and broadcast
|
||||||
|
j, Throttle responses
|
||||||
|
J, Throttle queries
|
||||||
|
k, Reserved for future use - Potentially Railcom
|
||||||
|
K, Reserved for future use - Potentially Railcom
|
||||||
|
l, Loco speedbyte/function map broadcast
|
||||||
|
L, Reserved for LCC interface (implemented in EXRAIL)
|
||||||
|
m,
|
||||||
|
M, Write DCC packet
|
||||||
|
n,
|
||||||
|
N,
|
||||||
|
o,
|
||||||
|
O, Output broadcast
|
||||||
|
p, Broadcast power state
|
||||||
|
P, Write DCC packet
|
||||||
|
q, Sensor deactivated
|
||||||
|
Q, Sensor activated
|
||||||
|
r, Broadcast address read on programming track
|
||||||
|
R, Read CVs
|
||||||
|
s, Display status
|
||||||
|
S, Sensor configuration
|
||||||
|
t, Cab/loco update command
|
||||||
|
T, Turnout configuration/control
|
||||||
|
u, Reserved for user commands
|
||||||
|
U, Reserved for user commands
|
||||||
|
v,
|
||||||
|
V, Verify CVs
|
||||||
|
w, Write CV on main
|
||||||
|
W, Write CV
|
||||||
|
x,
|
||||||
|
X, Invalid command
|
||||||
|
y,
|
||||||
|
Y, Output broadcast
|
||||||
|
z,
|
||||||
|
Z, Output configuration/control
|
||||||
|
*/
|
||||||
|
|
||||||
#include "StringFormatter.h"
|
#include "StringFormatter.h"
|
||||||
#include "DCCEXParser.h"
|
#include "DCCEXParser.h"
|
||||||
#include "DCC.h"
|
#include "DCC.h"
|
||||||
|
@ -40,22 +114,21 @@
|
||||||
#include "TrackManager.h"
|
#include "TrackManager.h"
|
||||||
#include "DCCTimer.h"
|
#include "DCCTimer.h"
|
||||||
#include "EXRAIL2.h"
|
#include "EXRAIL2.h"
|
||||||
|
#include "Turntables.h"
|
||||||
|
|
||||||
// This macro can't be created easily as a portable function because the
|
// This macro can't be created easily as a portable function because the
|
||||||
// flashlist requires a far pointer for high flash access.
|
// flashlist requires a far pointer for high flash access.
|
||||||
#define SENDFLASHLIST(stream,flashList) \
|
#define SENDFLASHLIST(stream,flashList) \
|
||||||
for (int16_t i=0;;i+=sizeof(flashList[0])) { \
|
for (int16_t i=0;;i+=sizeof(flashList[0])) { \
|
||||||
int16_t value=GETHIGHFLASHW(flashList,i); \
|
int16_t value=GETHIGHFLASHW(flashList,i); \
|
||||||
if (value==0) break; \
|
if (value==INT16_MAX) break; \
|
||||||
StringFormatter::send(stream,F(" %d"),value); \
|
StringFormatter::send(stream,F(" %d"),value); \
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
// These keywords are used in the <1> command. The number is what you get if you use the keyword as a parameter.
|
// These keywords are used in the <1> command. The number is what you get if you use the keyword as a parameter.
|
||||||
// To discover new keyword numbers , use the <$ YOURKEYWORD> command
|
// To discover new keyword numbers , use the <$ YOURKEYWORD> command
|
||||||
const int16_t HASH_KEYWORD_PROG = -29718;
|
|
||||||
const int16_t HASH_KEYWORD_MAIN = 11339;
|
const int16_t HASH_KEYWORD_MAIN = 11339;
|
||||||
const int16_t HASH_KEYWORD_JOIN = -30750;
|
|
||||||
const int16_t HASH_KEYWORD_CABS = -11981;
|
const int16_t HASH_KEYWORD_CABS = -11981;
|
||||||
const int16_t HASH_KEYWORD_RAM = 25982;
|
const int16_t HASH_KEYWORD_RAM = 25982;
|
||||||
const int16_t HASH_KEYWORD_CMD = 9962;
|
const int16_t HASH_KEYWORD_CMD = 9962;
|
||||||
|
@ -63,7 +136,11 @@ const int16_t HASH_KEYWORD_ACK = 3113;
|
||||||
const int16_t HASH_KEYWORD_ON = 2657;
|
const int16_t HASH_KEYWORD_ON = 2657;
|
||||||
const int16_t HASH_KEYWORD_DCC = 6436;
|
const int16_t HASH_KEYWORD_DCC = 6436;
|
||||||
const int16_t HASH_KEYWORD_SLOW = -17209;
|
const int16_t HASH_KEYWORD_SLOW = -17209;
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
|
const int16_t HASH_KEYWORD_JOIN = -30750;
|
||||||
|
const int16_t HASH_KEYWORD_PROG = -29718;
|
||||||
const int16_t HASH_KEYWORD_PROGBOOST = -6353;
|
const int16_t HASH_KEYWORD_PROGBOOST = -6353;
|
||||||
|
#endif
|
||||||
#ifndef DISABLE_EEPROM
|
#ifndef DISABLE_EEPROM
|
||||||
const int16_t HASH_KEYWORD_EEPROM = -7168;
|
const int16_t HASH_KEYWORD_EEPROM = -7168;
|
||||||
#endif
|
#endif
|
||||||
|
@ -80,7 +157,10 @@ const int16_t HASH_KEYWORD_VPIN=-415;
|
||||||
const int16_t HASH_KEYWORD_A='A';
|
const int16_t HASH_KEYWORD_A='A';
|
||||||
const int16_t HASH_KEYWORD_C='C';
|
const int16_t HASH_KEYWORD_C='C';
|
||||||
const int16_t HASH_KEYWORD_G='G';
|
const int16_t HASH_KEYWORD_G='G';
|
||||||
|
const int16_t HASH_KEYWORD_H='H';
|
||||||
const int16_t HASH_KEYWORD_I='I';
|
const int16_t HASH_KEYWORD_I='I';
|
||||||
|
const int16_t HASH_KEYWORD_O='O';
|
||||||
|
const int16_t HASH_KEYWORD_P='P';
|
||||||
const int16_t HASH_KEYWORD_R='R';
|
const int16_t HASH_KEYWORD_R='R';
|
||||||
const int16_t HASH_KEYWORD_T='T';
|
const int16_t HASH_KEYWORD_T='T';
|
||||||
const int16_t HASH_KEYWORD_X='X';
|
const int16_t HASH_KEYWORD_X='X';
|
||||||
|
@ -92,6 +172,8 @@ const int16_t HASH_KEYWORD_ANOUT = -26399;
|
||||||
const int16_t HASH_KEYWORD_WIFI = -5583;
|
const int16_t HASH_KEYWORD_WIFI = -5583;
|
||||||
const int16_t HASH_KEYWORD_ETHERNET = -30767;
|
const int16_t HASH_KEYWORD_ETHERNET = -30767;
|
||||||
const int16_t HASH_KEYWORD_WIT = 31594;
|
const int16_t HASH_KEYWORD_WIT = 31594;
|
||||||
|
const int16_t HASH_KEYWORD_EXTT = 8573;
|
||||||
|
const int16_t HASH_KEYWORD_ADD = 3201;
|
||||||
|
|
||||||
int16_t DCCEXParser::stashP[MAX_COMMAND_PARAMS];
|
int16_t DCCEXParser::stashP[MAX_COMMAND_PARAMS];
|
||||||
bool DCCEXParser::stashBusy;
|
bool DCCEXParser::stashBusy;
|
||||||
|
@ -216,6 +298,9 @@ void DCCEXParser::parse(Print *stream, byte *com, RingStream *ringStream) {
|
||||||
|
|
||||||
void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
{
|
{
|
||||||
|
#ifdef DISABLE_PROG
|
||||||
|
(void)ringStream;
|
||||||
|
#endif
|
||||||
#ifndef DISABLE_EEPROM
|
#ifndef DISABLE_EEPROM
|
||||||
(void)EEPROM; // tell compiler not to warn this is unused
|
(void)EEPROM; // tell compiler not to warn this is unused
|
||||||
#endif
|
#endif
|
||||||
|
@ -285,6 +370,8 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
|
|
||||||
if (direction < 0 || direction > 1)
|
if (direction < 0 || direction > 1)
|
||||||
break; // invalid direction code
|
break; // invalid direction code
|
||||||
|
if (cab > 10239 || cab < 0)
|
||||||
|
break; // beyond DCC range
|
||||||
|
|
||||||
DCC::setThrottle(cab, tspeed, direction);
|
DCC::setThrottle(cab, tspeed, direction);
|
||||||
if (params == 4) // send obsolete format T response
|
if (params == 4) // send obsolete format T response
|
||||||
|
@ -368,16 +455,24 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
return;
|
return;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
case 'w': // WRITE CV on MAIN <w CAB CV VALUE>
|
case 'w': // WRITE CV on MAIN <w CAB CV VALUE>
|
||||||
DCC::writeCVByteMain(p[0], p[1], p[2]);
|
if (params != 3)
|
||||||
return;
|
break;
|
||||||
|
DCC::writeCVByteMain(p[0], p[1], p[2]);
|
||||||
|
return;
|
||||||
|
|
||||||
case 'b': // WRITE CV BIT ON MAIN <b CAB CV BIT VALUE>
|
case 'b': // WRITE CV BIT ON MAIN <b CAB CV BIT VALUE>
|
||||||
DCC::writeCVBitMain(p[0], p[1], p[2], p[3]);
|
if (params != 4)
|
||||||
return;
|
break;
|
||||||
|
DCC::writeCVBitMain(p[0], p[1], p[2], p[3]);
|
||||||
|
return;
|
||||||
|
#endif
|
||||||
|
|
||||||
case 'M': // WRITE TRANSPARENT DCC PACKET MAIN <M REG X1 ... X9>
|
case 'M': // WRITE TRANSPARENT DCC PACKET MAIN <M REG X1 ... X9>
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
case 'P': // WRITE TRANSPARENT DCC PACKET PROG <P REG X1 ... X9>
|
case 'P': // WRITE TRANSPARENT DCC PACKET PROG <P REG X1 ... X9>
|
||||||
|
#endif
|
||||||
// NOTE: this command was parsed in HEX instead of decimal
|
// NOTE: this command was parsed in HEX instead of decimal
|
||||||
params--; // drop REG
|
params--; // drop REG
|
||||||
if (params<1) break;
|
if (params<1) break;
|
||||||
|
@ -392,15 +487,18 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
}
|
}
|
||||||
return;
|
return;
|
||||||
|
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
case 'W': // WRITE CV ON PROG <W CV VALUE CALLBACKNUM CALLBACKSUB>
|
case 'W': // WRITE CV ON PROG <W CV VALUE CALLBACKNUM CALLBACKSUB>
|
||||||
if (!stashCallback(stream, p, ringStream))
|
if (!stashCallback(stream, p, ringStream))
|
||||||
break;
|
break;
|
||||||
if (params == 1) // <W id> Write new loco id (clearing consist and managing short/long)
|
if (params == 1) // <W id> Write new loco id (clearing consist and managing short/long)
|
||||||
DCC::setLocoId(p[0],callback_Wloco);
|
DCC::setLocoId(p[0],callback_Wloco);
|
||||||
else if (params == 4) // WRITE CV ON PROG <W CV VALUE [CALLBACKNUM] [CALLBACKSUB]>
|
else if (params == 4) // WRITE CV ON PROG <W CV VALUE [CALLBACKNUM] [CALLBACKSUB]>
|
||||||
DCC::writeCVByte(p[0], p[1], callback_W4);
|
DCC::writeCVByte(p[0], p[1], callback_W4);
|
||||||
else // WRITE CV ON PROG <W CV VALUE>
|
else if (params == 2) // WRITE CV ON PROG <W CV VALUE>
|
||||||
DCC::writeCVByte(p[0], p[1], callback_W);
|
DCC::writeCVByte(p[0], p[1], callback_W);
|
||||||
|
else
|
||||||
|
break;
|
||||||
return;
|
return;
|
||||||
|
|
||||||
case 'V': // VERIFY CV ON PROG <V CV VALUE> <V CV BIT 0|1>
|
case 'V': // VERIFY CV ON PROG <V CV VALUE> <V CV BIT 0|1>
|
||||||
|
@ -420,9 +518,11 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'B': // WRITE CV BIT ON PROG <B CV BIT VALUE CALLBACKNUM CALLBACKSUB>
|
case 'B': // WRITE CV BIT ON PROG <B CV BIT VALUE CALLBACKNUM CALLBACKSUB> or <B CV BIT VALUE>
|
||||||
|
if (params != 3 && params != 5)
|
||||||
|
break;
|
||||||
if (!stashCallback(stream, p, ringStream))
|
if (!stashCallback(stream, p, ringStream))
|
||||||
break;
|
break;
|
||||||
DCC::writeCVBit(p[0], p[1], p[2], callback_B);
|
DCC::writeCVBit(p[0], p[1], p[2], callback_B);
|
||||||
return;
|
return;
|
||||||
|
|
||||||
|
@ -449,68 +549,135 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case '1': // POWERON <1 [MAIN|PROG|JOIN]>
|
case '1': // POWERON <1 [MAIN|PROG|JOIN]>
|
||||||
{
|
{
|
||||||
bool main=false;
|
bool main=false;
|
||||||
bool prog=false;
|
bool prog=false;
|
||||||
bool join=false;
|
bool join=false;
|
||||||
if (params > 1) break;
|
bool singletrack=false;
|
||||||
if (params==0 || MotorDriver::commonFaultPin) { // <1> or tracks can not be handled individually
|
//byte t=0;
|
||||||
main=true;
|
if (params > 1) break;
|
||||||
prog=true;
|
if (params==0) { // All
|
||||||
}
|
main=true;
|
||||||
if (params==1) {
|
prog=true;
|
||||||
if (p[0] == HASH_KEYWORD_JOIN) { // <1 JOIN>
|
}
|
||||||
main=true;
|
if (params==1) {
|
||||||
prog=true;
|
if (p[0]==HASH_KEYWORD_MAIN) { // <1 MAIN>
|
||||||
join=true;
|
main=true;
|
||||||
}
|
}
|
||||||
else if (p[0]==HASH_KEYWORD_MAIN) { // <1 MAIN>
|
#ifndef DISABLE_PROG
|
||||||
main=true;
|
else if (p[0] == HASH_KEYWORD_JOIN) { // <1 JOIN>
|
||||||
}
|
main=true;
|
||||||
else if (p[0]==HASH_KEYWORD_PROG) { // <1 PROG>
|
prog=true;
|
||||||
prog=true;
|
join=true;
|
||||||
}
|
}
|
||||||
else break; // will reply <X>
|
else if (p[0]==HASH_KEYWORD_PROG) { // <1 PROG>
|
||||||
}
|
prog=true;
|
||||||
if (main) TrackManager::setMainPower(POWERMODE::ON);
|
}
|
||||||
if (prog) TrackManager::setProgPower(POWERMODE::ON);
|
#endif
|
||||||
TrackManager::setJoin(join);
|
//else if (p[0] >= 'A' && p[0] <= 'H') { // <1 A-H>
|
||||||
|
else if (p[0] >= HASH_KEYWORD_A && p[0] <= HASH_KEYWORD_H) { // <1 A-H>
|
||||||
|
byte t = (p[0] - 'A');
|
||||||
|
//DIAG(F("Processing track - %d "), t);
|
||||||
|
if (TrackManager::isProg(t)) {
|
||||||
|
main = false;
|
||||||
|
prog = true;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
main=true;
|
||||||
|
prog=false;
|
||||||
|
}
|
||||||
|
singletrack=true;
|
||||||
|
if (main) TrackManager::setTrackPower(false, false, POWERMODE::ON, t);
|
||||||
|
if (prog) TrackManager::setTrackPower(true, false, POWERMODE::ON, t);
|
||||||
|
|
||||||
|
StringFormatter::send(stream, F("<1 %c>\n"), t+'A');
|
||||||
|
//CommandDistributor::broadcastPower();
|
||||||
|
//TrackManager::streamTrackState(NULL,t);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
else break; // will reply <X>
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!singletrack) {
|
||||||
|
TrackManager::setJoin(join);
|
||||||
|
if (join) TrackManager::setJoinPower(POWERMODE::ON);
|
||||||
|
else {
|
||||||
|
if (main) TrackManager::setMainPower(POWERMODE::ON);
|
||||||
|
if (prog) TrackManager::setProgPower(POWERMODE::ON);
|
||||||
|
}
|
||||||
|
CommandDistributor::broadcastPower();
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
CommandDistributor::broadcastPower();
|
|
||||||
return;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
case '0': // POWEROFF <0 [MAIN | PROG] >
|
case '0': // POWEROFF <0 [MAIN | PROG] >
|
||||||
{
|
{
|
||||||
bool main=false;
|
bool main=false;
|
||||||
bool prog=false;
|
bool prog=false;
|
||||||
if (params > 1) break;
|
bool singletrack=false;
|
||||||
if (params==0 || MotorDriver::commonFaultPin) { // <0> or tracks can not be handled individually
|
//byte t=0;
|
||||||
main=true;
|
if (params > 1) break;
|
||||||
prog=true;
|
if (params==0) { // All
|
||||||
}
|
main=true;
|
||||||
if (params==1) {
|
prog=true;
|
||||||
if (p[0]==HASH_KEYWORD_MAIN) { // <0 MAIN>
|
}
|
||||||
main=true;
|
if (params==1) {
|
||||||
}
|
if (p[0]==HASH_KEYWORD_MAIN) { // <0 MAIN>
|
||||||
else if (p[0]==HASH_KEYWORD_PROG) { // <0 PROG>
|
main=true;
|
||||||
prog=true;
|
}
|
||||||
}
|
#ifndef DISABLE_PROG
|
||||||
else break; // will reply <X>
|
else if (p[0]==HASH_KEYWORD_PROG) { // <0 PROG>
|
||||||
}
|
prog=true;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
//else if (p[0] >= 'A' && p[0] <= 'H') { // <1 A-H>
|
||||||
|
else if (p[0] >= HASH_KEYWORD_A && p[0] <= HASH_KEYWORD_H) { // <1 A-H>
|
||||||
|
byte t = (p[0] - 'A');
|
||||||
|
//DIAG(F("Processing track - %d "), t);
|
||||||
|
if (TrackManager::isProg(t)) {
|
||||||
|
main = false;
|
||||||
|
prog = true;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
main=true;
|
||||||
|
prog=false;
|
||||||
|
}
|
||||||
|
singletrack=true;
|
||||||
|
TrackManager::setJoin(false);
|
||||||
|
if (main) TrackManager::setTrackPower(false, false, POWERMODE::OFF, t);
|
||||||
|
if (prog) {
|
||||||
|
TrackManager::progTrackBoosted=false; // Prog track boost mode will not outlive prog track off
|
||||||
|
TrackManager::setTrackPower(true, false, POWERMODE::OFF, t);
|
||||||
|
}
|
||||||
|
StringFormatter::send(stream, F("<0 %c>\n"), t+'A');
|
||||||
|
//CommandDistributor::broadcastPower();
|
||||||
|
//TrackManager::streamTrackState(NULL, t);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
if (main) TrackManager::setMainPower(POWERMODE::OFF);
|
else break; // will reply <X>
|
||||||
if (prog) {
|
}
|
||||||
TrackManager::progTrackBoosted=false; // Prog track boost mode will not outlive prog track off
|
|
||||||
TrackManager::setProgPower(POWERMODE::OFF);
|
|
||||||
}
|
|
||||||
TrackManager::setJoin(false);
|
|
||||||
|
|
||||||
CommandDistributor::broadcastPower();
|
if (!singletrack) {
|
||||||
return;
|
TrackManager::setJoin(false);
|
||||||
|
|
||||||
|
if (main) TrackManager::setMainPower(POWERMODE::OFF);
|
||||||
|
if (prog) {
|
||||||
|
TrackManager::progTrackBoosted=false; // Prog track boost mode will not outlive prog track off
|
||||||
|
TrackManager::setProgPower(POWERMODE::OFF);
|
||||||
|
}
|
||||||
|
CommandDistributor::broadcastPower();
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
case '!': // ESTOP ALL <!>
|
case '!': // ESTOP ALL <!>
|
||||||
DCC::setThrottle(0,1,1); // this broadcasts speed 1(estop) and sets all reminders to speed 1.
|
DCC::setThrottle(0,1,1); // this broadcasts speed 1(estop) and sets all reminders to speed 1.
|
||||||
|
@ -547,12 +714,12 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
case ' ': // < >
|
case ' ': // < >
|
||||||
StringFormatter::send(stream, F("\n"));
|
StringFormatter::send(stream, F("\n"));
|
||||||
return;
|
return;
|
||||||
|
#ifndef DISABLE_DIAG
|
||||||
case 'D': // < >
|
case 'D': // < >
|
||||||
if (parseD(stream, params, p))
|
if (parseD(stream, params, p))
|
||||||
return;
|
return;
|
||||||
return;
|
break;
|
||||||
|
#endif
|
||||||
case '=': // <= Track manager control >
|
case '=': // <= Track manager control >
|
||||||
if (TrackManager::parseJ(stream, params, p))
|
if (TrackManager::parseJ(stream, params, p))
|
||||||
return;
|
return;
|
||||||
|
@ -637,8 +804,16 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
if (params==1) {
|
if (params==1) {
|
||||||
SENDFLASHLIST(stream,RMFT2::rosterIdList)
|
SENDFLASHLIST(stream,RMFT2::rosterIdList)
|
||||||
}
|
}
|
||||||
else StringFormatter::send(stream,F(" %d \"%S\" \"%S\""),
|
else {
|
||||||
id, RMFT2::getRosterName(id), RMFT2::getRosterFunctions(id));
|
auto rosterName= RMFT2::getRosterName(id);
|
||||||
|
if (!rosterName) rosterName=F("");
|
||||||
|
|
||||||
|
auto functionNames= RMFT2::getRosterFunctions(id);
|
||||||
|
if (!functionNames) functionNames=RMFT2::getRosterFunctions(0);
|
||||||
|
if (!functionNames) functionNames=F("");
|
||||||
|
StringFormatter::send(stream,F(" %d \"%S\" \"%S\""),
|
||||||
|
id, rosterName, functionNames);
|
||||||
|
}
|
||||||
#endif
|
#endif
|
||||||
StringFormatter::send(stream, F(">\n"));
|
StringFormatter::send(stream, F(">\n"));
|
||||||
return;
|
return;
|
||||||
|
@ -667,11 +842,73 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
}
|
}
|
||||||
StringFormatter::send(stream, F(">\n"));
|
StringFormatter::send(stream, F(">\n"));
|
||||||
return;
|
return;
|
||||||
|
// No turntables without HAL support
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
case HASH_KEYWORD_O: // <JO returns turntable list
|
||||||
|
StringFormatter::send(stream, F("<jO"));
|
||||||
|
if (params==1) { // <JO>
|
||||||
|
for (Turntable * tto=Turntable::first(); tto; tto=tto->next()) {
|
||||||
|
if (tto->isHidden()) continue;
|
||||||
|
StringFormatter::send(stream, F(" %d"),tto->getId());
|
||||||
|
}
|
||||||
|
StringFormatter::send(stream, F(">\n"));
|
||||||
|
} else { // <JO id>
|
||||||
|
Turntable *tto=Turntable::get(id);
|
||||||
|
if (!tto || tto->isHidden()) {
|
||||||
|
StringFormatter::send(stream, F(" %d X>\n"), id);
|
||||||
|
} else {
|
||||||
|
uint8_t pos = tto->getPosition();
|
||||||
|
uint8_t type = tto->isEXTT();
|
||||||
|
uint8_t posCount = tto->getPositionCount();
|
||||||
|
const FSH *todesc = NULL;
|
||||||
|
#ifdef EXRAIL_ACTIVE
|
||||||
|
todesc = RMFT2::getTurntableDescription(id);
|
||||||
|
#endif
|
||||||
|
if (todesc == NULL) todesc = F("");
|
||||||
|
StringFormatter::send(stream, F(" %d %d %d %d \"%S\">\n"), id, type, pos, posCount, todesc);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return;
|
||||||
|
case HASH_KEYWORD_P: // <JP id> returns turntable position list for the turntable id
|
||||||
|
if (params==2) { // <JP id>
|
||||||
|
Turntable *tto=Turntable::get(id);
|
||||||
|
if (!tto || tto->isHidden()) {
|
||||||
|
StringFormatter::send(stream, F(" %d X>\n"), id);
|
||||||
|
} else {
|
||||||
|
uint8_t posCount = tto->getPositionCount();
|
||||||
|
const FSH *tpdesc = NULL;
|
||||||
|
for (uint8_t p = 0; p < posCount; p++) {
|
||||||
|
StringFormatter::send(stream, F("<jP"));
|
||||||
|
int16_t angle = tto->getPositionAngle(p);
|
||||||
|
#ifdef EXRAIL_ACTIVE
|
||||||
|
tpdesc = RMFT2::getTurntablePositionDescription(id, p);
|
||||||
|
#endif
|
||||||
|
if (tpdesc == NULL) tpdesc = F("");
|
||||||
|
StringFormatter::send(stream, F(" %d %d %d \"%S\""), id, p, angle, tpdesc);
|
||||||
|
StringFormatter::send(stream, F(">\n"));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
StringFormatter::send(stream, F("<jP X>\n"));
|
||||||
|
}
|
||||||
|
return;
|
||||||
|
#endif
|
||||||
default: break;
|
default: break;
|
||||||
} // switch(p[1])
|
} // switch(p[1])
|
||||||
break; // case J
|
break; // case J
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// No turntables without HAL support
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
case 'I': // TURNTABLE <I ...>
|
||||||
|
if (parseI(stream, params, p))
|
||||||
|
return;
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
case 'L': // LCC interface implemented in EXRAIL parser
|
||||||
|
break; // Will <X> if not intercepted by EXRAIL
|
||||||
|
|
||||||
default: //anything else will diagnose and drop out to <X>
|
default: //anything else will diagnose and drop out to <X>
|
||||||
DIAG(F("Opcode=%c params=%d"), opcode, params);
|
DIAG(F("Opcode=%c params=%d"), opcode, params);
|
||||||
for (int i = 0; i < params; i++)
|
for (int i = 0; i < params; i++)
|
||||||
|
@ -890,8 +1127,9 @@ bool DCCEXParser::parseD(Print *stream, int16_t params, int16_t p[])
|
||||||
|
|
||||||
case HASH_KEYWORD_RAM: // <D RAM>
|
case HASH_KEYWORD_RAM: // <D RAM>
|
||||||
StringFormatter::send(stream, F("Free memory=%d\n"), DCCTimer::getMinimumFreeMemory());
|
StringFormatter::send(stream, F("Free memory=%d\n"), DCCTimer::getMinimumFreeMemory());
|
||||||
break;
|
return true;
|
||||||
|
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
case HASH_KEYWORD_ACK: // <D ACK ON/OFF> <D ACK [LIMIT|MIN|MAX|RETRY] Value>
|
case HASH_KEYWORD_ACK: // <D ACK ON/OFF> <D ACK [LIMIT|MIN|MAX|RETRY] Value>
|
||||||
if (params >= 3) {
|
if (params >= 3) {
|
||||||
if (p[1] == HASH_KEYWORD_LIMIT) {
|
if (p[1] == HASH_KEYWORD_LIMIT) {
|
||||||
|
@ -912,6 +1150,7 @@ bool DCCEXParser::parseD(Print *stream, int16_t params, int16_t p[])
|
||||||
Diag::ACK = onOff;
|
Diag::ACK = onOff;
|
||||||
}
|
}
|
||||||
return true;
|
return true;
|
||||||
|
#endif
|
||||||
|
|
||||||
case HASH_KEYWORD_CMD: // <D CMD ON/OFF>
|
case HASH_KEYWORD_CMD: // <D CMD ON/OFF>
|
||||||
Diag::CMD = onOff;
|
Diag::CMD = onOff;
|
||||||
|
@ -934,11 +1173,11 @@ bool DCCEXParser::parseD(Print *stream, int16_t params, int16_t p[])
|
||||||
Diag::LCN = onOff;
|
Diag::LCN = onOff;
|
||||||
return true;
|
return true;
|
||||||
#endif
|
#endif
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
case HASH_KEYWORD_PROGBOOST:
|
case HASH_KEYWORD_PROGBOOST:
|
||||||
TrackManager::progTrackBoosted=true;
|
TrackManager::progTrackBoosted=true;
|
||||||
return true;
|
return true;
|
||||||
|
#endif
|
||||||
case HASH_KEYWORD_RESET:
|
case HASH_KEYWORD_RESET:
|
||||||
DCCTimer::reset();
|
DCCTimer::reset();
|
||||||
break; // and <X> if we didnt restart
|
break; // and <X> if we didnt restart
|
||||||
|
@ -989,6 +1228,99 @@ bool DCCEXParser::parseD(Print *stream, int16_t params, int16_t p[])
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// ==========================
|
||||||
|
// Turntable - no support if no HAL
|
||||||
|
// <I> - list all
|
||||||
|
// <I id> - broadcast type and current position
|
||||||
|
// <I id DCC> - create DCC - This is TBA
|
||||||
|
// <I id steps> - operate (DCC)
|
||||||
|
// <I id steps activity> - operate (EXTT)
|
||||||
|
// <I id ADD position value> - add position
|
||||||
|
// <I id EXTT i2caddress vpin home> - create EXTT
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
bool DCCEXParser::parseI(Print *stream, int16_t params, int16_t p[])
|
||||||
|
{
|
||||||
|
switch (params)
|
||||||
|
{
|
||||||
|
case 0: // <I> list turntable objects
|
||||||
|
return Turntable::printAll(stream);
|
||||||
|
|
||||||
|
case 1: // <I id> broadcast type and current position
|
||||||
|
{
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
if (tto) {
|
||||||
|
bool type = tto->isEXTT();
|
||||||
|
uint8_t position = tto->getPosition();
|
||||||
|
StringFormatter::send(stream, F("<I %d %d>\n"), type, position);
|
||||||
|
} else {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
|
||||||
|
case 2: // <I id position> - rotate a DCC turntable
|
||||||
|
{
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
if (tto && !tto->isEXTT()) {
|
||||||
|
if (!tto->setPosition(p[0], p[1])) return false;
|
||||||
|
} else {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
|
||||||
|
case 3: // <I id position activity> | <I id DCC home> - rotate to position for EX-Turntable or create DCC turntable
|
||||||
|
{
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
if (p[1] == HASH_KEYWORD_DCC) {
|
||||||
|
if (tto || p[2] < 0 || p[2] > 3600) return false;
|
||||||
|
if (!DCCTurntable::create(p[0])) return false;
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
tto->addPosition(0, 0, p[2]);
|
||||||
|
StringFormatter::send(stream, F("<I>\n"));
|
||||||
|
} else {
|
||||||
|
if (!tto) return false;
|
||||||
|
if (!tto->isEXTT()) return false;
|
||||||
|
if (!tto->setPosition(p[0], p[1], p[2])) return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
|
||||||
|
case 4: // <I id EXTT vpin home> create an EXTT turntable
|
||||||
|
{
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
if (p[1] == HASH_KEYWORD_EXTT) {
|
||||||
|
if (tto || p[3] < 0 || p[3] > 3600) return false;
|
||||||
|
if (!EXTTTurntable::create(p[0], (VPIN)p[2])) return false;
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
tto->addPosition(0, 0, p[3]);
|
||||||
|
StringFormatter::send(stream, F("<I>\n"));
|
||||||
|
} else {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
|
||||||
|
case 5: // <I id ADD position value angle> add a position
|
||||||
|
{
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
if (p[1] == HASH_KEYWORD_ADD) {
|
||||||
|
// tto must exist, no more than 48 positions, angle 0 - 3600
|
||||||
|
if (!tto || p[2] > 48 || p[4] < 0 || p[4] > 3600) return false;
|
||||||
|
tto->addPosition(p[2], p[3], p[4]);
|
||||||
|
StringFormatter::send(stream, F("<I>\n"));
|
||||||
|
} else {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
|
||||||
|
default: // Anything else is invalid
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
// CALLBACKS must be static
|
// CALLBACKS must be static
|
||||||
bool DCCEXParser::stashCallback(Print *stream, int16_t p[MAX_COMMAND_PARAMS], RingStream * ringStream)
|
bool DCCEXParser::stashCallback(Print *stream, int16_t p[MAX_COMMAND_PARAMS], RingStream * ringStream)
|
||||||
{
|
{
|
||||||
|
|
|
@ -24,6 +24,7 @@
|
||||||
#include <Arduino.h>
|
#include <Arduino.h>
|
||||||
#include "FSH.h"
|
#include "FSH.h"
|
||||||
#include "RingStream.h"
|
#include "RingStream.h"
|
||||||
|
#include "defines.h"
|
||||||
|
|
||||||
typedef void (*FILTER_CALLBACK)(Print * stream, byte & opcode, byte & paramCount, int16_t p[]);
|
typedef void (*FILTER_CALLBACK)(Print * stream, byte & opcode, byte & paramCount, int16_t p[]);
|
||||||
typedef void (*AT_COMMAND_CALLBACK)(HardwareSerial * stream,const byte * command);
|
typedef void (*AT_COMMAND_CALLBACK)(HardwareSerial * stream,const byte * command);
|
||||||
|
@ -45,13 +46,16 @@ struct DCCEXParser
|
||||||
static int16_t splitValues( int16_t result[MAX_COMMAND_PARAMS], const byte * command, bool usehex);
|
static int16_t splitValues( int16_t result[MAX_COMMAND_PARAMS], const byte * command, bool usehex);
|
||||||
|
|
||||||
static bool parseT(Print * stream, int16_t params, int16_t p[]);
|
static bool parseT(Print * stream, int16_t params, int16_t p[]);
|
||||||
static bool parseZ(Print * stream, int16_t params, int16_t p[]);
|
static bool parseZ(Print * stream, int16_t params, int16_t p[]);
|
||||||
static bool parseS(Print * stream, int16_t params, int16_t p[]);
|
static bool parseS(Print * stream, int16_t params, int16_t p[]);
|
||||||
static bool parsef(Print * stream, int16_t params, int16_t p[]);
|
static bool parsef(Print * stream, int16_t params, int16_t p[]);
|
||||||
static bool parseD(Print * stream, int16_t params, int16_t p[]);
|
static bool parseD(Print * stream, int16_t params, int16_t p[]);
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
static bool parseI(Print * stream, int16_t params, int16_t p[]);
|
||||||
|
#endif
|
||||||
|
|
||||||
static Print * getAsyncReplyStream();
|
static Print * getAsyncReplyStream();
|
||||||
static void commitAsyncReplyStream();
|
static void commitAsyncReplyStream();
|
||||||
|
|
||||||
static bool stashBusy;
|
static bool stashBusy;
|
||||||
static byte stashTarget;
|
static byte stashTarget;
|
||||||
|
|
|
@ -194,8 +194,10 @@ int RMTChannel::RMTfillData(const byte buffer[], byte byteCount, byte repeatCoun
|
||||||
setDCCBit1(data + bitcounter-1); // overwrite previous zero bit with one bit
|
setDCCBit1(data + bitcounter-1); // overwrite previous zero bit with one bit
|
||||||
setEOT(data + bitcounter++); // EOT marker
|
setEOT(data + bitcounter++); // EOT marker
|
||||||
dataLen = bitcounter;
|
dataLen = bitcounter;
|
||||||
|
noInterrupts(); // keep dataReady and dataRepeat consistnet to each other
|
||||||
dataReady = true;
|
dataReady = true;
|
||||||
dataRepeat = repeatCount+1; // repeatCount of 0 means send once
|
dataRepeat = repeatCount+1; // repeatCount of 0 means send once
|
||||||
|
interrupts();
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -212,6 +214,8 @@ void IRAM_ATTR RMTChannel::RMTinterrupt() {
|
||||||
if (dataReady) { // if we have new data, fill while preamble is running
|
if (dataReady) { // if we have new data, fill while preamble is running
|
||||||
rmt_fill_tx_items(channel, data, dataLen, preambleLen-1);
|
rmt_fill_tx_items(channel, data, dataLen, preambleLen-1);
|
||||||
dataReady = false;
|
dataReady = false;
|
||||||
|
if (dataRepeat == 0) // all data should go out at least once
|
||||||
|
DIAG(F("Channel %d DCC signal lost data"), channel);
|
||||||
}
|
}
|
||||||
if (dataRepeat > 0) // if a repeat count was specified, work on that
|
if (dataRepeat > 0) // if a repeat count was specified, work on that
|
||||||
dataRepeat--;
|
dataRepeat--;
|
||||||
|
|
27
DCCTimer.h
27
DCCTimer.h
|
@ -1,7 +1,7 @@
|
||||||
/*
|
/*
|
||||||
* © 2022 Paul M. Antoine
|
* © 2022-2023 Paul M. Antoine
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021-2022 Harald Barth
|
* © 2021-2023 Harald Barth
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
|
@ -62,6 +62,9 @@ class DCCTimer {
|
||||||
static bool isPWMPin(byte pin);
|
static bool isPWMPin(byte pin);
|
||||||
static void setPWM(byte pin, bool high);
|
static void setPWM(byte pin, bool high);
|
||||||
static void clearPWM();
|
static void clearPWM();
|
||||||
|
static void DCCEXanalogWriteFrequency(uint8_t pin, uint32_t frequency);
|
||||||
|
static void DCCEXanalogWrite(uint8_t pin, int value);
|
||||||
|
|
||||||
// Update low ram level. Allow for extra bytes to be specified
|
// Update low ram level. Allow for extra bytes to be specified
|
||||||
// by estimation or inspection, that may be used by other
|
// by estimation or inspection, that may be used by other
|
||||||
// called subroutines. Must be called with interrupts disabled.
|
// called subroutines. Must be called with interrupts disabled.
|
||||||
|
@ -102,9 +105,14 @@ private:
|
||||||
// that an offset can be initialized.
|
// that an offset can be initialized.
|
||||||
class ADCee {
|
class ADCee {
|
||||||
public:
|
public:
|
||||||
// init does add the pin to the list of scanned pins (if this
|
// begin is called for any setup that must be done before
|
||||||
|
// **init** can be called. On some architectures this involves ADC
|
||||||
|
// initialisation and clock routing, sampling times etc.
|
||||||
|
static void begin();
|
||||||
|
// init adds the pin to the list of scanned pins (if this
|
||||||
// platform's implementation scans pins) and returns the first
|
// platform's implementation scans pins) and returns the first
|
||||||
// read value. It is called before the regular scan is started.
|
// read value (which is why it required begin to have been called first!)
|
||||||
|
// It must be called before the regular scan is started.
|
||||||
static int init(uint8_t pin);
|
static int init(uint8_t pin);
|
||||||
// read does read the pin value from the scanned cache or directly
|
// read does read the pin value from the scanned cache or directly
|
||||||
// if this is a platform that does not scan. fromISR is a hint if
|
// if this is a platform that does not scan. fromISR is a hint if
|
||||||
|
@ -113,19 +121,20 @@ public:
|
||||||
static int read(uint8_t pin, bool fromISR=false);
|
static int read(uint8_t pin, bool fromISR=false);
|
||||||
// returns possible max value that the ADC can return
|
// returns possible max value that the ADC can return
|
||||||
static int16_t ADCmax();
|
static int16_t ADCmax();
|
||||||
// begin is called for any setup that must be done before
|
|
||||||
// scan can be called.
|
|
||||||
static void begin();
|
|
||||||
private:
|
private:
|
||||||
// On platforms that scan, it is called from waveform ISR
|
// On platforms that scan, it is called from waveform ISR
|
||||||
// only on a regular basis.
|
// only on a regular basis.
|
||||||
static void scan();
|
static void scan();
|
||||||
|
#if defined (ARDUINO_ARCH_STM32)
|
||||||
|
// bit array of used pins (max 32)
|
||||||
|
static uint32_t usedpins;
|
||||||
|
#else
|
||||||
// bit array of used pins (max 16)
|
// bit array of used pins (max 16)
|
||||||
static uint16_t usedpins;
|
static uint16_t usedpins;
|
||||||
|
#endif
|
||||||
|
static uint8_t highestPin;
|
||||||
// cached analog values (malloc:ed to actual number of ADC channels)
|
// cached analog values (malloc:ed to actual number of ADC channels)
|
||||||
static int *analogvals;
|
static int *analogvals;
|
||||||
// ids to scan (new way)
|
|
||||||
static byte *idarr;
|
|
||||||
// friend so that we can call scan() and begin()
|
// friend so that we can call scan() and begin()
|
||||||
friend class DCCWaveform;
|
friend class DCCWaveform;
|
||||||
};
|
};
|
||||||
|
|
|
@ -1,6 +1,6 @@
|
||||||
/*
|
/*
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021-2022 Harald Barth
|
* © 2021-2023 Harald Barth
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2021 Chris Harlow
|
* © 2021 Chris Harlow
|
||||||
* © 2021 David Cutting
|
* © 2021 David Cutting
|
||||||
|
@ -29,6 +29,9 @@
|
||||||
#include <avr/boot.h>
|
#include <avr/boot.h>
|
||||||
#include <avr/wdt.h>
|
#include <avr/wdt.h>
|
||||||
#include "DCCTimer.h"
|
#include "DCCTimer.h"
|
||||||
|
#ifdef DEBUG_ADC
|
||||||
|
#include "TrackManager.h"
|
||||||
|
#endif
|
||||||
INTERRUPT_CALLBACK interruptHandler=0;
|
INTERRUPT_CALLBACK interruptHandler=0;
|
||||||
|
|
||||||
// Arduino nano, uno, mega etc
|
// Arduino nano, uno, mega etc
|
||||||
|
@ -128,8 +131,8 @@ void DCCTimer::reset() {
|
||||||
#define NUM_ADC_INPUTS 8
|
#define NUM_ADC_INPUTS 8
|
||||||
#endif
|
#endif
|
||||||
uint16_t ADCee::usedpins = 0;
|
uint16_t ADCee::usedpins = 0;
|
||||||
|
uint8_t ADCee::highestPin = 0;
|
||||||
int * ADCee::analogvals = NULL;
|
int * ADCee::analogvals = NULL;
|
||||||
byte *ADCee::idarr = NULL;
|
|
||||||
static bool ADCusesHighPort = false;
|
static bool ADCusesHighPort = false;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -139,28 +142,17 @@ static bool ADCusesHighPort = false;
|
||||||
*/
|
*/
|
||||||
int ADCee::init(uint8_t pin) {
|
int ADCee::init(uint8_t pin) {
|
||||||
uint8_t id = pin - A0;
|
uint8_t id = pin - A0;
|
||||||
byte n;
|
|
||||||
if (id >= NUM_ADC_INPUTS)
|
if (id >= NUM_ADC_INPUTS)
|
||||||
return -1023;
|
return -1023;
|
||||||
if (id > 7)
|
if (id > 7)
|
||||||
ADCusesHighPort = true;
|
ADCusesHighPort = true;
|
||||||
pinMode(pin, INPUT);
|
pinMode(pin, INPUT);
|
||||||
int value = analogRead(pin);
|
int value = analogRead(pin);
|
||||||
if (analogvals == NULL) {
|
if (analogvals == NULL)
|
||||||
analogvals = (int *)calloc(NUM_ADC_INPUTS, sizeof(int));
|
analogvals = (int *)calloc(NUM_ADC_INPUTS, sizeof(int));
|
||||||
for (n=0 ; n < NUM_ADC_INPUTS; n++) // set unreasonable value at startup as marker
|
analogvals[id] = value;
|
||||||
analogvals[n] = -32768; // 16 bit int min value
|
usedpins |= (1<<id);
|
||||||
idarr = (byte *)calloc(NUM_ADC_INPUTS+1, sizeof(byte)); // +1 for terminator value
|
if (id > highestPin) highestPin = id;
|
||||||
for (n=0 ; n <= NUM_ADC_INPUTS; n++)
|
|
||||||
idarr[n] = 255; // set 255 as end of array marker
|
|
||||||
}
|
|
||||||
analogvals[id] = value; // store before enable by idarr[n]
|
|
||||||
for (n=0 ; n <= NUM_ADC_INPUTS; n++) {
|
|
||||||
if (idarr[n] == 255) {
|
|
||||||
idarr[n] = id;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return value;
|
return value;
|
||||||
}
|
}
|
||||||
int16_t ADCee::ADCmax() {
|
int16_t ADCee::ADCmax() {
|
||||||
|
@ -170,14 +162,14 @@ int16_t ADCee::ADCmax() {
|
||||||
* Read function ADCee::read(pin) to get value instead of analogRead(pin)
|
* Read function ADCee::read(pin) to get value instead of analogRead(pin)
|
||||||
*/
|
*/
|
||||||
int ADCee::read(uint8_t pin, bool fromISR) {
|
int ADCee::read(uint8_t pin, bool fromISR) {
|
||||||
(void)fromISR; // AVR does ignore this arg
|
|
||||||
uint8_t id = pin - A0;
|
uint8_t id = pin - A0;
|
||||||
int a;
|
if ((usedpins & (1<<id) ) == 0)
|
||||||
|
return -1023;
|
||||||
// we do not need to check (analogvals == NULL)
|
// we do not need to check (analogvals == NULL)
|
||||||
// because usedpins would still be 0 in that case
|
// because usedpins would still be 0 in that case
|
||||||
noInterrupts();
|
if (!fromISR) noInterrupts();
|
||||||
a = analogvals[id];
|
int a = analogvals[id];
|
||||||
interrupts();
|
if (!fromISR) interrupts();
|
||||||
return a;
|
return a;
|
||||||
}
|
}
|
||||||
/*
|
/*
|
||||||
|
@ -186,7 +178,8 @@ int ADCee::read(uint8_t pin, bool fromISR) {
|
||||||
#pragma GCC push_options
|
#pragma GCC push_options
|
||||||
#pragma GCC optimize ("-O3")
|
#pragma GCC optimize ("-O3")
|
||||||
void ADCee::scan() {
|
void ADCee::scan() {
|
||||||
static byte num = 0; // index into id array
|
static byte id = 0; // id and mask are the same thing but it is faster to
|
||||||
|
static uint16_t mask = 1; // increment and shift instead to calculate mask from id
|
||||||
static bool waiting = false;
|
static bool waiting = false;
|
||||||
|
|
||||||
if (waiting) {
|
if (waiting) {
|
||||||
|
@ -198,26 +191,49 @@ void ADCee::scan() {
|
||||||
low = ADCL; //must read low before high
|
low = ADCL; //must read low before high
|
||||||
high = ADCH;
|
high = ADCH;
|
||||||
bitSet(ADCSRA, ADIF);
|
bitSet(ADCSRA, ADIF);
|
||||||
analogvals[idarr[num]] = (high << 8) | low;
|
analogvals[id] = (high << 8) | low;
|
||||||
|
// advance at least one track
|
||||||
|
#ifdef DEBUG_ADC
|
||||||
|
if (id == 1) TrackManager::track[1]->setBrake(0);
|
||||||
|
#endif
|
||||||
waiting = false;
|
waiting = false;
|
||||||
|
id++;
|
||||||
|
mask = mask << 1;
|
||||||
|
if (id > highestPin) {
|
||||||
|
id = 0;
|
||||||
|
mask = 1;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
if (!waiting) {
|
if (!waiting) {
|
||||||
// cycle around in-use analogue pins
|
if (usedpins == 0) // otherwise we would loop forever
|
||||||
num++;
|
return;
|
||||||
if (idarr[num] == 255)
|
// look for a valid track to sample or until we are around
|
||||||
num = 0;
|
while (true) {
|
||||||
// start new ADC aquire on id
|
if (mask & usedpins) {
|
||||||
|
// start new ADC aquire on id
|
||||||
#if defined(ADCSRB) && defined(MUX5)
|
#if defined(ADCSRB) && defined(MUX5)
|
||||||
if (ADCusesHighPort) { // if we ever have started to use high pins)
|
if (ADCusesHighPort) { // if we ever have started to use high pins)
|
||||||
if (idarr[num] > 7) // if we use a high ADC pin
|
if (id > 7) // if we use a high ADC pin
|
||||||
bitSet(ADCSRB, MUX5); // set MUX5 bit
|
bitSet(ADCSRB, MUX5); // set MUX5 bit
|
||||||
else
|
else
|
||||||
bitClear(ADCSRB, MUX5);
|
bitClear(ADCSRB, MUX5);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
ADMUX = (1 << REFS0) | (idarr[num] & 0x07); // select AVCC as reference and set MUX
|
ADMUX=(1<<REFS0)|(id & 0x07); //select AVCC as reference and set MUX
|
||||||
bitSet(ADCSRA, ADSC); // start conversion
|
bitSet(ADCSRA,ADSC); // start conversion
|
||||||
waiting = true;
|
#ifdef DEBUG_ADC
|
||||||
|
if (id == 1) TrackManager::track[1]->setBrake(1);
|
||||||
|
#endif
|
||||||
|
waiting = true;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
id++;
|
||||||
|
mask = mask << 1;
|
||||||
|
if (id > highestPin) {
|
||||||
|
id = 0;
|
||||||
|
mask = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#pragma GCC pop_options
|
#pragma GCC pop_options
|
||||||
|
|
|
@ -150,6 +150,45 @@ int DCCTimer::freeMemory() {
|
||||||
void DCCTimer::reset() {
|
void DCCTimer::reset() {
|
||||||
ESP.restart();
|
ESP.restart();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#include "esp32-hal.h"
|
||||||
|
#include "soc/soc_caps.h"
|
||||||
|
|
||||||
|
|
||||||
|
#ifdef SOC_LEDC_SUPPORT_HS_MODE
|
||||||
|
#define LEDC_CHANNELS (SOC_LEDC_CHANNEL_NUM<<1)
|
||||||
|
#else
|
||||||
|
#define LEDC_CHANNELS (SOC_LEDC_CHANNEL_NUM)
|
||||||
|
#endif
|
||||||
|
|
||||||
|
static int8_t pin_to_channel[SOC_GPIO_PIN_COUNT] = { 0 };
|
||||||
|
static int cnt_channel = LEDC_CHANNELS;
|
||||||
|
|
||||||
|
void DCCTimer::DCCEXanalogWriteFrequency(uint8_t pin, uint32_t frequency) {
|
||||||
|
if (pin < SOC_GPIO_PIN_COUNT) {
|
||||||
|
if (pin_to_channel[pin] != 0) {
|
||||||
|
ledcSetup(pin_to_channel[pin], frequency, 8);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void DCCTimer::DCCEXanalogWrite(uint8_t pin, int value) {
|
||||||
|
if (pin < SOC_GPIO_PIN_COUNT) {
|
||||||
|
if (pin_to_channel[pin] == 0) {
|
||||||
|
if (!cnt_channel) {
|
||||||
|
log_e("No more PWM channels available! All %u already used", LEDC_CHANNELS);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
pin_to_channel[pin] = --cnt_channel;
|
||||||
|
ledcSetup(cnt_channel, 1000, 8);
|
||||||
|
ledcAttachPin(pin, cnt_channel);
|
||||||
|
} else {
|
||||||
|
ledcAttachPin(pin, pin_to_channel[pin]);
|
||||||
|
}
|
||||||
|
ledcWrite(pin_to_channel[pin], value);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
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);
|
||||||
|
|
|
@ -162,7 +162,7 @@ uint16_t ADCee::usedpins = 0;
|
||||||
int * ADCee::analogvals = NULL;
|
int * ADCee::analogvals = NULL;
|
||||||
|
|
||||||
int ADCee::init(uint8_t pin) {
|
int ADCee::init(uint8_t pin) {
|
||||||
uint id = pin - A0;
|
uint8_t id = pin - A0;
|
||||||
int value = 0;
|
int value = 0;
|
||||||
|
|
||||||
if (id > NUM_ADC_INPUTS)
|
if (id > NUM_ADC_INPUTS)
|
||||||
|
@ -210,7 +210,7 @@ int ADCee::read(uint8_t pin, bool fromISR) {
|
||||||
#pragma GCC push_options
|
#pragma GCC push_options
|
||||||
#pragma GCC optimize ("-O3")
|
#pragma GCC optimize ("-O3")
|
||||||
void ADCee::scan() {
|
void ADCee::scan() {
|
||||||
static uint id = 0; // id and mask are the same thing but it is faster to
|
static uint8_t id = 0; // id and mask are the same thing but it is faster to
|
||||||
static uint16_t mask = 1; // increment and shift instead to calculate mask from id
|
static uint16_t mask = 1; // increment and shift instead to calculate mask from id
|
||||||
static bool waiting = false;
|
static bool waiting = false;
|
||||||
|
|
||||||
|
|
|
@ -1,8 +1,8 @@
|
||||||
/*
|
/*
|
||||||
* © 2023 Neil McKechnie
|
* © 2023 Neil McKechnie
|
||||||
* © 2022 Paul M. Antoine
|
* © 2022-2023 Paul M. Antoine
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021 Harald Barth
|
* © 2021, 2023 Harald Barth
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2021 Chris Harlow
|
* © 2021 Chris Harlow
|
||||||
* © 2021 David Cutting
|
* © 2021 David Cutting
|
||||||
|
@ -30,24 +30,35 @@
|
||||||
#ifdef ARDUINO_ARCH_STM32
|
#ifdef ARDUINO_ARCH_STM32
|
||||||
|
|
||||||
#include "DCCTimer.h"
|
#include "DCCTimer.h"
|
||||||
|
#ifdef DEBUG_ADC
|
||||||
|
#include "TrackManager.h"
|
||||||
|
#endif
|
||||||
|
#include "DIAG.h"
|
||||||
|
|
||||||
#if defined(ARDUINO_NUCLEO_F411RE)
|
#if defined(ARDUINO_NUCLEO_F401RE) || defined(ARDUINO_NUCLEO_F411RE)
|
||||||
// Nucleo-64 boards don't have Serial1 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
|
||||||
// via the debugger on the Nucleo-64. It is therefore unavailable for other DCC-EX uses like WiFi, DFPlayer, etc.
|
// 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 Nucleo-64s)
|
// Let's define Serial6 as an additional serial port (the only other option for the Nucleo-64s)
|
||||||
HardwareSerial Serial6(PA12, PA11); // Rx=PA12, Tx=PA11 -- CN10 pins 12 and 14 - F411RE
|
HardwareSerial Serial6(PA12, PA11); // Rx=PA12, Tx=PA11 -- CN10 pins 12 and 14 - F411RE
|
||||||
#elif defined(ARDUINO_NUCLEO_F446RE)
|
#elif defined(ARDUINO_NUCLEO_F446RE)
|
||||||
// Nucleo-64 boards don't have Serial1 defined by default
|
// Nucleo-64 boards don't have additional serial ports defined by default
|
||||||
HardwareSerial Serial1(PA10, PB6); // Rx=PA10 (D2), Tx=PB6 (D10) -- CN10 pins 17 and 9 - F446RE
|
// On the F446RE, Serial1 isn't really useable as it's Rx/Tx pair sit on already used D2/D10 pins
|
||||||
|
// HardwareSerial Serial1(PA10, PB6); // Rx=PA10 (D2), Tx=PB6 (D10) -- CN10 pins 17 and 9 - F446RE
|
||||||
// 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
|
||||||
// via the debugger on the Nucleo-64. It is therefore unavailable for other DCC-EX uses like WiFi, DFPlayer, etc.
|
// via the debugger on the Nucleo-64. It is therefore unavailable for other DCC-EX uses like WiFi, DFPlayer, etc.
|
||||||
#elif defined(ARDUINO_NUCLEO_F412ZG) || defined(ARDUINO_NUCLEO_F429ZI) || defined(ARDUINO_NUCLEO_F446ZE)
|
// On the F446RE, Serial3 and Serial5 are easy to use:
|
||||||
|
HardwareSerial Serial3(PC11, PC10); // Rx=PC11, Tx=PC10 -- USART3 - F446RE
|
||||||
|
HardwareSerial Serial5(PD2, PC12); // Rx=PC7, Tx=PC6 -- UART5 - F446RE
|
||||||
|
// 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_F429ZI) || defined(ARDUINO_NUCLEO_F446ZE)
|
||||||
// Nucleo-144 boards don't have Serial1 defined by default
|
// Nucleo-144 boards don't have Serial1 defined by default
|
||||||
HardwareSerial Serial1(PG9, PG14); // Rx=PG9, Tx=PG14 -- D0, D1 - F412ZG/F446ZE
|
HardwareSerial Serial6(PG9, PG14); // Rx=PG9, Tx=PG14 -- USART6
|
||||||
|
// Serial3 is defined to use USART3 by default, but is in fact used as the diag console
|
||||||
|
// via the debugger on the Nucleo-144. It is therefore unavailable for other DCC-EX uses like WiFi, DFPlayer, etc.
|
||||||
#else
|
#else
|
||||||
#warning Serial1 not defined
|
#error STM32 board selected is not yet explicitly supported - so Serial1 peripheral is not defined
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
///////////////////////////////////////////////////////////////////////////////////////////////
|
///////////////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
@ -143,13 +154,28 @@ HardwareSerial Serial1(PG9, PG14); // Rx=PG9, Tx=PG14 -- D0, D1 - F412ZG/F446ZE
|
||||||
///////////////////////////////////////////////////////////////////////////////////////////////
|
///////////////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
|
||||||
INTERRUPT_CALLBACK interruptHandler=0;
|
INTERRUPT_CALLBACK interruptHandler=0;
|
||||||
// Let's use STM32's timer #11 until disabused of this notion
|
|
||||||
// Timer #11 is used for "servo" library, but as DCC-EX is not using
|
// On STM32F4xx models that have them, Timers 6 and 7 have no PWM output capability,
|
||||||
// this libary, we should be free and clear.
|
// so are good choices for general timer duties - they are used for tone and servo
|
||||||
HardwareTimer timer(TIM11);
|
// in stm32duino so we shall usurp those as DCC-EX doesn't use tone or servo libs.
|
||||||
|
// NB: the F401, F410 and F411 do **not** have Timer 6 or 7, so we use Timer 11
|
||||||
|
#ifndef DCC_EX_TIMER
|
||||||
|
#if defined(TIM6)
|
||||||
|
#define DCC_EX_TIMER TIM6
|
||||||
|
#elif defined(TIM7)
|
||||||
|
#define DCC_EX_TIMER TIM7
|
||||||
|
#elif defined(TIM11)
|
||||||
|
#define DCC_EX_TIMER TIM11
|
||||||
|
#else
|
||||||
|
#warning This STM32F4XX variant does not have Timers 6,7 or 11!!
|
||||||
|
#endif
|
||||||
|
#endif // ifndef DCC_EX_TIMER
|
||||||
|
|
||||||
|
HardwareTimer dcctimer(DCC_EX_TIMER);
|
||||||
|
void DCCTimer_Handler() __attribute__((interrupt));
|
||||||
|
|
||||||
// Timer IRQ handler
|
// Timer IRQ handler
|
||||||
void Timer11_Handler() {
|
void DCCTimer_Handler() {
|
||||||
interruptHandler();
|
interruptHandler();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -157,22 +183,24 @@ void DCCTimer::begin(INTERRUPT_CALLBACK callback) {
|
||||||
interruptHandler=callback;
|
interruptHandler=callback;
|
||||||
noInterrupts();
|
noInterrupts();
|
||||||
|
|
||||||
// adc_set_sample_rate(ADC_SAMPLETIME_480CYCLES);
|
dcctimer.pause();
|
||||||
timer.pause();
|
dcctimer.setPrescaleFactor(1);
|
||||||
timer.setPrescaleFactor(1);
|
|
||||||
// timer.setOverflow(CLOCK_CYCLES * 2);
|
// timer.setOverflow(CLOCK_CYCLES * 2);
|
||||||
timer.setOverflow(DCC_SIGNAL_TIME, MICROSEC_FORMAT);
|
dcctimer.setOverflow(DCC_SIGNAL_TIME, MICROSEC_FORMAT);
|
||||||
timer.attachInterrupt(Timer11_Handler);
|
// dcctimer.attachInterrupt(Timer11_Handler);
|
||||||
timer.refresh();
|
dcctimer.attachInterrupt(DCCTimer_Handler);
|
||||||
timer.resume();
|
dcctimer.setInterruptPriority(0, 0); // Set highest preemptive priority!
|
||||||
|
dcctimer.refresh();
|
||||||
|
dcctimer.resume();
|
||||||
|
|
||||||
interrupts();
|
interrupts();
|
||||||
}
|
}
|
||||||
|
|
||||||
bool DCCTimer::isPWMPin(byte pin) {
|
bool DCCTimer::isPWMPin(byte pin) {
|
||||||
//TODO: SAMD whilst this call to digitalPinHasPWM will reveal which pins can do PWM,
|
//TODO: STM32 whilst this call to digitalPinHasPWM will reveal which pins can do PWM,
|
||||||
// there's no support yet for High Accuracy, so for now return false
|
// there's no support yet for High Accuracy, so for now return false
|
||||||
// return digitalPinHasPWM(pin);
|
// return digitalPinHasPWM(pin);
|
||||||
|
(void) pin;
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -224,28 +252,128 @@ void DCCTimer::reset() {
|
||||||
while(true) {};
|
while(true) {};
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// TODO: rationalise the size of these... could really use sparse arrays etc.
|
||||||
|
static HardwareTimer * pin_timer[100] = {0};
|
||||||
|
static uint32_t channel_frequency[100] = {0};
|
||||||
|
static uint32_t pin_channel[100] = {0};
|
||||||
|
|
||||||
|
// Using the HardwareTimer library API included in stm32duino core to handle PWM duties
|
||||||
|
// TODO: in order to use the HA code above which Neil kindly wrote, we may have to do something more
|
||||||
|
// sophisticated about detecting any clash between the timer we'd like to use for PWM and the ones
|
||||||
|
// currently used for HA so they don't interfere with one another. For now we'll just make PWM
|
||||||
|
// work well... then work backwards to integrate with HA mode if we can.
|
||||||
|
void DCCTimer::DCCEXanalogWriteFrequency(uint8_t pin, uint32_t frequency)
|
||||||
|
{
|
||||||
|
if (pin_timer[pin] == NULL) {
|
||||||
|
// Automatically retrieve TIM instance and channel associated to pin
|
||||||
|
// This is used to be compatible with all STM32 series automatically.
|
||||||
|
TIM_TypeDef *Instance = (TIM_TypeDef *)pinmap_peripheral(digitalPinToPinName(pin), PinMap_PWM);
|
||||||
|
if (Instance == NULL) {
|
||||||
|
// We shouldn't get here (famous last words) as it ought to have been caught by brakeCanPWM()!
|
||||||
|
DIAG(F("DCCEXanalogWriteFrequency::Pin %d has no PWM function!"), pin);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
pin_channel[pin] = STM_PIN_CHANNEL(pinmap_function(digitalPinToPinName(pin), PinMap_PWM));
|
||||||
|
|
||||||
|
// Instantiate HardwareTimer object. Thanks to 'new' instantiation,
|
||||||
|
// HardwareTimer is not destructed when setup function is finished.
|
||||||
|
pin_timer[pin] = new HardwareTimer(Instance);
|
||||||
|
// Configure and start PWM
|
||||||
|
// MyTim->setPWM(channel, pin, 5, 10, NULL, NULL); // No callback required, we can simplify the function call
|
||||||
|
if (pin_timer[pin] != NULL)
|
||||||
|
{
|
||||||
|
pin_timer[pin]->setPWM(pin_channel[pin], pin, frequency, 0); // set frequency in Hertz, 0% dutycycle
|
||||||
|
DIAG(F("DCCEXanalogWriteFrequency::Pin %d on Timer %d, frequency %d"), pin, pin_channel[pin], frequency);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
DIAG(F("DCCEXanalogWriteFrequency::failed to allocate HardwareTimer instance!"));
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
// Frequency change request
|
||||||
|
if (frequency != channel_frequency[pin])
|
||||||
|
{
|
||||||
|
pinmap_pinout(digitalPinToPinName(pin), PinMap_TIM); // ensure the pin has been configured!
|
||||||
|
pin_timer[pin]->setOverflow(frequency, HERTZ_FORMAT); // Just change the frequency if it's already running!
|
||||||
|
DIAG(F("DCCEXanalogWriteFrequency::setting frequency to %d"), frequency);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
channel_frequency[pin] = frequency;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
void DCCTimer::DCCEXanalogWrite(uint8_t pin, int value) {
|
||||||
|
// Calculate percentage duty cycle from value given
|
||||||
|
uint32_t duty_cycle = (value * 100 / 256) + 1;
|
||||||
|
if (pin_timer[pin] != NULL) {
|
||||||
|
// if (duty_cycle == 100)
|
||||||
|
// {
|
||||||
|
// pin_timer[pin]->pauseChannel(pin_channel[pin]);
|
||||||
|
// DIAG(F("DCCEXanalogWrite::Pausing timer channel on pin %d"), pin);
|
||||||
|
// }
|
||||||
|
// else
|
||||||
|
// {
|
||||||
|
pinmap_pinout(digitalPinToPinName(pin), PinMap_TIM); // ensure the pin has been configured!
|
||||||
|
// pin_timer[pin]->resumeChannel(pin_channel[pin]);
|
||||||
|
pin_timer[pin]->setCaptureCompare(pin_channel[pin], duty_cycle, PERCENT_COMPARE_FORMAT); // DCC_EX_PWM_FREQ Hertz, duty_cycle% dutycycle
|
||||||
|
DIAG(F("DCCEXanalogWrite::Pin %d, value %d, duty cycle %d"), pin, value, duty_cycle);
|
||||||
|
// }
|
||||||
|
}
|
||||||
|
else
|
||||||
|
DIAG(F("DCCEXanalogWrite::Pin %d is not configured for PWM!"), pin);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Now we can handle more ADCs, maybe this works!
|
||||||
#define NUM_ADC_INPUTS NUM_ANALOG_INPUTS
|
#define NUM_ADC_INPUTS NUM_ANALOG_INPUTS
|
||||||
|
|
||||||
// TODO: may need to use uint32_t on STMF4xx variants with > 16 analog inputs!
|
uint32_t ADCee::usedpins = 0; // Max of 32 ADC input channels!
|
||||||
uint16_t ADCee::usedpins = 0;
|
uint8_t ADCee::highestPin = 0; // Highest pin to scan
|
||||||
int * ADCee::analogvals = NULL;
|
int * ADCee::analogvals = NULL; // Array of analog values last captured
|
||||||
uint32_t * analogchans = NULL;
|
uint32_t * analogchans = NULL; // Array of channel numbers to be scanned
|
||||||
bool adc1configured = false;
|
// bool adc1configured = false;
|
||||||
|
ADC_TypeDef * * adcchans = NULL; // Array to capture which ADC is each input channel on
|
||||||
|
|
||||||
int16_t ADCee::ADCmax() {
|
int16_t ADCee::ADCmax()
|
||||||
return 4095;
|
{
|
||||||
|
return 4095;
|
||||||
}
|
}
|
||||||
|
|
||||||
int ADCee::init(uint8_t pin) {
|
int ADCee::init(uint8_t pin) {
|
||||||
uint id = pin - A0;
|
|
||||||
int value = 0;
|
|
||||||
PinName stmpin = digitalPin[analogInputPin[id]];
|
|
||||||
uint32_t stmgpio = stmpin / 16; // 16-bits per GPIO port group on STM32
|
|
||||||
uint32_t adcchan = STM_PIN_CHANNEL(pinmap_function(stmpin, PinMap_ADC)); // find ADC channel (only valid for ADC1!)
|
|
||||||
GPIO_TypeDef * gpioBase;
|
|
||||||
|
|
||||||
// Port config - find which port we're on and power it up
|
int value = 0;
|
||||||
switch(stmgpio) {
|
PinName stmpin = analogInputToPinName(pin);
|
||||||
|
if (stmpin == NC) // do not continue if this is not an analog pin at all
|
||||||
|
return -1024; // some silly value as error
|
||||||
|
|
||||||
|
uint32_t stmgpio = STM_PORT(stmpin); // converts to the GPIO port (16-bits per port group on STM32)
|
||||||
|
uint32_t adcchan = STM_PIN_CHANNEL(pinmap_function(stmpin, PinMap_ADC)); // find ADC input channel
|
||||||
|
ADC_TypeDef *adc = (ADC_TypeDef *)pinmap_find_peripheral(stmpin, PinMap_ADC); // find which ADC this pin is on ADC1/2/3 etc.
|
||||||
|
int adcnum = 1;
|
||||||
|
if (adc == ADC1)
|
||||||
|
DIAG(F("ADCee::init(): found pin %d on ADC1"), pin);
|
||||||
|
// Checking for ADC2 and ADC3 being defined helps cater for more variants later
|
||||||
|
#if defined(ADC2)
|
||||||
|
else if (adc == ADC2)
|
||||||
|
{
|
||||||
|
DIAG(F("ADCee::init(): found pin %d on ADC2"), pin);
|
||||||
|
adcnum = 2;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
#if defined(ADC3)
|
||||||
|
else if (adc == ADC3)
|
||||||
|
{
|
||||||
|
DIAG(F("ADCee::init(): found pin %d on ADC3"), pin);
|
||||||
|
adcnum = 3;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
else DIAG(F("ADCee::init(): found pin %d on unknown ADC!"), pin);
|
||||||
|
|
||||||
|
// Port config - find which port we're on and power it up
|
||||||
|
GPIO_TypeDef *gpioBase;
|
||||||
|
|
||||||
|
switch (stmgpio)
|
||||||
|
{
|
||||||
case 0x00:
|
case 0x00:
|
||||||
RCC->AHB1ENR |= RCC_AHB1ENR_GPIOAEN; //Power up PORTA
|
RCC->AHB1ENR |= RCC_AHB1ENR_GPIOAEN; //Power up PORTA
|
||||||
gpioBase = GPIOA;
|
gpioBase = GPIOA;
|
||||||
|
@ -258,31 +386,62 @@ int ADCee::init(uint8_t pin) {
|
||||||
RCC->AHB1ENR |= RCC_AHB1ENR_GPIOCEN; //Power up PORTC
|
RCC->AHB1ENR |= RCC_AHB1ENR_GPIOCEN; //Power up PORTC
|
||||||
gpioBase = GPIOC;
|
gpioBase = GPIOC;
|
||||||
break;
|
break;
|
||||||
|
case 0x03:
|
||||||
|
RCC->AHB1ENR |= RCC_AHB1ENR_GPIODEN; //Power up PORTD
|
||||||
|
gpioBase = GPIOD;
|
||||||
|
break;
|
||||||
|
case 0x04:
|
||||||
|
RCC->AHB1ENR |= RCC_AHB1ENR_GPIOEEN; //Power up PORTE
|
||||||
|
gpioBase = GPIOE;
|
||||||
|
break;
|
||||||
|
#if defined(GPIOF)
|
||||||
|
case 0x05:
|
||||||
|
RCC->AHB1ENR |= RCC_AHB1ENR_GPIOFEN; //Power up PORTF
|
||||||
|
gpioBase = GPIOF;
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
default:
|
||||||
|
return -1023; // some silly value as error
|
||||||
}
|
}
|
||||||
|
|
||||||
// Set pin mux mode to analog input
|
// Set pin mux mode to analog input, the 32 bit port mode register has 2 bits per pin
|
||||||
gpioBase->MODER |= (0b011 << (stmpin << 1)); // Set pin mux to analog mode
|
gpioBase->MODER |= (0b011 << (STM_PIN(stmpin) << 1)); // Set pin mux to analog mode (binary 11)
|
||||||
|
|
||||||
// Set the sampling rate for that analog input
|
// Set the sampling rate for that analog input
|
||||||
|
// This is F411x specific! Different on for example F334
|
||||||
|
// STM32F11xC/E Reference manual
|
||||||
|
// 11.12.4 ADC sample time register 1 (ADC_SMPR1) (channels 10 to 18)
|
||||||
|
// 11.12.5 ADC sample time register 2 (ADC_SMPR2) (channels 0 to 9)
|
||||||
|
if (adcchan > 18)
|
||||||
|
return -1022; // silly value as error
|
||||||
if (adcchan < 10)
|
if (adcchan < 10)
|
||||||
ADC1->SMPR2 |= (0b111 << (adcchan * 3)); // Channel sampling rate 480 cycles
|
adc->SMPR2 |= (0b111 << (adcchan * 3)); // Channel sampling rate 480 cycles
|
||||||
else
|
else
|
||||||
ADC1->SMPR1 |= (0b111 << ((adcchan - 10) * 3)); // Channel sampling rate 480 cycles
|
adc->SMPR1 |= (0b111 << ((adcchan - 10) * 3)); // Channel sampling rate 480 cycles
|
||||||
|
|
||||||
// Read the inital ADC value for this analog input
|
// Read the inital ADC value for this analog input
|
||||||
ADC1->SQR3 = adcchan; // 1st conversion in regular sequence
|
adc->SQR3 = adcchan; // 1st conversion in regular sequence
|
||||||
ADC1->CR2 |= (1 << 30); // Start 1st conversion SWSTART
|
adc->CR2 |= ADC_CR2_SWSTART; //(1 << 30); // Start 1st conversion SWSTART
|
||||||
while(!(ADC1->SR & (1 << 1))); // Wait until conversion is complete
|
while(!(adc->SR & (1 << 1))); // Wait until conversion is complete
|
||||||
value = ADC1->DR; // Read value from register
|
value = adc->DR; // Read value from register
|
||||||
|
|
||||||
if (analogvals == NULL)
|
uint8_t id = pin - PNUM_ANALOG_BASE;
|
||||||
{
|
// if (id > 15) { // today we have not enough bits in the mask to support more
|
||||||
|
// return -1021;
|
||||||
|
// }
|
||||||
|
|
||||||
|
if (analogvals == NULL) { // allocate analogvals, analogchans and adcchans if this is the first invocation of init
|
||||||
analogvals = (int *)calloc(NUM_ADC_INPUTS+1, sizeof(int));
|
analogvals = (int *)calloc(NUM_ADC_INPUTS+1, sizeof(int));
|
||||||
analogchans = (uint32_t *)calloc(NUM_ADC_INPUTS+1, sizeof(uint32_t));
|
analogchans = (uint32_t *)calloc(NUM_ADC_INPUTS+1, sizeof(uint32_t));
|
||||||
|
adcchans = (ADC_TypeDef **)calloc(NUM_ADC_INPUTS+1, sizeof(ADC_TypeDef));
|
||||||
}
|
}
|
||||||
analogvals[id] = value; // Store sampled value
|
analogvals[id] = value; // Store sampled value
|
||||||
analogchans[id] = adcchan; // Keep track of which ADC channel is used for reading this pin
|
analogchans[id] = adcchan; // Keep track of which ADC channel is used for reading this pin
|
||||||
usedpins |= (1 << id); // This pin is now ready
|
adcchans[id] = adc; // Keep track of which ADC this channel is on
|
||||||
|
usedpins |= (1 << id); // This pin is now ready
|
||||||
|
if (id > highestPin) highestPin = id; // Store our highest pin in use
|
||||||
|
|
||||||
|
DIAG(F("ADCee::init(): value=%d, ADC%d: channel=%d, id=%d"), value, adcnum, adcchan, id);
|
||||||
|
|
||||||
return value;
|
return value;
|
||||||
}
|
}
|
||||||
|
@ -291,7 +450,7 @@ int ADCee::init(uint8_t pin) {
|
||||||
* Read function ADCee::read(pin) to get value instead of analogRead(pin)
|
* Read function ADCee::read(pin) to get value instead of analogRead(pin)
|
||||||
*/
|
*/
|
||||||
int ADCee::read(uint8_t pin, bool fromISR) {
|
int ADCee::read(uint8_t pin, bool fromISR) {
|
||||||
uint8_t id = pin - A0;
|
uint8_t id = pin - PNUM_ANALOG_BASE;
|
||||||
// Was this pin initialised yet?
|
// Was this pin initialised yet?
|
||||||
if ((usedpins & (1<<id) ) == 0)
|
if ((usedpins & (1<<id) ) == 0)
|
||||||
return -1023;
|
return -1023;
|
||||||
|
@ -306,22 +465,27 @@ int ADCee::read(uint8_t pin, bool fromISR) {
|
||||||
#pragma GCC push_options
|
#pragma GCC push_options
|
||||||
#pragma GCC optimize ("-O3")
|
#pragma GCC optimize ("-O3")
|
||||||
void ADCee::scan() {
|
void ADCee::scan() {
|
||||||
static uint id = 0; // id and mask are the same thing but it is faster to
|
static uint8_t id = 0; // id and mask are the same thing but it is faster to
|
||||||
static uint16_t mask = 1; // increment and shift instead to calculate mask from id
|
static uint16_t mask = 1; // increment and shift instead to calculate mask from id
|
||||||
static bool waiting = false;
|
static bool waiting = false;
|
||||||
|
static ADC_TypeDef *adc;
|
||||||
|
|
||||||
if (waiting) {
|
adc = adcchans[id];
|
||||||
|
if (waiting)
|
||||||
|
{
|
||||||
// look if we have a result
|
// look if we have a result
|
||||||
if (!(ADC1->SR & (1 << 1)))
|
if (!(adc->SR & (1 << 1)))
|
||||||
return; // no result, continue to wait
|
return; // no result, continue to wait
|
||||||
// found value
|
// found value
|
||||||
analogvals[id] = ADC1->DR;
|
analogvals[id] = adc->DR;
|
||||||
// advance at least one track
|
// advance at least one track
|
||||||
// for scope debug TrackManager::track[1]->setBrake(0);
|
#ifdef DEBUG_ADC
|
||||||
|
if (id == 1) TrackManager::track[1]->setBrake(0);
|
||||||
|
#endif
|
||||||
waiting = false;
|
waiting = false;
|
||||||
id++;
|
id++;
|
||||||
mask = mask << 1;
|
mask = mask << 1;
|
||||||
if (id == NUM_ADC_INPUTS+1) {
|
if (id > highestPin) { // the 1 has been shifted out
|
||||||
id = 0;
|
id = 0;
|
||||||
mask = 1;
|
mask = 1;
|
||||||
}
|
}
|
||||||
|
@ -332,18 +496,21 @@ void ADCee::scan() {
|
||||||
// look for a valid track to sample or until we are around
|
// look for a valid track to sample or until we are around
|
||||||
while (true) {
|
while (true) {
|
||||||
if (mask & usedpins) {
|
if (mask & usedpins) {
|
||||||
// start new ADC aquire on id
|
// start new ADC aquire on id
|
||||||
ADC1->SQR3 = analogchans[id]; //1st conversion in regular sequence
|
adc = adcchans[id];
|
||||||
ADC1->CR2 |= (1 << 30); //Start 1st conversion SWSTART
|
adc->SQR3 = analogchans[id]; // 1st conversion in regular sequence
|
||||||
// for scope debug TrackManager::track[1]->setBrake(1);
|
adc->CR2 |= (1 << 30); // Start 1st conversion SWSTART
|
||||||
waiting = true;
|
#ifdef DEBUG_ADC
|
||||||
return;
|
if (id == 1) TrackManager::track[1]->setBrake(1);
|
||||||
|
#endif
|
||||||
|
waiting = true;
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
id++;
|
id++;
|
||||||
mask = mask << 1;
|
mask = mask << 1;
|
||||||
if (id == NUM_ADC_INPUTS+1) {
|
if (id > highestPin) {
|
||||||
id = 0;
|
id = 0;
|
||||||
mask = 1;
|
mask = 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -353,19 +520,83 @@ void ADCee::scan() {
|
||||||
void ADCee::begin() {
|
void ADCee::begin() {
|
||||||
noInterrupts();
|
noInterrupts();
|
||||||
//ADC1 config sequence
|
//ADC1 config sequence
|
||||||
// TODO: currently defaults to ADC1, may need more to handle other members of STM32F4xx family
|
RCC->APB2ENR |= RCC_APB2ENR_ADC1EN; // Enable ADC1 clock
|
||||||
RCC->APB2ENR |= (1 << 8); //Enable ADC1 clock (Bit8)
|
|
||||||
// Set ADC prescaler - DIV8 ~ 40ms, DIV6 ~ 30ms, DIV4 ~ 20ms, DIV2 ~ 11ms
|
// Set ADC prescaler - DIV8 ~ 40ms, DIV6 ~ 30ms, DIV4 ~ 20ms, DIV2 ~ 11ms
|
||||||
ADC->CCR = (0 << 16); // Set prescaler 0=DIV2, 1=DIV4, 2=DIV6, 3=DIV8
|
ADC->CCR = (0 << 16); // Set prescaler 0=DIV2, 1=DIV4, 2=DIV6, 3=DIV8
|
||||||
ADC1->CR1 &= ~(1 << 8); //SCAN mode disabled (Bit8)
|
ADC1->CR1 &= ~(1 << 8); //SCAN mode disabled (Bit8)
|
||||||
ADC1->CR1 &= ~(3 << 24); //12bit resolution (Bit24,25 0b00)
|
ADC1->CR1 &= ~(3 << 24); //12bit resolution (Bit24,25 0b00)
|
||||||
ADC1->SQR1 = (1 << 20); //Set number of conversions projected (L[3:0] 0b0001) -> 1 conversion
|
ADC1->SQR1 = (1 << 20); //Set number of conversions projected (L[3:0] 0b0001) -> 1 conversion
|
||||||
|
// Disable the DMA controller for ADC1
|
||||||
|
ADC1->CR2 &= ~ADC_CR2_DMA;
|
||||||
ADC1->CR2 &= ~(1 << 1); //Single conversion
|
ADC1->CR2 &= ~(1 << 1); //Single conversion
|
||||||
ADC1->CR2 &= ~(1 << 11); //Right alignment of data bits bit12....bit0
|
ADC1->CR2 &= ~(1 << 11); //Right alignment of data bits bit12....bit0
|
||||||
ADC1->SQR1 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
ADC1->SQR1 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
ADC1->SQR2 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
ADC1->SQR2 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
ADC1->SQR3 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
ADC1->SQR3 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
ADC1->CR2 |= (1 << 0); // Switch on ADC1
|
ADC1->CR2 |= (1 << 0); // Switch on ADC1
|
||||||
|
// Wait for ADC1 to become ready (calibration complete)
|
||||||
|
while (!(ADC1->CR2 & ADC_CR2_ADON)) {
|
||||||
|
}
|
||||||
|
#if defined(ADC2)
|
||||||
|
// Enable the ADC2 clock
|
||||||
|
RCC->APB2ENR |= RCC_APB2ENR_ADC2EN;
|
||||||
|
|
||||||
|
// Initialize ADC2
|
||||||
|
ADC2->CR1 = 0; // Disable all channels
|
||||||
|
ADC2->CR2 = 0; // Clear CR2 register
|
||||||
|
|
||||||
|
ADC2->CR1 &= ~(1 << 8); //SCAN mode disabled (Bit8)
|
||||||
|
ADC2->CR1 &= ~(3 << 24); //12bit resolution (Bit24,25 0b00)
|
||||||
|
ADC2->SQR1 = (1 << 20); //Set number of conversions projected (L[3:0] 0b0001) -> 1 conversion
|
||||||
|
ADC2->CR2 &= ~ADC_CR2_DMA; // Disable the DMA controller for ADC3
|
||||||
|
ADC2->CR2 &= ~(1 << 1); //Single conversion
|
||||||
|
ADC2->CR2 &= ~(1 << 11); //Right alignment of data bits bit12....bit0
|
||||||
|
ADC2->SQR1 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
|
ADC2->SQR2 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
|
ADC2->SQR3 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
|
|
||||||
|
// Enable the ADC
|
||||||
|
ADC2->CR2 |= ADC_CR2_ADON;
|
||||||
|
|
||||||
|
// Wait for ADC2 to become ready (calibration complete)
|
||||||
|
while (!(ADC2->CR2 & ADC_CR2_ADON)) {
|
||||||
|
}
|
||||||
|
|
||||||
|
// Perform ADC3 calibration (optional)
|
||||||
|
// ADC3->CR2 |= ADC_CR2_CAL;
|
||||||
|
// while (ADC3->CR2 & ADC_CR2_CAL) {
|
||||||
|
// }
|
||||||
|
#endif
|
||||||
|
#if defined(ADC3)
|
||||||
|
// Enable the ADC3 clock
|
||||||
|
RCC->APB2ENR |= RCC_APB2ENR_ADC3EN;
|
||||||
|
|
||||||
|
// Initialize ADC3
|
||||||
|
ADC3->CR1 = 0; // Disable all channels
|
||||||
|
ADC3->CR2 = 0; // Clear CR2 register
|
||||||
|
|
||||||
|
ADC3->CR1 &= ~(1 << 8); //SCAN mode disabled (Bit8)
|
||||||
|
ADC3->CR1 &= ~(3 << 24); //12bit resolution (Bit24,25 0b00)
|
||||||
|
ADC3->SQR1 = (1 << 20); //Set number of conversions projected (L[3:0] 0b0001) -> 1 conversion
|
||||||
|
ADC3->CR2 &= ~ADC_CR2_DMA; // Disable the DMA controller for ADC3
|
||||||
|
ADC3->CR2 &= ~(1 << 1); //Single conversion
|
||||||
|
ADC3->CR2 &= ~(1 << 11); //Right alignment of data bits bit12....bit0
|
||||||
|
ADC3->SQR1 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
|
ADC3->SQR2 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
|
ADC3->SQR3 &= ~(0x3FFFFFFF); //Clear whole 1st 30bits in register
|
||||||
|
|
||||||
|
// Enable the ADC
|
||||||
|
ADC3->CR2 |= ADC_CR2_ADON;
|
||||||
|
|
||||||
|
// Wait for ADC3 to become ready (calibration complete)
|
||||||
|
while (!(ADC3->CR2 & ADC_CR2_ADON)) {
|
||||||
|
}
|
||||||
|
|
||||||
|
// Perform ADC3 calibration (optional)
|
||||||
|
// ADC3->CR2 |= ADC_CR2_CAL;
|
||||||
|
// while (ADC3->CR2 & ADC_CR2_CAL) {
|
||||||
|
// }
|
||||||
|
#endif
|
||||||
interrupts();
|
interrupts();
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
|
@ -247,6 +247,9 @@ void DCCWaveform::schedulePacket(const byte buffer[], byte byteCount, byte repea
|
||||||
pendingPacket[byteCount] = checksum;
|
pendingPacket[byteCount] = checksum;
|
||||||
pendingLength = byteCount + 1;
|
pendingLength = byteCount + 1;
|
||||||
pendingRepeats = repeats;
|
pendingRepeats = repeats;
|
||||||
|
// DIAG repeated commands (accesories)
|
||||||
|
// if (pendingRepeats > 0)
|
||||||
|
// DIAG(F("Repeats=%d on %s track"), pendingRepeats, isMainTrack ? "MAIN" : "PROG");
|
||||||
// The resets will be zero not only now but as well repeats packets into the future
|
// The resets will be zero not only now but as well repeats packets into the future
|
||||||
clearResets(repeats+1);
|
clearResets(repeats+1);
|
||||||
{
|
{
|
||||||
|
|
|
@ -1,61 +0,0 @@
|
||||||
/*
|
|
||||||
* © 2022 Harald Barth
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This file is part of CommandStation-EX
|
|
||||||
*
|
|
||||||
* 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/>.
|
|
||||||
*/
|
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
|
||||||
#include <Arduino.h>
|
|
||||||
#include "ESP32-fixes.h"
|
|
||||||
|
|
||||||
#include "esp32-hal.h"
|
|
||||||
#include "soc/soc_caps.h"
|
|
||||||
|
|
||||||
|
|
||||||
#ifdef SOC_LEDC_SUPPORT_HS_MODE
|
|
||||||
#define LEDC_CHANNELS (SOC_LEDC_CHANNEL_NUM<<1)
|
|
||||||
#else
|
|
||||||
#define LEDC_CHANNELS (SOC_LEDC_CHANNEL_NUM)
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static int8_t pin_to_channel[SOC_GPIO_PIN_COUNT] = { 0 };
|
|
||||||
static int cnt_channel = LEDC_CHANNELS;
|
|
||||||
|
|
||||||
void DCCEXanalogWriteFrequency(uint8_t pin, uint32_t frequency) {
|
|
||||||
if (pin < SOC_GPIO_PIN_COUNT) {
|
|
||||||
if (pin_to_channel[pin] != 0) {
|
|
||||||
ledcSetup(pin_to_channel[pin], frequency, 8);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void DCCEXanalogWrite(uint8_t pin, int value) {
|
|
||||||
if (pin < SOC_GPIO_PIN_COUNT) {
|
|
||||||
if (pin_to_channel[pin] == 0) {
|
|
||||||
if (!cnt_channel) {
|
|
||||||
log_e("No more PWM channels available! All %u already used", LEDC_CHANNELS);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
pin_to_channel[pin] = --cnt_channel;
|
|
||||||
ledcAttachPin(pin, cnt_channel);
|
|
||||||
ledcSetup(cnt_channel, 1000, 8);
|
|
||||||
} else {
|
|
||||||
ledcAttachPin(pin, pin_to_channel[pin]);
|
|
||||||
}
|
|
||||||
ledcWrite(pin_to_channel[pin], value);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
|
@ -1,26 +0,0 @@
|
||||||
/*
|
|
||||||
* © 2022 Harald Barth
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This file is part of CommandStation-EX
|
|
||||||
*
|
|
||||||
* 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/>.
|
|
||||||
*/
|
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
|
||||||
#pragma once
|
|
||||||
#include <Arduino.h>
|
|
||||||
void DCCEXanalogWriteFrequency(uint8_t pin, uint32_t frequency);
|
|
||||||
void DCCEXanalogWrite(uint8_t pin, int value);
|
|
||||||
#endif
|
|
||||||
|
|
BIN
EX-CommandStation-installer.exe
Normal file
BIN
EX-CommandStation-installer.exe
Normal file
Binary file not shown.
259
EXRAIL2.cpp
259
EXRAIL2.cpp
|
@ -2,6 +2,7 @@
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2021-2023 Harald Barth
|
* © 2021-2023 Harald Barth
|
||||||
* © 2020-2023 Chris Harlow
|
* © 2020-2023 Chris Harlow
|
||||||
|
* © 2022-2023 Colin Murdoch
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -51,6 +52,8 @@
|
||||||
#include "Turnouts.h"
|
#include "Turnouts.h"
|
||||||
#include "CommandDistributor.h"
|
#include "CommandDistributor.h"
|
||||||
#include "TrackManager.h"
|
#include "TrackManager.h"
|
||||||
|
#include "Turntables.h"
|
||||||
|
#include "IODevice.h"
|
||||||
|
|
||||||
// Command parsing keywords
|
// Command parsing keywords
|
||||||
const int16_t HASH_KEYWORD_EXRAIL=15435;
|
const int16_t HASH_KEYWORD_EXRAIL=15435;
|
||||||
|
@ -82,7 +85,7 @@ RMFT2 * RMFT2::pausingTask=NULL; // Task causing a PAUSE.
|
||||||
// when pausingTask is set, that is the ONLY task that gets any service,
|
// when pausingTask is set, that is the ONLY task that gets any service,
|
||||||
// and all others will have their locos stopped, then resumed after the pausing task resumes.
|
// and all others will have their locos stopped, then resumed after the pausing task resumes.
|
||||||
byte RMFT2::flags[MAX_FLAGS];
|
byte RMFT2::flags[MAX_FLAGS];
|
||||||
|
Print * RMFT2::LCCSerial=0;
|
||||||
LookList * RMFT2::sequenceLookup=NULL;
|
LookList * RMFT2::sequenceLookup=NULL;
|
||||||
LookList * RMFT2::onThrowLookup=NULL;
|
LookList * RMFT2::onThrowLookup=NULL;
|
||||||
LookList * RMFT2::onCloseLookup=NULL;
|
LookList * RMFT2::onCloseLookup=NULL;
|
||||||
|
@ -93,6 +96,10 @@ LookList * RMFT2::onAmberLookup=NULL;
|
||||||
LookList * RMFT2::onGreenLookup=NULL;
|
LookList * RMFT2::onGreenLookup=NULL;
|
||||||
LookList * RMFT2::onChangeLookup=NULL;
|
LookList * RMFT2::onChangeLookup=NULL;
|
||||||
LookList * RMFT2::onClockLookup=NULL;
|
LookList * RMFT2::onClockLookup=NULL;
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
LookList * RMFT2::onRotateLookup=NULL;
|
||||||
|
#endif
|
||||||
|
LookList * RMFT2::onOverloadLookup=NULL;
|
||||||
|
|
||||||
#define GET_OPCODE GETHIGHFLASH(RMFT2::RouteCode,progCounter)
|
#define GET_OPCODE GETHIGHFLASH(RMFT2::RouteCode,progCounter)
|
||||||
#define SKIPOP progCounter+=3
|
#define SKIPOP progCounter+=3
|
||||||
|
@ -169,20 +176,26 @@ LookList* RMFT2::LookListLoader(OPCODE op1, OPCODE op2, OPCODE op3) {
|
||||||
onCloseLookup=LookListLoader(OPCODE_ONCLOSE);
|
onCloseLookup=LookListLoader(OPCODE_ONCLOSE);
|
||||||
onActivateLookup=LookListLoader(OPCODE_ONACTIVATE);
|
onActivateLookup=LookListLoader(OPCODE_ONACTIVATE);
|
||||||
onDeactivateLookup=LookListLoader(OPCODE_ONDEACTIVATE);
|
onDeactivateLookup=LookListLoader(OPCODE_ONDEACTIVATE);
|
||||||
onRedLookup=LookListLoader(OPCODE_ONRED);
|
|
||||||
onAmberLookup=LookListLoader(OPCODE_ONAMBER);
|
|
||||||
onGreenLookup=LookListLoader(OPCODE_ONGREEN);
|
|
||||||
onChangeLookup=LookListLoader(OPCODE_ONCHANGE);
|
onChangeLookup=LookListLoader(OPCODE_ONCHANGE);
|
||||||
onClockLookup=LookListLoader(OPCODE_ONTIME);
|
onClockLookup=LookListLoader(OPCODE_ONTIME);
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
onRotateLookup=LookListLoader(OPCODE_ONROTATE);
|
||||||
|
#endif
|
||||||
|
onOverloadLookup=LookListLoader(OPCODE_ONOVERLOAD);
|
||||||
|
// onLCCLookup is not the same so not loaded here.
|
||||||
|
|
||||||
// Second pass startup, define any turnouts or servos, set signals red
|
// Second pass startup, define any turnouts or servos, set signals red
|
||||||
// add sequences onRoutines to the lookups
|
// add sequences onRoutines to the lookups
|
||||||
|
if (compileFeatures & FEATURE_SIGNAL) {
|
||||||
|
onRedLookup=LookListLoader(OPCODE_ONRED);
|
||||||
|
onAmberLookup=LookListLoader(OPCODE_ONAMBER);
|
||||||
|
onGreenLookup=LookListLoader(OPCODE_ONGREEN);
|
||||||
for (int sigslot=0;;sigslot++) {
|
for (int sigslot=0;;sigslot++) {
|
||||||
VPIN sigid=GETHIGHFLASHW(RMFT2::SignalDefinitions,sigslot*8);
|
VPIN sigid=GETHIGHFLASHW(RMFT2::SignalDefinitions,sigslot*8);
|
||||||
if (sigid==0) break; // end of signal list
|
if (sigid==0) break; // end of signal list
|
||||||
doSignal(sigid & SIGNAL_ID_MASK, SIGNAL_RED);
|
doSignal(sigid & SIGNAL_ID_MASK, SIGNAL_RED);
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
int progCounter;
|
int progCounter;
|
||||||
for (progCounter=0;; SKIPOP){
|
for (progCounter=0;; SKIPOP){
|
||||||
|
@ -194,6 +207,7 @@ 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;
|
||||||
|
@ -238,6 +252,37 @@ LookList* RMFT2::LookListLoader(OPCODE op1, OPCODE op2, OPCODE op3) {
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
case OPCODE_DCCTURNTABLE: {
|
||||||
|
VPIN id=operand;
|
||||||
|
int home=getOperand(progCounter,1);
|
||||||
|
setTurntableHiddenState(DCCTurntable::create(id));
|
||||||
|
Turntable *tto=Turntable::get(id);
|
||||||
|
tto->addPosition(0,0,home);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
case OPCODE_EXTTTURNTABLE: {
|
||||||
|
VPIN id=operand;
|
||||||
|
VPIN pin=getOperand(progCounter,1);
|
||||||
|
int home=getOperand(progCounter,3);
|
||||||
|
setTurntableHiddenState(EXTTTurntable::create(id,pin));
|
||||||
|
Turntable *tto=Turntable::get(id);
|
||||||
|
tto->addPosition(0,0,home);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
case OPCODE_TTADDPOSITION: {
|
||||||
|
VPIN id=operand;
|
||||||
|
int position=getOperand(progCounter,1);
|
||||||
|
int value=getOperand(progCounter,2);
|
||||||
|
int angle=getOperand(progCounter,3);
|
||||||
|
Turntable *tto=Turntable::get(id);
|
||||||
|
tto->addPosition(position,value,angle);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
case OPCODE_AUTOSTART:
|
case OPCODE_AUTOSTART:
|
||||||
// automatically create a task from here at startup.
|
// automatically create a task from here at startup.
|
||||||
// Removed if (progCounter>0) check 4.2.31 because
|
// Removed if (progCounter>0) check 4.2.31 because
|
||||||
|
@ -262,19 +307,26 @@ void RMFT2::setTurnoutHiddenState(Turnout * t) {
|
||||||
t->setHidden(GETFLASH(getTurnoutDescription(t->getId()))==0x01);
|
t->setHidden(GETFLASH(getTurnoutDescription(t->getId()))==0x01);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
void RMFT2::setTurntableHiddenState(Turntable * tto) {
|
||||||
|
tto->setHidden(GETFLASH(getTurntableDescription(tto->getId()))==0x01);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
char RMFT2::getRouteType(int16_t id) {
|
char RMFT2::getRouteType(int16_t id) {
|
||||||
for (int16_t i=0;;i+=2) {
|
for (int16_t i=0;;i+=2) {
|
||||||
int16_t rid= GETHIGHFLASHW(routeIdList,i);
|
int16_t rid= GETHIGHFLASHW(routeIdList,i);
|
||||||
|
if (rid==INT16_MAX) break;
|
||||||
if (rid==id) return 'R';
|
if (rid==id) return 'R';
|
||||||
if (rid==0) break;
|
|
||||||
}
|
}
|
||||||
for (int16_t i=0;;i+=2) {
|
for (int16_t i=0;;i+=2) {
|
||||||
int16_t rid= GETHIGHFLASHW(automationIdList,i);
|
int16_t rid= GETHIGHFLASHW(automationIdList,i);
|
||||||
|
if (rid==INT16_MAX) break;
|
||||||
if (rid==id) return 'A';
|
if (rid==id) return 'A';
|
||||||
if (rid==0) break;
|
|
||||||
}
|
}
|
||||||
return 'X';
|
return 'X';
|
||||||
}
|
}
|
||||||
|
|
||||||
// This filter intercepts <> commands to do the following:
|
// This filter intercepts <> commands to do the following:
|
||||||
// - Implement RMFT specific commands/diagnostics
|
// - Implement RMFT specific commands/diagnostics
|
||||||
// - Reject/modify JMRI commands that would interfere with RMFT processing
|
// - Reject/modify JMRI commands that would interfere with RMFT processing
|
||||||
|
@ -294,13 +346,65 @@ void RMFT2::ComandFilter(Print * stream, byte & opcode, byte & paramCount, int16
|
||||||
reject=!parseSlash(stream,paramCount,p);
|
reject=!parseSlash(stream,paramCount,p);
|
||||||
opcode=0;
|
opcode=0;
|
||||||
break;
|
break;
|
||||||
|
case 'L':
|
||||||
|
if (compileFeatures & FEATURE_LCC) {
|
||||||
|
// This entire code block is compiled out if LLC macros not used
|
||||||
|
if (paramCount==0) { //<L> LCC adapter introducing self
|
||||||
|
LCCSerial=stream; // now we know where to send events we raise
|
||||||
|
|
||||||
|
// loop through all possible sent events
|
||||||
|
for (int progCounter=0;; SKIPOP) {
|
||||||
|
byte opcode=GET_OPCODE;
|
||||||
|
if (opcode==OPCODE_ENDEXRAIL) break;
|
||||||
|
if (opcode==OPCODE_LCC) StringFormatter::send(stream,F("<LS x%h>\n"),getOperand(progCounter,0));
|
||||||
|
if (opcode==OPCODE_LCCX) { // long form LCC
|
||||||
|
StringFormatter::send(stream,F("<LS x%h%h%h%h>\n"),
|
||||||
|
getOperand(progCounter,1),
|
||||||
|
getOperand(progCounter,2),
|
||||||
|
getOperand(progCounter,3),
|
||||||
|
getOperand(progCounter,0)
|
||||||
|
);
|
||||||
|
}}
|
||||||
|
|
||||||
|
// we stream the hex events we wish to listen to
|
||||||
|
// and at the same time build the event index looku.
|
||||||
|
|
||||||
|
|
||||||
|
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"),
|
||||||
|
eventIndex,
|
||||||
|
getOperand(progCounter,1),
|
||||||
|
getOperand(progCounter,2),
|
||||||
|
getOperand(progCounter,3),
|
||||||
|
getOperand(progCounter,0)
|
||||||
|
);
|
||||||
|
eventIndex++;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
StringFormatter::send(stream,F("<LR>\n")); // Ready to rumble
|
||||||
|
opcode=0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (paramCount==1) { // <L eventid> LCC event arrived from adapter
|
||||||
|
int16_t eventid=p[0];
|
||||||
|
reject=eventid<0 || eventid>=countLCCLookup;
|
||||||
|
if (!reject) startNonRecursiveTask(F("LCC"),eventid,onLCCLookup[eventid]);
|
||||||
|
opcode=0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
default: // other commands pass through
|
default: // other commands pass through
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
if (reject) {
|
if (reject) {
|
||||||
opcode=0;
|
opcode=0;
|
||||||
StringFormatter::send(stream,F("<X>"));
|
StringFormatter::send(stream,F("<X>\n"));
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -328,17 +432,19 @@ bool RMFT2::parseSlash(Print * stream, byte & paramCount, int16_t p[]) {
|
||||||
if (flag & LATCH_FLAG) StringFormatter::send(stream,F(" LATCHED"));
|
if (flag & LATCH_FLAG) StringFormatter::send(stream,F(" LATCHED"));
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
// do the signals
|
|
||||||
// flags[n] represents the state of the nth signal in the table
|
|
||||||
for (int sigslot=0;;sigslot++) {
|
|
||||||
VPIN sigid=GETHIGHFLASHW(RMFT2::SignalDefinitions,sigslot*8);
|
|
||||||
if (sigid==0) break; // end of signal list
|
|
||||||
byte flag=flags[sigslot] & SIGNAL_MASK; // obtain signal flags for this id
|
|
||||||
StringFormatter::send(stream,F("\n%S[%d]"),
|
|
||||||
(flag == SIGNAL_RED)? F("RED") : (flag==SIGNAL_GREEN) ? F("GREEN") : F("AMBER"),
|
|
||||||
sigid & SIGNAL_ID_MASK);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
if (compileFeatures & FEATURE_SIGNAL) {
|
||||||
|
// do the signals
|
||||||
|
// flags[n] represents the state of the nth signal in the table
|
||||||
|
for (int sigslot=0;;sigslot++) {
|
||||||
|
VPIN sigid=GETHIGHFLASHW(RMFT2::SignalDefinitions,sigslot*8);
|
||||||
|
if (sigid==0) break; // end of signal list
|
||||||
|
byte flag=flags[sigslot] & SIGNAL_MASK; // obtain signal flags for this id
|
||||||
|
StringFormatter::send(stream,F("\n%S[%d]"),
|
||||||
|
(flag == SIGNAL_RED)? F("RED") : (flag==SIGNAL_GREEN) ? F("GREEN") : F("AMBER"),
|
||||||
|
sigid & SIGNAL_ID_MASK);
|
||||||
|
}
|
||||||
|
}
|
||||||
StringFormatter::send(stream,F(" *>\n"));
|
StringFormatter::send(stream,F(" *>\n"));
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
@ -597,6 +703,14 @@ void RMFT2::loop2() {
|
||||||
Turnout::setClosed(operand, true);
|
Turnout::setClosed(operand, true);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
case OPCODE_ROTATE:
|
||||||
|
uint8_t activity;
|
||||||
|
activity=getOperand(2);
|
||||||
|
Turntable::setPosition(operand,getOperand(1),activity);
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case OPCODE_REV:
|
case OPCODE_REV:
|
||||||
forward = false;
|
forward = false;
|
||||||
driveLoco(operand);
|
driveLoco(operand);
|
||||||
|
@ -608,6 +722,7 @@ void RMFT2::loop2() {
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case OPCODE_SPEED:
|
case OPCODE_SPEED:
|
||||||
|
forward=DCC::getThrottleDirection(loco)^invert;
|
||||||
driveLoco(operand);
|
driveLoco(operand);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
@ -682,6 +797,16 @@ void RMFT2::loop2() {
|
||||||
if (millis()-waitAfter < 500 ) return;
|
if (millis()-waitAfter < 500 ) return;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case OPCODE_AFTEROVERLOAD: // waits for the power to be turned back on - either by power routine or button
|
||||||
|
if (!TrackManager::isPowerOn(operand)) {
|
||||||
|
// reset timer to half a second and keep waiting
|
||||||
|
waitAfter=millis();
|
||||||
|
delayMe(50);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if (millis()-waitAfter < 500 ) return;
|
||||||
|
break;
|
||||||
|
|
||||||
case OPCODE_LATCH:
|
case OPCODE_LATCH:
|
||||||
setFlag(operand,LATCH_FLAG);
|
setFlag(operand,LATCH_FLAG);
|
||||||
break;
|
break;
|
||||||
|
@ -713,6 +838,20 @@ void RMFT2::loop2() {
|
||||||
CommandDistributor::broadcastPower();
|
CommandDistributor::broadcastPower();
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case OPCODE_SET_POWER:
|
||||||
|
// operand is TRACK_POWER , trackid
|
||||||
|
//byte thistrack=getOperand(1);
|
||||||
|
switch (operand) {
|
||||||
|
case TRACK_POWER_0:
|
||||||
|
TrackManager::setTrackPower(TrackManager::isProg(getOperand(1)), false, POWERMODE::OFF, getOperand(1));
|
||||||
|
break;
|
||||||
|
case TRACK_POWER_1:
|
||||||
|
TrackManager::setTrackPower(TrackManager::isProg(getOperand(1)), false, POWERMODE::ON, getOperand(1));
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
break;
|
||||||
|
|
||||||
case OPCODE_SET_TRACK:
|
case OPCODE_SET_TRACK:
|
||||||
// operand is trackmode<<8 | track id
|
// operand is trackmode<<8 | track id
|
||||||
// If DC/DCX use my loco for DC address
|
// If DC/DCX use my loco for DC address
|
||||||
|
@ -786,6 +925,12 @@ void RMFT2::loop2() {
|
||||||
skipIf=Turnout::isThrown(operand);
|
skipIf=Turnout::isThrown(operand);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
case OPCODE_IFTTPOSITION: // do block if turntable at this position
|
||||||
|
skipIf=Turntable::getPosition(operand)!=(int)getOperand(1);
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case OPCODE_ENDIF:
|
case OPCODE_ENDIF:
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
@ -881,18 +1026,13 @@ void RMFT2::loop2() {
|
||||||
while(loopTask) loopTask->kill(F("KILLALL"));
|
while(loopTask) loopTask->kill(F("KILLALL"));
|
||||||
return;
|
return;
|
||||||
|
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
case OPCODE_JOIN:
|
case OPCODE_JOIN:
|
||||||
TrackManager::setPower(POWERMODE::ON);
|
TrackManager::setPower(POWERMODE::ON);
|
||||||
TrackManager::setJoin(true);
|
TrackManager::setJoin(true);
|
||||||
CommandDistributor::broadcastPower();
|
CommandDistributor::broadcastPower();
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case OPCODE_POWERON:
|
|
||||||
TrackManager::setMainPower(POWERMODE::ON);
|
|
||||||
TrackManager::setJoin(false);
|
|
||||||
CommandDistributor::broadcastPower();
|
|
||||||
break;
|
|
||||||
|
|
||||||
case OPCODE_UNJOIN:
|
case OPCODE_UNJOIN:
|
||||||
TrackManager::setJoin(false);
|
TrackManager::setJoin(false);
|
||||||
CommandDistributor::broadcastPower();
|
CommandDistributor::broadcastPower();
|
||||||
|
@ -918,6 +1058,13 @@ void RMFT2::loop2() {
|
||||||
forward=true;
|
forward=true;
|
||||||
invert=false;
|
invert=false;
|
||||||
break;
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
case OPCODE_POWERON:
|
||||||
|
TrackManager::setMainPower(POWERMODE::ON);
|
||||||
|
TrackManager::setJoin(false);
|
||||||
|
CommandDistributor::broadcastPower();
|
||||||
|
break;
|
||||||
|
|
||||||
case OPCODE_START:
|
case OPCODE_START:
|
||||||
{
|
{
|
||||||
|
@ -945,6 +1092,20 @@ void RMFT2::loop2() {
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case OPCODE_LCC: // short form LCC
|
||||||
|
if ((compileFeatures & FEATURE_LCC) && LCCSerial)
|
||||||
|
StringFormatter::send(LCCSerial,F("<L x%h>"),(uint16_t)operand);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case OPCODE_LCCX: // long form LCC
|
||||||
|
if ((compileFeatures & FEATURE_LCC) && LCCSerial)
|
||||||
|
StringFormatter::send(LCCSerial,F("<L x%h%h%h%h>\n"),
|
||||||
|
getOperand(progCounter,1),
|
||||||
|
getOperand(progCounter,2),
|
||||||
|
getOperand(progCounter,3),
|
||||||
|
getOperand(progCounter,0)
|
||||||
|
);
|
||||||
|
break;
|
||||||
|
|
||||||
case OPCODE_SERVO: // OPCODE_SERVO,V(vpin),OPCODE_PAD,V(position),OPCODE_PAD,V(profile),OPCODE_PAD,V(duration)
|
case OPCODE_SERVO: // OPCODE_SERVO,V(vpin),OPCODE_PAD,V(position),OPCODE_PAD,V(profile),OPCODE_PAD,V(duration)
|
||||||
IODevice::writeAnalogue(operand,getOperand(1),getOperand(2),getOperand(3));
|
IODevice::writeAnalogue(operand,getOperand(1),getOperand(2),getOperand(3));
|
||||||
|
@ -957,6 +1118,15 @@ void RMFT2::loop2() {
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
case OPCODE_WAITFORTT: // OPCODE_WAITFOR,V(turntable_id)
|
||||||
|
if (Turntable::ttMoving(operand)) {
|
||||||
|
delayMe(100);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case OPCODE_PRINT:
|
case OPCODE_PRINT:
|
||||||
printMessage(operand);
|
printMessage(operand);
|
||||||
break;
|
break;
|
||||||
|
@ -973,6 +1143,7 @@ void RMFT2::loop2() {
|
||||||
case OPCODE_SERVOTURNOUT: // Turnout definition ignored at runtime
|
case OPCODE_SERVOTURNOUT: // Turnout definition ignored at runtime
|
||||||
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_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:
|
||||||
|
@ -981,6 +1152,13 @@ void RMFT2::loop2() {
|
||||||
case OPCODE_ONGREEN:
|
case OPCODE_ONGREEN:
|
||||||
case OPCODE_ONCHANGE:
|
case OPCODE_ONCHANGE:
|
||||||
case OPCODE_ONTIME:
|
case OPCODE_ONTIME:
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
case OPCODE_DCCTURNTABLE: // Turntable definition ignored at runtime
|
||||||
|
case OPCODE_EXTTTURNTABLE: // Turntable definition ignored at runtime
|
||||||
|
case OPCODE_TTADDPOSITION: // Turntable position definition ignored at runtime
|
||||||
|
case OPCODE_ONROTATE:
|
||||||
|
#endif
|
||||||
|
case OPCODE_ONOVERLOAD:
|
||||||
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
@ -1035,6 +1213,7 @@ int16_t RMFT2::getSignalSlot(int16_t id) {
|
||||||
}
|
}
|
||||||
|
|
||||||
/* static */ void RMFT2::doSignal(int16_t id,char rag) {
|
/* static */ void RMFT2::doSignal(int16_t id,char rag) {
|
||||||
|
if (!(compileFeatures & FEATURE_SIGNAL)) return; // dont compile code below
|
||||||
if (diag) DIAG(F(" doSignal %d %x"),id,rag);
|
if (diag) DIAG(F(" doSignal %d %x"),id,rag);
|
||||||
|
|
||||||
// Schedule any event handler for this signal change.
|
// Schedule any event handler for this signal change.
|
||||||
|
@ -1102,6 +1281,7 @@ int16_t RMFT2::getSignalSlot(int16_t id) {
|
||||||
}
|
}
|
||||||
|
|
||||||
/* static */ bool RMFT2::isSignal(int16_t id,char rag) {
|
/* static */ bool RMFT2::isSignal(int16_t id,char rag) {
|
||||||
|
if (!(compileFeatures & FEATURE_SIGNAL)) return false;
|
||||||
int16_t sigslot=getSignalSlot(id);
|
int16_t sigslot=getSignalSlot(id);
|
||||||
if (sigslot<0) return false;
|
if (sigslot<0) return false;
|
||||||
return (flags[sigslot] & SIGNAL_MASK) == rag;
|
return (flags[sigslot] & SIGNAL_MASK) == rag;
|
||||||
|
@ -1125,17 +1305,39 @@ void RMFT2::changeEvent(int16_t vpin, bool change) {
|
||||||
if (change) handleEvent(F("CHANGE"),onChangeLookup,vpin);
|
if (change) handleEvent(F("CHANGE"),onChangeLookup,vpin);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
void RMFT2::rotateEvent(int16_t turntableId, bool change) {
|
||||||
|
// Hunt or an ONROTATE for this turntable
|
||||||
|
if (change) handleEvent(F("ROTATE"),onRotateLookup,turntableId);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
void RMFT2::clockEvent(int16_t clocktime, bool change) {
|
void RMFT2::clockEvent(int16_t clocktime, bool change) {
|
||||||
// Hunt for an ONTIME for this time
|
// Hunt for an ONTIME for this time
|
||||||
if (Diag::CMD)
|
if (Diag::CMD)
|
||||||
DIAG(F("Looking for clock event at : %d"), clocktime);
|
DIAG(F("Looking for clock event at : %d"), clocktime);
|
||||||
if (change) handleEvent(F("CLOCK"),onClockLookup,clocktime);
|
if (change) {
|
||||||
|
handleEvent(F("CLOCK"),onClockLookup,clocktime);
|
||||||
|
handleEvent(F("CLOCK"),onClockLookup,25*60+clocktime%60);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void RMFT2::powerEvent(int16_t track, bool overload) {
|
||||||
|
// Hunt for an ONOVERLOAD for this item
|
||||||
|
if (Diag::CMD)
|
||||||
|
DIAG(F("Looking for Power event on track : %c"), track);
|
||||||
|
if (overload) {
|
||||||
|
handleEvent(F("POWER"),onOverloadLookup,track);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
void RMFT2::handleEvent(const FSH* reason,LookList* handlers, int16_t id) {
|
void RMFT2::handleEvent(const FSH* reason,LookList* handlers, int16_t id) {
|
||||||
int pc= handlers->find(id);
|
int pc= handlers->find(id);
|
||||||
if (pc<0) return;
|
if (pc>=0) startNonRecursiveTask(reason,id,pc);
|
||||||
|
}
|
||||||
|
|
||||||
|
void RMFT2::startNonRecursiveTask(const FSH* reason, int16_t id,int pc) {
|
||||||
// Check we dont already have a task running this handler
|
// Check we dont already have a task running this handler
|
||||||
RMFT2 * task=loopTask;
|
RMFT2 * task=loopTask;
|
||||||
while(task) {
|
while(task) {
|
||||||
|
@ -1237,7 +1439,10 @@ void RMFT2::thrungeString(uint32_t strfar, thrunger mode, byte id) {
|
||||||
DCCEXParser::parseOne(&USB_SERIAL,(byte*)buffer->getString(),NULL);
|
DCCEXParser::parseOne(&USB_SERIAL,(byte*)buffer->getString(),NULL);
|
||||||
break;
|
break;
|
||||||
case thrunge_broadcast:
|
case thrunge_broadcast:
|
||||||
// TODO CommandDistributor::broadcastText(buffer->getString());
|
CommandDistributor::broadcastRaw(CommandDistributor::COMMAND_TYPE,buffer->getString());
|
||||||
|
break;
|
||||||
|
case thrunge_withrottle:
|
||||||
|
CommandDistributor::broadcastRaw(CommandDistributor::WITHROTTLE_TYPE,buffer->getString());
|
||||||
break;
|
break;
|
||||||
case thrunge_lcd:
|
case thrunge_lcd:
|
||||||
LCD(id,F("%s"),buffer->getString());
|
LCD(id,F("%s"),buffer->getString());
|
||||||
|
|
43
EXRAIL2.h
43
EXRAIL2.h
|
@ -1,6 +1,7 @@
|
||||||
/*
|
/*
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2020-2022 Chris Harlow
|
* © 2020-2022 Chris Harlow
|
||||||
|
* © 2022-2023 Colin Murdoch
|
||||||
* © 2023 Harald Barth
|
* © 2023 Harald Barth
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
|
@ -24,6 +25,7 @@
|
||||||
#include "FSH.h"
|
#include "FSH.h"
|
||||||
#include "IODevice.h"
|
#include "IODevice.h"
|
||||||
#include "Turnouts.h"
|
#include "Turnouts.h"
|
||||||
|
#include "Turntables.h"
|
||||||
|
|
||||||
// The following are the operation codes (or instructions) for a kind of virtual machine.
|
// The following are the operation codes (or instructions) for a kind of virtual machine.
|
||||||
// Each instruction is normally 3 bytes long with an operation code followed by a parameter.
|
// Each instruction is normally 3 bytes long with an operation code followed by a parameter.
|
||||||
|
@ -34,7 +36,8 @@
|
||||||
enum OPCODE : byte {OPCODE_THROW,OPCODE_CLOSE,
|
enum OPCODE : byte {OPCODE_THROW,OPCODE_CLOSE,
|
||||||
OPCODE_FWD,OPCODE_REV,OPCODE_SPEED,OPCODE_INVERT_DIRECTION,
|
OPCODE_FWD,OPCODE_REV,OPCODE_SPEED,OPCODE_INVERT_DIRECTION,
|
||||||
OPCODE_RESERVE,OPCODE_FREE,
|
OPCODE_RESERVE,OPCODE_FREE,
|
||||||
OPCODE_AT,OPCODE_AFTER,OPCODE_AUTOSTART,
|
OPCODE_AT,OPCODE_AFTER,
|
||||||
|
OPCODE_AFTEROVERLOAD,OPCODE_AUTOSTART,
|
||||||
OPCODE_ATGTE,OPCODE_ATLT,
|
OPCODE_ATGTE,OPCODE_ATLT,
|
||||||
OPCODE_ATTIMEOUT1,OPCODE_ATTIMEOUT2,
|
OPCODE_ATTIMEOUT1,OPCODE_ATTIMEOUT2,
|
||||||
OPCODE_LATCH,OPCODE_UNLATCH,OPCODE_SET,OPCODE_RESET,
|
OPCODE_LATCH,OPCODE_UNLATCH,OPCODE_SET,OPCODE_RESET,
|
||||||
|
@ -44,7 +47,10 @@ enum OPCODE : byte {OPCODE_THROW,OPCODE_CLOSE,
|
||||||
OPCODE_RED,OPCODE_GREEN,OPCODE_AMBER,OPCODE_DRIVE,
|
OPCODE_RED,OPCODE_GREEN,OPCODE_AMBER,OPCODE_DRIVE,
|
||||||
OPCODE_SERVO,OPCODE_SIGNAL,OPCODE_TURNOUT,OPCODE_WAITFOR,
|
OPCODE_SERVO,OPCODE_SIGNAL,OPCODE_TURNOUT,OPCODE_WAITFOR,
|
||||||
OPCODE_PAD,OPCODE_FOLLOW,OPCODE_CALL,OPCODE_RETURN,
|
OPCODE_PAD,OPCODE_FOLLOW,OPCODE_CALL,OPCODE_RETURN,
|
||||||
OPCODE_JOIN,OPCODE_UNJOIN,OPCODE_READ_LOCO1,OPCODE_READ_LOCO2,OPCODE_POM,
|
#ifndef DISABLE_PROG
|
||||||
|
OPCODE_JOIN,OPCODE_UNJOIN,OPCODE_READ_LOCO1,OPCODE_READ_LOCO2,
|
||||||
|
#endif
|
||||||
|
OPCODE_POM,
|
||||||
OPCODE_START,OPCODE_SETLOCO,OPCODE_SENDLOCO,OPCODE_FORGET,
|
OPCODE_START,OPCODE_SETLOCO,OPCODE_SENDLOCO,OPCODE_FORGET,
|
||||||
OPCODE_PAUSE, OPCODE_RESUME,OPCODE_POWEROFF,OPCODE_POWERON,
|
OPCODE_PAUSE, OPCODE_RESUME,OPCODE_POWEROFF,OPCODE_POWERON,
|
||||||
OPCODE_ONCLOSE, OPCODE_ONTHROW, OPCODE_SERVOTURNOUT, OPCODE_PINTURNOUT,
|
OPCODE_ONCLOSE, OPCODE_ONTHROW, OPCODE_SERVOTURNOUT, OPCODE_PINTURNOUT,
|
||||||
|
@ -53,11 +59,15 @@ enum OPCODE : byte {OPCODE_THROW,OPCODE_CLOSE,
|
||||||
OPCODE_ROSTER,OPCODE_KILLALL,
|
OPCODE_ROSTER,OPCODE_KILLALL,
|
||||||
OPCODE_ROUTE,OPCODE_AUTOMATION,OPCODE_SEQUENCE,
|
OPCODE_ROUTE,OPCODE_AUTOMATION,OPCODE_SEQUENCE,
|
||||||
OPCODE_ENDTASK,OPCODE_ENDEXRAIL,
|
OPCODE_ENDTASK,OPCODE_ENDEXRAIL,
|
||||||
OPCODE_SET_TRACK,
|
OPCODE_SET_TRACK,OPCODE_SET_POWER,
|
||||||
OPCODE_ONRED,OPCODE_ONAMBER,OPCODE_ONGREEN,
|
OPCODE_ONRED,OPCODE_ONAMBER,OPCODE_ONGREEN,
|
||||||
OPCODE_ONCHANGE,
|
OPCODE_ONCHANGE,
|
||||||
OPCODE_ONCLOCKTIME,
|
OPCODE_ONCLOCKTIME,
|
||||||
OPCODE_ONTIME,
|
OPCODE_ONTIME,
|
||||||
|
OPCODE_TTADDPOSITION,OPCODE_DCCTURNTABLE,OPCODE_EXTTTURNTABLE,
|
||||||
|
OPCODE_ONROTATE,OPCODE_ROTATE,OPCODE_WAITFORTT,
|
||||||
|
OPCODE_LCC,OPCODE_LCCX,OPCODE_ONLCC,
|
||||||
|
OPCODE_ONOVERLOAD,
|
||||||
|
|
||||||
// OPcodes below this point are skip-nesting IF operations
|
// OPcodes below this point are skip-nesting IF operations
|
||||||
// placed here so that they may be skipped as a group
|
// placed here so that they may be skipped as a group
|
||||||
|
@ -70,19 +80,25 @@ enum OPCODE : byte {OPCODE_THROW,OPCODE_CLOSE,
|
||||||
OPCODE_IFRANDOM,OPCODE_IFRESERVE,
|
OPCODE_IFRANDOM,OPCODE_IFRESERVE,
|
||||||
OPCODE_IFCLOSED,OPCODE_IFTHROWN,
|
OPCODE_IFCLOSED,OPCODE_IFTHROWN,
|
||||||
OPCODE_IFRE,
|
OPCODE_IFRE,
|
||||||
OPCODE_IFLOCO
|
OPCODE_IFLOCO,
|
||||||
|
OPCODE_IFTTPOSITION
|
||||||
};
|
};
|
||||||
|
|
||||||
// Ensure thrunge_lcd is put last as there may be more than one display,
|
// Ensure thrunge_lcd is put last as there may be more than one display,
|
||||||
// sequentially numbered from thrunge_lcd.
|
// sequentially numbered from thrunge_lcd.
|
||||||
enum thrunger: byte {
|
enum thrunger: byte {
|
||||||
thrunge_print, thrunge_broadcast, thrunge_serial,thrunge_parse,
|
thrunge_print, thrunge_broadcast, thrunge_withrottle,
|
||||||
|
thrunge_serial,thrunge_parse,
|
||||||
thrunge_serial1, thrunge_serial2, thrunge_serial3,
|
thrunge_serial1, thrunge_serial2, thrunge_serial3,
|
||||||
thrunge_serial4, thrunge_serial5, thrunge_serial6,
|
thrunge_serial4, thrunge_serial5, thrunge_serial6,
|
||||||
thrunge_lcn,
|
thrunge_lcn,
|
||||||
thrunge_lcd, // Must be last!!
|
thrunge_lcd, // Must be last!!
|
||||||
};
|
};
|
||||||
|
|
||||||
|
// Flag bits for compile time features.
|
||||||
|
static const byte FEATURE_SIGNAL= 0x80;
|
||||||
|
static const byte FEATURE_LCC = 0x40;
|
||||||
|
static const byte FEATURE_ROSTER= 0x20;
|
||||||
|
|
||||||
|
|
||||||
// Flag bits for status of hardware and TPL
|
// Flag bits for status of hardware and TPL
|
||||||
|
@ -125,6 +141,8 @@ class LookList {
|
||||||
static void activateEvent(int16_t addr, bool active);
|
static void activateEvent(int16_t addr, bool active);
|
||||||
static void changeEvent(int16_t id, bool change);
|
static void changeEvent(int16_t id, bool change);
|
||||||
static void clockEvent(int16_t clocktime, bool change);
|
static void clockEvent(int16_t clocktime, bool change);
|
||||||
|
static void rotateEvent(int16_t id, bool change);
|
||||||
|
static void powerEvent(int16_t track, bool overload);
|
||||||
static const int16_t SERVO_SIGNAL_FLAG=0x4000;
|
static const int16_t SERVO_SIGNAL_FLAG=0x4000;
|
||||||
static const int16_t ACTIVE_HIGH_SIGNAL_FLAG=0x2000;
|
static const int16_t ACTIVE_HIGH_SIGNAL_FLAG=0x2000;
|
||||||
static const int16_t DCC_SIGNAL_FLAG=0x1000;
|
static const int16_t DCC_SIGNAL_FLAG=0x1000;
|
||||||
|
@ -139,6 +157,8 @@ class LookList {
|
||||||
static const FSH * getTurnoutDescription(int16_t id);
|
static const FSH * getTurnoutDescription(int16_t id);
|
||||||
static const FSH * getRosterName(int16_t id);
|
static const FSH * getRosterName(int16_t id);
|
||||||
static const FSH * getRosterFunctions(int16_t id);
|
static const FSH * getRosterFunctions(int16_t id);
|
||||||
|
static const FSH * getTurntableDescription(int16_t id);
|
||||||
|
static const FSH * getTurntablePositionDescription(int16_t turntableId, uint8_t positionId);
|
||||||
|
|
||||||
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[]);
|
||||||
|
@ -151,10 +171,14 @@ private:
|
||||||
static bool isSignal(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
|
||||||
|
static void setTurntableHiddenState(Turntable * tto);
|
||||||
|
#endif
|
||||||
static LookList* LookListLoader(OPCODE op1,
|
static LookList* LookListLoader(OPCODE op1,
|
||||||
OPCODE op2=OPCODE_ENDEXRAIL,OPCODE op3=OPCODE_ENDEXRAIL);
|
OPCODE op2=OPCODE_ENDEXRAIL,OPCODE op3=OPCODE_ENDEXRAIL);
|
||||||
static void handleEvent(const FSH* reason,LookList* handlers, int16_t id);
|
static void handleEvent(const FSH* reason,LookList* handlers, int16_t id);
|
||||||
static uint16_t getOperand(int progCounter,byte n);
|
static uint16_t getOperand(int progCounter,byte n);
|
||||||
|
static void startNonRecursiveTask(const FSH* reason, int16_t id,int pc);
|
||||||
static RMFT2 * loopTask;
|
static RMFT2 * loopTask;
|
||||||
static RMFT2 * pausingTask;
|
static RMFT2 * pausingTask;
|
||||||
void delayMe(long millisecs);
|
void delayMe(long millisecs);
|
||||||
|
@ -173,6 +197,7 @@ private:
|
||||||
static const HIGHFLASH byte RouteCode[];
|
static const HIGHFLASH byte RouteCode[];
|
||||||
static const HIGHFLASH int16_t SignalDefinitions[];
|
static const HIGHFLASH int16_t SignalDefinitions[];
|
||||||
static byte flags[MAX_FLAGS];
|
static byte flags[MAX_FLAGS];
|
||||||
|
static Print * LCCSerial;
|
||||||
static LookList * sequenceLookup;
|
static LookList * sequenceLookup;
|
||||||
static LookList * onThrowLookup;
|
static LookList * onThrowLookup;
|
||||||
static LookList * onCloseLookup;
|
static LookList * onCloseLookup;
|
||||||
|
@ -183,6 +208,14 @@ private:
|
||||||
static LookList * onGreenLookup;
|
static LookList * onGreenLookup;
|
||||||
static LookList * onChangeLookup;
|
static LookList * onChangeLookup;
|
||||||
static LookList * onClockLookup;
|
static LookList * onClockLookup;
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
static LookList * onRotateLookup;
|
||||||
|
#endif
|
||||||
|
static LookList * onOverloadLookup;
|
||||||
|
|
||||||
|
static const int countLCCLookup;
|
||||||
|
static int onLCCLookup[];
|
||||||
|
static const byte compileFeatures;
|
||||||
|
|
||||||
// Local variables - exist for each instance/task
|
// Local variables - exist for each instance/task
|
||||||
RMFT2 *next; // loop chain
|
RMFT2 *next; // loop chain
|
||||||
|
|
|
@ -1,5 +1,6 @@
|
||||||
/*
|
/*
|
||||||
* © 2020-2022 Chris Harlow. All rights reserved.
|
* © 2020-2022 Chris Harlow. All rights reserved.
|
||||||
|
* © 2022-2023 Colin Murdoch
|
||||||
* © 2023 Harald Barth
|
* © 2023 Harald Barth
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -26,6 +27,7 @@
|
||||||
#undef ACTIVATE
|
#undef ACTIVATE
|
||||||
#undef ACTIVATEL
|
#undef ACTIVATEL
|
||||||
#undef AFTER
|
#undef AFTER
|
||||||
|
#undef AFTEROVERLOAD
|
||||||
#undef ALIAS
|
#undef ALIAS
|
||||||
#undef AMBER
|
#undef AMBER
|
||||||
#undef ANOUT
|
#undef ANOUT
|
||||||
|
@ -39,6 +41,7 @@
|
||||||
#undef CALL
|
#undef CALL
|
||||||
#undef CLOSE
|
#undef CLOSE
|
||||||
#undef DCC_SIGNAL
|
#undef DCC_SIGNAL
|
||||||
|
#undef DCC_TURNTABLE
|
||||||
#undef DEACTIVATE
|
#undef DEACTIVATE
|
||||||
#undef DEACTIVATEL
|
#undef DEACTIVATEL
|
||||||
#undef DELAY
|
#undef DELAY
|
||||||
|
@ -52,6 +55,7 @@
|
||||||
#undef ENDTASK
|
#undef ENDTASK
|
||||||
#undef ESTOP
|
#undef ESTOP
|
||||||
#undef EXRAIL
|
#undef EXRAIL
|
||||||
|
#undef EXTT_TURNTABLE
|
||||||
#undef FADE
|
#undef FADE
|
||||||
#undef FOFF
|
#undef FOFF
|
||||||
#undef FOLLOW
|
#undef FOLLOW
|
||||||
|
@ -74,6 +78,7 @@
|
||||||
#undef IFRESERVE
|
#undef IFRESERVE
|
||||||
#undef IFTHROWN
|
#undef IFTHROWN
|
||||||
#undef IFTIMEOUT
|
#undef IFTIMEOUT
|
||||||
|
#undef IFTTPOSITION
|
||||||
#undef IFRE
|
#undef IFRE
|
||||||
#undef INVERT_DIRECTION
|
#undef INVERT_DIRECTION
|
||||||
#undef JOIN
|
#undef JOIN
|
||||||
|
@ -81,6 +86,8 @@
|
||||||
#undef LATCH
|
#undef LATCH
|
||||||
#undef LCD
|
#undef LCD
|
||||||
#undef SCREEN
|
#undef SCREEN
|
||||||
|
#undef LCC
|
||||||
|
#undef LCCX
|
||||||
#undef LCN
|
#undef LCN
|
||||||
#undef MOVETT
|
#undef MOVETT
|
||||||
#undef ONACTIVATE
|
#undef ONACTIVATE
|
||||||
|
@ -89,17 +96,23 @@
|
||||||
#undef ONDEACTIVATE
|
#undef ONDEACTIVATE
|
||||||
#undef ONDEACTIVATEL
|
#undef ONDEACTIVATEL
|
||||||
#undef ONCLOSE
|
#undef ONCLOSE
|
||||||
|
#undef ONLCC
|
||||||
#undef ONTIME
|
#undef ONTIME
|
||||||
#undef ONCLOCKTIME
|
#undef ONCLOCKTIME
|
||||||
|
#undef ONCLOCKMINS
|
||||||
|
#undef ONOVERLOAD
|
||||||
#undef ONGREEN
|
#undef ONGREEN
|
||||||
#undef ONRED
|
#undef ONRED
|
||||||
|
#undef ONROTATE
|
||||||
#undef ONTHROW
|
#undef ONTHROW
|
||||||
#undef ONCHANGE
|
#undef ONCHANGE
|
||||||
#undef PARSE
|
#undef PARSE
|
||||||
#undef PAUSE
|
#undef PAUSE
|
||||||
#undef PIN_TURNOUT
|
#undef PIN_TURNOUT
|
||||||
#undef PRINT
|
#undef PRINT
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
#undef POM
|
#undef POM
|
||||||
|
#endif
|
||||||
#undef POWEROFF
|
#undef POWEROFF
|
||||||
#undef POWERON
|
#undef POWERON
|
||||||
#undef READ_LOCO
|
#undef READ_LOCO
|
||||||
|
@ -110,6 +123,8 @@
|
||||||
#undef RETURN
|
#undef RETURN
|
||||||
#undef REV
|
#undef REV
|
||||||
#undef ROSTER
|
#undef ROSTER
|
||||||
|
#undef ROTATE
|
||||||
|
#undef ROTATE_DCC
|
||||||
#undef ROUTE
|
#undef ROUTE
|
||||||
#undef SENDLOCO
|
#undef SENDLOCO
|
||||||
#undef SEQUENCE
|
#undef SEQUENCE
|
||||||
|
@ -126,6 +141,7 @@
|
||||||
#undef SERVO_SIGNAL
|
#undef SERVO_SIGNAL
|
||||||
#undef SET
|
#undef SET
|
||||||
#undef SET_TRACK
|
#undef SET_TRACK
|
||||||
|
#undef SET_POWER
|
||||||
#undef SETLOCO
|
#undef SETLOCO
|
||||||
#undef SIGNAL
|
#undef SIGNAL
|
||||||
#undef SIGNALH
|
#undef SIGNALH
|
||||||
|
@ -133,12 +149,18 @@
|
||||||
#undef START
|
#undef START
|
||||||
#undef STOP
|
#undef STOP
|
||||||
#undef THROW
|
#undef THROW
|
||||||
|
#undef TT_ADDPOSITION
|
||||||
#undef TURNOUT
|
#undef TURNOUT
|
||||||
|
#undef TURNOUTL
|
||||||
#undef UNJOIN
|
#undef UNJOIN
|
||||||
#undef UNLATCH
|
#undef UNLATCH
|
||||||
#undef VIRTUAL_SIGNAL
|
#undef VIRTUAL_SIGNAL
|
||||||
#undef VIRTUAL_TURNOUT
|
#undef VIRTUAL_TURNOUT
|
||||||
#undef WAITFOR
|
#undef WAITFOR
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#undef WAITFORTT
|
||||||
|
#endif
|
||||||
|
#undef WITHROTTLE
|
||||||
#undef XFOFF
|
#undef XFOFF
|
||||||
#undef XFON
|
#undef XFON
|
||||||
|
|
||||||
|
@ -146,6 +168,7 @@
|
||||||
#define ACTIVATE(addr,subaddr)
|
#define ACTIVATE(addr,subaddr)
|
||||||
#define ACTIVATEL(addr)
|
#define ACTIVATEL(addr)
|
||||||
#define AFTER(sensor_id)
|
#define AFTER(sensor_id)
|
||||||
|
#define AFTEROVERLOAD(track_id)
|
||||||
#define ALIAS(name,value...)
|
#define ALIAS(name,value...)
|
||||||
#define AMBER(signal_id)
|
#define AMBER(signal_id)
|
||||||
#define ANOUT(vpin,value,param1,param2)
|
#define ANOUT(vpin,value,param1,param2)
|
||||||
|
@ -159,6 +182,7 @@
|
||||||
#define CALL(route)
|
#define CALL(route)
|
||||||
#define CLOSE(id)
|
#define CLOSE(id)
|
||||||
#define DCC_SIGNAL(id,add,subaddr)
|
#define DCC_SIGNAL(id,add,subaddr)
|
||||||
|
#define DCC_TURNTABLE(id,home,description)
|
||||||
#define DEACTIVATE(addr,subaddr)
|
#define DEACTIVATE(addr,subaddr)
|
||||||
#define DEACTIVATEL(addr)
|
#define DEACTIVATEL(addr)
|
||||||
#define DELAY(mindelay)
|
#define DELAY(mindelay)
|
||||||
|
@ -172,6 +196,7 @@
|
||||||
#define ENDTASK
|
#define ENDTASK
|
||||||
#define ESTOP
|
#define ESTOP
|
||||||
#define EXRAIL
|
#define EXRAIL
|
||||||
|
#define EXTT_TURNTABLE(id,vpin,home,description)
|
||||||
#define FADE(pin,value,ms)
|
#define FADE(pin,value,ms)
|
||||||
#define FOFF(func)
|
#define FOFF(func)
|
||||||
#define FOLLOW(route)
|
#define FOLLOW(route)
|
||||||
|
@ -194,11 +219,14 @@
|
||||||
#define IFTHROWN(turnout_id)
|
#define IFTHROWN(turnout_id)
|
||||||
#define IFRESERVE(block)
|
#define IFRESERVE(block)
|
||||||
#define IFTIMEOUT
|
#define IFTIMEOUT
|
||||||
|
#define IFTTPOSITION(turntable_id,position)
|
||||||
#define IFRE(sensor_id,value)
|
#define IFRE(sensor_id,value)
|
||||||
#define INVERT_DIRECTION
|
#define INVERT_DIRECTION
|
||||||
#define JOIN
|
#define JOIN
|
||||||
#define KILLALL
|
#define KILLALL
|
||||||
#define LATCH(sensor_id)
|
#define LATCH(sensor_id)
|
||||||
|
#define LCC(eventid)
|
||||||
|
#define LCCX(senderid,eventid)
|
||||||
#define LCD(row,msg)
|
#define LCD(row,msg)
|
||||||
#define SCREEN(display,row,msg)
|
#define SCREEN(display,row,msg)
|
||||||
#define LCN(msg)
|
#define LCN(msg)
|
||||||
|
@ -208,18 +236,24 @@
|
||||||
#define ONAMBER(signal_id)
|
#define ONAMBER(signal_id)
|
||||||
#define ONTIME(value)
|
#define ONTIME(value)
|
||||||
#define ONCLOCKTIME(hours,mins)
|
#define ONCLOCKTIME(hours,mins)
|
||||||
|
#define ONCLOCKMINS(mins)
|
||||||
|
#define ONOVERLOAD(track_id)
|
||||||
#define ONDEACTIVATE(addr,subaddr)
|
#define ONDEACTIVATE(addr,subaddr)
|
||||||
#define ONDEACTIVATEL(linear)
|
#define ONDEACTIVATEL(linear)
|
||||||
#define ONCLOSE(turnout_id)
|
#define ONCLOSE(turnout_id)
|
||||||
|
#define ONLCC(sender,event)
|
||||||
#define ONGREEN(signal_id)
|
#define ONGREEN(signal_id)
|
||||||
#define ONRED(signal_id)
|
#define ONRED(signal_id)
|
||||||
|
#define ONROTATE(turntable_id)
|
||||||
#define ONTHROW(turnout_id)
|
#define ONTHROW(turnout_id)
|
||||||
#define ONCHANGE(sensor_id)
|
#define ONCHANGE(sensor_id)
|
||||||
#define PAUSE
|
#define PAUSE
|
||||||
#define PIN_TURNOUT(id,pin,description...)
|
#define PIN_TURNOUT(id,pin,description...)
|
||||||
#define PRINT(msg)
|
#define PRINT(msg)
|
||||||
#define PARSE(msg)
|
#define PARSE(msg)
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
#define POM(cv,value)
|
#define POM(cv,value)
|
||||||
|
#endif
|
||||||
#define POWEROFF
|
#define POWEROFF
|
||||||
#define POWERON
|
#define POWERON
|
||||||
#define READ_LOCO
|
#define READ_LOCO
|
||||||
|
@ -229,8 +263,10 @@
|
||||||
#define RESUME
|
#define RESUME
|
||||||
#define RETURN
|
#define RETURN
|
||||||
#define REV(speed)
|
#define REV(speed)
|
||||||
#define ROUTE(id,description)
|
#define ROTATE(turntable_id,position,activity)
|
||||||
|
#define ROTATE_DCC(turntable_id,position)
|
||||||
#define ROSTER(cab,name,funcmap...)
|
#define ROSTER(cab,name,funcmap...)
|
||||||
|
#define ROUTE(id,description)
|
||||||
#define SENDLOCO(cab,route)
|
#define SENDLOCO(cab,route)
|
||||||
#define SEQUENCE(id)
|
#define SEQUENCE(id)
|
||||||
#define SERIAL(msg)
|
#define SERIAL(msg)
|
||||||
|
@ -246,6 +282,7 @@
|
||||||
#define SERVO_TURNOUT(id,pin,activeAngle,inactiveAngle,profile,description...)
|
#define SERVO_TURNOUT(id,pin,activeAngle,inactiveAngle,profile,description...)
|
||||||
#define SET(pin)
|
#define SET(pin)
|
||||||
#define SET_TRACK(track,mode)
|
#define SET_TRACK(track,mode)
|
||||||
|
#define SET_POWER(track,onoff)
|
||||||
#define SETLOCO(loco)
|
#define SETLOCO(loco)
|
||||||
#define SIGNAL(redpin,amberpin,greenpin)
|
#define SIGNAL(redpin,amberpin,greenpin)
|
||||||
#define SIGNALH(redpin,amberpin,greenpin)
|
#define SIGNALH(redpin,amberpin,greenpin)
|
||||||
|
@ -253,12 +290,18 @@
|
||||||
#define START(route)
|
#define START(route)
|
||||||
#define STOP
|
#define STOP
|
||||||
#define THROW(id)
|
#define THROW(id)
|
||||||
|
#define TT_ADDPOSITION(turntable_id,position,value,angle,description...)
|
||||||
#define TURNOUT(id,addr,subaddr,description...)
|
#define TURNOUT(id,addr,subaddr,description...)
|
||||||
|
#define TURNOUTL(id,addr,description...)
|
||||||
#define UNJOIN
|
#define UNJOIN
|
||||||
#define UNLATCH(sensor_id)
|
#define UNLATCH(sensor_id)
|
||||||
#define VIRTUAL_SIGNAL(id)
|
#define VIRTUAL_SIGNAL(id)
|
||||||
#define VIRTUAL_TURNOUT(id,description...)
|
#define VIRTUAL_TURNOUT(id,description...)
|
||||||
#define WAITFOR(pin)
|
#define WAITFOR(pin)
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define WAITFORTT(turntable_id)
|
||||||
|
#endif
|
||||||
|
#define WITHROTTLE(msg)
|
||||||
#define XFOFF(cab,func)
|
#define XFOFF(cab,func)
|
||||||
#define XFON(cab,func)
|
#define XFON(cab,func)
|
||||||
#endif
|
#endif
|
||||||
|
|
119
EXRAILMacros.h
119
EXRAILMacros.h
|
@ -1,6 +1,7 @@
|
||||||
/*
|
/*
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2020-2022 Chris Harlow
|
* © 2020-2022 Chris Harlow
|
||||||
|
* © 2022-2023 Colin Murdoch
|
||||||
* © 2023 Harald Barth
|
* © 2023 Harald Barth
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
|
@ -53,6 +54,8 @@
|
||||||
|
|
||||||
// helper macro for turnout descriptions, creates NULL for missing description
|
// helper macro for turnout descriptions, creates NULL for missing description
|
||||||
#define O_DESC(id, desc) case id: return ("" desc)[0]?F("" desc):NULL;
|
#define O_DESC(id, desc) case id: return ("" desc)[0]?F("" desc):NULL;
|
||||||
|
// helper macro for turntable descriptions, creates NULL for missing description
|
||||||
|
#define T_DESC(tid,pid,desc) if(turntableId==tid && positionId==pid) return ("" desc)[0]?F("" desc):NULL;
|
||||||
// helper macro for turnout description as HIDDEN
|
// helper macro for turnout description as HIDDEN
|
||||||
#define HIDDEN "\x01"
|
#define HIDDEN "\x01"
|
||||||
|
|
||||||
|
@ -60,6 +63,11 @@
|
||||||
// (10#mins)%100)
|
// (10#mins)%100)
|
||||||
#define STRIP_ZERO(value) 10##value%100
|
#define STRIP_ZERO(value) 10##value%100
|
||||||
|
|
||||||
|
// These constants help EXRAIL macros convert Track Power e.g. SET_POWER(A ON|OFF).
|
||||||
|
//const byte TRACK_POWER_0=0, TRACK_POWER_OFF=0;
|
||||||
|
//const byte TRACK_POWER_1=1, TRACK_POWER_ON=1;
|
||||||
|
|
||||||
|
|
||||||
// Pass 1 Implements aliases
|
// Pass 1 Implements aliases
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
#undef ALIAS
|
#undef ALIAS
|
||||||
|
@ -67,6 +75,7 @@
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
|
|
||||||
// Pass 1h Implements HAL macro by creating exrailHalSetup function
|
// Pass 1h Implements HAL macro by creating exrailHalSetup function
|
||||||
|
// Also allows creating EXTurntable object
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
#undef HAL
|
#undef HAL
|
||||||
#define HAL(haltype,params...) haltype::create(params);
|
#define HAL(haltype,params...) haltype::create(params);
|
||||||
|
@ -74,20 +83,44 @@ void exrailHalSetup() {
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Pass 1c detect compile time featurtes
|
||||||
|
#include "EXRAIL2MacroReset.h"
|
||||||
|
#undef SIGNAL
|
||||||
|
#define SIGNAL(redpin,amberpin,greenpin) | FEATURE_SIGNAL
|
||||||
|
#undef SIGNALH
|
||||||
|
#define SIGNALH(redpin,amberpin,greenpin) | FEATURE_SIGNAL
|
||||||
|
#undef SERVO_SIGNAL
|
||||||
|
#define SERVO_SIGNAL(vpin,redval,amberval,greenval) | FEATURE_SIGNAL
|
||||||
|
#undef DCC_SIGNAL
|
||||||
|
#define DCC_SIGNAL(id,addr,subaddr) | FEATURE_SIGNAL
|
||||||
|
#undef VIRTUAL_SIGNAL
|
||||||
|
#define VIRTUAL_SIGNAL(id) | FEATURE_SIGNAL
|
||||||
|
|
||||||
|
#undef LCC
|
||||||
|
#define LCC(eventid) | FEATURE_LCC
|
||||||
|
#undef LCCX
|
||||||
|
#define LCCX(senderid,eventid) | FEATURE_LCC
|
||||||
|
#undef ONLCC
|
||||||
|
#define ONLCC(senderid,eventid) | FEATURE_LCC
|
||||||
|
|
||||||
|
const byte RMFT2::compileFeatures = 0
|
||||||
|
#include "myAutomation.h"
|
||||||
|
;
|
||||||
|
|
||||||
// Pass 2 create throttle route list
|
// Pass 2 create throttle route list
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
#undef ROUTE
|
#undef ROUTE
|
||||||
#define ROUTE(id, description) id,
|
#define ROUTE(id, description) id,
|
||||||
const int16_t HIGHFLASH RMFT2::routeIdList[]= {
|
const int16_t HIGHFLASH RMFT2::routeIdList[]= {
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
0};
|
INT16_MAX};
|
||||||
// Pass 2a create throttle automation list
|
// Pass 2a create throttle automation list
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
#undef AUTOMATION
|
#undef AUTOMATION
|
||||||
#define AUTOMATION(id, description) id,
|
#define AUTOMATION(id, description) id,
|
||||||
const int16_t HIGHFLASH RMFT2::automationIdList[]= {
|
const int16_t HIGHFLASH RMFT2::automationIdList[]= {
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
0};
|
INT16_MAX};
|
||||||
|
|
||||||
// Pass 3 Create route descriptions:
|
// Pass 3 Create route descriptions:
|
||||||
#undef ROUTE
|
#undef ROUTE
|
||||||
|
@ -152,6 +185,8 @@ const int StringMacroTracker1=__COUNTER__;
|
||||||
lcdid=id;\
|
lcdid=id;\
|
||||||
break;\
|
break;\
|
||||||
}
|
}
|
||||||
|
#undef WITHROTTLE
|
||||||
|
#define WITHROTTLE(msg) THRUNGE(msg,thrunge_withrottle)
|
||||||
|
|
||||||
void RMFT2::printMessage(uint16_t id) {
|
void RMFT2::printMessage(uint16_t id) {
|
||||||
thrunger tmode;
|
thrunger tmode;
|
||||||
|
@ -184,10 +219,35 @@ const FSH * RMFT2::getTurnoutDescription(int16_t turnoutid) {
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Pass to get turntable descriptions (optional)
|
||||||
|
#include "EXRAIL2MacroReset.h"
|
||||||
|
#undef DCC_TURNTABLE
|
||||||
|
#define DCC_TURNTABLE(id,home,description...) O_DESC(id,description)
|
||||||
|
#undef EXTT_TURNTABLE
|
||||||
|
#define EXTT_TURNTABLE(id,vpin,home,description...) O_DESC(id,description)
|
||||||
|
|
||||||
|
const FSH * RMFT2::getTurntableDescription(int16_t turntableId) {
|
||||||
|
switch (turntableId) {
|
||||||
|
#include "myAutomation.h"
|
||||||
|
default:break;
|
||||||
|
}
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Pass to get turntable position descriptions (optional)
|
||||||
|
#include "EXRAIL2MacroReset.h"
|
||||||
|
#undef TT_ADDPOSITION
|
||||||
|
#define TT_ADDPOSITION(turntable_id,position,value,home,description...) T_DESC(turntable_id,position,description)
|
||||||
|
|
||||||
|
const FSH * RMFT2::getTurntablePositionDescription(int16_t turntableId, uint8_t positionId) {
|
||||||
|
#include "myAutomation.h"
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
// Pass 6: Roster IDs (count)
|
// Pass 6: Roster IDs (count)
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
#undef ROSTER
|
#undef ROSTER
|
||||||
#define ROSTER(cabid,name,funcmap...) +1
|
#define ROSTER(cabid,name,funcmap...) +(cabid <= 0 ? 0 : 1)
|
||||||
const byte RMFT2::rosterNameCount=0
|
const byte RMFT2::rosterNameCount=0
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
;
|
;
|
||||||
|
@ -198,7 +258,7 @@ const byte RMFT2::rosterNameCount=0
|
||||||
#define ROSTER(cabid,name,funcmap...) cabid,
|
#define ROSTER(cabid,name,funcmap...) cabid,
|
||||||
const int16_t HIGHFLASH RMFT2::rosterIdList[]={
|
const int16_t HIGHFLASH RMFT2::rosterIdList[]={
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
0};
|
INT16_MAX};
|
||||||
|
|
||||||
// Pass 7: Roster names getter
|
// Pass 7: Roster names getter
|
||||||
#include "EXRAIL2MacroReset.h"
|
#include "EXRAIL2MacroReset.h"
|
||||||
|
@ -220,7 +280,7 @@ const FSH * RMFT2::getRosterFunctions(int16_t id) {
|
||||||
#include "myAutomation.h"
|
#include "myAutomation.h"
|
||||||
default: break;
|
default: break;
|
||||||
}
|
}
|
||||||
return F("");
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Pass 8 Signal definitions
|
// Pass 8 Signal definitions
|
||||||
|
@ -240,6 +300,16 @@ 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
|
||||||
|
#include "EXRAIL2MacroReset.h"
|
||||||
|
#undef ONLCC
|
||||||
|
#define ONLCC(sender,event) +1
|
||||||
|
|
||||||
|
const int RMFT2::countLCCLookup=0
|
||||||
|
#include "myAutomation.h"
|
||||||
|
;
|
||||||
|
int RMFT2::onLCCLookup[RMFT2::countLCCLookup];
|
||||||
|
|
||||||
// Last Pass : create main routes table
|
// Last Pass : create main routes table
|
||||||
// Only undef the macros, not dummy them.
|
// Only undef the macros, not dummy them.
|
||||||
#define RMFT2_UNDEF_ONLY
|
#define RMFT2_UNDEF_ONLY
|
||||||
|
@ -253,6 +323,7 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#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) OPCODE_AT,V(sensor_id),OPCODE_AFTER,V(sensor_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),
|
||||||
#define ANOUT(vpin,value,param1,param2) OPCODE_SERVO,V(vpin),OPCODE_PAD,V(value),OPCODE_PAD,V(param1),OPCODE_PAD,V(param2),
|
#define ANOUT(vpin,value,param1,param2) OPCODE_SERVO,V(vpin),OPCODE_PAD,V(value),OPCODE_PAD,V(param1),OPCODE_PAD,V(param2),
|
||||||
|
@ -265,6 +336,9 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#define BROADCAST(msg) PRINT(msg)
|
#define BROADCAST(msg) PRINT(msg)
|
||||||
#define CALL(route) OPCODE_CALL,V(route),
|
#define CALL(route) OPCODE_CALL,V(route),
|
||||||
#define CLOSE(id) OPCODE_CLOSE,V(id),
|
#define CLOSE(id) OPCODE_CLOSE,V(id),
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define DCC_TURNTABLE(id,home,description...) OPCODE_DCCTURNTABLE,V(id),OPCODE_PAD,V(home),
|
||||||
|
#endif
|
||||||
#define DEACTIVATE(addr,subaddr) OPCODE_DCCACTIVATE,V(addr<<3 | subaddr<<1),
|
#define DEACTIVATE(addr,subaddr) OPCODE_DCCACTIVATE,V(addr<<3 | subaddr<<1),
|
||||||
#define DEACTIVATEL(addr) OPCODE_DCCACTIVATE,V((addr+3)<<1),
|
#define DEACTIVATEL(addr) OPCODE_DCCACTIVATE,V((addr+3)<<1),
|
||||||
#define DELAY(ms) ms<30000?OPCODE_DELAYMS:OPCODE_DELAY,V(ms/(ms<30000?1L:100L)),
|
#define DELAY(ms) ms<30000?OPCODE_DELAYMS:OPCODE_DELAY,V(ms/(ms<30000?1L:100L)),
|
||||||
|
@ -279,6 +353,9 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#define ENDTASK OPCODE_ENDTASK,0,0,
|
#define ENDTASK OPCODE_ENDTASK,0,0,
|
||||||
#define ESTOP OPCODE_SPEED,V(1),
|
#define ESTOP OPCODE_SPEED,V(1),
|
||||||
#define EXRAIL
|
#define EXRAIL
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define EXTT_TURNTABLE(id,vpin,home,description...) OPCODE_EXTTTURNTABLE,V(id),OPCODE_PAD,V(vpin),OPCODE_PAD,V(home),
|
||||||
|
#endif
|
||||||
#define FADE(pin,value,ms) OPCODE_SERVO,V(pin),OPCODE_PAD,V(value),OPCODE_PAD,V(PCA9685::ProfileType::UseDuration|PCA9685::NoPowerOff),OPCODE_PAD,V(ms/100L),
|
#define FADE(pin,value,ms) OPCODE_SERVO,V(pin),OPCODE_PAD,V(value),OPCODE_PAD,V(PCA9685::ProfileType::UseDuration|PCA9685::NoPowerOff),OPCODE_PAD,V(ms/100L),
|
||||||
#define FOFF(func) OPCODE_FOFF,V(func),
|
#define FOFF(func) OPCODE_FOFF,V(func),
|
||||||
#define FOLLOW(route) OPCODE_FOLLOW,V(route),
|
#define FOLLOW(route) OPCODE_FOLLOW,V(route),
|
||||||
|
@ -301,11 +378,19 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#define IFRESERVE(block) OPCODE_IFRESERVE,V(block),
|
#define IFRESERVE(block) OPCODE_IFRESERVE,V(block),
|
||||||
#define IFTHROWN(turnout_id) OPCODE_IFTHROWN,V(turnout_id),
|
#define IFTHROWN(turnout_id) OPCODE_IFTHROWN,V(turnout_id),
|
||||||
#define IFTIMEOUT OPCODE_IFTIMEOUT,0,0,
|
#define IFTIMEOUT OPCODE_IFTIMEOUT,0,0,
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define IFTTPOSITION(id,position) OPCODE_IFTTPOSITION,V(id),OPCODE_PAD,V(position),
|
||||||
|
#endif
|
||||||
#define IFRE(sensor_id,value) OPCODE_IFRE,V(sensor_id),OPCODE_PAD,V(value),
|
#define IFRE(sensor_id,value) OPCODE_IFRE,V(sensor_id),OPCODE_PAD,V(value),
|
||||||
#define INVERT_DIRECTION OPCODE_INVERT_DIRECTION,0,0,
|
#define INVERT_DIRECTION OPCODE_INVERT_DIRECTION,0,0,
|
||||||
#define JOIN OPCODE_JOIN,0,0,
|
#define JOIN OPCODE_JOIN,0,0,
|
||||||
#define KILLALL OPCODE_KILLALL,0,0,
|
#define KILLALL OPCODE_KILLALL,0,0,
|
||||||
#define LATCH(sensor_id) OPCODE_LATCH,V(sensor_id),
|
#define LATCH(sensor_id) OPCODE_LATCH,V(sensor_id),
|
||||||
|
#define LCC(eventid) OPCODE_LCC,V(eventid),
|
||||||
|
#define LCCX(sender,event) OPCODE_LCCX,V(event),\
|
||||||
|
OPCODE_PAD,V((((uint64_t)sender)>>32)&0xFFFF),\
|
||||||
|
OPCODE_PAD,V((((uint64_t)sender)>>16)&0xFFFF),\
|
||||||
|
OPCODE_PAD,V((((uint64_t)sender)>>0)&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 LCN(msg) PRINT(msg)
|
#define LCN(msg) PRINT(msg)
|
||||||
|
@ -314,17 +399,28 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#define ONACTIVATEL(linear) OPCODE_ONACTIVATE,V(linear+3),
|
#define ONACTIVATEL(linear) OPCODE_ONACTIVATE,V(linear+3),
|
||||||
#define ONAMBER(signal_id) OPCODE_ONAMBER,V(signal_id),
|
#define ONAMBER(signal_id) OPCODE_ONAMBER,V(signal_id),
|
||||||
#define ONCLOSE(turnout_id) OPCODE_ONCLOSE,V(turnout_id),
|
#define ONCLOSE(turnout_id) OPCODE_ONCLOSE,V(turnout_id),
|
||||||
|
#define ONLCC(sender,event) OPCODE_ONLCC,V(event),\
|
||||||
|
OPCODE_PAD,V((((uint64_t)sender)>>32)&0xFFFF),\
|
||||||
|
OPCODE_PAD,V((((uint64_t)sender)>>16)&0xFFFF),\
|
||||||
|
OPCODE_PAD,V((((uint64_t)sender)>>0)&0xFFFF),
|
||||||
#define ONTIME(value) OPCODE_ONTIME,V(value),
|
#define ONTIME(value) OPCODE_ONTIME,V(value),
|
||||||
#define ONCLOCKTIME(hours,mins) OPCODE_ONTIME,V((STRIP_ZERO(hours)*60)+STRIP_ZERO(mins)),
|
#define ONCLOCKTIME(hours,mins) OPCODE_ONTIME,V((STRIP_ZERO(hours)*60)+STRIP_ZERO(mins)),
|
||||||
|
#define ONCLOCKMINS(mins) ONCLOCKTIME(25,mins)
|
||||||
|
#define ONOVERLOAD(track_id) OPCODE_ONOVERLOAD,V(TRACK_NUMBER_##track_id),
|
||||||
#define ONDEACTIVATE(addr,subaddr) OPCODE_ONDEACTIVATE,V(addr<<2|subaddr),
|
#define ONDEACTIVATE(addr,subaddr) OPCODE_ONDEACTIVATE,V(addr<<2|subaddr),
|
||||||
#define ONDEACTIVATEL(linear) OPCODE_ONDEACTIVATE,V(linear+3),
|
#define ONDEACTIVATEL(linear) OPCODE_ONDEACTIVATE,V(linear+3),
|
||||||
#define ONGREEN(signal_id) OPCODE_ONGREEN,V(signal_id),
|
#define ONGREEN(signal_id) OPCODE_ONGREEN,V(signal_id),
|
||||||
#define ONRED(signal_id) OPCODE_ONRED,V(signal_id),
|
#define ONRED(signal_id) OPCODE_ONRED,V(signal_id),
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define ONROTATE(id) OPCODE_ONROTATE,V(id),
|
||||||
|
#endif
|
||||||
#define ONTHROW(turnout_id) OPCODE_ONTHROW,V(turnout_id),
|
#define ONTHROW(turnout_id) OPCODE_ONTHROW,V(turnout_id),
|
||||||
#define ONCHANGE(sensor_id) OPCODE_ONCHANGE,V(sensor_id),
|
#define ONCHANGE(sensor_id) OPCODE_ONCHANGE,V(sensor_id),
|
||||||
#define PAUSE OPCODE_PAUSE,0,0,
|
#define PAUSE OPCODE_PAUSE,0,0,
|
||||||
#define PIN_TURNOUT(id,pin,description...) OPCODE_PINTURNOUT,V(id),OPCODE_PAD,V(pin),
|
#define PIN_TURNOUT(id,pin,description...) OPCODE_PINTURNOUT,V(id),OPCODE_PAD,V(pin),
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
#define POM(cv,value) OPCODE_POM,V(cv),OPCODE_PAD,V(value),
|
#define POM(cv,value) OPCODE_POM,V(cv),OPCODE_PAD,V(value),
|
||||||
|
#endif
|
||||||
#define POWEROFF OPCODE_POWEROFF,0,0,
|
#define POWEROFF OPCODE_POWEROFF,0,0,
|
||||||
#define POWERON OPCODE_POWERON,0,0,
|
#define POWERON OPCODE_POWERON,0,0,
|
||||||
#define PRINT(msg) OPCODE_PRINT,V(__COUNTER__ - StringMacroTracker2),
|
#define PRINT(msg) OPCODE_PRINT,V(__COUNTER__ - StringMacroTracker2),
|
||||||
|
@ -337,6 +433,10 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#define RETURN OPCODE_RETURN,0,0,
|
#define RETURN OPCODE_RETURN,0,0,
|
||||||
#define REV(speed) OPCODE_REV,V(speed),
|
#define REV(speed) OPCODE_REV,V(speed),
|
||||||
#define ROSTER(cabid,name,funcmap...)
|
#define ROSTER(cabid,name,funcmap...)
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define ROTATE(id,position,activity) OPCODE_ROTATE,V(id),OPCODE_PAD,V(position),OPCODE_PAD,V(EXTurntable::activity),
|
||||||
|
#define ROTATE_DCC(id,position) OPCODE_ROTATE,V(id),OPCODE_PAD,V(position),OPCODE_PAD,V(0),
|
||||||
|
#endif
|
||||||
#define ROUTE(id, description) OPCODE_ROUTE, V(id),
|
#define ROUTE(id, description) OPCODE_ROUTE, V(id),
|
||||||
#define SENDLOCO(cab,route) OPCODE_SENDLOCO,V(cab),OPCODE_PAD,V(route),
|
#define SENDLOCO(cab,route) OPCODE_SENDLOCO,V(cab),OPCODE_PAD,V(route),
|
||||||
#define SEQUENCE(id) OPCODE_SEQUENCE, V(id),
|
#define SEQUENCE(id) OPCODE_SEQUENCE, V(id),
|
||||||
|
@ -353,6 +453,7 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#define SERVO_TURNOUT(id,pin,activeAngle,inactiveAngle,profile,description...) OPCODE_SERVOTURNOUT,V(id),OPCODE_PAD,V(pin),OPCODE_PAD,V(activeAngle),OPCODE_PAD,V(inactiveAngle),OPCODE_PAD,V(PCA9685::ProfileType::profile),
|
#define SERVO_TURNOUT(id,pin,activeAngle,inactiveAngle,profile,description...) OPCODE_SERVOTURNOUT,V(id),OPCODE_PAD,V(pin),OPCODE_PAD,V(activeAngle),OPCODE_PAD,V(inactiveAngle),OPCODE_PAD,V(PCA9685::ProfileType::profile),
|
||||||
#define SET(pin) OPCODE_SET,V(pin),
|
#define SET(pin) OPCODE_SET,V(pin),
|
||||||
#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 SETLOCO(loco) OPCODE_SETLOCO,V(loco),
|
#define SETLOCO(loco) OPCODE_SETLOCO,V(loco),
|
||||||
#define SIGNAL(redpin,amberpin,greenpin)
|
#define SIGNAL(redpin,amberpin,greenpin)
|
||||||
#define SIGNALH(redpin,amberpin,greenpin)
|
#define SIGNALH(redpin,amberpin,greenpin)
|
||||||
|
@ -360,12 +461,20 @@ const HIGHFLASH int16_t RMFT2::SignalDefinitions[] = {
|
||||||
#define START(route) OPCODE_START,V(route),
|
#define START(route) OPCODE_START,V(route),
|
||||||
#define STOP OPCODE_SPEED,V(0),
|
#define STOP OPCODE_SPEED,V(0),
|
||||||
#define THROW(id) OPCODE_THROW,V(id),
|
#define THROW(id) OPCODE_THROW,V(id),
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define TT_ADDPOSITION(id,position,value,angle,description...) OPCODE_TTADDPOSITION,V(id),OPCODE_PAD,V(position),OPCODE_PAD,V(value),OPCODE_PAD,V(angle),
|
||||||
|
#endif
|
||||||
#define TURNOUT(id,addr,subaddr,description...) OPCODE_TURNOUT,V(id),OPCODE_PAD,V(addr),OPCODE_PAD,V(subaddr),
|
#define TURNOUT(id,addr,subaddr,description...) OPCODE_TURNOUT,V(id),OPCODE_PAD,V(addr),OPCODE_PAD,V(subaddr),
|
||||||
|
#define TURNOUTL(id,addr,description...) TURNOUT(id,(addr-1)/4+1,(addr-1)%4, description)
|
||||||
#define UNJOIN OPCODE_UNJOIN,0,0,
|
#define UNJOIN OPCODE_UNJOIN,0,0,
|
||||||
#define UNLATCH(sensor_id) OPCODE_UNLATCH,V(sensor_id),
|
#define UNLATCH(sensor_id) OPCODE_UNLATCH,V(sensor_id),
|
||||||
#define VIRTUAL_SIGNAL(id)
|
#define VIRTUAL_SIGNAL(id)
|
||||||
#define VIRTUAL_TURNOUT(id,description...) OPCODE_PINTURNOUT,V(id),OPCODE_PAD,V(0),
|
#define VIRTUAL_TURNOUT(id,description...) OPCODE_PINTURNOUT,V(id),OPCODE_PAD,V(0),
|
||||||
|
#define WITHROTTLE(msg) PRINT(msg)
|
||||||
#define WAITFOR(pin) OPCODE_WAITFOR,V(pin),
|
#define WAITFOR(pin) OPCODE_WAITFOR,V(pin),
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
#define WAITFORTT(turntable_id) OPCODE_WAITFORTT,V(turntable_id),
|
||||||
|
#endif
|
||||||
#define XFOFF(cab,func) OPCODE_XFOFF,V(cab),OPCODE_PAD,V(func),
|
#define XFOFF(cab,func) OPCODE_XFOFF,V(cab),OPCODE_PAD,V(func),
|
||||||
#define XFON(cab,func) OPCODE_XFON,V(cab),OPCODE_PAD,V(func),
|
#define XFON(cab,func) OPCODE_XFON,V(cab),OPCODE_PAD,V(func),
|
||||||
|
|
||||||
|
|
|
@ -1 +1 @@
|
||||||
#define GITHUB_SHA "devel-202303252126Z"
|
#define GITHUB_SHA "devel-202309241855Z"
|
||||||
|
|
|
@ -92,7 +92,7 @@ void I2CManagerClass::begin(void) {
|
||||||
// Probe and list devices. Use standard mode
|
// Probe and list devices. Use standard mode
|
||||||
// (clock speed 100kHz) for best device compatibility.
|
// (clock speed 100kHz) for best device compatibility.
|
||||||
_setClock(100000);
|
_setClock(100000);
|
||||||
unsigned long originalTimeout = _timeout;
|
uint32_t originalTimeout = _timeout;
|
||||||
setTimeout(1000); // use 1ms timeout for probes
|
setTimeout(1000); // use 1ms timeout for probes
|
||||||
|
|
||||||
#if defined(I2C_EXTENDED_ADDRESS)
|
#if defined(I2C_EXTENDED_ADDRESS)
|
||||||
|
|
|
@ -485,7 +485,7 @@ private:
|
||||||
// When retries are enabled, the timeout applies to each
|
// When retries are enabled, the timeout applies to each
|
||||||
// try, and failure from timeout does not get retried.
|
// try, and failure from timeout does not get retried.
|
||||||
// A value of 0 means disable timeout monitoring.
|
// A value of 0 means disable timeout monitoring.
|
||||||
unsigned long _timeout = 100000UL;
|
uint32_t _timeout = 100000UL;
|
||||||
|
|
||||||
// Finish off request block by waiting for completion and posting status.
|
// Finish off request block by waiting for completion and posting status.
|
||||||
uint8_t finishRB(I2CRB *rb, uint8_t status);
|
uint8_t finishRB(I2CRB *rb, uint8_t status);
|
||||||
|
@ -532,13 +532,14 @@ private:
|
||||||
uint8_t bytesToSend = 0;
|
uint8_t bytesToSend = 0;
|
||||||
uint8_t bytesToReceive = 0;
|
uint8_t bytesToReceive = 0;
|
||||||
uint8_t operation = 0;
|
uint8_t operation = 0;
|
||||||
unsigned long startTime = 0;
|
uint32_t startTime = 0;
|
||||||
uint8_t muxPhase = 0;
|
uint8_t muxPhase = 0;
|
||||||
uint8_t muxAddress = 0;
|
uint8_t muxAddress = 0;
|
||||||
uint8_t muxData[1];
|
uint8_t muxData[1];
|
||||||
uint8_t deviceAddress;
|
uint8_t deviceAddress;
|
||||||
const uint8_t *sendBuffer;
|
const uint8_t *sendBuffer;
|
||||||
uint8_t *receiveBuffer;
|
uint8_t *receiveBuffer;
|
||||||
|
uint8_t transactionState = 0;
|
||||||
|
|
||||||
volatile uint32_t pendingClockSpeed = 0;
|
volatile uint32_t pendingClockSpeed = 0;
|
||||||
|
|
||||||
|
|
|
@ -172,6 +172,10 @@ void I2CManagerClass::startTransaction() {
|
||||||
* Function to queue a request block and initiate operations.
|
* Function to queue a request block and initiate operations.
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
void I2CManagerClass::queueRequest(I2CRB *req) {
|
void I2CManagerClass::queueRequest(I2CRB *req) {
|
||||||
|
|
||||||
|
if (((req->operation & OPERATION_MASK) == OPERATION_READ) && req->readLen == 0)
|
||||||
|
return; // Ignore null read
|
||||||
|
|
||||||
req->status = I2C_STATUS_PENDING;
|
req->status = I2C_STATUS_PENDING;
|
||||||
req->nextRequest = NULL;
|
req->nextRequest = NULL;
|
||||||
ATOMIC_BLOCK() {
|
ATOMIC_BLOCK() {
|
||||||
|
@ -184,6 +188,7 @@ void I2CManagerClass::queueRequest(I2CRB *req) {
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/***************************************************************************
|
/***************************************************************************
|
||||||
* Initiate a write to an I2C device (non-blocking operation)
|
* Initiate a write to an I2C device (non-blocking operation)
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
|
@ -240,8 +245,8 @@ void I2CManagerClass::checkForTimeout() {
|
||||||
I2CRB *t = queueHead;
|
I2CRB *t = queueHead;
|
||||||
if (state==I2C_STATE_ACTIVE && t!=0 && t==currentRequest && _timeout > 0) {
|
if (state==I2C_STATE_ACTIVE && t!=0 && t==currentRequest && _timeout > 0) {
|
||||||
// Check for timeout
|
// Check for timeout
|
||||||
unsigned long elapsed = micros() - startTime;
|
int32_t elapsed = micros() - startTime;
|
||||||
if (elapsed > _timeout) {
|
if (elapsed > (int32_t)_timeout) {
|
||||||
#ifdef DIAG_IO
|
#ifdef DIAG_IO
|
||||||
//DIAG(F("I2CManager Timeout on %s"), t->i2cAddress.toString());
|
//DIAG(F("I2CManager Timeout on %s"), t->i2cAddress.toString());
|
||||||
#endif
|
#endif
|
||||||
|
@ -300,12 +305,12 @@ void I2CManagerClass::handleInterrupt() {
|
||||||
|
|
||||||
// Check if current request has completed. If there's a current request
|
// Check if current request has completed. If there's a current request
|
||||||
// and state isn't active then state contains the completion status of the request.
|
// and state isn't active then state contains the completion status of the request.
|
||||||
if (state == I2C_STATE_COMPLETED && currentRequest != NULL) {
|
if (state == I2C_STATE_COMPLETED && currentRequest != NULL && currentRequest == queueHead) {
|
||||||
// Operation has completed.
|
// Operation has completed.
|
||||||
if (completionStatus == I2C_STATUS_OK || ++retryCounter > MAX_I2C_RETRIES
|
if (completionStatus == I2C_STATUS_OK || ++retryCounter > MAX_I2C_RETRIES
|
||||||
|| currentRequest->operation & OPERATION_NORETRY)
|
|| currentRequest->operation & OPERATION_NORETRY)
|
||||||
{
|
{
|
||||||
// Status is OK, or has failed and retry count exceeded, or retries disabled.
|
// Status is OK, or has failed and retry count exceeded, or failed and retries disabled.
|
||||||
#if defined(I2C_EXTENDED_ADDRESS)
|
#if defined(I2C_EXTENDED_ADDRESS)
|
||||||
if (muxPhase == MuxPhase_PROLOG ) {
|
if (muxPhase == MuxPhase_PROLOG ) {
|
||||||
overallStatus = completionStatus;
|
overallStatus = completionStatus;
|
||||||
|
|
|
@ -26,27 +26,44 @@
|
||||||
#include "I2CManager.h"
|
#include "I2CManager.h"
|
||||||
#include "I2CManager_NonBlocking.h" // to satisfy intellisense
|
#include "I2CManager_NonBlocking.h" // to satisfy intellisense
|
||||||
|
|
||||||
//#include <avr/io.h>
|
|
||||||
//#include <avr/interrupt.h>
|
|
||||||
#include <wiring_private.h>
|
#include <wiring_private.h>
|
||||||
|
#include "stm32f4xx_hal_rcc.h"
|
||||||
|
|
||||||
/***************************************************************************
|
/*****************************************************************************
|
||||||
* Interrupt handler.
|
* STM32F4xx I2C native driver support
|
||||||
* IRQ handler for SERCOM3 which is the default I2C definition for Arduino Zero
|
*
|
||||||
* compatible variants such as the Sparkfun SAMD21 Dev Breakout etc.
|
* Nucleo-64 and Nucleo-144 boards all use I2C1 as the default I2C peripheral
|
||||||
* Later we may wish to allow use of an alternate I2C bus, or more than one I2C
|
* Later we may wish to support other STM32 boards, allow use of an alternate
|
||||||
* bus on the SAMD architecture
|
* I2C bus, or more than one I2C bus on the STM32 architecture
|
||||||
***************************************************************************/
|
*****************************************************************************/
|
||||||
#if defined(I2C_USE_INTERRUPTS) && defined(ARDUINO_ARCH_STM32)
|
#if defined(I2C_USE_INTERRUPTS) && defined(ARDUINO_ARCH_STM32)
|
||||||
void I2C1_IRQHandler() {
|
#if defined(ARDUINO_NUCLEO_F401RE) || defined(ARDUINO_NUCLEO_F411RE) || defined(ARDUINO_NUCLEO_F446RE) \
|
||||||
|
|| defined(ARDUINO_NUCLEO_F412ZG) || defined(ARDUINO_NUCLEO_F413ZH) \
|
||||||
|
|| defined(ARDUINO_NUCLEO_F429ZI) || defined(ARDUINO_NUCLEO_F446ZE)
|
||||||
|
// Assume I2C1 for now - default I2C bus on Nucleo-F411RE and likely all Nucleo-64
|
||||||
|
// and Nucleo-144 variants
|
||||||
|
I2C_TypeDef *s = I2C1;
|
||||||
|
|
||||||
|
// In init we will ask the STM32 HAL layer for the configured APB1 clock frequency in Hz
|
||||||
|
uint32_t APB1clk1; // Peripheral Input Clock speed in Hz.
|
||||||
|
uint32_t i2c_MHz; // Peripheral Input Clock speed in MHz.
|
||||||
|
|
||||||
|
// IRQ handler for I2C1, replacing the weak definition in the STM32 HAL
|
||||||
|
extern "C" void I2C1_EV_IRQHandler(void) {
|
||||||
I2CManager.handleInterrupt();
|
I2CManager.handleInterrupt();
|
||||||
}
|
}
|
||||||
|
extern "C" void I2C1_ER_IRQHandler(void) {
|
||||||
|
I2CManager.handleInterrupt();
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
#warning STM32 board selected is not yet supported - so I2C1 peripheral is not defined
|
||||||
|
#endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// Assume I2C1 for now - default I2C bus on Nucleo-F411RE and likely Nucleo-64 variants
|
// Peripheral Input Clock speed in MHz.
|
||||||
I2C_TypeDef *s = I2C1;
|
// For STM32F446RE, the speed is 45MHz. Ideally, this should be determined
|
||||||
#define I2C_IRQn I2C1_EV_IRQn
|
// at run-time from the APB1 clock, as it can vary from STM32 family to family.
|
||||||
#define I2C_BUSFREQ 16
|
// #define I2C_PERIPH_CLK 45
|
||||||
|
|
||||||
// I2C SR1 Status Register #1 bit definitions for convenience
|
// I2C SR1 Status Register #1 bit definitions for convenience
|
||||||
// #define I2C_SR1_SMBALERT (1<<15) // SMBus alert
|
// #define I2C_SR1_SMBALERT (1<<15) // SMBus alert
|
||||||
|
@ -80,52 +97,66 @@ I2C_TypeDef *s = I2C1;
|
||||||
// #define I2C_CR1_SMBUS (1<<1) // SMBus mode, 1=SMBus, 0=I2C
|
// #define I2C_CR1_SMBUS (1<<1) // SMBus mode, 1=SMBus, 0=I2C
|
||||||
// #define I2C_CR1_PE (1<<0) // I2C Peripheral enable
|
// #define I2C_CR1_PE (1<<0) // I2C Peripheral enable
|
||||||
|
|
||||||
|
// States of the STM32 I2C driver state machine
|
||||||
|
enum {TS_IDLE,TS_START,TS_W_ADDR,TS_W_DATA,TS_W_STOP,TS_R_ADDR,TS_R_DATA,TS_R_STOP};
|
||||||
|
|
||||||
|
|
||||||
/***************************************************************************
|
/***************************************************************************
|
||||||
* Set I2C clock speed register. This should only be called outside of
|
* Set I2C clock speed register. This should only be called outside of
|
||||||
* a transmission. The I2CManagerClass::_setClock() function ensures
|
* a transmission. The I2CManagerClass::_setClock() function ensures
|
||||||
* that it is only called at the beginning of an I2C transaction.
|
* that it is only called at the beginning of an I2C transaction.
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
void I2CManagerClass::I2C_setClock(uint32_t i2cClockSpeed) {
|
void I2CManagerClass::I2C_setClock(uint32_t i2cClockSpeed) {
|
||||||
|
|
||||||
// Calculate a rise time appropriate to the requested bus speed
|
// Calculate a rise time appropriate to the requested bus speed
|
||||||
// Use 10x the rise time spec to enable integer divide of 62.5ns clock period
|
// Use 10x the rise time spec to enable integer divide of 50ns clock period
|
||||||
uint16_t t_rise;
|
uint16_t t_rise;
|
||||||
uint32_t ccr_freq;
|
uint32_t ccr_freq;
|
||||||
if (i2cClockSpeed < 200000L) {
|
|
||||||
// i2cClockSpeed = 100000L;
|
while (s->CR1 & I2C_CR1_STOP); // Prevents lockup by guarding further
|
||||||
t_rise = 0x11; // (1000ns /62.5ns) + 1;
|
// writes to CR1 while STOP is being executed!
|
||||||
}
|
|
||||||
else if (i2cClockSpeed < 800000L)
|
// Disable the I2C device, as TRISE can only be programmed whilst disabled
|
||||||
|
s->CR1 &= ~(I2C_CR1_PE); // Disable I2C
|
||||||
|
s->CR1 |= I2C_CR1_SWRST; // reset the I2C
|
||||||
|
asm("nop"); // wait a bit... suggestion from online!
|
||||||
|
s->CR1 &= ~(I2C_CR1_SWRST); // Normal operation
|
||||||
|
|
||||||
|
if (i2cClockSpeed > 100000UL)
|
||||||
{
|
{
|
||||||
i2cClockSpeed = 400000L;
|
// if (i2cClockSpeed > 400000L)
|
||||||
t_rise = 0x06; // (300ns / 62.5ns) + 1;
|
// i2cClockSpeed = 400000L;
|
||||||
// } else if (i2cClockSpeed < 1200000L) {
|
|
||||||
// i2cClockSpeed = 1000000L;
|
t_rise = 300; // nanoseconds
|
||||||
// t_rise = 120;
|
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
i2cClockSpeed = 100000L;
|
// i2cClockSpeed = 100000L;
|
||||||
t_rise = 0x11; // (1000ns /62.5ns) + 1;
|
t_rise = 1000; // nanoseconds
|
||||||
}
|
}
|
||||||
|
// Configure the rise time register - max allowed tRISE is 1000ns,
|
||||||
// Enable the I2C master mode
|
// so value = 1000ns * I2C_PERIPH_CLK MHz / 1000 + 1.
|
||||||
s->CR1 &= ~(I2C_CR1_PE); // Enable I2C
|
s->TRISE = (t_rise * i2c_MHz / 1000) + 1;
|
||||||
// Software reset the I2C peripheral
|
|
||||||
// s->CR1 |= I2C_CR1_SWRST; // reset the I2C
|
|
||||||
// Release reset
|
|
||||||
// s->CR1 &= ~(I2C_CR1_SWRST); // Normal operation
|
|
||||||
|
|
||||||
// Calculate baudrate - using a rise time appropriate for the speed
|
|
||||||
ccr_freq = I2C_BUSFREQ * 1000000 / i2cClockSpeed / 2;
|
|
||||||
|
|
||||||
// Bit 15: I2C Master mode, 0=standard, 1=Fast Mode
|
// Bit 15: I2C Master mode, 0=standard, 1=Fast Mode
|
||||||
// Bit 14: Duty, fast mode duty cycle
|
// Bit 14: Duty, fast mode duty cycle (use 2:1)
|
||||||
// Bit 11-0: FREQR = 16MHz => TPCLK1 = 62.5ns, so CCR divisor must be 0x50 (80 * 62.5ns = 5000ns)
|
// Bit 11-0: FREQR
|
||||||
s->CCR = (uint16_t)ccr_freq;
|
// if (i2cClockSpeed > 400000UL) {
|
||||||
|
// // In fast mode plus, I2C period is 3 * CCR * TPCLK1.
|
||||||
|
// // s->CCR &= ~(0x3000); // Clear all bits except 12 and 13 which must remain per reset value
|
||||||
|
// s->CCR = APB1clk1 / 3 / i2cClockSpeed; // Set I2C clockspeed to start!
|
||||||
|
// s->CCR |= 0xC000; // We need Fast Mode AND DUTY bits set
|
||||||
|
// } else {
|
||||||
|
// In standard and fast mode, I2C period is 2 * CCR * TPCLK1
|
||||||
|
s->CCR &= ~(0x3000); // Clear all bits except 12 and 13 which must remain per reset value
|
||||||
|
s->CCR |= (APB1clk1 / 2 / i2cClockSpeed); // Set I2C clockspeed to start!
|
||||||
|
// s->CCR |= (i2c_MHz * 500 / (i2cClockSpeed / 1000)); // Set I2C clockspeed to start!
|
||||||
|
// if (i2cClockSpeed > 100000UL)
|
||||||
|
// s->CCR |= 0xC000; // We need Fast Mode bits set as well
|
||||||
|
// }
|
||||||
|
|
||||||
// Configure the rise time register
|
// DIAG(F("I2C_init() peripheral clock is now: %d, full reg is %x"), (s->CR2 & 0xFF), s->CR2);
|
||||||
s->TRISE = t_rise; // 1000 ns / 62.5 ns = 16 + 1
|
// DIAG(F("I2C_init() peripheral CCR is now: %d"), s->CCR);
|
||||||
|
// DIAG(F("I2C_init() peripheral TRISE is now: %d"), s->TRISE);
|
||||||
|
|
||||||
// Enable the I2C master mode
|
// Enable the I2C master mode
|
||||||
s->CR1 |= I2C_CR1_PE; // Enable I2C
|
s->CR1 |= I2C_CR1_PE; // Enable I2C
|
||||||
|
@ -136,32 +167,54 @@ void I2CManagerClass::I2C_setClock(uint32_t i2cClockSpeed) {
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
void I2CManagerClass::I2C_init()
|
void I2CManagerClass::I2C_init()
|
||||||
{
|
{
|
||||||
//Setting up the clocks
|
// Query the clockspeed from the STM32 HAL layer
|
||||||
RCC->APB1ENR |= (1<<21); // Enable I2C CLOCK
|
APB1clk1 = HAL_RCC_GetPCLK1Freq();
|
||||||
RCC->AHB1ENR |= (1<<1); // Enable GPIOB CLOCK for PB8/PB9
|
i2c_MHz = APB1clk1 / 1000000UL;
|
||||||
|
// DIAG(F("I2C_init() peripheral clock speed is: %d"), i2c_MHz);
|
||||||
|
// Enable clocks
|
||||||
|
RCC->APB1ENR |= RCC_APB1ENR_I2C1EN;//(1 << 21); // Enable I2C CLOCK
|
||||||
|
// Reset the I2C1 peripheral to initial state
|
||||||
|
RCC->APB1RSTR |= RCC_APB1RSTR_I2C1RST;
|
||||||
|
RCC->APB1RSTR &= ~RCC_APB1RSTR_I2C1RST;
|
||||||
// Standard I2C pins are SCL on PB8 and SDA on PB9
|
// Standard I2C pins are SCL on PB8 and SDA on PB9
|
||||||
|
RCC->AHB1ENR |= (1<<1); // Enable GPIOB CLOCK for PB8/PB9
|
||||||
// Bits (17:16)= 1:0 --> Alternate Function for Pin PB8;
|
// Bits (17:16)= 1:0 --> Alternate Function for Pin PB8;
|
||||||
// Bits (19:18)= 1:0 --> Alternate Function for Pin PB9
|
// Bits (19:18)= 1:0 --> Alternate Function for Pin PB9
|
||||||
|
GPIOB->MODER &= ~((3<<(8*2)) | (3<<(9*2))); // Clear all MODER bits for PB8 and PB9
|
||||||
GPIOB->MODER |= (2<<(8*2)) | (2<<(9*2)); // PB8 and PB9 set to ALT function
|
GPIOB->MODER |= (2<<(8*2)) | (2<<(9*2)); // PB8 and PB9 set to ALT function
|
||||||
GPIOB->OTYPER |= (1<<8) | (1<<9); // PB8 and PB9 set to open drain output capability
|
GPIOB->OTYPER |= (1<<8) | (1<<9); // PB8 and PB9 set to open drain output capability
|
||||||
GPIOB->OSPEEDR |= (3<<(8*2)) | (3<<(9*2)); // PB8 and PB9 set to High Speed mode
|
GPIOB->OSPEEDR |= (3<<(8*2)) | (3<<(9*2)); // PB8 and PB9 set to High Speed mode
|
||||||
|
GPIOB->PUPDR &= ~((3<<(8*2)) | (3<<(9*2))); // Clear all PUPDR bits for PB8 and PB9
|
||||||
GPIOB->PUPDR |= (1<<(8*2)) | (1<<(9*2)); // PB8 and PB9 set to pull-up capability
|
GPIOB->PUPDR |= (1<<(8*2)) | (1<<(9*2)); // PB8 and PB9 set to pull-up capability
|
||||||
// Alt Function High register routing pins PB8 and PB9 for I2C1:
|
// Alt Function High register routing pins PB8 and PB9 for I2C1:
|
||||||
// Bits (3:2:1:0) = 0:1:0:0 --> AF4 for pin PB8
|
// Bits (3:2:1:0) = 0:1:0:0 --> AF4 for pin PB8
|
||||||
// Bits (7:6:5:4) = 0:1:0:0 --> AF4 for pin PB9
|
// Bits (7:6:5:4) = 0:1:0:0 --> AF4 for pin PB9
|
||||||
|
GPIOB->AFR[1] &= ~((15<<0) | (15<<4)); // Clear all AFR bits for PB8 on low nibble, PB9 on next nibble up
|
||||||
GPIOB->AFR[1] |= (4<<0) | (4<<4); // PB8 on low nibble, PB9 on next nibble up
|
GPIOB->AFR[1] |= (4<<0) | (4<<4); // PB8 on low nibble, PB9 on next nibble up
|
||||||
|
|
||||||
// Software reset the I2C peripheral
|
// Software reset the I2C peripheral
|
||||||
|
I2C1->CR1 &= ~I2C_CR1_PE; // Disable I2C1 peripheral
|
||||||
s->CR1 |= I2C_CR1_SWRST; // reset the I2C
|
s->CR1 |= I2C_CR1_SWRST; // reset the I2C
|
||||||
s->CR1 &= ~(I2C_CR1_SWRST); // Normal operation
|
asm("nop"); // wait a bit... suggestion from online!
|
||||||
|
s->CR1 &= ~(I2C_CR1_SWRST); // Normal operation
|
||||||
|
|
||||||
// Program the peripheral input clock in CR2 Register in order to generate correct timings
|
// Clear all bits in I2C CR2 register except reserved bits
|
||||||
s->CR2 |= I2C_BUSFREQ; // PCLK1 FREQUENCY in MHz
|
s->CR2 &= 0xE000;
|
||||||
|
|
||||||
|
// Set I2C peripheral clock frequency
|
||||||
|
// s->CR2 |= I2C_PERIPH_CLK;
|
||||||
|
s->CR2 |= i2c_MHz;
|
||||||
|
// DIAG(F("I2C_init() peripheral clock is now: %d"), s->CR2);
|
||||||
|
|
||||||
|
// set own address to 00 - not used in master mode
|
||||||
|
I2C1->OAR1 = (1 << 14); // bit 14 should be kept at 1 according to the datasheet
|
||||||
|
|
||||||
#if defined(I2C_USE_INTERRUPTS)
|
#if defined(I2C_USE_INTERRUPTS)
|
||||||
// Setting NVIC
|
// Setting NVIC
|
||||||
NVIC_SetPriority(I2C_IRQn, 1); // Match default priorities
|
NVIC_SetPriority(I2C1_EV_IRQn, 1); // Match default priorities
|
||||||
NVIC_EnableIRQ(I2C_IRQn);
|
NVIC_EnableIRQ(I2C1_EV_IRQn);
|
||||||
|
NVIC_SetPriority(I2C1_ER_IRQn, 1); // Match default priorities
|
||||||
|
NVIC_EnableIRQ(I2C1_ER_IRQn);
|
||||||
|
|
||||||
// CR2 Interrupt Settings
|
// CR2 Interrupt Settings
|
||||||
// Bit 15-13: reserved
|
// Bit 15-13: reserved
|
||||||
|
@ -172,23 +225,28 @@ void I2CManagerClass::I2C_init()
|
||||||
// Bit 8: ITERREN - Error interrupt enable
|
// Bit 8: ITERREN - Error interrupt enable
|
||||||
// Bit 7-6: reserved
|
// Bit 7-6: reserved
|
||||||
// Bit 5-0: FREQ - Peripheral clock frequency (max 50MHz)
|
// Bit 5-0: FREQ - Peripheral clock frequency (max 50MHz)
|
||||||
// s->CR2 |= 0x0700; // Enable Buffer, Event and Error interrupts
|
s->CR2 |= (I2C_CR2_ITBUFEN | I2C_CR2_ITEVTEN | I2C_CR2_ITERREN); // Enable Buffer, Event and Error interrupts
|
||||||
s->CR2 |= 0x0300; // Enable Event and Error interrupts
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
// DIAG(F("I2C_init() setting initial I2C clock to 100KHz"));
|
||||||
// Calculate baudrate and set default rate for now
|
// Calculate baudrate and set default rate for now
|
||||||
// Configure the Clock Control Register for 100KHz SCL frequency
|
// Configure the Clock Control Register for 100KHz SCL frequency
|
||||||
// Bit 15: I2C Master mode, 0=standard, 1=Fast Mode
|
// Bit 15: I2C Master mode, 0=standard, 1=Fast Mode
|
||||||
// Bit 14: Duty, fast mode duty cycle
|
// Bit 14: Duty, fast mode duty cycle
|
||||||
// Bit 11-0: FREQR = 16MHz => TPCLK1 = 62.5ns, so CCR divisor must be 0x50 (80 * 62.5ns = 5000ns)
|
// Bit 11-0: so CCR divisor would be clk / 2 / 100000 (where clk is in Hz)
|
||||||
s->CCR = 0x0050;
|
// s->CCR = I2C_PERIPH_CLK * 5;
|
||||||
|
s->CCR &= ~(0x3000); // Clear all bits except 12 and 13 which must remain per reset value
|
||||||
|
s->CCR |= (APB1clk1 / 2 / 100000UL); // Set a default of 100KHz I2C clockspeed to start!
|
||||||
|
|
||||||
// Configure the rise time register - max allowed in 1000ns
|
// Configure the rise time register - max allowed is 1000ns, so value = 1000ns * I2C_PERIPH_CLK MHz / 1000 + 1.
|
||||||
s->TRISE = 0x0011; // 1000 ns / 62.5 ns = 16 + 1
|
s->TRISE = (1000 * i2c_MHz / 1000) + 1;
|
||||||
|
|
||||||
|
// DIAG(F("I2C_init() peripheral clock is now: %d, full reg is %x"), (s->CR2 & 0xFF), s->CR2);
|
||||||
|
// DIAG(F("I2C_init() peripheral CCR is now: %d"), s->CCR);
|
||||||
|
// DIAG(F("I2C_init() peripheral TRISE is now: %d"), s->TRISE);
|
||||||
|
|
||||||
// Enable the I2C master mode
|
// Enable the I2C master mode
|
||||||
s->CR1 |= I2C_CR1_PE; // Enable I2C
|
s->CR1 |= I2C_CR1_PE; // Enable I2C
|
||||||
// Setting bus idle mode and wait for sync
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/***************************************************************************
|
/***************************************************************************
|
||||||
|
@ -198,49 +256,30 @@ void I2CManagerClass::I2C_sendStart() {
|
||||||
|
|
||||||
// Set counters here in case this is a retry.
|
// Set counters here in case this is a retry.
|
||||||
rxCount = txCount = 0;
|
rxCount = txCount = 0;
|
||||||
uint8_t temp;
|
|
||||||
|
|
||||||
// On a single-master I2C bus, the start bit won't be sent until the bus
|
// On a single-master I2C bus, the start bit won't be sent until the bus
|
||||||
// state goes to IDLE so we can request it without waiting. On a
|
// state goes to IDLE so we can request it without waiting. On a
|
||||||
// multi-master bus, the bus may be BUSY under control of another master,
|
// multi-master bus, the bus may be BUSY under control of another master,
|
||||||
// in which case we can avoid some arbitration failures by waiting until
|
// in which case we can avoid some arbitration failures by waiting until
|
||||||
// the bus state is IDLE. We don't do that here.
|
// the bus state is IDLE. We don't do that here.
|
||||||
|
//while (s->SR2 & I2C_SR2_BUSY) {}
|
||||||
|
|
||||||
// If anything to send, initiate write. Otherwise initiate read.
|
// Check there's no STOP still in progress. If we OR the START bit into CR1
|
||||||
if (operation == OPERATION_READ || ((operation == OPERATION_REQUEST) && !bytesToSend))
|
// and the STOP bit is already set, we could output multiple STOP conditions.
|
||||||
{
|
while (s->CR1 & I2C_CR1_STOP) {} // Wait for STOP bit to reset
|
||||||
// Send start for read operation
|
|
||||||
s->CR1 |= I2C_CR1_ACK; // Enable the ACK
|
s->CR2 |= (I2C_CR2_ITEVTEN | I2C_CR2_ITERREN); // Enable interrupts
|
||||||
s->CR1 |= I2C_CR1_START; // Generate START
|
s->CR2 &= ~I2C_CR2_ITBUFEN; // Don't enable buffer interupts yet.
|
||||||
// Send address with read flag (1) or'd in
|
s->CR1 &= ~I2C_CR1_POS; // Clear the POS bit
|
||||||
s->DR = (deviceAddress << 1) | 1; // send the address
|
s->CR1 |= (I2C_CR1_ACK | I2C_CR1_START); // Enable the ACK and generate START
|
||||||
while (!(s->SR1 && I2C_SR1_ADDR)); // wait for ADDR bit to set
|
transactionState = TS_START;
|
||||||
// Special case for 1 byte reads!
|
|
||||||
if (bytesToReceive == 1)
|
|
||||||
{
|
|
||||||
s->CR1 &= ~I2C_CR1_ACK; // clear the ACK bit
|
|
||||||
temp = I2C1->SR1 | I2C1->SR2; // read SR1 and SR2 to clear the ADDR bit.... EV6 condition
|
|
||||||
s->CR1 |= I2C_CR1_STOP; // Stop I2C
|
|
||||||
}
|
|
||||||
else
|
|
||||||
temp = s->SR1 | s->SR2; // read SR1 and SR2 to clear the ADDR bit
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
// Send start for write operation
|
|
||||||
s->CR1 |= I2C_CR1_ACK; // Enable the ACK
|
|
||||||
s->CR1 |= I2C_CR1_START; // Generate START
|
|
||||||
// Send address with write flag (0) or'd in
|
|
||||||
s->DR = (deviceAddress << 1) | 0; // send the address
|
|
||||||
while (!(s->SR1 && I2C_SR1_ADDR)); // wait for ADDR bit to set
|
|
||||||
temp = s->SR1 | s->SR2; // read SR1 and SR2 to clear the ADDR bit
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/***************************************************************************
|
/***************************************************************************
|
||||||
* Initiate a stop bit for transmission (does not interrupt)
|
* Initiate a stop bit for transmission (does not interrupt)
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
void I2CManagerClass::I2C_sendStop() {
|
void I2CManagerClass::I2C_sendStop() {
|
||||||
s->CR1 |= I2C_CR1_STOP; // Stop I2C
|
s->CR1 |= I2C_CR1_STOP; // Stop I2C
|
||||||
}
|
}
|
||||||
|
|
||||||
/***************************************************************************
|
/***************************************************************************
|
||||||
|
@ -252,9 +291,11 @@ void I2CManagerClass::I2C_close() {
|
||||||
s->CR1 &= ~I2C_CR1_PE; // Disable I2C peripheral
|
s->CR1 &= ~I2C_CR1_PE; // Disable I2C peripheral
|
||||||
// Should never happen, but wait for up to 500us only.
|
// Should never happen, but wait for up to 500us only.
|
||||||
unsigned long startTime = micros();
|
unsigned long startTime = micros();
|
||||||
while ((s->CR1 && I2C_CR1_PE) != 0) {
|
while ((s->CR1 & I2C_CR1_PE) != 0) {
|
||||||
if (micros() - startTime >= 500UL) break;
|
if ((int32_t)(micros() - startTime) >= 500) break;
|
||||||
}
|
}
|
||||||
|
NVIC_DisableIRQ(I2C1_EV_IRQn);
|
||||||
|
NVIC_DisableIRQ(I2C1_ER_IRQn);
|
||||||
}
|
}
|
||||||
|
|
||||||
/***************************************************************************
|
/***************************************************************************
|
||||||
|
@ -263,50 +304,217 @@ void I2CManagerClass::I2C_close() {
|
||||||
* (and therefore, indirectly, from I2CRB::wait() and I2CRB::isBusy()).
|
* (and therefore, indirectly, from I2CRB::wait() and I2CRB::isBusy()).
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
void I2CManagerClass::I2C_handleInterrupt() {
|
void I2CManagerClass::I2C_handleInterrupt() {
|
||||||
|
volatile uint16_t temp_sr1, temp_sr2;
|
||||||
|
|
||||||
if (s->SR1 && I2C_SR1_ARLO) {
|
temp_sr1 = s->SR1;
|
||||||
// Arbitration lost, restart
|
|
||||||
I2C_sendStart(); // Reinitiate request
|
// Check for errors first
|
||||||
} else if (s->SR1 && I2C_SR1_BERR) {
|
if (temp_sr1 & (I2C_SR1_AF | I2C_SR1_ARLO | I2C_SR1_BERR)) {
|
||||||
// Bus error
|
// Check which error flag is set
|
||||||
completionStatus = I2C_STATUS_BUS_ERROR;
|
if (temp_sr1 & I2C_SR1_AF)
|
||||||
state = I2C_STATE_COMPLETED;
|
{
|
||||||
} else if (s->SR1 && I2C_SR1_TXE) {
|
s->SR1 &= ~(I2C_SR1_AF); // Clear AF
|
||||||
// Master write completed
|
I2C_sendStop(); // Clear the bus
|
||||||
if (s->SR1 && (1<<10)) {
|
transactionState = TS_IDLE;
|
||||||
// Nacked, send stop.
|
|
||||||
I2C_sendStop();
|
|
||||||
completionStatus = I2C_STATUS_NEGATIVE_ACKNOWLEDGE;
|
completionStatus = I2C_STATUS_NEGATIVE_ACKNOWLEDGE;
|
||||||
state = I2C_STATE_COMPLETED;
|
state = I2C_STATE_COMPLETED;
|
||||||
} else if (bytesToSend) {
|
|
||||||
// Acked, so send next byte
|
|
||||||
s->DR = sendBuffer[txCount++];
|
|
||||||
bytesToSend--;
|
|
||||||
} else if (bytesToReceive) {
|
|
||||||
// Last sent byte acked and no more to send. Send repeated start, address and read bit.
|
|
||||||
// s->I2CM.ADDR.bit.ADDR = (deviceAddress << 1) | 1;
|
|
||||||
} else {
|
|
||||||
// Check both TxE/BTF == 1 before generating stop
|
|
||||||
while (!(s->SR1 && I2C_SR1_TXE)); // Check TxE
|
|
||||||
while (!(s->SR1 && I2C_SR1_BTF)); // Check BTF
|
|
||||||
// No more data to send/receive. Initiate a STOP condition and finish
|
|
||||||
I2C_sendStop();
|
|
||||||
state = I2C_STATE_COMPLETED;
|
|
||||||
}
|
}
|
||||||
} else if (s->SR1 && I2C_SR1_RXNE) {
|
else if (temp_sr1 & I2C_SR1_ARLO)
|
||||||
// Master read completed without errors
|
{
|
||||||
if (bytesToReceive == 1) {
|
// Arbitration lost, restart
|
||||||
// s->I2CM.CTRLB.bit.ACKACT = 1; // NAK final byte
|
s->SR1 &= ~(I2C_SR1_ARLO); // Clear ARLO
|
||||||
I2C_sendStop(); // send stop
|
I2C_sendStart(); // Reinitiate request
|
||||||
receiveBuffer[rxCount++] = s->DR; // Store received byte
|
transactionState = TS_START;
|
||||||
bytesToReceive = 0;
|
}
|
||||||
|
else if (temp_sr1 & I2C_SR1_BERR)
|
||||||
|
{
|
||||||
|
// Bus error
|
||||||
|
s->SR1 &= ~(I2C_SR1_BERR); // Clear BERR
|
||||||
|
I2C_sendStop(); // Clear the bus
|
||||||
|
transactionState = TS_IDLE;
|
||||||
|
completionStatus = I2C_STATUS_BUS_ERROR;
|
||||||
state = I2C_STATE_COMPLETED;
|
state = I2C_STATE_COMPLETED;
|
||||||
} else if (bytesToReceive) {
|
|
||||||
// s->I2CM.CTRLB.bit.ACKACT = 0; // ACK all but final byte
|
|
||||||
receiveBuffer[rxCount++] = s->DR; // Store received byte
|
|
||||||
bytesToReceive--;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
else {
|
||||||
|
// No error flags, so process event according to current state.
|
||||||
|
switch (transactionState) {
|
||||||
|
case TS_START:
|
||||||
|
if (temp_sr1 & I2C_SR1_SB) {
|
||||||
|
// Event EV5
|
||||||
|
// Start bit has been sent successfully and we have the bus.
|
||||||
|
// If anything to send, initiate write. Otherwise initiate read.
|
||||||
|
if (operation == OPERATION_READ || ((operation == OPERATION_REQUEST) && !bytesToSend)) {
|
||||||
|
// Send address with read flag (1) or'd in
|
||||||
|
s->DR = (deviceAddress << 1) | 1; // send the address
|
||||||
|
transactionState = TS_R_ADDR;
|
||||||
|
} else {
|
||||||
|
// Send address with write flag (0) or'd in
|
||||||
|
s->DR = (deviceAddress << 1) | 0; // send the address
|
||||||
|
transactionState = TS_W_ADDR;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// SB bit is cleared by writing to DR (already done).
|
||||||
|
break;
|
||||||
|
|
||||||
|
case TS_W_ADDR:
|
||||||
|
if (temp_sr1 & I2C_SR1_ADDR) {
|
||||||
|
temp_sr2 = s->SR2; // read SR2 to complete clearing the ADDR bit
|
||||||
|
// Event EV6
|
||||||
|
// Address sent successfully, device has ack'd in response.
|
||||||
|
if (!bytesToSend) {
|
||||||
|
I2C_sendStop();
|
||||||
|
transactionState = TS_IDLE;
|
||||||
|
completionStatus = I2C_STATUS_OK;
|
||||||
|
state = I2C_STATE_COMPLETED;
|
||||||
|
} else {
|
||||||
|
// Put one byte into DR to load shift register.
|
||||||
|
s->DR = sendBuffer[txCount++];
|
||||||
|
bytesToSend--;
|
||||||
|
if (bytesToSend) {
|
||||||
|
// Put another byte to load DR
|
||||||
|
s->DR = sendBuffer[txCount++];
|
||||||
|
bytesToSend--;
|
||||||
|
}
|
||||||
|
if (!bytesToSend) {
|
||||||
|
// No more bytes to send.
|
||||||
|
// The TXE interrupt occurs when the DR is empty, and the BTF interrupt
|
||||||
|
// occurs when the shift register is also empty (one character later).
|
||||||
|
// To avoid repeated TXE interrupts during this time, we disable TXE interrupt.
|
||||||
|
s->CR2 &= ~I2C_CR2_ITBUFEN; // Wait for BTF interrupt, disable TXE interrupt
|
||||||
|
transactionState = TS_W_STOP;
|
||||||
|
} else {
|
||||||
|
// More data remaining to send after this interrupt, enable TXE interrupt.
|
||||||
|
s->CR2 |= I2C_CR2_ITBUFEN;
|
||||||
|
transactionState = TS_W_DATA;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case TS_W_DATA:
|
||||||
|
if (temp_sr1 & I2C_SR1_TXE) {
|
||||||
|
// Event EV8_1/EV8
|
||||||
|
// Transmitter empty, write a byte to it.
|
||||||
|
if (bytesToSend) {
|
||||||
|
s->DR = sendBuffer[txCount++];
|
||||||
|
bytesToSend--;
|
||||||
|
if (!bytesToSend) {
|
||||||
|
s->CR2 &= ~I2C_CR2_ITBUFEN; // Disable TXE interrupt
|
||||||
|
transactionState = TS_W_STOP;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case TS_W_STOP:
|
||||||
|
if (temp_sr1 & I2C_SR1_BTF) {
|
||||||
|
// Event EV8_2
|
||||||
|
// Done, last character sent. Anything to receive?
|
||||||
|
if (bytesToReceive) {
|
||||||
|
I2C_sendStart();
|
||||||
|
// NOTE: Three redundant BTF interrupts take place between the
|
||||||
|
// first BTF interrupt and the START interrupt. I've tried all sorts
|
||||||
|
// of ways to eliminate them, and the only thing that worked for
|
||||||
|
// me was to loop until the BTF bit becomes reset. Either way,
|
||||||
|
// it's a waste of processor time. Anyone got a solution?
|
||||||
|
//while (s->SR1 && I2C_SR1_BTF) {}
|
||||||
|
transactionState = TS_START;
|
||||||
|
} else {
|
||||||
|
I2C_sendStop();
|
||||||
|
transactionState = TS_IDLE;
|
||||||
|
completionStatus = I2C_STATUS_OK;
|
||||||
|
state = I2C_STATE_COMPLETED;
|
||||||
|
}
|
||||||
|
s->SR1 &= I2C_SR1_BTF; // Clear BTF interrupt
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case TS_R_ADDR:
|
||||||
|
if (temp_sr1 & I2C_SR1_ADDR) {
|
||||||
|
// Event EV6
|
||||||
|
// Address sent for receive.
|
||||||
|
// The next bit is different depending on whether there are
|
||||||
|
// 1 byte, 2 bytes or >2 bytes to be received, in accordance with the
|
||||||
|
// Programmers Reference RM0390.
|
||||||
|
if (bytesToReceive == 1) {
|
||||||
|
// Receive 1 byte
|
||||||
|
s->CR1 &= ~I2C_CR1_ACK; // Disable ack
|
||||||
|
temp_sr2 = s->SR2; // read SR2 to complete clearing the ADDR bit
|
||||||
|
// Next step will occur after a RXNE interrupt, so enable it
|
||||||
|
s->CR2 |= I2C_CR2_ITBUFEN;
|
||||||
|
transactionState = TS_R_STOP;
|
||||||
|
} else if (bytesToReceive == 2) {
|
||||||
|
// Receive 2 bytes
|
||||||
|
s->CR1 &= ~I2C_CR1_ACK; // Disable ACK for final byte
|
||||||
|
s->CR1 |= I2C_CR1_POS; // set POS flag to delay effect of ACK flag
|
||||||
|
// Next step will occur after a BTF interrupt, so disable RXNE interrupt
|
||||||
|
s->CR2 &= ~I2C_CR2_ITBUFEN;
|
||||||
|
temp_sr2 = s->SR2; // read SR2 to complete clearing the ADDR bit
|
||||||
|
transactionState = TS_R_STOP;
|
||||||
|
} else {
|
||||||
|
// >2 bytes, just wait for bytes to come in and ack them for the time being
|
||||||
|
// (ack flag has already been set).
|
||||||
|
// Next step will occur after a BTF interrupt, so disable RXNE interrupt
|
||||||
|
s->CR2 &= ~I2C_CR2_ITBUFEN;
|
||||||
|
temp_sr2 = s->SR2; // read SR2 to complete clearing the ADDR bit
|
||||||
|
transactionState = TS_R_DATA;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case TS_R_DATA:
|
||||||
|
// Event EV7/EV7_1
|
||||||
|
if (temp_sr1 & I2C_SR1_BTF) {
|
||||||
|
// Byte received in receiver - read next byte
|
||||||
|
if (bytesToReceive == 3) {
|
||||||
|
// Getting close to the last byte, so a specific sequence is recommended.
|
||||||
|
s->CR1 &= ~I2C_CR1_ACK; // Reset ack for next byte received.
|
||||||
|
transactionState = TS_R_STOP;
|
||||||
|
}
|
||||||
|
receiveBuffer[rxCount++] = s->DR; // Store received byte
|
||||||
|
bytesToReceive--;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case TS_R_STOP:
|
||||||
|
if (temp_sr1 & I2C_SR1_BTF) {
|
||||||
|
// Event EV7 (last one)
|
||||||
|
// When we've got here, the receiver has got the last two bytes
|
||||||
|
// (or one byte, if only one byte is being received),
|
||||||
|
// and NAK has already been sent, so we need to read from the receiver.
|
||||||
|
if (bytesToReceive) {
|
||||||
|
if (bytesToReceive > 1)
|
||||||
|
I2C_sendStop();
|
||||||
|
while(bytesToReceive) {
|
||||||
|
receiveBuffer[rxCount++] = s->DR; // Store received byte(s)
|
||||||
|
bytesToReceive--;
|
||||||
|
}
|
||||||
|
// Finish.
|
||||||
|
transactionState = TS_IDLE;
|
||||||
|
completionStatus = I2C_STATUS_OK;
|
||||||
|
state = I2C_STATE_COMPLETED;
|
||||||
|
}
|
||||||
|
} else if (temp_sr1 & I2C_SR1_RXNE) {
|
||||||
|
if (bytesToReceive == 1) {
|
||||||
|
// One byte on a single-byte transfer. Ack has already been set.
|
||||||
|
I2C_sendStop();
|
||||||
|
receiveBuffer[rxCount++] = s->DR; // Store received byte
|
||||||
|
bytesToReceive--;
|
||||||
|
// Finish.
|
||||||
|
transactionState = TS_IDLE;
|
||||||
|
completionStatus = I2C_STATUS_OK;
|
||||||
|
state = I2C_STATE_COMPLETED;
|
||||||
|
} else
|
||||||
|
s->SR1 &= I2C_SR1_RXNE; // Acknowledge interrupt
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
// If we've received an interrupt at any other time, we're not interested so clear it
|
||||||
|
// to prevent it recurring ad infinitum.
|
||||||
|
s->SR1 = 0;
|
||||||
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* I2CMANAGER_STM32_H */
|
#endif /* I2CMANAGER_STM32_H */
|
||||||
|
|
|
@ -176,6 +176,13 @@ bool IODevice::exists(VPIN vpin) {
|
||||||
return findDevice(vpin) != NULL;
|
return findDevice(vpin) != NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Return the status of the device att vpin.
|
||||||
|
uint8_t IODevice::getStatus(VPIN vpin) {
|
||||||
|
IODevice *dev = findDevice(vpin);
|
||||||
|
if (!dev) return false;
|
||||||
|
return dev->_deviceState;
|
||||||
|
}
|
||||||
|
|
||||||
// check whether the pin supports notification. If so, then regular _read calls are not required.
|
// check whether the pin supports notification. If so, then regular _read calls are not required.
|
||||||
bool IODevice::hasCallback(VPIN vpin) {
|
bool IODevice::hasCallback(VPIN vpin) {
|
||||||
IODevice *dev = findDevice(vpin);
|
IODevice *dev = findDevice(vpin);
|
||||||
|
|
14
IODevice.h
14
IODevice.h
|
@ -27,12 +27,6 @@
|
||||||
// Define symbol DIAG_LOOPTIMES to enable CS loop execution time to be reported
|
// Define symbol DIAG_LOOPTIMES to enable CS loop execution time to be reported
|
||||||
//#define DIAG_LOOPTIMES
|
//#define DIAG_LOOPTIMES
|
||||||
|
|
||||||
// Define symbol IO_NO_HAL to reduce FLASH footprint when HAL features not required
|
|
||||||
// The HAL is disabled by default on Nano and Uno platforms, because of limited flash space.
|
|
||||||
#if defined(ARDUINO_AVR_NANO) || defined(ARDUINO_AVR_UNO)
|
|
||||||
#define IO_NO_HAL
|
|
||||||
#endif
|
|
||||||
|
|
||||||
// Define symbol IO_SWITCH_OFF_SERVO to set the PCA9685 output to 0 when an
|
// Define symbol IO_SWITCH_OFF_SERVO to set the PCA9685 output to 0 when an
|
||||||
// animation has completed. This switches off the servo motor, preventing
|
// animation has completed. This switches off the servo motor, preventing
|
||||||
// the continuous buzz sometimes found on servos, and reducing the
|
// the continuous buzz sometimes found on servos, and reducing the
|
||||||
|
@ -160,6 +154,9 @@ public:
|
||||||
// exists checks whether there is a device owning the specified vpin
|
// exists checks whether there is a device owning the specified vpin
|
||||||
static bool exists(VPIN vpin);
|
static bool exists(VPIN vpin);
|
||||||
|
|
||||||
|
// getStatus returns the state of the device at the specified vpin
|
||||||
|
static uint8_t getStatus(VPIN vpin);
|
||||||
|
|
||||||
// Enable shared interrupt on specified pin for GPIO extender modules. The extender module
|
// Enable shared interrupt on specified pin for GPIO extender modules. The extender module
|
||||||
// should pull down this pin when requesting a scan. The pin may be shared by multiple modules.
|
// should pull down this pin when requesting a scan. The pin may be shared by multiple modules.
|
||||||
// Without the shared interrupt, input states are scanned periodically to detect changes on
|
// Without the shared interrupt, input states are scanned periodically to detect changes on
|
||||||
|
@ -383,6 +380,7 @@ private:
|
||||||
uint8_t *_pinInUse;
|
uint8_t *_pinInUse;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
/////////////////////////////////////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////////////////////////////////////
|
||||||
/*
|
/*
|
||||||
* IODevice subclass for EX-Turntable.
|
* IODevice subclass for EX-Turntable.
|
||||||
|
@ -411,10 +409,14 @@ private:
|
||||||
void _begin() override;
|
void _begin() override;
|
||||||
void _loop(unsigned long currentMicros) override;
|
void _loop(unsigned long currentMicros) override;
|
||||||
int _read(VPIN vpin) override;
|
int _read(VPIN vpin) override;
|
||||||
|
void _broadcastStatus (VPIN vpin, uint8_t status, uint8_t activity);
|
||||||
void _writeAnalogue(VPIN vpin, int value, uint8_t activity, uint16_t duration) override;
|
void _writeAnalogue(VPIN vpin, int value, uint8_t activity, uint16_t duration) override;
|
||||||
void _display() override;
|
void _display() override;
|
||||||
uint8_t _stepperStatus;
|
uint8_t _stepperStatus;
|
||||||
|
uint8_t _previousStatus;
|
||||||
|
uint8_t _currentActivity;
|
||||||
};
|
};
|
||||||
|
#endif
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
|
||||||
|
|
|
@ -20,20 +20,21 @@
|
||||||
/*
|
/*
|
||||||
* The IO_EXTurntable device driver is used to control a turntable via an Arduino with a stepper motor over I2C.
|
* The IO_EXTurntable device driver is used to control a turntable via an Arduino with a stepper motor over I2C.
|
||||||
*
|
*
|
||||||
* The EX-Turntable code lives in a separate repo (https://github.com/DCC-EX/Turntable-EX) and contains the stepper motor logic.
|
* The EX-Turntable code lives in a separate repo (https://github.com/DCC-EX/EX-Turntable) and contains the stepper motor logic.
|
||||||
*
|
*
|
||||||
* This device driver sends a step position to Turntable-EX to indicate the step position to move to using either of these commands:
|
* This device driver sends a step position to EX-Turntable to indicate the step position to move to using either of these commands:
|
||||||
* <D TT vpin steps activity> in the serial console
|
* <D TT vpin steps activity> in the serial console
|
||||||
* MOVETT(vpin, steps, activity) in EX-RAIL
|
* MOVETT(vpin, steps, activity) in EX-RAIL
|
||||||
* Refer to the documentation for further information including the valid activities.
|
* Refer to the documentation for further information including the valid activities.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef IO_EXTurntable_h
|
|
||||||
#define IO_EXTurntable_h
|
|
||||||
|
|
||||||
#include "IODevice.h"
|
#include "IODevice.h"
|
||||||
#include "I2CManager.h"
|
#include "I2CManager.h"
|
||||||
#include "DIAG.h"
|
#include "DIAG.h"
|
||||||
|
#include "Turntables.h"
|
||||||
|
#include "CommandDistributor.h"
|
||||||
|
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
|
||||||
void EXTurntable::create(VPIN firstVpin, int nPins, I2CAddress I2CAddress) {
|
void EXTurntable::create(VPIN firstVpin, int nPins, I2CAddress I2CAddress) {
|
||||||
new EXTurntable(firstVpin, nPins, I2CAddress);
|
new EXTurntable(firstVpin, nPins, I2CAddress);
|
||||||
|
@ -44,18 +45,21 @@ EXTurntable::EXTurntable(VPIN firstVpin, int nPins, I2CAddress I2CAddress) {
|
||||||
_firstVpin = firstVpin;
|
_firstVpin = firstVpin;
|
||||||
_nPins = nPins;
|
_nPins = nPins;
|
||||||
_I2CAddress = I2CAddress;
|
_I2CAddress = I2CAddress;
|
||||||
|
_stepperStatus = 0;
|
||||||
|
_previousStatus = 0;
|
||||||
addDevice(this);
|
addDevice(this);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Initialisation of EXTurntable
|
// Initialisation of EXTurntable
|
||||||
void EXTurntable::_begin() {
|
void EXTurntable::_begin() {
|
||||||
I2CManager.begin();
|
I2CManager.begin();
|
||||||
I2CManager.setClock(1000000);
|
|
||||||
if (I2CManager.exists(_I2CAddress)) {
|
if (I2CManager.exists(_I2CAddress)) {
|
||||||
|
DIAG(F("EX-Turntable device found, I2C:%s"), _I2CAddress.toString());
|
||||||
#ifdef DIAG_IO
|
#ifdef DIAG_IO
|
||||||
_display();
|
_display();
|
||||||
#endif
|
#endif
|
||||||
} else {
|
} else {
|
||||||
|
DIAG(F("EX-Turntable I2C:%s device not found"), _I2CAddress.toString());
|
||||||
_deviceState = DEVSTATE_FAILED;
|
_deviceState = DEVSTATE_FAILED;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -67,15 +71,19 @@ void EXTurntable::_loop(unsigned long currentMicros) {
|
||||||
uint8_t readBuffer[1];
|
uint8_t readBuffer[1];
|
||||||
I2CManager.read(_I2CAddress, readBuffer, 1);
|
I2CManager.read(_I2CAddress, readBuffer, 1);
|
||||||
_stepperStatus = readBuffer[0];
|
_stepperStatus = readBuffer[0];
|
||||||
// DIAG(F("Turntable-EX returned status: %d"), _stepperStatus);
|
if (_stepperStatus != _previousStatus && _stepperStatus == 0) { // Broadcast when a rotation finishes
|
||||||
delayUntil(currentMicros + 500000); // Wait 500ms before checking again, turntables turn slowly
|
if ( _currentActivity < 4) {
|
||||||
|
_broadcastStatus(_firstVpin, _stepperStatus, _currentActivity);
|
||||||
|
}
|
||||||
|
_previousStatus = _stepperStatus;
|
||||||
|
}
|
||||||
|
delayUntil(currentMicros + 100000); // Wait 100ms before checking again
|
||||||
}
|
}
|
||||||
|
|
||||||
// Read returns status as obtained in our loop.
|
// Read returns status as obtained in our loop.
|
||||||
// Return false if our status value is invalid.
|
// Return false if our status value is invalid.
|
||||||
int EXTurntable::_read(VPIN vpin) {
|
int EXTurntable::_read(VPIN vpin) {
|
||||||
if (_deviceState == DEVSTATE_FAILED) return 0;
|
if (_deviceState == DEVSTATE_FAILED) return 0;
|
||||||
// DIAG(F("_read status: %d"), _stepperStatus);
|
|
||||||
if (_stepperStatus > 1) {
|
if (_stepperStatus > 1) {
|
||||||
return false;
|
return false;
|
||||||
} else {
|
} else {
|
||||||
|
@ -83,6 +91,17 @@ int EXTurntable::_read(VPIN vpin) {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// If a status change has occurred for a turntable object, broadcast it
|
||||||
|
void EXTurntable::_broadcastStatus (VPIN vpin, uint8_t status, uint8_t activity) {
|
||||||
|
Turntable *tto = Turntable::getByVpin(vpin);
|
||||||
|
if (tto) {
|
||||||
|
if (activity < 4) {
|
||||||
|
tto->setMoving(status);
|
||||||
|
CommandDistributor::broadcastTurntable(tto->getId(), tto->getPosition(), status);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
// writeAnalogue to send the steps and activity to Turntable-EX.
|
// writeAnalogue to send the steps and activity to Turntable-EX.
|
||||||
// Sends 3 bytes containing the MSB and LSB of the step count, and activity.
|
// Sends 3 bytes containing the MSB and LSB of the step count, and activity.
|
||||||
// value contains the steps, bit shifted to MSB + LSB.
|
// value contains the steps, bit shifted to MSB + LSB.
|
||||||
|
@ -100,6 +119,7 @@ int EXTurntable::_read(VPIN vpin) {
|
||||||
// Acc_Off = 9 // Turn accessory pin off
|
// Acc_Off = 9 // Turn accessory pin off
|
||||||
void EXTurntable::_writeAnalogue(VPIN vpin, int value, uint8_t activity, uint16_t duration) {
|
void EXTurntable::_writeAnalogue(VPIN vpin, int value, uint8_t activity, uint16_t duration) {
|
||||||
if (_deviceState == DEVSTATE_FAILED) return;
|
if (_deviceState == DEVSTATE_FAILED) return;
|
||||||
|
if (value < 0) return;
|
||||||
uint8_t stepsMSB = value >> 8;
|
uint8_t stepsMSB = value >> 8;
|
||||||
uint8_t stepsLSB = value & 0xFF;
|
uint8_t stepsLSB = value & 0xFF;
|
||||||
#ifdef DIAG_IO
|
#ifdef DIAG_IO
|
||||||
|
@ -108,7 +128,10 @@ void EXTurntable::_writeAnalogue(VPIN vpin, int value, uint8_t activity, uint16_
|
||||||
DIAG(F("I2CManager write I2C Address:%d stepsMSB:%d stepsLSB:%d activity:%d"),
|
DIAG(F("I2CManager write I2C Address:%d stepsMSB:%d stepsLSB:%d activity:%d"),
|
||||||
_I2CAddress.toString(), stepsMSB, stepsLSB, activity);
|
_I2CAddress.toString(), stepsMSB, stepsLSB, activity);
|
||||||
#endif
|
#endif
|
||||||
_stepperStatus = 1; // Tell the device driver Turntable-EX is busy
|
if (activity < 4) _stepperStatus = 1; // Tell the device driver Turntable-EX is busy
|
||||||
|
_previousStatus = _stepperStatus;
|
||||||
|
_currentActivity = activity;
|
||||||
|
_broadcastStatus(vpin, _stepperStatus, activity); // Broadcast when the rotation starts
|
||||||
I2CManager.write(_I2CAddress, 3, stepsMSB, stepsLSB, activity);
|
I2CManager.write(_I2CAddress, 3, stepsMSB, stepsLSB, activity);
|
||||||
}
|
}
|
||||||
|
|
111
IO_PCA9555.h
Normal file
111
IO_PCA9555.h
Normal file
|
@ -0,0 +1,111 @@
|
||||||
|
/*
|
||||||
|
* © 2021, Neil McKechnie. All rights reserved.
|
||||||
|
*
|
||||||
|
* This file is part of DCC++EX API
|
||||||
|
*
|
||||||
|
* 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/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef io_pca9555_h
|
||||||
|
#define io_pca9555_h
|
||||||
|
|
||||||
|
#include "IO_GPIOBase.h"
|
||||||
|
#include "FSH.h"
|
||||||
|
|
||||||
|
/////////////////////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
/*
|
||||||
|
* IODevice subclass for PCA9555 16-bit I/O expander (NXP & Texas Instruments).
|
||||||
|
*/
|
||||||
|
|
||||||
|
class PCA9555 : public GPIOBase<uint16_t> {
|
||||||
|
public:
|
||||||
|
static void create(VPIN vpin, uint8_t nPins, I2CAddress i2cAddress, int interruptPin=-1) {
|
||||||
|
if (checkNoOverlap(vpin, nPins, i2cAddress)) new PCA9555(vpin,nPins, i2cAddress, interruptPin);
|
||||||
|
}
|
||||||
|
|
||||||
|
private:
|
||||||
|
// Constructor
|
||||||
|
PCA9555(VPIN vpin, uint8_t nPins, I2CAddress I2CAddress, int interruptPin=-1)
|
||||||
|
: GPIOBase<uint16_t>((FSH *)F("PCA9555"), vpin, nPins, I2CAddress, interruptPin)
|
||||||
|
{
|
||||||
|
requestBlock.setRequestParams(_I2CAddress, inputBuffer, sizeof(inputBuffer),
|
||||||
|
outputBuffer, sizeof(outputBuffer));
|
||||||
|
outputBuffer[0] = REG_INPUT_P0;
|
||||||
|
}
|
||||||
|
void _writeGpioPort() override {
|
||||||
|
I2CManager.write(_I2CAddress, 3, REG_OUTPUT_P0, _portOutputState, _portOutputState>>8);
|
||||||
|
}
|
||||||
|
void _writePullups() override {
|
||||||
|
// Do nothing, pull-ups are always in place for input ports
|
||||||
|
// This function is here for HAL GPIOBase API compatibilitiy
|
||||||
|
|
||||||
|
}
|
||||||
|
void _writePortModes() override {
|
||||||
|
// Write 0 to REG_CONF_P0 & REG_CONF_P1 for in-use pins that are outputs, 1 for others.
|
||||||
|
// PCA9555 & TCA9555, Interrupt is always enabled for raising and falling edge
|
||||||
|
uint16_t temp = ~(_portMode & _portInUse);
|
||||||
|
I2CManager.write(_I2CAddress, 3, REG_CONF_P0, temp, temp>>8);
|
||||||
|
}
|
||||||
|
void _readGpioPort(bool immediate) override {
|
||||||
|
if (immediate) {
|
||||||
|
uint8_t buffer[2];
|
||||||
|
I2CManager.read(_I2CAddress, buffer, 2, 1, REG_INPUT_P0);
|
||||||
|
_portInputState = ((uint16_t)buffer[1]<<8) | buffer[0];
|
||||||
|
/* PCA9555 Int bug fix, from PCA9555 datasheet: "must change command byte to something besides 00h
|
||||||
|
* after a Read operation to the PCA9555 device or before reading from
|
||||||
|
* another device"
|
||||||
|
* Recommended solution, read from REG_OUTPUT_P0, then do nothing with the received data
|
||||||
|
* Issue not seen during testing, uncomment if needed
|
||||||
|
*/
|
||||||
|
//I2CManager.read(_I2CAddress, buffer, 2, 1, REG_OUTPUT_P0);
|
||||||
|
} else {
|
||||||
|
// Queue new request
|
||||||
|
requestBlock.wait(); // Wait for preceding operation to complete
|
||||||
|
// Issue new request to read GPIO register
|
||||||
|
I2CManager.queueRequest(&requestBlock);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// This function is invoked when an I/O operation on the requestBlock completes.
|
||||||
|
void _processCompletion(uint8_t status) override {
|
||||||
|
if (status == I2C_STATUS_OK)
|
||||||
|
_portInputState = ((uint16_t)inputBuffer[1]<<8) | inputBuffer[0];
|
||||||
|
else
|
||||||
|
_portInputState = 0xffff;
|
||||||
|
}
|
||||||
|
|
||||||
|
void _setupDevice() override {
|
||||||
|
// HAL API calls
|
||||||
|
_writePortModes();
|
||||||
|
_writePullups();
|
||||||
|
_writeGpioPort();
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t inputBuffer[2];
|
||||||
|
uint8_t outputBuffer[1];
|
||||||
|
|
||||||
|
|
||||||
|
enum {
|
||||||
|
REG_INPUT_P0 = 0x00,
|
||||||
|
REG_INPUT_P1 = 0x01,
|
||||||
|
REG_OUTPUT_P0 = 0x02,
|
||||||
|
REG_OUTPUT_P1 = 0x03,
|
||||||
|
REG_POL_INV_P0 = 0x04,
|
||||||
|
REG_POL_INV_P1 = 0x05,
|
||||||
|
REG_CONF_P0 = 0x06,
|
||||||
|
REG_CONF_P1 = 0x07,
|
||||||
|
};
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
|
@ -1,4 +1,5 @@
|
||||||
/*
|
/*
|
||||||
|
* © 2023, Peter Cole. All rights reserved.
|
||||||
* © 2022, Peter Cole. All rights reserved.
|
* © 2022, Peter Cole. All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of EX-CommandStation
|
* This file is part of EX-CommandStation
|
||||||
|
@ -28,9 +29,23 @@
|
||||||
* ONCHANGE(vpin) - flag when the rotary encoder position has changed from the previous position
|
* ONCHANGE(vpin) - flag when the rotary encoder position has changed from the previous position
|
||||||
* IFRE(vpin, position) - test to see if specified rotary encoder position has been received
|
* IFRE(vpin, position) - test to see if specified rotary encoder position has been received
|
||||||
*
|
*
|
||||||
* Further to this, feedback can be sent to the rotary encoder by using 2 Vpins, and sending a SET()/RESET() to the second Vpin.
|
* Feedback can also be sent to the rotary encoder by using 2 Vpins, and sending a SET()/RESET() to the second Vpin.
|
||||||
* A SET(vpin) will flag that a turntable (or anything else) is in motion, and a RESET(vpin) that the motion has finished.
|
* A SET(vpin) will flag that a turntable (or anything else) is in motion, and a RESET(vpin) that the motion has finished.
|
||||||
*
|
*
|
||||||
|
* In addition, defining a third Vpin will allow a position number to be sent so that when an EXRAIL automation or some other
|
||||||
|
* activity has moved a turntable, the position can be reflected in the rotary encoder software. This can be accomplished
|
||||||
|
* using the EXRAIL SERVO(vpin, position, profile) command, where:
|
||||||
|
* - vpin = the third defined Vpin (any other is ignored)
|
||||||
|
* - position = the defined position in the DCC-EX Rotary Encoder software, 0 (Home) to 255
|
||||||
|
* - profile = Must be defined as per the SERVO() command, but is ignored as it has no relevance
|
||||||
|
*
|
||||||
|
* Defining in myAutomation.h requires the device driver to be included in addition to the HAL() statement. Examples:
|
||||||
|
*
|
||||||
|
* #include "IO_RotaryEncoder.h"
|
||||||
|
* HAL(RotaryEncoder, 700, 1, 0x70) // Define single Vpin, no feedback or position sent to rotary encoder software
|
||||||
|
* HAL(RotaryEncoder, 700, 2, 0x70) // Define two Vpins, feedback only sent to rotary encoder software
|
||||||
|
* HAL(RotaryEncoder, 700, 3, 0x70) // Define three Vpins, can send feedback and position update to rotary encoder software
|
||||||
|
*
|
||||||
* Refer to the documentation for further information including the valid activities and examples.
|
* Refer to the documentation for further information including the valid activities and examples.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
@ -44,58 +59,88 @@
|
||||||
|
|
||||||
class RotaryEncoder : public IODevice {
|
class RotaryEncoder : public IODevice {
|
||||||
public:
|
public:
|
||||||
// Constructor
|
|
||||||
RotaryEncoder(VPIN firstVpin, int nPins, I2CAddress i2cAddress){
|
|
||||||
_firstVpin = firstVpin;
|
|
||||||
_nPins = nPins;
|
|
||||||
_I2CAddress = i2cAddress;
|
|
||||||
addDevice(this);
|
|
||||||
}
|
|
||||||
static void create(VPIN firstVpin, int nPins, I2CAddress i2cAddress) {
|
static void create(VPIN firstVpin, int nPins, I2CAddress i2cAddress) {
|
||||||
if (checkNoOverlap(firstVpin, nPins, i2cAddress)) new RotaryEncoder(firstVpin, nPins, i2cAddress);
|
if (checkNoOverlap(firstVpin, nPins, i2cAddress)) new RotaryEncoder(firstVpin, nPins, i2cAddress);
|
||||||
}
|
}
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
// Constructor
|
||||||
|
RotaryEncoder(VPIN firstVpin, int nPins, I2CAddress i2cAddress){
|
||||||
|
_firstVpin = firstVpin;
|
||||||
|
_nPins = nPins;
|
||||||
|
if (_nPins > 3) {
|
||||||
|
_nPins = 3;
|
||||||
|
DIAG(F("RotaryEncoder WARNING:%d vpins defined, only 3 supported"), _nPins);
|
||||||
|
}
|
||||||
|
_I2CAddress = i2cAddress;
|
||||||
|
addDevice(this);
|
||||||
|
}
|
||||||
|
|
||||||
// Initiate the device
|
// Initiate the device
|
||||||
void _begin() {
|
void _begin() {
|
||||||
|
uint8_t _status;
|
||||||
|
// Attempt to initilalise device
|
||||||
I2CManager.begin();
|
I2CManager.begin();
|
||||||
if (I2CManager.exists(_I2CAddress)) {
|
if (I2CManager.exists(_I2CAddress)) {
|
||||||
byte _getVersion[1] = {RE_VER};
|
// Send RE_RDY, must receive RE_RDY to be online
|
||||||
I2CManager.read(_I2CAddress, _versionBuffer, 3, _getVersion, 1);
|
_sendBuffer[0] = RE_RDY;
|
||||||
_majorVer = _versionBuffer[0];
|
_status = I2CManager.read(_I2CAddress, _rcvBuffer, 1, _sendBuffer, 1);
|
||||||
_minorVer = _versionBuffer[1];
|
if (_status == I2C_STATUS_OK) {
|
||||||
_patchVer = _versionBuffer[2];
|
if (_rcvBuffer[0] == RE_RDY) {
|
||||||
_buffer[0] = RE_OP;
|
_sendBuffer[0] = RE_VER;
|
||||||
I2CManager.write(_I2CAddress, _buffer, 1);
|
if (I2CManager.read(_I2CAddress, _versionBuffer, 3, _sendBuffer, 1) == I2C_STATUS_OK) {
|
||||||
|
_majorVer = _versionBuffer[0];
|
||||||
|
_minorVer = _versionBuffer[1];
|
||||||
|
_patchVer = _versionBuffer[2];
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
DIAG(F("RotaryEncoder I2C:%s garbage received: %d"), _I2CAddress.toString(), _rcvBuffer[0]);
|
||||||
|
_deviceState = DEVSTATE_FAILED;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
DIAG(F("RotaryEncoder I2C:%s ERROR connecting"), _I2CAddress.toString());
|
||||||
|
_deviceState = DEVSTATE_FAILED;
|
||||||
|
return;
|
||||||
|
}
|
||||||
#ifdef DIAG_IO
|
#ifdef DIAG_IO
|
||||||
_display();
|
_display();
|
||||||
#endif
|
#endif
|
||||||
} else {
|
} else {
|
||||||
_deviceState = DEVSTATE_FAILED;
|
DIAG(F("RotaryEncoder I2C:%s device not found"), _I2CAddress.toString());
|
||||||
|
_deviceState = DEVSTATE_FAILED;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void _loop(unsigned long currentMicros) override {
|
void _loop(unsigned long currentMicros) override {
|
||||||
I2CManager.read(_I2CAddress, _buffer, 1);
|
if (_deviceState == DEVSTATE_FAILED) return; // Return if device has failed
|
||||||
_position = _buffer[0];
|
if (_i2crb.isBusy()) return; // Return if I2C operation still in progress
|
||||||
// This here needs to have a change check, ie. position is a different value.
|
|
||||||
#if defined(EXRAIL_ACTIVE)
|
if (currentMicros - _lastPositionRead > _positionRefresh) {
|
||||||
|
_lastPositionRead = currentMicros;
|
||||||
|
_sendBuffer[0] = RE_READ;
|
||||||
|
I2CManager.read(_I2CAddress, _rcvBuffer, 1, _sendBuffer, 1, &_i2crb); // Read position from encoder
|
||||||
|
_position = _rcvBuffer[0];
|
||||||
|
// If EXRAIL is active, we need to trigger the ONCHANGE() event handler if it's in use
|
||||||
|
#if defined(EXRAIL_ACTIVE)
|
||||||
if (_position != _previousPosition) {
|
if (_position != _previousPosition) {
|
||||||
_previousPosition = _position;
|
_previousPosition = _position;
|
||||||
RMFT2::changeEvent(_firstVpin,1);
|
RMFT2::changeEvent(_firstVpin, 1);
|
||||||
} else {
|
} else {
|
||||||
RMFT2::changeEvent(_firstVpin,0);
|
RMFT2::changeEvent(_firstVpin, 0);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
delayUntil(currentMicros + 100000);
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Device specific read function
|
// Return the position sent by the rotary encoder software
|
||||||
int _readAnalogue(VPIN vpin) override {
|
int _readAnalogue(VPIN vpin) override {
|
||||||
if (_deviceState == DEVSTATE_FAILED) return 0;
|
if (_deviceState == DEVSTATE_FAILED) return 0;
|
||||||
return _position;
|
return _position;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Send the feedback value to the rotary encoder software
|
||||||
void _write(VPIN vpin, int value) override {
|
void _write(VPIN vpin, int value) override {
|
||||||
if (vpin == _firstVpin + 1) {
|
if (vpin == _firstVpin + 1) {
|
||||||
if (value != 0) value = 0x01;
|
if (value != 0) value = 0x01;
|
||||||
|
@ -104,6 +149,19 @@ private:
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Send a position update to the rotary encoder software
|
||||||
|
// To be valid, must be 0 to 255, and different to the current position
|
||||||
|
// If the current position is the same, it was initiated by the rotary encoder
|
||||||
|
void _writeAnalogue(VPIN vpin, int position, uint8_t profile, uint16_t duration) override {
|
||||||
|
if (vpin == _firstVpin + 2) {
|
||||||
|
if (position >= 0 && position <= 255 && position != _position) {
|
||||||
|
byte newPosition = position & 0xFF;
|
||||||
|
byte _positionBuffer[2] = {RE_MOVE, newPosition};
|
||||||
|
I2CManager.write(_I2CAddress, _positionBuffer, 2);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void _display() override {
|
void _display() override {
|
||||||
DIAG(F("Rotary Encoder I2C:%s v%d.%d.%d Configured on VPIN:%u-%d %S"), _I2CAddress.toString(), _majorVer, _minorVer, _patchVer,
|
DIAG(F("Rotary Encoder I2C:%s v%d.%d.%d Configured on VPIN:%u-%d %S"), _I2CAddress.toString(), _majorVer, _minorVer, _patchVer,
|
||||||
(int)_firstVpin, _firstVpin+_nPins-1, (_deviceState==DEVSTATE_FAILED) ? F("OFFLINE") : F(""));
|
(int)_firstVpin, _firstVpin+_nPins-1, (_deviceState==DEVSTATE_FAILED) ? F("OFFLINE") : F(""));
|
||||||
|
@ -112,14 +170,21 @@ private:
|
||||||
int8_t _position;
|
int8_t _position;
|
||||||
int8_t _previousPosition = 0;
|
int8_t _previousPosition = 0;
|
||||||
uint8_t _versionBuffer[3];
|
uint8_t _versionBuffer[3];
|
||||||
uint8_t _buffer[1];
|
uint8_t _sendBuffer[1];
|
||||||
|
uint8_t _rcvBuffer[1];
|
||||||
uint8_t _majorVer = 0;
|
uint8_t _majorVer = 0;
|
||||||
uint8_t _minorVer = 0;
|
uint8_t _minorVer = 0;
|
||||||
uint8_t _patchVer = 0;
|
uint8_t _patchVer = 0;
|
||||||
|
I2CRB _i2crb;
|
||||||
|
unsigned long _lastPositionRead = 0;
|
||||||
|
const unsigned long _positionRefresh = 100000UL; // Delay refreshing position for 100ms
|
||||||
|
|
||||||
enum {
|
enum {
|
||||||
RE_VER = 0xA0, // Flag to retrieve rotary encoder version from the device
|
RE_RDY = 0xA0, // Flag to check if encoder is ready for operation
|
||||||
RE_OP = 0xA1, // Flag for normal operation
|
RE_VER = 0xA1, // Flag to retrieve rotary encoder software version
|
||||||
|
RE_READ = 0xA2, // Flag to read the current position of the encoder
|
||||||
|
RE_OP = 0xA3, // Flag for operation start/end, sent to when sending feedback on move start/end
|
||||||
|
RE_MOVE = 0xA4, // Flag for sending a position update from the device driver to the encoder
|
||||||
};
|
};
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
460
MotorDriver.cpp
460
MotorDriver.cpp
|
@ -1,9 +1,10 @@
|
||||||
/*
|
/*
|
||||||
* © 2022 Paul M Antoine
|
* © 2022-2023 Paul M Antoine
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2020-2022 Harald Barth
|
* © 2020-2023 Harald Barth
|
||||||
* © 2020-2021 Chris Harlow
|
* © 2020-2021 Chris Harlow
|
||||||
|
* © 2023 Colin Murdoch
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -26,20 +27,23 @@
|
||||||
#include "DCCWaveform.h"
|
#include "DCCWaveform.h"
|
||||||
#include "DCCTimer.h"
|
#include "DCCTimer.h"
|
||||||
#include "DIAG.h"
|
#include "DIAG.h"
|
||||||
|
#include "EXRAIL2.h"
|
||||||
|
|
||||||
#if defined(ARDUINO_ARCH_ESP32)
|
unsigned long MotorDriver::globalOverloadStart = 0;
|
||||||
#include "ESP32-fixes.h"
|
|
||||||
#endif
|
|
||||||
|
|
||||||
bool MotorDriver::commonFaultPin=false;
|
|
||||||
|
|
||||||
volatile portreg_t shadowPORTA;
|
volatile portreg_t shadowPORTA;
|
||||||
volatile portreg_t shadowPORTB;
|
volatile portreg_t shadowPORTB;
|
||||||
volatile portreg_t shadowPORTC;
|
volatile portreg_t shadowPORTC;
|
||||||
|
#if defined(ARDUINO_ARCH_STM32)
|
||||||
|
volatile portreg_t shadowPORTD;
|
||||||
|
volatile portreg_t shadowPORTE;
|
||||||
|
volatile portreg_t shadowPORTF;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
MotorDriver::MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, int16_t brake_pin,
|
||||||
|
byte current_pin, float sense_factor, unsigned int trip_milliamps, int16_t fault_pin) {
|
||||||
|
const FSH * warnString = F("** WARNING **");
|
||||||
|
|
||||||
MotorDriver::MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, int8_t brake_pin,
|
|
||||||
byte current_pin, float sense_factor, unsigned int trip_milliamps, byte fault_pin) {
|
|
||||||
powerPin=power_pin;
|
|
||||||
invertPower=power_pin < 0;
|
invertPower=power_pin < 0;
|
||||||
if (invertPower) {
|
if (invertPower) {
|
||||||
powerPin = 0-power_pin;
|
powerPin = 0-power_pin;
|
||||||
|
@ -69,6 +73,21 @@ MotorDriver::MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, i
|
||||||
fastSignalPin.shadowinout = fastSignalPin.inout;
|
fastSignalPin.shadowinout = fastSignalPin.inout;
|
||||||
fastSignalPin.inout = &shadowPORTC;
|
fastSignalPin.inout = &shadowPORTC;
|
||||||
}
|
}
|
||||||
|
if (HAVE_PORTD(fastSignalPin.inout == &PORTD)) {
|
||||||
|
DIAG(F("Found PORTD pin %d"),signalPin);
|
||||||
|
fastSignalPin.shadowinout = fastSignalPin.inout;
|
||||||
|
fastSignalPin.inout = &shadowPORTD;
|
||||||
|
}
|
||||||
|
if (HAVE_PORTE(fastSignalPin.inout == &PORTE)) {
|
||||||
|
DIAG(F("Found PORTE pin %d"),signalPin);
|
||||||
|
fastSignalPin.shadowinout = fastSignalPin.inout;
|
||||||
|
fastSignalPin.inout = &shadowPORTE;
|
||||||
|
}
|
||||||
|
if (HAVE_PORTF(fastSignalPin.inout == &PORTF)) {
|
||||||
|
DIAG(F("Found PORTF pin %d"),signalPin);
|
||||||
|
fastSignalPin.shadowinout = fastSignalPin.inout;
|
||||||
|
fastSignalPin.inout = &shadowPORTF;
|
||||||
|
}
|
||||||
|
|
||||||
signalPin2=signal_pin2;
|
signalPin2=signal_pin2;
|
||||||
if (signalPin2!=UNUSED_PIN) {
|
if (signalPin2!=UNUSED_PIN) {
|
||||||
|
@ -92,35 +111,72 @@ MotorDriver::MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, i
|
||||||
fastSignalPin2.shadowinout = fastSignalPin2.inout;
|
fastSignalPin2.shadowinout = fastSignalPin2.inout;
|
||||||
fastSignalPin2.inout = &shadowPORTC;
|
fastSignalPin2.inout = &shadowPORTC;
|
||||||
}
|
}
|
||||||
|
if (HAVE_PORTD(fastSignalPin2.inout == &PORTD)) {
|
||||||
|
DIAG(F("Found PORTD pin %d"),signalPin2);
|
||||||
|
fastSignalPin2.shadowinout = fastSignalPin2.inout;
|
||||||
|
fastSignalPin2.inout = &shadowPORTD;
|
||||||
|
}
|
||||||
|
if (HAVE_PORTE(fastSignalPin2.inout == &PORTE)) {
|
||||||
|
DIAG(F("Found PORTE pin %d"),signalPin2);
|
||||||
|
fastSignalPin2.shadowinout = fastSignalPin2.inout;
|
||||||
|
fastSignalPin2.inout = &shadowPORTE;
|
||||||
|
}
|
||||||
|
if (HAVE_PORTF(fastSignalPin2.inout == &PORTF)) {
|
||||||
|
DIAG(F("Found PORTF pin %d"),signalPin2);
|
||||||
|
fastSignalPin2.shadowinout = fastSignalPin2.inout;
|
||||||
|
fastSignalPin2.inout = &shadowPORTF;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
else dualSignal=false;
|
else dualSignal=false;
|
||||||
|
|
||||||
brakePin=brake_pin;
|
|
||||||
if (brake_pin!=UNUSED_PIN){
|
if (brake_pin!=UNUSED_PIN){
|
||||||
invertBrake=brake_pin < 0;
|
invertBrake=brake_pin < 0;
|
||||||
brakePin=invertBrake ? 0-brake_pin : brake_pin;
|
if (invertBrake)
|
||||||
|
brake_pin = 0-brake_pin;
|
||||||
|
if (brake_pin > MAX_PIN)
|
||||||
|
DIAG(F("%S Brake pin %d > %d"), warnString, brake_pin, MAX_PIN);
|
||||||
|
brakePin=(byte)brake_pin;
|
||||||
getFastPin(F("BRAKE"),brakePin,fastBrakePin);
|
getFastPin(F("BRAKE"),brakePin,fastBrakePin);
|
||||||
// if brake is used for railcom cutout we need to do PORTX register trick here as well
|
// if brake is used for railcom cutout we need to do PORTX register trick here as well
|
||||||
pinMode(brakePin, OUTPUT);
|
pinMode(brakePin, OUTPUT);
|
||||||
setBrake(true); // start with brake on in case we hace DC stuff going on
|
setBrake(true); // start with brake on in case we hace DC stuff going on
|
||||||
|
} else {
|
||||||
|
brakePin=UNUSED_PIN;
|
||||||
}
|
}
|
||||||
else brakePin=UNUSED_PIN;
|
|
||||||
|
|
||||||
currentPin=current_pin;
|
currentPin=current_pin;
|
||||||
if (currentPin!=UNUSED_PIN) ADCee::init(currentPin);
|
if (currentPin!=UNUSED_PIN) {
|
||||||
|
int ret = ADCee::init(currentPin);
|
||||||
|
if (ret < -1010) { // XXX give value a name later
|
||||||
|
DIAG(F("ADCee::init error %d, disable current pin %d"), ret, currentPin);
|
||||||
|
currentPin = UNUSED_PIN;
|
||||||
|
}
|
||||||
|
}
|
||||||
senseOffset=0; // value can not be obtained until waveform is activated
|
senseOffset=0; // value can not be obtained until waveform is activated
|
||||||
|
|
||||||
faultPin=fault_pin;
|
if (fault_pin != UNUSED_PIN) {
|
||||||
if (faultPin != UNUSED_PIN) {
|
invertFault=fault_pin < 0;
|
||||||
|
if (invertFault)
|
||||||
|
fault_pin = 0-fault_pin;
|
||||||
|
if (fault_pin > MAX_PIN)
|
||||||
|
DIAG(F("%S Fault pin %d > %d"), warnString, fault_pin, MAX_PIN);
|
||||||
|
faultPin=(byte)fault_pin;
|
||||||
|
DIAG(F("Fault pin = %d invert %d"), faultPin, invertFault);
|
||||||
getFastPin(F("FAULT"),faultPin, 1 /*input*/, fastFaultPin);
|
getFastPin(F("FAULT"),faultPin, 1 /*input*/, fastFaultPin);
|
||||||
pinMode(faultPin, INPUT);
|
pinMode(faultPin, INPUT);
|
||||||
|
} else {
|
||||||
|
faultPin=UNUSED_PIN;
|
||||||
}
|
}
|
||||||
|
|
||||||
// This conversion performed at compile time so the remainder of the code never needs
|
// This conversion performed at compile time so the remainder of the code never needs
|
||||||
// float calculations or libraray code.
|
// float calculations or libraray code.
|
||||||
senseFactorInternal=sense_factor * senseScale;
|
senseFactorInternal=sense_factor * senseScale;
|
||||||
tripMilliamps=trip_milliamps;
|
tripMilliamps=trip_milliamps;
|
||||||
rawCurrentTripValue=mA2raw(trip_milliamps);
|
#ifdef MAX_CURRENT
|
||||||
|
if (MAX_CURRENT > 0 && MAX_CURRENT < tripMilliamps)
|
||||||
|
tripMilliamps = MAX_CURRENT;
|
||||||
|
#endif
|
||||||
|
rawCurrentTripValue=mA2raw(tripMilliamps);
|
||||||
|
|
||||||
if (rawCurrentTripValue + senseOffset > ADCee::ADCmax()) {
|
if (rawCurrentTripValue + senseOffset > ADCee::ADCmax()) {
|
||||||
// This would mean that the values obtained from the ADC never
|
// This would mean that the values obtained from the ADC never
|
||||||
|
@ -135,20 +191,16 @@ MotorDriver::MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, i
|
||||||
}
|
}
|
||||||
|
|
||||||
if (currentPin==UNUSED_PIN)
|
if (currentPin==UNUSED_PIN)
|
||||||
DIAG(F("** WARNING ** No current or short detection"));
|
DIAG(F("%S No current or short detection"), warnString);
|
||||||
else {
|
else {
|
||||||
DIAG(F("Track %c, TripValue=%d"), trackLetter, rawCurrentTripValue);
|
DIAG(F("Pin %d Max %dmA (%d)"), currentPin, raw2mA(rawCurrentTripValue), rawCurrentTripValue);
|
||||||
|
|
||||||
// self testing diagnostic for the non-float converters... may be removed when happy
|
// self testing diagnostic for the non-float converters... may be removed when happy
|
||||||
// DIAG(F("senseFactorInternal=%d raw2mA(1000)=%d mA2Raw(1000)=%d"),
|
// DIAG(F("senseFactorInternal=%d raw2mA(1000)=%d mA2Raw(1000)=%d"),
|
||||||
// senseFactorInternal, raw2mA(1000),mA2raw(1000));
|
// senseFactorInternal, raw2mA(1000),mA2raw(1000));
|
||||||
}
|
}
|
||||||
|
|
||||||
// prepare values for current detection
|
|
||||||
sampleDelay = 0;
|
|
||||||
lastSampleTaken = millis();
|
|
||||||
progTripValue = mA2raw(TRIP_CURRENT_PROG);
|
progTripValue = mA2raw(TRIP_CURRENT_PROG);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
bool MotorDriver::isPWMCapable() {
|
bool MotorDriver::isPWMCapable() {
|
||||||
|
@ -157,7 +209,12 @@ bool MotorDriver::isPWMCapable() {
|
||||||
|
|
||||||
|
|
||||||
void MotorDriver::setPower(POWERMODE mode) {
|
void MotorDriver::setPower(POWERMODE mode) {
|
||||||
bool on=mode==POWERMODE::ON;
|
if (powerMode == mode) return;
|
||||||
|
//DIAG(F("Track %c POWERMODE=%d"), trackLetter, (int)mode);
|
||||||
|
lastPowerChange[(int)mode] = micros();
|
||||||
|
if (mode == POWERMODE::OVERLOAD)
|
||||||
|
globalOverloadStart = lastPowerChange[(int)mode];
|
||||||
|
bool on=(mode==POWERMODE::ON || mode ==POWERMODE::ALERT);
|
||||||
if (on) {
|
if (on) {
|
||||||
// when switching a track On, we need to check the crrentOffset with the pin OFF
|
// when switching a track On, we need to check the crrentOffset with the pin OFF
|
||||||
if (powerMode==POWERMODE::OFF && currentPin!=UNUSED_PIN) {
|
if (powerMode==POWERMODE::OFF && currentPin!=UNUSED_PIN) {
|
||||||
|
@ -197,8 +254,8 @@ bool MotorDriver::canMeasureCurrent() {
|
||||||
return currentPin!=UNUSED_PIN;
|
return currentPin!=UNUSED_PIN;
|
||||||
}
|
}
|
||||||
/*
|
/*
|
||||||
* Return the current reading as pin reading 0 to 1023. If the fault
|
* Return the current reading as pin reading 0 to max resolution (1024 or 4096).
|
||||||
* pin is activated return a negative current to show active fault pin.
|
* If the fault pin is activated return a negative current to show active fault pin.
|
||||||
* As there is no -0, cheat a little and return -1 in that case.
|
* As there is no -0, cheat a little and return -1 in that case.
|
||||||
*
|
*
|
||||||
* senseOffset handles the case where a shield returns values above or below
|
* senseOffset handles the case where a shield returns values above or below
|
||||||
|
@ -210,12 +267,17 @@ int MotorDriver::getCurrentRaw(bool fromISR) {
|
||||||
(void)fromISR;
|
(void)fromISR;
|
||||||
if (currentPin==UNUSED_PIN) return 0;
|
if (currentPin==UNUSED_PIN) return 0;
|
||||||
int current;
|
int current;
|
||||||
current = ADCee::read(currentPin, fromISR)-senseOffset;
|
current = ADCee::read(currentPin, fromISR);
|
||||||
|
// here one can diag raw value
|
||||||
|
// if (fromISR == false) DIAG(F("%c: %d"), trackLetter, current);
|
||||||
|
current = current-senseOffset; // adjust with offset
|
||||||
if (current<0) current=0-current;
|
if (current<0) current=0-current;
|
||||||
if ((faultPin != UNUSED_PIN) && isLOW(fastFaultPin) && powerMode==POWERMODE::ON)
|
// current >= 0 here, we use negative current as fault pin flag
|
||||||
|
if ((faultPin != UNUSED_PIN) && powerPin) {
|
||||||
|
if (invertFault ? isHIGH(fastFaultPin) : isLOW(fastFaultPin))
|
||||||
return (current == 0 ? -1 : -current);
|
return (current == 0 ? -1 : -current);
|
||||||
|
}
|
||||||
return current;
|
return current;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef ANALOG_READ_INTERRUPT
|
#ifdef ANALOG_READ_INTERRUPT
|
||||||
|
@ -252,7 +314,8 @@ void MotorDriver::startCurrentFromHW() {
|
||||||
#pragma GCC pop_options
|
#pragma GCC pop_options
|
||||||
#endif //ANALOG_READ_INTERRUPT
|
#endif //ANALOG_READ_INTERRUPT
|
||||||
|
|
||||||
#if defined(ARDUINO_ARCH_ESP32)
|
#if defined(ARDUINO_ARCH_ESP32) || defined(ARDUINO_ARCH_STM32)
|
||||||
|
#ifdef VARIABLE_TONES
|
||||||
uint16_t taurustones[28] = { 165, 175, 196, 220,
|
uint16_t taurustones[28] = { 165, 175, 196, 220,
|
||||||
247, 262, 294, 330,
|
247, 262, 294, 330,
|
||||||
349, 392, 440, 494,
|
349, 392, 440, 494,
|
||||||
|
@ -261,29 +324,58 @@ uint16_t taurustones[28] = { 165, 175, 196, 220,
|
||||||
330, 284, 262, 247,
|
330, 284, 262, 247,
|
||||||
220, 196, 175, 165 };
|
220, 196, 175, 165 };
|
||||||
#endif
|
#endif
|
||||||
|
#endif
|
||||||
void MotorDriver::setDCSignal(byte speedcode) {
|
void MotorDriver::setDCSignal(byte speedcode) {
|
||||||
if (brakePin == UNUSED_PIN)
|
if (brakePin == UNUSED_PIN)
|
||||||
return;
|
return;
|
||||||
|
switch(brakePin) {
|
||||||
#if defined(ARDUINO_AVR_UNO)
|
#if defined(ARDUINO_AVR_UNO)
|
||||||
TCCR2B = (TCCR2B & B11111000) | B00000110; // set divisor on timer 2 to result in (approx) 122.55Hz
|
// Not worth doin something here as:
|
||||||
|
// If we are on pin 9 or 10 we are on Timer1 and we can not touch Timer1 as that is our DCC source.
|
||||||
|
// If we are on pin 5 or 6 we are on Timer 0 ad we can not touch Timer0 as that is millis() etc.
|
||||||
|
// We are most likely not on pin 3 or 11 as no known motor shield has that as brake.
|
||||||
#endif
|
#endif
|
||||||
#if defined(ARDUINO_AVR_MEGA) || defined(ARDUINO_AVR_MEGA2560)
|
#if defined(ARDUINO_AVR_MEGA) || defined(ARDUINO_AVR_MEGA2560)
|
||||||
TCCR2B = (TCCR2B & B11111000) | B00000110; // set divisor on timer 2 to result in (approx) 122.55Hz
|
case 9:
|
||||||
TCCR4B = (TCCR4B & B11111000) | B00000100; // same for timer 4 but maxcount and thus divisor differs
|
case 10:
|
||||||
|
// Timer2 (is differnet)
|
||||||
|
TCCR2A = (TCCR2A & B11111100) | B00000001; // set WGM1=0 and WGM0=1 phase correct PWM
|
||||||
|
TCCR2B = (TCCR2B & B11110000) | B00000110; // set WGM2=0 ; set divisor on timer 2 to 1/256 for 122.55Hz
|
||||||
|
//DIAG(F("2 A=%x B=%x"), TCCR2A, TCCR2B);
|
||||||
|
break;
|
||||||
|
case 6:
|
||||||
|
case 7:
|
||||||
|
case 8:
|
||||||
|
// Timer4
|
||||||
|
TCCR4A = (TCCR4A & B11111100) | B00000001; // set WGM0=1 and WGM1=0 for normal PWM 8-bit
|
||||||
|
TCCR4B = (TCCR4B & B11100000) | B00000100; // set WGM2=0 and WGM3=0 for normal PWM 8 bit and div 1/256 for 122.55Hz
|
||||||
|
break;
|
||||||
|
case 46:
|
||||||
|
case 45:
|
||||||
|
case 44:
|
||||||
|
// Timer5
|
||||||
|
TCCR5A = (TCCR5A & B11111100) | B00000001; // set WGM0=1 and WGM1=0 for normal PWM 8-bit
|
||||||
|
TCCR5B = (TCCR5B & B11100000) | B00000100; // set WGM2=0 and WGM3=0 for normal PWM 8 bit and div 1/256 for 122.55Hz
|
||||||
|
break;
|
||||||
#endif
|
#endif
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
// spedcoode is a dcc speed & direction
|
// spedcoode is a dcc speed & direction
|
||||||
byte tSpeed=speedcode & 0x7F; // DCC Speed with 0,1 stop and speed steps 2 to 127
|
byte tSpeed=speedcode & 0x7F; // DCC Speed with 0,1 stop and speed steps 2 to 127
|
||||||
byte tDir=speedcode & 0x80;
|
byte tDir=speedcode & 0x80;
|
||||||
byte brake;
|
byte brake;
|
||||||
#if defined(ARDUINO_ARCH_ESP32)
|
#if defined(ARDUINO_ARCH_ESP32) || defined(ARDUINO_ARCH_STM32)
|
||||||
{
|
{
|
||||||
int f = 131;
|
int f = 131;
|
||||||
|
#ifdef VARIABLE_TONES
|
||||||
if (tSpeed > 2) {
|
if (tSpeed > 2) {
|
||||||
if (tSpeed <= 58) {
|
if (tSpeed <= 58) {
|
||||||
f = taurustones[ (tSpeed-2)/2 ] ;
|
f = taurustones[ (tSpeed-2)/2 ] ;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
DCCEXanalogWriteFrequency(brakePin, f); // set DC PWM frequency to 100Hz XXX May move to setup
|
#endif
|
||||||
|
DCCTimer::DCCEXanalogWriteFrequency(brakePin, f); // set DC PWM frequency to 100Hz XXX May move to setup
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
if (tSpeed <= 1) brake = 255;
|
if (tSpeed <= 1) brake = 255;
|
||||||
|
@ -291,8 +383,8 @@ void MotorDriver::setDCSignal(byte speedcode) {
|
||||||
else brake = 2 * (128-tSpeed);
|
else brake = 2 * (128-tSpeed);
|
||||||
if (invertBrake)
|
if (invertBrake)
|
||||||
brake=255-brake;
|
brake=255-brake;
|
||||||
#if defined(ARDUINO_ARCH_ESP32)
|
#if defined(ARDUINO_ARCH_ESP32) || defined(ARDUINO_ARCH_STM32)
|
||||||
DCCEXanalogWrite(brakePin,brake);
|
DCCTimer::DCCEXanalogWrite(brakePin,brake);
|
||||||
#else
|
#else
|
||||||
analogWrite(brakePin,brake);
|
analogWrite(brakePin,brake);
|
||||||
#endif
|
#endif
|
||||||
|
@ -315,13 +407,91 @@ void MotorDriver::setDCSignal(byte speedcode) {
|
||||||
setSignal(tDir);
|
setSignal(tDir);
|
||||||
HAVE_PORTC(PORTC=shadowPORTC);
|
HAVE_PORTC(PORTC=shadowPORTC);
|
||||||
interrupts();
|
interrupts();
|
||||||
|
} else if (HAVE_PORTD(fastSignalPin.shadowinout == &PORTD)) {
|
||||||
|
noInterrupts();
|
||||||
|
HAVE_PORTD(shadowPORTD=PORTD);
|
||||||
|
setSignal(tDir);
|
||||||
|
HAVE_PORTD(PORTD=shadowPORTD);
|
||||||
|
interrupts();
|
||||||
|
} else if (HAVE_PORTE(fastSignalPin.shadowinout == &PORTE)) {
|
||||||
|
noInterrupts();
|
||||||
|
HAVE_PORTE(shadowPORTE=PORTE);
|
||||||
|
setSignal(tDir);
|
||||||
|
HAVE_PORTE(PORTE=shadowPORTE);
|
||||||
|
interrupts();
|
||||||
|
} else if (HAVE_PORTF(fastSignalPin.shadowinout == &PORTF)) {
|
||||||
|
noInterrupts();
|
||||||
|
HAVE_PORTF(shadowPORTF=PORTF);
|
||||||
|
setSignal(tDir);
|
||||||
|
HAVE_PORTF(PORTF=shadowPORTF);
|
||||||
|
interrupts();
|
||||||
} else {
|
} else {
|
||||||
noInterrupts();
|
noInterrupts();
|
||||||
setSignal(tDir);
|
setSignal(tDir);
|
||||||
interrupts();
|
interrupts();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
void MotorDriver::throttleInrush(bool on) {
|
||||||
|
if (brakePin == UNUSED_PIN)
|
||||||
|
return;
|
||||||
|
if ( !(trackMode & (TRACK_MODE_MAIN | TRACK_MODE_PROG | TRACK_MODE_EXT)))
|
||||||
|
return;
|
||||||
|
byte duty = on ? 208 : 0;
|
||||||
|
if (invertBrake)
|
||||||
|
duty = 255-duty;
|
||||||
|
#if defined(ARDUINO_ARCH_ESP32)
|
||||||
|
if(on) {
|
||||||
|
DCCTimer::DCCEXanalogWrite(brakePin,duty);
|
||||||
|
DCCTimer::DCCEXanalogWriteFrequency(brakePin, 62500);
|
||||||
|
} else {
|
||||||
|
ledcDetachPin(brakePin);
|
||||||
|
}
|
||||||
|
#elif defined(ARDUINO_ARCH_STM32)
|
||||||
|
if(on) {
|
||||||
|
DCCTimer::DCCEXanalogWriteFrequency(brakePin, 62500);
|
||||||
|
DCCTimer::DCCEXanalogWrite(brakePin,duty);
|
||||||
|
} else {
|
||||||
|
pinMode(brakePin, OUTPUT);
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
if(on){
|
||||||
|
switch(brakePin) {
|
||||||
|
#if defined(ARDUINO_AVR_UNO)
|
||||||
|
// Not worth doin something here as:
|
||||||
|
// If we are on pin 9 or 10 we are on Timer1 and we can not touch Timer1 as that is our DCC source.
|
||||||
|
// If we are on pin 5 or 6 we are on Timer 0 ad we can not touch Timer0 as that is millis() etc.
|
||||||
|
// We are most likely not on pin 3 or 11 as no known motor shield has that as brake.
|
||||||
|
#endif
|
||||||
|
#if defined(ARDUINO_AVR_MEGA) || defined(ARDUINO_AVR_MEGA2560)
|
||||||
|
case 9:
|
||||||
|
case 10:
|
||||||
|
// Timer2 (is different)
|
||||||
|
TCCR2A = (TCCR2A & B11111100) | B00000011; // set WGM0=1 and WGM1=1 for fast PWM
|
||||||
|
TCCR2B = (TCCR2B & B11110000) | B00000001; // set WGM2=0 and prescaler div=1 (max)
|
||||||
|
DIAG(F("2 A=%x B=%x"), TCCR2A, TCCR2B);
|
||||||
|
break;
|
||||||
|
case 6:
|
||||||
|
case 7:
|
||||||
|
case 8:
|
||||||
|
// Timer4
|
||||||
|
TCCR4A = (TCCR4A & B11111100) | B00000001; // set WGM0=1 and WGM1=0 for fast PWM 8-bit
|
||||||
|
TCCR4B = (TCCR4B & B11100000) | B00001001; // set WGM2=1 and WGM3=0 for fast PWM 8 bit and div=1 (max)
|
||||||
|
break;
|
||||||
|
case 46:
|
||||||
|
case 45:
|
||||||
|
case 44:
|
||||||
|
// Timer5
|
||||||
|
TCCR5A = (TCCR5A & B11111100) | B00000001; // set WGM0=1 and WGM1=0 for fast PWM 8-bit
|
||||||
|
TCCR5B = (TCCR5B & B11100000) | B00001001; // set WGM2=1 and WGM3=0 for fast PWM 8 bit and div=1 (max)
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
analogWrite(brakePin,duty);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
unsigned int MotorDriver::raw2mA( int raw) {
|
unsigned int MotorDriver::raw2mA( int raw) {
|
||||||
//DIAG(F("%d = %d * %d / %d"), (int32_t)raw * senseFactorInternal / senseScale, raw, senseFactorInternal, senseScale);
|
//DIAG(F("%d = %d * %d / %d"), (int32_t)raw * senseFactorInternal / senseScale, raw, senseFactorInternal, senseScale);
|
||||||
return (int32_t)raw * senseFactorInternal / senseScale;
|
return (int32_t)raw * senseFactorInternal / senseScale;
|
||||||
|
@ -350,64 +520,172 @@ void MotorDriver::getFastPin(const FSH* type,int pin, bool input, FASTPIN & res
|
||||||
// DIAG(F(" port=0x%x, inoutpin=0x%x, isinput=%d, mask=0x%x"),port, result.inout,input,result.maskHIGH);
|
// DIAG(F(" port=0x%x, inoutpin=0x%x, isinput=%d, mask=0x%x"),port, result.inout,input,result.maskHIGH);
|
||||||
}
|
}
|
||||||
|
|
||||||
void MotorDriver::checkPowerOverload(bool useProgLimit, byte trackno) {
|
///////////////////////////////////////////////////////////////////////////////////////////
|
||||||
if (millis() - lastSampleTaken < sampleDelay) return;
|
// checkPowerOverload(useProgLimit, trackno)
|
||||||
lastSampleTaken = millis();
|
// bool useProgLimit: Trackmanager knows if this track is in prog mode or in main mode
|
||||||
int tripValue= useProgLimit?progTripValue:getRawCurrentTripValue();
|
// byte trackno: trackmanager knows it's number (could be skipped?)
|
||||||
|
//
|
||||||
|
// Short ciruit handling strategy:
|
||||||
|
//
|
||||||
|
// There are the following power states: ON ALERT OVERLOAD OFF
|
||||||
|
// OFF state is only changed to/from manually. Power is on
|
||||||
|
// during ON and ALERT. Power is off during OVERLOAD and OFF.
|
||||||
|
// The overload mechanism changes between the other states like
|
||||||
|
//
|
||||||
|
// ON -1-> ALERT -2-> OVERLOAD -3-> ALERT -4-> ON
|
||||||
|
// or
|
||||||
|
// ON -1-> ALERT -4-> ON
|
||||||
|
//
|
||||||
|
// Times are in class MotorDriver (MotorDriver.h).
|
||||||
|
//
|
||||||
|
// 1. ON to ALERT:
|
||||||
|
// Transition on fault pin condition or current overload
|
||||||
|
//
|
||||||
|
// 2. ALERT to OVERLOAD:
|
||||||
|
// Transition happens if different timeouts have elapsed.
|
||||||
|
// If only the fault pin is active, timeout is
|
||||||
|
// POWER_SAMPLE_IGNORE_FAULT_LOW (100ms)
|
||||||
|
// If only overcurrent is detected, timeout is
|
||||||
|
// POWER_SAMPLE_IGNORE_CURRENT (100ms)
|
||||||
|
// If fault pin and overcurrent are active, timeout is
|
||||||
|
// POWER_SAMPLE_IGNORE_FAULT_HIGH (5ms)
|
||||||
|
// Transition to OVERLOAD turns off power to the affected
|
||||||
|
// output (unless fault pins are shared)
|
||||||
|
// If the transition conditions are not fullfilled,
|
||||||
|
// transition according to 4 is tested.
|
||||||
|
//
|
||||||
|
// 3. OVERLOAD to ALERT
|
||||||
|
// Transiton happens when timeout has elapsed, timeout
|
||||||
|
// is named power_sample_overload_wait. It is started
|
||||||
|
// at POWER_SAMPLE_OVERLOAD_WAIT (40ms) at first entry
|
||||||
|
// to OVERLOAD and then increased by a factor of 2
|
||||||
|
// at further entries to the OVERLOAD condition. This
|
||||||
|
// happens until POWER_SAMPLE_RETRY_MAX (10sec) is reached.
|
||||||
|
// power_sample_overload_wait is reset by a poweroff or
|
||||||
|
// a POWER_SAMPLE_ALL_GOOD (5sec) period during ON.
|
||||||
|
// After timeout power is turned on again and state
|
||||||
|
// goes back to ALERT.
|
||||||
|
//
|
||||||
|
// 4. ALERT to ON
|
||||||
|
// Transition happens by watching the current and fault pin
|
||||||
|
// samples during POWER_SAMPLE_ALERT_GOOD (20ms) time. If
|
||||||
|
// values have been good during that time, transition is
|
||||||
|
// made back to ON. Note that even if state is back to ON,
|
||||||
|
// the power_sample_overload_wait time is first reset
|
||||||
|
// later (see above).
|
||||||
|
//
|
||||||
|
// The time keeping is handled by timestamps lastPowerChange[]
|
||||||
|
// which are set by each power change and by lastBadSample which
|
||||||
|
// keeps track if conditions during ALERT have been good enough
|
||||||
|
// to go back to ON. The time differences are calculated by
|
||||||
|
// microsSinceLastPowerChange().
|
||||||
|
//
|
||||||
|
|
||||||
|
void MotorDriver::checkPowerOverload(bool useProgLimit, byte trackno) {
|
||||||
|
|
||||||
// Trackname for diag messages later
|
|
||||||
switch (powerMode) {
|
switch (powerMode) {
|
||||||
case POWERMODE::OFF:
|
|
||||||
sampleDelay = POWER_SAMPLE_OFF_WAIT;
|
case POWERMODE::OFF: {
|
||||||
break;
|
lastPowerMode = POWERMODE::OFF;
|
||||||
case POWERMODE::ON:
|
power_sample_overload_wait = POWER_SAMPLE_OVERLOAD_WAIT;
|
||||||
// Check current
|
break;
|
||||||
lastCurrent=getCurrentRaw();
|
}
|
||||||
if (lastCurrent < 0) {
|
|
||||||
// We have a fault pin condition to take care of
|
case POWERMODE::ON: {
|
||||||
lastCurrent = -lastCurrent;
|
lastPowerMode = POWERMODE::ON;
|
||||||
setPower(POWERMODE::OVERLOAD); // Turn off, decide later how fast to turn on again
|
bool cF = checkFault();
|
||||||
if (commonFaultPin) {
|
bool cC = checkCurrent(useProgLimit);
|
||||||
if (lastCurrent < tripValue) {
|
if(cF || cC ) {
|
||||||
setPower(POWERMODE::ON); // maybe other track
|
if (cC) {
|
||||||
}
|
unsigned int mA=raw2mA(lastCurrent);
|
||||||
// Write this after the fact as we want to turn on as fast as possible
|
DIAG(F("TRACK %c ALERT %s %dmA"), trackno + 'A',
|
||||||
// because we don't know which output actually triggered the fault pin
|
cF ? "FAULT" : "",
|
||||||
DIAG(F("COMMON FAULT PIN ACTIVE: POWERTOGGLE TRACK %c"), trackno + 'A');
|
mA);
|
||||||
} else {
|
|
||||||
DIAG(F("TRACK %c FAULT PIN ACTIVE - OVERLOAD"), trackno + 'A');
|
|
||||||
if (lastCurrent < tripValue) {
|
|
||||||
lastCurrent = tripValue; // exaggerate
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if (lastCurrent < tripValue) {
|
|
||||||
sampleDelay = POWER_SAMPLE_ON_WAIT;
|
|
||||||
if(power_good_counter<100)
|
|
||||||
power_good_counter++;
|
|
||||||
else
|
|
||||||
if (power_sample_overload_wait>POWER_SAMPLE_OVERLOAD_WAIT) power_sample_overload_wait=POWER_SAMPLE_OVERLOAD_WAIT;
|
|
||||||
} else {
|
} else {
|
||||||
setPower(POWERMODE::OVERLOAD);
|
DIAG(F("TRACK %c ALERT FAULT"), trackno + 'A');
|
||||||
unsigned int mA=raw2mA(lastCurrent);
|
|
||||||
unsigned int maxmA=raw2mA(tripValue);
|
|
||||||
power_good_counter=0;
|
|
||||||
sampleDelay = power_sample_overload_wait;
|
|
||||||
DIAG(F("TRACK %c POWER OVERLOAD %dmA (limit %dmA) shutdown for %dms"), trackno + 'A', mA, maxmA, sampleDelay);
|
|
||||||
if (power_sample_overload_wait >= 10000)
|
|
||||||
power_sample_overload_wait = 10000;
|
|
||||||
else
|
|
||||||
power_sample_overload_wait *= 2;
|
|
||||||
}
|
}
|
||||||
|
setPower(POWERMODE::ALERT);
|
||||||
break;
|
break;
|
||||||
case POWERMODE::OVERLOAD:
|
}
|
||||||
// Try setting it back on after the OVERLOAD_WAIT
|
// all well
|
||||||
|
if (microsSinceLastPowerChange(POWERMODE::ON) > POWER_SAMPLE_ALL_GOOD) {
|
||||||
|
power_sample_overload_wait = POWER_SAMPLE_OVERLOAD_WAIT;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
case POWERMODE::ALERT: {
|
||||||
|
// set local flags that handle how much is output to diag (do not output duplicates)
|
||||||
|
bool notFromOverload = (lastPowerMode != POWERMODE::OVERLOAD);
|
||||||
|
bool powerModeChange = (powerMode != lastPowerMode);
|
||||||
|
unsigned long now = micros();
|
||||||
|
if (powerModeChange)
|
||||||
|
lastBadSample = now;
|
||||||
|
lastPowerMode = POWERMODE::ALERT;
|
||||||
|
// check how long we have been in this state
|
||||||
|
unsigned long mslpc = microsSinceLastPowerChange(POWERMODE::ALERT);
|
||||||
|
if(checkFault()) {
|
||||||
|
throttleInrush(true);
|
||||||
|
lastBadSample = now;
|
||||||
|
unsigned long timeout = checkCurrent(useProgLimit) ? POWER_SAMPLE_IGNORE_FAULT_HIGH : POWER_SAMPLE_IGNORE_FAULT_LOW;
|
||||||
|
if ( mslpc < timeout) {
|
||||||
|
if (powerModeChange)
|
||||||
|
DIAG(F("TRACK %c FAULT PIN (%M ignore)"), trackno + 'A', timeout);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
DIAG(F("TRACK %c FAULT PIN detected after %4M. Pause %4M)"), trackno + 'A', mslpc, power_sample_overload_wait);
|
||||||
|
throttleInrush(false);
|
||||||
|
setPower(POWERMODE::OVERLOAD);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (checkCurrent(useProgLimit)) {
|
||||||
|
lastBadSample = now;
|
||||||
|
if (mslpc < POWER_SAMPLE_IGNORE_CURRENT) {
|
||||||
|
if (powerModeChange) {
|
||||||
|
unsigned int mA=raw2mA(lastCurrent);
|
||||||
|
DIAG(F("TRACK %c CURRENT (%M ignore) %dmA"), trackno + 'A', POWER_SAMPLE_IGNORE_CURRENT, mA);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
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, mslpc, power_sample_overload_wait);
|
||||||
|
throttleInrush(false);
|
||||||
|
setPower(POWERMODE::OVERLOAD);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
// all well
|
||||||
|
unsigned long goodtime = micros() - lastBadSample;
|
||||||
|
if (goodtime > POWER_SAMPLE_ALERT_GOOD) {
|
||||||
|
if (true || notFromOverload) { // we did a RESTORE message XXX
|
||||||
|
unsigned int mA=raw2mA(lastCurrent);
|
||||||
|
DIAG(F("TRACK %c NORMAL (after %M/%M) %dmA"), trackno + 'A', goodtime, mslpc, mA);
|
||||||
|
}
|
||||||
|
throttleInrush(false);
|
||||||
setPower(POWERMODE::ON);
|
setPower(POWERMODE::ON);
|
||||||
sampleDelay = POWER_SAMPLE_ON_WAIT;
|
}
|
||||||
// Debug code....
|
break;
|
||||||
DIAG(F("TRACK %c POWER RESTORE (check %dms)"), trackno + 'A', sampleDelay);
|
}
|
||||||
break;
|
|
||||||
default:
|
case POWERMODE::OVERLOAD: {
|
||||||
sampleDelay = 999; // cant get here..meaningless statement to avoid compiler warning.
|
lastPowerMode = POWERMODE::OVERLOAD;
|
||||||
|
unsigned long mslpc = (commonFaultPin ? (micros() - globalOverloadStart) : microsSinceLastPowerChange(POWERMODE::OVERLOAD));
|
||||||
|
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;
|
||||||
|
DIAG(F("Calling EXRAIL"));
|
||||||
|
RMFT2::powerEvent(trackno, true); // Tell EXRAIL we have an overload
|
||||||
|
// power on test
|
||||||
|
DIAG(F("TRACK %c POWER RESTORE (after %4M)"), trackno + 'A', mslpc);
|
||||||
|
setPower(POWERMODE::ALERT);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
default:
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
121
MotorDriver.h
121
MotorDriver.h
|
@ -1,5 +1,5 @@
|
||||||
/*
|
/*
|
||||||
* © 2022 Paul M Antoine
|
* © 2022-2023 Paul M. Antoine
|
||||||
* © 2021 Mike S
|
* © 2021 Mike S
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2020 Chris Harlow
|
* © 2020 Chris Harlow
|
||||||
|
@ -27,6 +27,10 @@
|
||||||
#include "IODevice.h"
|
#include "IODevice.h"
|
||||||
#include "DCCTimer.h"
|
#include "DCCTimer.h"
|
||||||
|
|
||||||
|
// use powers of two so we can do logical and/or on the track modes in if clauses.
|
||||||
|
enum TRACK_MODE : byte {TRACK_MODE_NONE = 1, TRACK_MODE_MAIN = 2, TRACK_MODE_PROG = 4,
|
||||||
|
TRACK_MODE_DC = 8, TRACK_MODE_DCX = 16, TRACK_MODE_EXT = 32};
|
||||||
|
|
||||||
#define setHIGH(fastpin) *fastpin.inout |= fastpin.maskHIGH
|
#define setHIGH(fastpin) *fastpin.inout |= fastpin.maskHIGH
|
||||||
#define setLOW(fastpin) *fastpin.inout &= fastpin.maskLOW
|
#define setLOW(fastpin) *fastpin.inout &= fastpin.maskLOW
|
||||||
#define isHIGH(fastpin) (*fastpin.inout & fastpin.maskHIGH)
|
#define isHIGH(fastpin) (*fastpin.inout & fastpin.maskHIGH)
|
||||||
|
@ -56,6 +60,16 @@
|
||||||
#define HAVE_PORTB(X) X
|
#define HAVE_PORTB(X) X
|
||||||
#define PORTC GPIOC->ODR
|
#define PORTC GPIOC->ODR
|
||||||
#define HAVE_PORTC(X) X
|
#define HAVE_PORTC(X) X
|
||||||
|
#define PORTD GPIOD->ODR
|
||||||
|
#define HAVE_PORTD(X) X
|
||||||
|
#if defined(GPIOE)
|
||||||
|
#define PORTE GPIOE->ODR
|
||||||
|
#define HAVE_PORTE(X) X
|
||||||
|
#endif
|
||||||
|
#if defined(GPIOF)
|
||||||
|
#define PORTF GPIOF->ODR
|
||||||
|
#define HAVE_PORTF(X) X
|
||||||
|
#endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// if macros not defined as pass-through we define
|
// if macros not defined as pass-through we define
|
||||||
|
@ -70,12 +84,22 @@
|
||||||
#ifndef HAVE_PORTC
|
#ifndef HAVE_PORTC
|
||||||
#define HAVE_PORTC(X) byte TOKENPASTE2(Unique_, __LINE__) __attribute__((unused)) =0
|
#define HAVE_PORTC(X) byte TOKENPASTE2(Unique_, __LINE__) __attribute__((unused)) =0
|
||||||
#endif
|
#endif
|
||||||
|
#ifndef HAVE_PORTD
|
||||||
|
#define HAVE_PORTD(X) byte TOKENPASTE2(Unique_, __LINE__) __attribute__((unused)) =0
|
||||||
|
#endif
|
||||||
|
#ifndef HAVE_PORTE
|
||||||
|
#define HAVE_PORTE(X) byte TOKENPASTE2(Unique_, __LINE__) __attribute__((unused)) =0
|
||||||
|
#endif
|
||||||
|
#ifndef HAVE_PORTF
|
||||||
|
#define HAVE_PORTF(X) byte TOKENPASTE2(Unique_, __LINE__) __attribute__((unused)) =0
|
||||||
|
#endif
|
||||||
|
|
||||||
// Virtualised Motor shield 1-track hardware Interface
|
// Virtualised Motor shield 1-track hardware Interface
|
||||||
|
|
||||||
#ifndef UNUSED_PIN // sync define with the one in MotorDrivers.h
|
#ifndef UNUSED_PIN // sync define with the one in MotorDrivers.h
|
||||||
#define UNUSED_PIN 127 // inside int8_t
|
#define UNUSED_PIN 255 // inside uint8_t
|
||||||
#endif
|
#endif
|
||||||
|
#define MAX_PIN 254
|
||||||
|
|
||||||
class pinpair {
|
class pinpair {
|
||||||
public:
|
public:
|
||||||
|
@ -105,14 +129,17 @@ struct FASTPIN {
|
||||||
extern volatile portreg_t shadowPORTA;
|
extern volatile portreg_t shadowPORTA;
|
||||||
extern volatile portreg_t shadowPORTB;
|
extern volatile portreg_t shadowPORTB;
|
||||||
extern volatile portreg_t shadowPORTC;
|
extern volatile portreg_t shadowPORTC;
|
||||||
|
extern volatile portreg_t shadowPORTD;
|
||||||
|
extern volatile portreg_t shadowPORTE;
|
||||||
|
extern volatile portreg_t shadowPORTF;
|
||||||
|
|
||||||
enum class POWERMODE : byte { OFF, ON, OVERLOAD };
|
enum class POWERMODE : byte { OFF, ON, OVERLOAD, ALERT };
|
||||||
|
|
||||||
class MotorDriver {
|
class MotorDriver {
|
||||||
public:
|
public:
|
||||||
|
|
||||||
MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, int8_t brake_pin,
|
MotorDriver(int16_t power_pin, byte signal_pin, byte signal_pin2, int16_t brake_pin,
|
||||||
byte current_pin, float senseFactor, unsigned int tripMilliamps, byte faultPin);
|
byte current_pin, float senseFactor, unsigned int tripMilliamps, int16_t fault_pin);
|
||||||
void setPower( POWERMODE mode);
|
void setPower( POWERMODE mode);
|
||||||
POWERMODE getPower() { return powerMode;}
|
POWERMODE getPower() { return powerMode;}
|
||||||
// as the port registers can be shadowed to get syncronized DCC signals
|
// as the port registers can be shadowed to get syncronized DCC signals
|
||||||
|
@ -144,6 +171,7 @@ class MotorDriver {
|
||||||
};
|
};
|
||||||
inline pinpair getSignalPin() { return pinpair(signalPin,signalPin2); };
|
inline pinpair getSignalPin() { return pinpair(signalPin,signalPin2); };
|
||||||
void setDCSignal(byte speedByte);
|
void setDCSignal(byte speedByte);
|
||||||
|
void throttleInrush(bool on);
|
||||||
inline void detachDCSignal() {
|
inline void detachDCSignal() {
|
||||||
#if defined(__arm__)
|
#if defined(__arm__)
|
||||||
pinMode(brakePin, OUTPUT);
|
pinMode(brakePin, OUTPUT);
|
||||||
|
@ -157,16 +185,16 @@ class MotorDriver {
|
||||||
unsigned int raw2mA( int raw);
|
unsigned int raw2mA( int raw);
|
||||||
unsigned int mA2raw( unsigned int mA);
|
unsigned int mA2raw( unsigned int mA);
|
||||||
inline bool brakeCanPWM() {
|
inline bool brakeCanPWM() {
|
||||||
#if defined(ARDUINO_ARCH_ESP32) || defined(__arm__)
|
#if defined(ARDUINO_ARCH_ESP32)
|
||||||
// TODO: on ARM we can use digitalPinHasPWM, and may wish/need to
|
return (brakePin != UNUSED_PIN); // This was just (true) but we probably do need to check for UNUSED_PIN!
|
||||||
return true;
|
#elif defined(__arm__)
|
||||||
#else
|
// On ARM we can use digitalPinHasPWM
|
||||||
#ifdef digitalPinToTimer
|
return ((brakePin!=UNUSED_PIN) && (digitalPinHasPWM(brakePin)));
|
||||||
|
#elif defined(digitalPinToTimer)
|
||||||
return ((brakePin!=UNUSED_PIN) && (digitalPinToTimer(brakePin)));
|
return ((brakePin!=UNUSED_PIN) && (digitalPinToTimer(brakePin)));
|
||||||
#else
|
#else
|
||||||
return (brakePin<14 && brakePin >1);
|
return (brakePin<14 && brakePin >1);
|
||||||
#endif //digitalPinToTimer
|
#endif
|
||||||
#endif //ESP32/ARM
|
|
||||||
}
|
}
|
||||||
inline int getRawCurrentTripValue() {
|
inline int getRawCurrentTripValue() {
|
||||||
return rawCurrentTripValue;
|
return rawCurrentTripValue;
|
||||||
|
@ -174,7 +202,10 @@ class MotorDriver {
|
||||||
bool isPWMCapable();
|
bool isPWMCapable();
|
||||||
bool canMeasureCurrent();
|
bool canMeasureCurrent();
|
||||||
bool trackPWM = false; // this track uses PWM timer to generate the DCC waveform
|
bool trackPWM = false; // this track uses PWM timer to generate the DCC waveform
|
||||||
static bool commonFaultPin; // This is a stupid motor shield which has only a common fault pin for both outputs
|
bool commonFaultPin = false; // 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() {
|
inline byte getFaultPin() {
|
||||||
return faultPin;
|
return faultPin;
|
||||||
}
|
}
|
||||||
|
@ -185,23 +216,53 @@ class MotorDriver {
|
||||||
inline void setTrackLetter(char c) {
|
inline void setTrackLetter(char c) {
|
||||||
trackLetter = 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(POWERMODE mode) {
|
||||||
|
unsigned long now = micros();
|
||||||
|
unsigned long diff = now - lastPowerChange[(int)mode];
|
||||||
|
if (diff > (1UL << (7 *sizeof(unsigned long)))) // 2^(4*7)us = 268.4 seconds
|
||||||
|
lastPowerChange[(int)mode] = now - 30000000UL; // 30 seconds ago
|
||||||
|
return diff;
|
||||||
|
};
|
||||||
#ifdef ANALOG_READ_INTERRUPT
|
#ifdef ANALOG_READ_INTERRUPT
|
||||||
bool sampleCurrentFromHW();
|
bool sampleCurrentFromHW();
|
||||||
void startCurrentFromHW();
|
void startCurrentFromHW();
|
||||||
#endif
|
#endif
|
||||||
|
inline void setMode(TRACK_MODE m) {
|
||||||
|
trackMode = m;
|
||||||
|
};
|
||||||
|
inline TRACK_MODE getMode() {
|
||||||
|
return trackMode;
|
||||||
|
};
|
||||||
private:
|
private:
|
||||||
char trackLetter = '?';
|
char trackLetter = '?';
|
||||||
bool isProgTrack = false; // tells us if this is a prog track
|
bool isProgTrack = false; // tells us if this is a prog track
|
||||||
void getFastPin(const FSH* type,int pin, bool input, FASTPIN & result);
|
void getFastPin(const FSH* type,int pin, bool input, FASTPIN & result);
|
||||||
void getFastPin(const FSH* type,int pin, FASTPIN & result) {
|
inline void getFastPin(const FSH* type,int pin, FASTPIN & result) {
|
||||||
getFastPin(type, pin, 0, result);
|
getFastPin(type, pin, 0, result);
|
||||||
}
|
};
|
||||||
|
// side effect sets lastCurrent and tripValue
|
||||||
|
inline bool checkCurrent(bool useProgLimit) {
|
||||||
|
tripValue= useProgLimit?progTripValue:getRawCurrentTripValue();
|
||||||
|
lastCurrent = getCurrentRaw();
|
||||||
|
if (lastCurrent < 0)
|
||||||
|
lastCurrent = -lastCurrent;
|
||||||
|
return lastCurrent >= tripValue;
|
||||||
|
};
|
||||||
|
// side effect sets lastCurrent
|
||||||
|
inline bool checkFault() {
|
||||||
|
lastCurrent = getCurrentRaw();
|
||||||
|
return lastCurrent < 0;
|
||||||
|
};
|
||||||
VPIN powerPin;
|
VPIN powerPin;
|
||||||
byte signalPin, signalPin2, currentPin, faultPin, brakePin;
|
byte signalPin, signalPin2, currentPin, faultPin, brakePin;
|
||||||
FASTPIN fastSignalPin, fastSignalPin2, fastBrakePin,fastFaultPin;
|
FASTPIN fastSignalPin, fastSignalPin2, fastBrakePin,fastFaultPin;
|
||||||
bool dualSignal; // true to use signalPin2
|
bool dualSignal; // true to use signalPin2
|
||||||
bool invertBrake; // brake pin passed as negative means pin is inverted
|
bool invertBrake; // brake pin passed as negative means pin is inverted
|
||||||
bool invertPower; // power pin passed as negative means pin is inverted
|
bool invertPower; // power pin passed as negative means pin is inverted
|
||||||
|
bool invertFault; // fault pin passed as negative means pin is inverted
|
||||||
|
|
||||||
// Raw to milliamp conversion factors avoiding float data types.
|
// Raw to milliamp conversion factors avoiding float data types.
|
||||||
// Milliamps=rawADCreading * sensefactorInternal / senseScale
|
// Milliamps=rawADCreading * sensefactorInternal / senseScale
|
||||||
|
@ -215,10 +276,14 @@ class MotorDriver {
|
||||||
int rawCurrentTripValue;
|
int rawCurrentTripValue;
|
||||||
// current sampling
|
// current sampling
|
||||||
POWERMODE powerMode;
|
POWERMODE powerMode;
|
||||||
unsigned long lastSampleTaken;
|
POWERMODE lastPowerMode;
|
||||||
unsigned int sampleDelay;
|
unsigned long lastPowerChange[4]; // timestamp in microseconds
|
||||||
|
unsigned long lastBadSample; // timestamp in microseconds
|
||||||
|
// used to sync restore time when common Fault pin detected
|
||||||
|
static unsigned long globalOverloadStart; // timestamp in microseconds
|
||||||
int progTripValue;
|
int progTripValue;
|
||||||
int lastCurrent;
|
int lastCurrent; //temp value
|
||||||
|
int tripValue; //temp value
|
||||||
#ifdef ANALOG_READ_INTERRUPT
|
#ifdef ANALOG_READ_INTERRUPT
|
||||||
volatile unsigned long sampleCurrentTimestamp;
|
volatile unsigned long sampleCurrentTimestamp;
|
||||||
volatile uint16_t sampleCurrent;
|
volatile uint16_t sampleCurrent;
|
||||||
|
@ -226,16 +291,28 @@ class MotorDriver {
|
||||||
int maxmA;
|
int maxmA;
|
||||||
int tripmA;
|
int tripmA;
|
||||||
|
|
||||||
// Wait times for power management. Unit: milliseconds
|
// Times for overload management. Unit: microseconds.
|
||||||
static const int POWER_SAMPLE_ON_WAIT = 100;
|
// Base for wait time until power is turned on again
|
||||||
static const int POWER_SAMPLE_OFF_WAIT = 1000;
|
static const unsigned long POWER_SAMPLE_OVERLOAD_WAIT = 40000UL;
|
||||||
static const int POWER_SAMPLE_OVERLOAD_WAIT = 20;
|
// Time after we consider all faults old and forgotten
|
||||||
|
static const unsigned long POWER_SAMPLE_ALL_GOOD = 5000000UL;
|
||||||
|
// Time after which we consider a ALERT over
|
||||||
|
static const unsigned long POWER_SAMPLE_ALERT_GOOD = 20000UL;
|
||||||
|
// How long to ignore fault pin if current is under limit
|
||||||
|
static const unsigned long POWER_SAMPLE_IGNORE_FAULT_LOW = 100000UL;
|
||||||
|
// 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_IGNORE_CURRENT = 100000UL;
|
||||||
|
// 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
|
// Trip current for programming track, 250mA. Change only if you really
|
||||||
// need to be non-NMRA-compliant because of decoders that are not either.
|
// need to be non-NMRA-compliant because of decoders that are not either.
|
||||||
static const int TRIP_CURRENT_PROG=250;
|
static const int TRIP_CURRENT_PROG=250;
|
||||||
unsigned long power_sample_overload_wait = POWER_SAMPLE_OVERLOAD_WAIT;
|
unsigned long power_sample_overload_wait = POWER_SAMPLE_OVERLOAD_WAIT;
|
||||||
unsigned int power_good_counter = 0;
|
unsigned int power_good_counter = 0;
|
||||||
|
TRACK_MODE trackMode = TRACK_MODE_NONE; // we assume track not assigned at startup
|
||||||
|
|
||||||
};
|
};
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -1,7 +1,7 @@
|
||||||
/*
|
/*
|
||||||
* © 2022 Paul M. Antoine
|
* © 2022-2023 Paul M. Antoine
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2020-2022 Harald Barth
|
* © 2020-2023 Harald Barth
|
||||||
* (c) 2020 Chris Harlow. All rights reserved.
|
* (c) 2020 Chris Harlow. All rights reserved.
|
||||||
* (c) 2021 Fred Decker. All rights reserved.
|
* (c) 2021 Fred Decker. All rights reserved.
|
||||||
* (c) 2020 Harald Barth. All rights reserved.
|
* (c) 2020 Harald Barth. All rights reserved.
|
||||||
|
@ -36,7 +36,7 @@
|
||||||
// custom defines in config.h.
|
// custom defines in config.h.
|
||||||
|
|
||||||
#ifndef UNUSED_PIN // sync define with the one in MotorDriver.h
|
#ifndef UNUSED_PIN // sync define with the one in MotorDriver.h
|
||||||
#define UNUSED_PIN 127 // inside int8_t
|
#define UNUSED_PIN 255 // inside uint8_t
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// The MotorDriver definition is:
|
// The MotorDriver definition is:
|
||||||
|
@ -60,7 +60,8 @@
|
||||||
// Arduino STANDARD Motor Shield, used on different architectures:
|
// Arduino STANDARD Motor Shield, used on different architectures:
|
||||||
|
|
||||||
#if defined(ARDUINO_ARCH_SAMD) || defined(ARDUINO_ARCH_STM32)
|
#if defined(ARDUINO_ARCH_SAMD) || defined(ARDUINO_ARCH_STM32)
|
||||||
// Setup for SAMD21 Sparkfun DEV board using Arduino standard Motor Shield R3 (MUST be R3
|
// Standard Motor Shield definition for 3v3 processors (other than the ESP32)
|
||||||
|
// Setup for SAMD21 Sparkfun DEV board MUST use Arduino Motor Shield R3 (MUST be R3
|
||||||
// for 3v3 compatibility!!) senseFactor for 3.3v systems is 1.95 as calculated when using
|
// for 3v3 compatibility!!) senseFactor for 3.3v systems is 1.95 as calculated when using
|
||||||
// 10-bit A/D samples, and for 12-bit samples it's more like 0.488, but we probably need
|
// 10-bit A/D samples, and for 12-bit samples it's more like 0.488, but we probably need
|
||||||
// to tweak both these
|
// to tweak both these
|
||||||
|
@ -70,15 +71,27 @@
|
||||||
#define SAMD_STANDARD_MOTOR_SHIELD STANDARD_MOTOR_SHIELD
|
#define SAMD_STANDARD_MOTOR_SHIELD STANDARD_MOTOR_SHIELD
|
||||||
#define STM32_STANDARD_MOTOR_SHIELD STANDARD_MOTOR_SHIELD
|
#define STM32_STANDARD_MOTOR_SHIELD STANDARD_MOTOR_SHIELD
|
||||||
|
|
||||||
|
// EX 8874 based shield connected to a 3V3 system with 12-bit (4096) ADC
|
||||||
|
#define EX8874_SHIELD F("EX8874"), \
|
||||||
|
new MotorDriver( 3, 12, UNUSED_PIN, 9, A0, 1.27, 5000, A4), \
|
||||||
|
new MotorDriver(11, 13, UNUSED_PIN, 8, A1, 1.27, 5000, A5)
|
||||||
|
|
||||||
|
|
||||||
#elif defined(ARDUINO_ARCH_ESP32)
|
#elif defined(ARDUINO_ARCH_ESP32)
|
||||||
// STANDARD shield on an ESPDUINO-32 (ESP32 in Uno form factor). The shield must be eiter the
|
// STANDARD shield on an ESPDUINO-32 (ESP32 in Uno form factor). The shield must be eiter the
|
||||||
// 3.3V compatible R3 version or it has to be modified to not supply more than 3.3V to the
|
// 3.3V compatible R3 version or it has to be modified to not supply more than 3.3V to the
|
||||||
// analog inputs. Here we use analog inputs A2 and A3 as A0 and A1 are wired in a way so that
|
// analog inputs. Here we use analog inputs A2 and A3 as A0 and A1 are wired in a way so that
|
||||||
// they are not useable at the same time as WiFi (what a bummer). The numbers below are the
|
// they are not useable at the same time as WiFi (what a bummer). The numbers below are the
|
||||||
// actual GPIO numbers. In comments the numbers the pins have on an Uno.
|
// actual GPIO numbers. In comments the numbers the pins have on an Uno.
|
||||||
#define STANDARD_MOTOR_SHIELD F("STANDARD_MOTOR_SHIELD"), \
|
#define STANDARD_MOTOR_SHIELD F("STANDARD_MOTOR_SHIELD"), \
|
||||||
new MotorDriver(25/* 3*/, 19/*12*/, UNUSED_PIN, 13/*9*/, 35/*A2*/, 0.70, 1500, UNUSED_PIN), \
|
new MotorDriver(25/* 3*/, 19/*12*/, UNUSED_PIN, 13/*9*/, 35/*A2*/, 0.70, 1500, UNUSED_PIN), \
|
||||||
new MotorDriver(23/*11*/, 18/*13*/, UNUSED_PIN, 12/*8*/, 34/*A3*/, 0.70, 1500, UNUSED_PIN)
|
new MotorDriver(23/*11*/, 18/*13*/, UNUSED_PIN, 12/*8*/, 34/*A3*/, 0.70, 1500, UNUSED_PIN)
|
||||||
|
|
||||||
|
// EX 8874 based shield connected to a 3.3V system (like ESP32) and 12bit (4096) ADC
|
||||||
|
// numbers are GPIO numbers. comments are UNO form factor shield pin numbers
|
||||||
|
#define EX8874_SHIELD F("EX8874"),\
|
||||||
|
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*/)
|
||||||
|
|
||||||
#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.
|
||||||
|
@ -88,6 +101,12 @@
|
||||||
#define BRAKE_PWM_SWAPPED_MOTOR_SHIELD F("BPS_MOTOR_SHIELD"), \
|
#define BRAKE_PWM_SWAPPED_MOTOR_SHIELD F("BPS_MOTOR_SHIELD"), \
|
||||||
new MotorDriver(-9 , 12, UNUSED_PIN, -3, A0, 2.99, 1500, UNUSED_PIN), \
|
new MotorDriver(-9 , 12, UNUSED_PIN, -3, A0, 2.99, 1500, UNUSED_PIN), \
|
||||||
new MotorDriver(-8 , 13, UNUSED_PIN,-11, A1, 2.99, 1500, UNUSED_PIN)
|
new MotorDriver(-8 , 13, UNUSED_PIN,-11, A1, 2.99, 1500, UNUSED_PIN)
|
||||||
|
|
||||||
|
// EX 8874 based shield connected to a 5V system (like Arduino) and 10bit (1024) ADC
|
||||||
|
#define EX8874_SHIELD F("EX8874"), \
|
||||||
|
new MotorDriver( 3, 12, UNUSED_PIN, 9, A0, 5.08, 5000, A4), \
|
||||||
|
new MotorDriver(11, 13, UNUSED_PIN, 8, A1, 5.08, 5000, A5)
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// Pololu Motor Shield
|
// Pololu Motor Shield
|
||||||
|
|
|
@ -87,6 +87,9 @@ void SerialManager::init() {
|
||||||
delay(1000);
|
delay(1000);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
#ifdef SABERTOOTH
|
||||||
|
Serial2.begin(9600, SERIAL_8N1, 16, 17); // GPIO 16 RXD2; GPIO 17 TXD2 on ESP32
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
void SerialManager::broadcast(char * stringBuffer) {
|
void SerialManager::broadcast(char * stringBuffer) {
|
||||||
|
|
|
@ -117,6 +117,25 @@ void StringFormatter::send2(Print * stream,const FSH* format, va_list args) {
|
||||||
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;
|
||||||
case 'X': stream->print((unsigned long)va_arg(args, unsigned long), HEX); break;
|
case 'X': stream->print((unsigned long)va_arg(args, unsigned long), HEX); break;
|
||||||
|
case 'h': printHex(stream,(unsigned int)va_arg(args, unsigned int)); 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;
|
//case 'f': stream->print(va_arg(args, double), 2); break;
|
||||||
//format width prefix
|
//format width prefix
|
||||||
case '-':
|
case '-':
|
||||||
|
@ -200,4 +219,15 @@ void StringFormatter::printPadded(Print* stream, long value, byte width, bool fo
|
||||||
if (!formatLeft) stream->print(value, DEC);
|
if (!formatLeft) stream->print(value, DEC);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// printHex prints the full 2 byte hex with leading zeros, unlike print(value,HEX)
|
||||||
|
const char FLASH hexchars[]="0123456789ABCDEF";
|
||||||
|
void StringFormatter::printHex(Print * stream,uint16_t value) {
|
||||||
|
char result[5];
|
||||||
|
for (int i=3;i>=0;i--) {
|
||||||
|
result[i]=GETFLASH(hexchars+(value & 0x0F));
|
||||||
|
value>>=4;
|
||||||
|
}
|
||||||
|
result[4]='\0';
|
||||||
|
stream->print(result);
|
||||||
|
}
|
||||||
|
|
|
@ -49,6 +49,7 @@ class StringFormatter
|
||||||
static void lcd2(uint8_t display, byte row, const FSH* input...);
|
static void lcd2(uint8_t display, byte row, const FSH* input...);
|
||||||
static void printEscapes(char * input);
|
static void printEscapes(char * input);
|
||||||
static void printEscape( char c);
|
static void printEscape( char c);
|
||||||
|
static void printHex(Print * stream,uint16_t value);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
static void send2(Print * serial, const FSH* input,va_list args);
|
static void send2(Print * serial, const FSH* input,va_list args);
|
||||||
|
|
267
TrackManager.cpp
267
TrackManager.cpp
|
@ -1,6 +1,7 @@
|
||||||
/*
|
/*
|
||||||
* © 2022 Chris Harlow
|
* © 2022 Chris Harlow
|
||||||
* © 2022 Harald Barth
|
* © 2022 Harald Barth
|
||||||
|
* © 2023 Colin Murdoch
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of DCC++EX
|
* This file is part of DCC++EX
|
||||||
|
@ -25,25 +26,27 @@
|
||||||
#include "MotorDriver.h"
|
#include "MotorDriver.h"
|
||||||
#include "DCCTimer.h"
|
#include "DCCTimer.h"
|
||||||
#include "DIAG.h"
|
#include "DIAG.h"
|
||||||
#include"CommandDistributor.h"
|
#include "CommandDistributor.h"
|
||||||
|
#include "DCCEXParser.h"
|
||||||
// Virtualised Motor shield multi-track hardware Interface
|
// Virtualised Motor shield multi-track hardware Interface
|
||||||
#define FOR_EACH_TRACK(t) for (byte t=0;t<=lastTrack;t++)
|
#define FOR_EACH_TRACK(t) for (byte t=0;t<=lastTrack;t++)
|
||||||
|
|
||||||
#define APPLY_BY_MODE(findmode,function) \
|
#define APPLY_BY_MODE(findmode,function) \
|
||||||
FOR_EACH_TRACK(t) \
|
FOR_EACH_TRACK(t) \
|
||||||
if (trackMode[t]==findmode) \
|
if (track[t]->getMode()==findmode) \
|
||||||
track[t]->function;
|
track[t]->function;
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
const int16_t HASH_KEYWORD_PROG = -29718;
|
const int16_t HASH_KEYWORD_PROG = -29718;
|
||||||
|
#endif
|
||||||
const int16_t HASH_KEYWORD_MAIN = 11339;
|
const int16_t HASH_KEYWORD_MAIN = 11339;
|
||||||
const int16_t HASH_KEYWORD_OFF = 22479;
|
const int16_t HASH_KEYWORD_OFF = 22479;
|
||||||
|
const int16_t HASH_KEYWORD_NONE = -26550;
|
||||||
const int16_t HASH_KEYWORD_DC = 2183;
|
const int16_t HASH_KEYWORD_DC = 2183;
|
||||||
const int16_t HASH_KEYWORD_DCX = 6463; // DC reversed polarity
|
const int16_t HASH_KEYWORD_DCX = 6463; // DC reversed polarity
|
||||||
const int16_t HASH_KEYWORD_EXT = 8201; // External DCC signal
|
const int16_t HASH_KEYWORD_EXT = 8201; // External DCC signal
|
||||||
const int16_t HASH_KEYWORD_A = 65; // parser makes single chars the ascii.
|
const int16_t HASH_KEYWORD_A = 65; // parser makes single chars the ascii.
|
||||||
|
|
||||||
MotorDriver * TrackManager::track[MAX_TRACKS];
|
MotorDriver * TrackManager::track[MAX_TRACKS];
|
||||||
TRACK_MODE TrackManager::trackMode[MAX_TRACKS];
|
|
||||||
int16_t TrackManager::trackDCAddr[MAX_TRACKS];
|
int16_t TrackManager::trackDCAddr[MAX_TRACKS];
|
||||||
|
|
||||||
POWERMODE TrackManager::mainPowerGuess=POWERMODE::OFF;
|
POWERMODE TrackManager::mainPowerGuess=POWERMODE::OFF;
|
||||||
|
@ -52,7 +55,7 @@ bool TrackManager::progTrackSyncMain=false;
|
||||||
bool TrackManager::progTrackBoosted=false;
|
bool TrackManager::progTrackBoosted=false;
|
||||||
int16_t TrackManager::joinRelay=UNUSED_PIN;
|
int16_t TrackManager::joinRelay=UNUSED_PIN;
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
#ifdef ARDUINO_ARCH_ESP32
|
||||||
byte TrackManager::tempProgTrack=MAX_TRACKS+1;
|
byte TrackManager::tempProgTrack=MAX_TRACKS+1; // MAX_TRACKS+1 is the unused flag
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef ANALOG_READ_INTERRUPT
|
#ifdef ANALOG_READ_INTERRUPT
|
||||||
|
@ -73,7 +76,7 @@ void TrackManager::sampleCurrent() {
|
||||||
waiting = false;
|
waiting = false;
|
||||||
tr++;
|
tr++;
|
||||||
if (tr > lastTrack) tr = 0;
|
if (tr > lastTrack) tr = 0;
|
||||||
if (lastTrack < 2 || trackMode[tr] & TRACK_MODE_PROG) {
|
if (lastTrack < 2 || track[tr]->getMode() & TRACK_MODE_PROG) {
|
||||||
return; // We could continue but for prog track we
|
return; // We could continue but for prog track we
|
||||||
// rather do it in next interrupt beacuse
|
// rather do it in next interrupt beacuse
|
||||||
// that gives us well defined sampling point.
|
// that gives us well defined sampling point.
|
||||||
|
@ -84,7 +87,7 @@ void TrackManager::sampleCurrent() {
|
||||||
if (!waiting) {
|
if (!waiting) {
|
||||||
// look for a valid track to sample or until we are around
|
// look for a valid track to sample or until we are around
|
||||||
while (true) {
|
while (true) {
|
||||||
if (trackMode[tr] & ( TRACK_MODE_MAIN|TRACK_MODE_PROG|TRACK_MODE_DC|TRACK_MODE_DCX|TRACK_MODE_EXT )) {
|
if (track[tr]->getMode() & ( TRACK_MODE_MAIN|TRACK_MODE_PROG|TRACK_MODE_DC|TRACK_MODE_DCX|TRACK_MODE_EXT )) {
|
||||||
track[tr]->startCurrentFromHW();
|
track[tr]->startCurrentFromHW();
|
||||||
// for scope debug track[1]->setBrake(1);
|
// for scope debug track[1]->setBrake(1);
|
||||||
waiting = true;
|
waiting = true;
|
||||||
|
@ -116,19 +119,31 @@ void TrackManager::Setup(const FSH * shieldname,
|
||||||
|
|
||||||
// Default the first 2 tracks (which may be null) and perform HA waveform check.
|
// Default the first 2 tracks (which may be null) and perform HA waveform check.
|
||||||
setTrackMode(0,TRACK_MODE_MAIN);
|
setTrackMode(0,TRACK_MODE_MAIN);
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
setTrackMode(1,TRACK_MODE_PROG);
|
setTrackMode(1,TRACK_MODE_PROG);
|
||||||
|
#else
|
||||||
|
setTrackMode(1,TRACK_MODE_MAIN);
|
||||||
|
#endif
|
||||||
|
|
||||||
// TODO Fault pin config for odd motor boards (example pololu)
|
// Fault pin config for odd motor boards (example pololu)
|
||||||
// MotorDriver::commonFaultPin = ((mainDriver->getFaultPin() == progDriver->getFaultPin())
|
FOR_EACH_TRACK(t) {
|
||||||
// && (mainDriver->getFaultPin() != UNUSED_PIN));
|
for (byte s=t+1;s<=lastTrack;s++) {
|
||||||
DCC::begin(shieldname);
|
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::setShieldName(shieldname);
|
||||||
}
|
}
|
||||||
|
|
||||||
void TrackManager::addTrack(byte t, MotorDriver* driver) {
|
void TrackManager::addTrack(byte t, MotorDriver* driver) {
|
||||||
trackMode[t]=TRACK_MODE_OFF;
|
|
||||||
track[t]=driver;
|
track[t]=driver;
|
||||||
if (driver) {
|
if (driver) {
|
||||||
track[t]->setPower(POWERMODE::OFF);
|
track[t]->setPower(POWERMODE::OFF);
|
||||||
|
track[t]->setMode(TRACK_MODE_NONE);
|
||||||
track[t]->setTrackLetter('A'+t);
|
track[t]->setTrackLetter('A'+t);
|
||||||
lastTrack=t;
|
lastTrack=t;
|
||||||
}
|
}
|
||||||
|
@ -140,10 +155,16 @@ void TrackManager::setDCCSignal( bool on) {
|
||||||
HAVE_PORTA(shadowPORTA=PORTA);
|
HAVE_PORTA(shadowPORTA=PORTA);
|
||||||
HAVE_PORTB(shadowPORTB=PORTB);
|
HAVE_PORTB(shadowPORTB=PORTB);
|
||||||
HAVE_PORTC(shadowPORTC=PORTC);
|
HAVE_PORTC(shadowPORTC=PORTC);
|
||||||
|
HAVE_PORTD(shadowPORTD=PORTD);
|
||||||
|
HAVE_PORTE(shadowPORTE=PORTE);
|
||||||
|
HAVE_PORTF(shadowPORTF=PORTF);
|
||||||
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);
|
||||||
HAVE_PORTC(PORTC=shadowPORTC);
|
HAVE_PORTC(PORTC=shadowPORTC);
|
||||||
|
HAVE_PORTD(PORTD=shadowPORTD);
|
||||||
|
HAVE_PORTE(PORTE=shadowPORTE);
|
||||||
|
HAVE_PORTF(PORTF=shadowPORTF);
|
||||||
}
|
}
|
||||||
|
|
||||||
void TrackManager::setCutout( bool on) {
|
void TrackManager::setCutout( bool on) {
|
||||||
|
@ -158,10 +179,16 @@ void TrackManager::setPROGSignal( bool on) {
|
||||||
HAVE_PORTA(shadowPORTA=PORTA);
|
HAVE_PORTA(shadowPORTA=PORTA);
|
||||||
HAVE_PORTB(shadowPORTB=PORTB);
|
HAVE_PORTB(shadowPORTB=PORTB);
|
||||||
HAVE_PORTC(shadowPORTC=PORTC);
|
HAVE_PORTC(shadowPORTC=PORTC);
|
||||||
|
HAVE_PORTD(shadowPORTD=PORTD);
|
||||||
|
HAVE_PORTE(shadowPORTE=PORTE);
|
||||||
|
HAVE_PORTF(shadowPORTF=PORTF);
|
||||||
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);
|
||||||
HAVE_PORTC(PORTC=shadowPORTC);
|
HAVE_PORTC(PORTC=shadowPORTC);
|
||||||
|
HAVE_PORTD(PORTD=shadowPORTD);
|
||||||
|
HAVE_PORTE(PORTE=shadowPORTE);
|
||||||
|
HAVE_PORTF(PORTF=shadowPORTF);
|
||||||
}
|
}
|
||||||
|
|
||||||
// setDCSignal(), called from normal context
|
// setDCSignal(), called from normal context
|
||||||
|
@ -169,22 +196,27 @@ void TrackManager::setPROGSignal( bool on) {
|
||||||
// with interrupts turned off around the critical section
|
// with interrupts turned off around the critical section
|
||||||
void TrackManager::setDCSignal(int16_t cab, byte speedbyte) {
|
void TrackManager::setDCSignal(int16_t cab, byte speedbyte) {
|
||||||
FOR_EACH_TRACK(t) {
|
FOR_EACH_TRACK(t) {
|
||||||
if (trackDCAddr[t]!=cab) continue;
|
if (trackDCAddr[t]!=cab && cab != 0) continue;
|
||||||
if (trackMode[t]==TRACK_MODE_DC) track[t]->setDCSignal(speedbyte);
|
if (track[t]->getMode()==TRACK_MODE_DC) track[t]->setDCSignal(speedbyte);
|
||||||
else if (trackMode[t]==TRACK_MODE_DCX) track[t]->setDCSignal(speedbyte ^ 128);
|
else if (track[t]->getMode()==TRACK_MODE_DCX) track[t]->setDCSignal(speedbyte ^ 128);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
bool TrackManager::setTrackMode(byte trackToSet, TRACK_MODE mode, int16_t dcAddr) {
|
bool TrackManager::setTrackMode(byte trackToSet, TRACK_MODE mode, int16_t dcAddr) {
|
||||||
if (trackToSet>lastTrack || track[trackToSet]==NULL) return false;
|
if (trackToSet>lastTrack || track[trackToSet]==NULL) return false;
|
||||||
|
|
||||||
//DIAG(F("Track=%c"),trackToSet+'A');
|
//DIAG(F("Track=%c Mode=%d"),trackToSet+'A', mode);
|
||||||
// DC tracks require a motorDriver that can set brake!
|
// DC tracks require a motorDriver that can set brake!
|
||||||
if ((mode==TRACK_MODE_DC || mode==TRACK_MODE_DCX)
|
if (mode==TRACK_MODE_DC || mode==TRACK_MODE_DCX) {
|
||||||
&& !track[trackToSet]->brakeCanPWM()) {
|
#if defined(ARDUINO_AVR_UNO)
|
||||||
DIAG(F("Brake pin can't PWM: No DC"));
|
DIAG(F("Uno has no PWM timers available for DC"));
|
||||||
return false;
|
return false;
|
||||||
}
|
#endif
|
||||||
|
if (!track[trackToSet]->brakeCanPWM()) {
|
||||||
|
DIAG(F("Brake pin can't PWM: No DC"));
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
#ifdef ARDUINO_ARCH_ESP32
|
||||||
// remove pin from MUX matrix and turn it off
|
// remove pin from MUX matrix and turn it off
|
||||||
|
@ -198,12 +230,16 @@ bool TrackManager::setTrackMode(byte trackToSet, TRACK_MODE mode, int16_t dcAddr
|
||||||
pinMode(p.invpin, OUTPUT); // gpio_reset_pin may reset to input
|
pinMode(p.invpin, OUTPUT); // gpio_reset_pin may reset to input
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
if (mode==TRACK_MODE_PROG) {
|
if (mode==TRACK_MODE_PROG) {
|
||||||
|
#else
|
||||||
|
if (false) {
|
||||||
|
#endif
|
||||||
// only allow 1 track to be prog
|
// only allow 1 track to be prog
|
||||||
FOR_EACH_TRACK(t)
|
FOR_EACH_TRACK(t)
|
||||||
if (trackMode[t]==TRACK_MODE_PROG && t != trackToSet) {
|
if (track[t]->getMode()==TRACK_MODE_PROG && t != trackToSet) {
|
||||||
track[t]->setPower(POWERMODE::OFF);
|
track[t]->setPower(POWERMODE::OFF);
|
||||||
trackMode[t]=TRACK_MODE_OFF;
|
track[t]->setMode(TRACK_MODE_NONE);
|
||||||
track[t]->makeProgTrack(false); // revoke prog track special handling
|
track[t]->makeProgTrack(false); // revoke prog track special handling
|
||||||
streamTrackState(NULL,t);
|
streamTrackState(NULL,t);
|
||||||
}
|
}
|
||||||
|
@ -211,7 +247,7 @@ bool TrackManager::setTrackMode(byte trackToSet, TRACK_MODE mode, int16_t dcAddr
|
||||||
} else {
|
} else {
|
||||||
track[trackToSet]->makeProgTrack(false); // only the prog track knows it's type
|
track[trackToSet]->makeProgTrack(false); // only the prog track knows it's type
|
||||||
}
|
}
|
||||||
trackMode[trackToSet]=mode;
|
track[trackToSet]->setMode(mode);
|
||||||
trackDCAddr[trackToSet]=dcAddr;
|
trackDCAddr[trackToSet]=dcAddr;
|
||||||
streamTrackState(NULL,trackToSet);
|
streamTrackState(NULL,trackToSet);
|
||||||
|
|
||||||
|
@ -238,7 +274,7 @@ bool TrackManager::setTrackMode(byte trackToSet, TRACK_MODE mode, int16_t dcAddr
|
||||||
// DC tracks must not have the DCC PWM switched on
|
// DC tracks must not have the DCC PWM switched on
|
||||||
// so we globally turn it off if one of the PWM
|
// so we globally turn it off if one of the PWM
|
||||||
// capable tracks is now DC or DCX.
|
// capable tracks is now DC or DCX.
|
||||||
if (trackMode[t]==TRACK_MODE_DC || trackMode[t]==TRACK_MODE_DCX) {
|
if (track[t]->getMode()==TRACK_MODE_DC || track[t]->getMode()==TRACK_MODE_DCX) {
|
||||||
if (track[t]->isPWMCapable()) {
|
if (track[t]->isPWMCapable()) {
|
||||||
canDo=false; // this track is capable but can not run PWM
|
canDo=false; // this track is capable but can not run PWM
|
||||||
break; // in this mode, so abort and prevent globally below
|
break; // in this mode, so abort and prevent globally below
|
||||||
|
@ -246,7 +282,7 @@ bool TrackManager::setTrackMode(byte trackToSet, TRACK_MODE mode, int16_t dcAddr
|
||||||
track[t]->trackPWM=false; // this track sure can not run with PWM
|
track[t]->trackPWM=false; // this track sure can not run with PWM
|
||||||
//DIAG(F("Track %c trackPWM 0 (not capable)"), t+'A');
|
//DIAG(F("Track %c trackPWM 0 (not capable)"), t+'A');
|
||||||
}
|
}
|
||||||
} else if (trackMode[t]==TRACK_MODE_MAIN || trackMode[t]==TRACK_MODE_PROG) {
|
} else if (track[t]->getMode()==TRACK_MODE_MAIN || track[t]->getMode()==TRACK_MODE_PROG) {
|
||||||
track[t]->trackPWM = track[t]->isPWMCapable(); // trackPWM is still a guess here
|
track[t]->trackPWM = track[t]->isPWMCapable(); // trackPWM is still a guess here
|
||||||
//DIAG(F("Track %c trackPWM %d"), t+'A', track[t]->trackPWM);
|
//DIAG(F("Track %c trackPWM %d"), t+'A', track[t]->trackPWM);
|
||||||
canDo &= track[t]->trackPWM;
|
canDo &= track[t]->trackPWM;
|
||||||
|
@ -284,7 +320,7 @@ bool TrackManager::setTrackMode(byte trackToSet, TRACK_MODE mode, int16_t dcAddr
|
||||||
|
|
||||||
void TrackManager::applyDCSpeed(byte t) {
|
void TrackManager::applyDCSpeed(byte t) {
|
||||||
uint8_t speedByte=DCC::getThrottleSpeedByte(trackDCAddr[t]);
|
uint8_t speedByte=DCC::getThrottleSpeedByte(trackDCAddr[t]);
|
||||||
if (trackMode[t]==TRACK_MODE_DCX)
|
if (track[t]->getMode()==TRACK_MODE_DCX)
|
||||||
speedByte = speedByte ^ 128; // reverse direction bit
|
speedByte = speedByte ^ 128; // reverse direction bit
|
||||||
track[t]->setDCSignal(speedByte);
|
track[t]->setDCSignal(speedByte);
|
||||||
}
|
}
|
||||||
|
@ -296,6 +332,7 @@ bool TrackManager::parseJ(Print *stream, int16_t params, int16_t p[])
|
||||||
FOR_EACH_TRACK(t)
|
FOR_EACH_TRACK(t)
|
||||||
streamTrackState(stream,t);
|
streamTrackState(stream,t);
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
p[0]-=HASH_KEYWORD_A; // convert A... to 0....
|
p[0]-=HASH_KEYWORD_A; // convert A... to 0....
|
||||||
|
@ -306,11 +343,13 @@ bool TrackManager::parseJ(Print *stream, int16_t params, int16_t p[])
|
||||||
if (params==2 && p[1]==HASH_KEYWORD_MAIN) // <= id MAIN>
|
if (params==2 && p[1]==HASH_KEYWORD_MAIN) // <= id MAIN>
|
||||||
return setTrackMode(p[0],TRACK_MODE_MAIN);
|
return setTrackMode(p[0],TRACK_MODE_MAIN);
|
||||||
|
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
if (params==2 && p[1]==HASH_KEYWORD_PROG) // <= id PROG>
|
if (params==2 && p[1]==HASH_KEYWORD_PROG) // <= id PROG>
|
||||||
return setTrackMode(p[0],TRACK_MODE_PROG);
|
return setTrackMode(p[0],TRACK_MODE_PROG);
|
||||||
|
#endif
|
||||||
|
|
||||||
if (params==2 && p[1]==HASH_KEYWORD_OFF) // <= id OFF>
|
if (params==2 && (p[1]==HASH_KEYWORD_OFF || p[1]==HASH_KEYWORD_NONE)) // <= id OFF> <= id NONE>
|
||||||
return setTrackMode(p[0],TRACK_MODE_OFF);
|
return setTrackMode(p[0],TRACK_MODE_NONE);
|
||||||
|
|
||||||
if (params==2 && p[1]==HASH_KEYWORD_EXT) // <= id EXT>
|
if (params==2 && p[1]==HASH_KEYWORD_EXT) // <= id EXT>
|
||||||
return setTrackMode(p[0],TRACK_MODE_EXT);
|
return setTrackMode(p[0],TRACK_MODE_EXT);
|
||||||
|
@ -328,49 +367,57 @@ void TrackManager::streamTrackState(Print* stream, byte t) {
|
||||||
// null stream means send to commandDistributor for broadcast
|
// null stream means send to commandDistributor for broadcast
|
||||||
if (track[t]==NULL) return;
|
if (track[t]==NULL) return;
|
||||||
auto format=F("");
|
auto format=F("");
|
||||||
switch(trackMode[t]) {
|
bool pstate = TrackManager::isPowerOn(t);
|
||||||
|
|
||||||
|
switch(track[t]->getMode()) {
|
||||||
case TRACK_MODE_MAIN:
|
case TRACK_MODE_MAIN:
|
||||||
format=F("<= %c MAIN>\n");
|
if (pstate) {format=F("<= %c MAIN ON>\n");} else {format = F("<= %c MAIN OFF>\n");}
|
||||||
break;
|
break;
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
case TRACK_MODE_PROG:
|
case TRACK_MODE_PROG:
|
||||||
format=F("<= %c PROG>\n");
|
if (pstate) {format=F("<= %c PROG ON>\n");} else {format=F("<= %c PROG OFF>\n");}
|
||||||
break;
|
break;
|
||||||
case TRACK_MODE_OFF:
|
#endif
|
||||||
format=F("<= %c OFF>\n");
|
case TRACK_MODE_NONE:
|
||||||
|
if (pstate) {format=F("<= %c NONE ON>\n");} else {format=F("<= %c NONE OFF>\n");}
|
||||||
break;
|
break;
|
||||||
case TRACK_MODE_EXT:
|
case TRACK_MODE_EXT:
|
||||||
format=F("<= %c EXT>\n");
|
if (pstate) {format=F("<= %c EXT ON>\n");} else {format=F("<= %c EXT OFF>\n");}
|
||||||
break;
|
break;
|
||||||
case TRACK_MODE_DC:
|
case TRACK_MODE_DC:
|
||||||
format=F("<= %c DC %d>\n");
|
if (pstate) {format=F("<= %c DC %d ON>\n");} else {format=F("<= %c DC %d OFF>\n");}
|
||||||
break;
|
break;
|
||||||
case TRACK_MODE_DCX:
|
case TRACK_MODE_DCX:
|
||||||
format=F("<= %c DCX %d>\n");
|
if (pstate) {format=F("<= %c DCX %d ON>\n");} else {format=F("<= %c DCX %d OFF>\n");}
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
break; // unknown, dont care
|
break; // unknown, dont care
|
||||||
}
|
}
|
||||||
if (stream) StringFormatter::send(stream,format,'A'+t,trackDCAddr[t]);
|
|
||||||
else CommandDistributor::broadcastTrackState(format,'A'+t,trackDCAddr[t]);
|
if (stream) StringFormatter::send(stream,format,'A'+t, trackDCAddr[t]);
|
||||||
|
else CommandDistributor::broadcastTrackState(format,'A'+t, trackDCAddr[t]);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
byte TrackManager::nextCycleTrack=MAX_TRACKS;
|
byte TrackManager::nextCycleTrack=MAX_TRACKS;
|
||||||
|
|
||||||
void TrackManager::loop() {
|
void TrackManager::loop() {
|
||||||
DCCWaveform::loop();
|
DCCWaveform::loop();
|
||||||
|
#ifndef DISABLE_PROG
|
||||||
DCCACK::loop();
|
DCCACK::loop();
|
||||||
|
#endif
|
||||||
bool dontLimitProg=DCCACK::isActive() || progTrackSyncMain || progTrackBoosted;
|
bool dontLimitProg=DCCACK::isActive() || progTrackSyncMain || progTrackBoosted;
|
||||||
nextCycleTrack++;
|
nextCycleTrack++;
|
||||||
if (nextCycleTrack>lastTrack) nextCycleTrack=0;
|
if (nextCycleTrack>lastTrack) nextCycleTrack=0;
|
||||||
if (track[nextCycleTrack]==NULL) return;
|
if (track[nextCycleTrack]==NULL) return;
|
||||||
MotorDriver * motorDriver=track[nextCycleTrack];
|
MotorDriver * motorDriver=track[nextCycleTrack];
|
||||||
bool useProgLimit=dontLimitProg? false: trackMode[nextCycleTrack]==TRACK_MODE_PROG;
|
bool useProgLimit=dontLimitProg? false: track[nextCycleTrack]->getMode()==TRACK_MODE_PROG;
|
||||||
motorDriver->checkPowerOverload(useProgLimit, nextCycleTrack);
|
motorDriver->checkPowerOverload(useProgLimit, nextCycleTrack);
|
||||||
}
|
}
|
||||||
|
|
||||||
MotorDriver * TrackManager::getProgDriver() {
|
MotorDriver * TrackManager::getProgDriver() {
|
||||||
FOR_EACH_TRACK(t)
|
FOR_EACH_TRACK(t)
|
||||||
if (trackMode[t]==TRACK_MODE_PROG) return track[t];
|
if (track[t]->getMode()==TRACK_MODE_PROG) return track[t];
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -378,54 +425,75 @@ MotorDriver * TrackManager::getProgDriver() {
|
||||||
std::vector<MotorDriver *>TrackManager::getMainDrivers() {
|
std::vector<MotorDriver *>TrackManager::getMainDrivers() {
|
||||||
std::vector<MotorDriver *> v;
|
std::vector<MotorDriver *> v;
|
||||||
FOR_EACH_TRACK(t)
|
FOR_EACH_TRACK(t)
|
||||||
if (trackMode[t]==TRACK_MODE_MAIN) v.push_back(track[t]);
|
if (track[t]->getMode()==TRACK_MODE_MAIN) v.push_back(track[t]);
|
||||||
return v;
|
return v;
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
void TrackManager::setPower2(bool setProg,POWERMODE mode) {
|
void TrackManager::setPower2(bool setProg,bool setJoin, POWERMODE mode) {
|
||||||
if (!setProg) mainPowerGuess=mode;
|
if (!setProg) mainPowerGuess=mode;
|
||||||
FOR_EACH_TRACK(t) {
|
FOR_EACH_TRACK(t) {
|
||||||
MotorDriver * driver=track[t];
|
|
||||||
if (!driver) continue;
|
TrackManager::setTrackPower(setProg, setJoin, mode, t);
|
||||||
switch (trackMode[t]) {
|
|
||||||
case TRACK_MODE_MAIN:
|
|
||||||
if (setProg) break;
|
|
||||||
// toggle brake before turning power on - resets overcurrent error
|
|
||||||
// on the Pololu board if brake is wired to ^D2.
|
|
||||||
// XXX see if we can make this conditional
|
|
||||||
driver->setBrake(true);
|
|
||||||
driver->setBrake(false); // DCC runs with brake off
|
|
||||||
driver->setPower(mode);
|
|
||||||
break;
|
|
||||||
case TRACK_MODE_DC:
|
|
||||||
case TRACK_MODE_DCX:
|
|
||||||
if (setProg) break;
|
|
||||||
driver->setBrake(true); // DC starts with brake on
|
|
||||||
applyDCSpeed(t); // speed match DCC throttles
|
|
||||||
driver->setPower(mode);
|
|
||||||
break;
|
|
||||||
case TRACK_MODE_PROG:
|
|
||||||
if (!setProg) break;
|
|
||||||
driver->setBrake(true);
|
|
||||||
driver->setBrake(false);
|
|
||||||
driver->setPower(mode);
|
|
||||||
break;
|
|
||||||
case TRACK_MODE_EXT:
|
|
||||||
driver->setBrake(true);
|
|
||||||
driver->setBrake(false);
|
|
||||||
driver->setPower(mode);
|
|
||||||
break;
|
|
||||||
case TRACK_MODE_OFF:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
void TrackManager::setTrackPower(bool setProg, bool setJoin, POWERMODE mode, byte thistrack) {
|
||||||
|
|
||||||
|
//DIAG(F("SetTrackPower Processing Track %d"), thistrack);
|
||||||
|
MotorDriver * driver=track[thistrack];
|
||||||
|
if (!driver) return;
|
||||||
|
|
||||||
|
switch (track[thistrack]->getMode()) {
|
||||||
|
case TRACK_MODE_MAIN:
|
||||||
|
if (setProg) break;
|
||||||
|
// toggle brake before turning power on - resets overcurrent error
|
||||||
|
// on the Pololu board if brake is wired to ^D2.
|
||||||
|
// XXX see if we can make this conditional
|
||||||
|
driver->setBrake(true);
|
||||||
|
driver->setBrake(false); // DCC runs with brake off
|
||||||
|
driver->setPower(mode);
|
||||||
|
break;
|
||||||
|
case TRACK_MODE_DC:
|
||||||
|
case TRACK_MODE_DCX:
|
||||||
|
//DIAG(F("Processing track - %d setProg %d"), thistrack, setProg);
|
||||||
|
if (setProg || setJoin) break;
|
||||||
|
driver->setBrake(true); // DC starts with brake on
|
||||||
|
applyDCSpeed(thistrack); // speed match DCC throttles
|
||||||
|
driver->setPower(mode);
|
||||||
|
break;
|
||||||
|
case TRACK_MODE_PROG:
|
||||||
|
if (!setProg && !setJoin) break;
|
||||||
|
driver->setBrake(true);
|
||||||
|
driver->setBrake(false);
|
||||||
|
driver->setPower(mode);
|
||||||
|
break;
|
||||||
|
case TRACK_MODE_EXT:
|
||||||
|
driver->setBrake(true);
|
||||||
|
driver->setBrake(false);
|
||||||
|
driver->setPower(mode);
|
||||||
|
break;
|
||||||
|
case TRACK_MODE_NONE:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void TrackManager::reportPowerChange(Print* stream, byte thistrack) {
|
||||||
|
// This function is for backward JMRI compatibility only
|
||||||
|
// It reports the first track only, as main, regardless of track settings.
|
||||||
|
// <c MeterName value C/V unit min max res warn>
|
||||||
|
int maxCurrent=track[0]->raw2mA(track[0]->getRawCurrentTripValue());
|
||||||
|
StringFormatter::send(stream, F("<c CurrentMAIN %d C Milli 0 %d 1 %d>\n"),
|
||||||
|
track[0]->raw2mA(track[0]->getCurrentRaw(false)), maxCurrent, maxCurrent);
|
||||||
}
|
}
|
||||||
|
|
||||||
POWERMODE TrackManager::getProgPower() {
|
POWERMODE TrackManager::getProgPower() {
|
||||||
FOR_EACH_TRACK(t)
|
FOR_EACH_TRACK(t)
|
||||||
if (trackMode[t]==TRACK_MODE_PROG)
|
if (track[t]->getMode()==TRACK_MODE_PROG)
|
||||||
return track[t]->getPower();
|
return track[t]->getPower();
|
||||||
return POWERMODE::OFF;
|
return POWERMODE::OFF;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -469,7 +537,7 @@ void TrackManager::setJoin(bool joined) {
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
#ifdef ARDUINO_ARCH_ESP32
|
||||||
if (joined) {
|
if (joined) {
|
||||||
FOR_EACH_TRACK(t) {
|
FOR_EACH_TRACK(t) {
|
||||||
if (trackMode[t]==TRACK_MODE_PROG) {
|
if (track[t]->getMode()==TRACK_MODE_PROG) {
|
||||||
tempProgTrack = t;
|
tempProgTrack = t;
|
||||||
setTrackMode(t, TRACK_MODE_MAIN);
|
setTrackMode(t, TRACK_MODE_MAIN);
|
||||||
break;
|
break;
|
||||||
|
@ -477,7 +545,12 @@ void TrackManager::setJoin(bool joined) {
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
if (tempProgTrack != MAX_TRACKS+1) {
|
if (tempProgTrack != MAX_TRACKS+1) {
|
||||||
|
// as setTrackMode with TRACK_MODE_PROG defaults to
|
||||||
|
// power off, we will take the current power state
|
||||||
|
// of our track and then preserve that state.
|
||||||
|
POWERMODE tPTmode = track[tempProgTrack]->getPower(); //get current power status of this track
|
||||||
setTrackMode(tempProgTrack, TRACK_MODE_PROG);
|
setTrackMode(tempProgTrack, TRACK_MODE_PROG);
|
||||||
|
track[tempProgTrack]->setPower(tPTmode); //set track status as it was before
|
||||||
tempProgTrack = MAX_TRACKS+1;
|
tempProgTrack = MAX_TRACKS+1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -485,3 +558,39 @@ void TrackManager::setJoin(bool joined) {
|
||||||
progTrackSyncMain=joined;
|
progTrackSyncMain=joined;
|
||||||
if (joinRelay!=UNUSED_PIN) digitalWrite(joinRelay,joined?HIGH:LOW);
|
if (joinRelay!=UNUSED_PIN) digitalWrite(joinRelay,joined?HIGH:LOW);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
bool TrackManager::isPowerOn(byte t) {
|
||||||
|
if (track[t]->getPower()!=POWERMODE::ON)
|
||||||
|
return false;
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool TrackManager::isProg(byte t) {
|
||||||
|
if (track[t]->getMode()==TRACK_MODE_PROG)
|
||||||
|
return true;
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
byte TrackManager::returnMode(byte t) {
|
||||||
|
return (track[t]->getMode());
|
||||||
|
}
|
||||||
|
|
||||||
|
int16_t TrackManager::returnDCAddr(byte t) {
|
||||||
|
return (trackDCAddr[t]);
|
||||||
|
}
|
||||||
|
|
||||||
|
const char* TrackManager::getModeName(byte Mode) {
|
||||||
|
|
||||||
|
//DIAG(F("PowerMode %d"), Mode);
|
||||||
|
|
||||||
|
switch (Mode)
|
||||||
|
{
|
||||||
|
case 1: return "NONE";
|
||||||
|
case 2: return "MAIN";
|
||||||
|
case 4: return "PROG";
|
||||||
|
case 8: return "DC";
|
||||||
|
case 16: return "DCX";
|
||||||
|
case 32: return "EXT";
|
||||||
|
default: return "----";
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
|
@ -1,6 +1,8 @@
|
||||||
/*
|
/*
|
||||||
* © 2022 Chris Harlow
|
* © 2022 Chris Harlow
|
||||||
* © 2022 Harald Barth
|
* © 2022 Harald Barth
|
||||||
|
* © 2023 Colin Murdoch
|
||||||
|
*
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -27,10 +29,6 @@
|
||||||
#include "MotorDriver.h"
|
#include "MotorDriver.h"
|
||||||
// Virtualised Motor shield multi-track hardware Interface
|
// Virtualised Motor shield multi-track hardware Interface
|
||||||
|
|
||||||
// use powers of two so we can do logical and/or on the track modes in if clauses.
|
|
||||||
enum TRACK_MODE : byte {TRACK_MODE_OFF = 1, TRACK_MODE_MAIN = 2, TRACK_MODE_PROG = 4,
|
|
||||||
TRACK_MODE_DC = 8, TRACK_MODE_DCX = 16, TRACK_MODE_EXT = 32};
|
|
||||||
|
|
||||||
// These constants help EXRAIL macros say SET_TRACK(2,mode) OR SET_TRACK(C,mode) etc.
|
// These constants help EXRAIL macros say SET_TRACK(2,mode) OR SET_TRACK(C,mode) etc.
|
||||||
const byte TRACK_NUMBER_0=0, TRACK_NUMBER_A=0;
|
const byte TRACK_NUMBER_0=0, TRACK_NUMBER_A=0;
|
||||||
const byte TRACK_NUMBER_1=1, TRACK_NUMBER_B=1;
|
const byte TRACK_NUMBER_1=1, TRACK_NUMBER_B=1;
|
||||||
|
@ -41,6 +39,10 @@ const byte TRACK_NUMBER_5=5, TRACK_NUMBER_F=5;
|
||||||
const byte TRACK_NUMBER_6=6, TRACK_NUMBER_G=6;
|
const byte TRACK_NUMBER_6=6, TRACK_NUMBER_G=6;
|
||||||
const byte TRACK_NUMBER_7=7, TRACK_NUMBER_H=7;
|
const byte TRACK_NUMBER_7=7, TRACK_NUMBER_H=7;
|
||||||
|
|
||||||
|
// These constants help EXRAIL macros convert Track Power e.g. SET_POWER(A ON|OFF).
|
||||||
|
const byte TRACK_POWER_0=0, TRACK_POWER_OFF=0;
|
||||||
|
const byte TRACK_POWER_1=1, TRACK_POWER_ON=1;
|
||||||
|
|
||||||
class TrackManager {
|
class TrackManager {
|
||||||
public:
|
public:
|
||||||
static void Setup(const FSH * shieldName,
|
static void Setup(const FSH * shieldName,
|
||||||
|
@ -62,10 +64,14 @@ class TrackManager {
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
#ifdef ARDUINO_ARCH_ESP32
|
||||||
static std::vector<MotorDriver *>getMainDrivers();
|
static std::vector<MotorDriver *>getMainDrivers();
|
||||||
#endif
|
#endif
|
||||||
static void setPower2(bool progTrack,POWERMODE mode);
|
|
||||||
|
static void setPower2(bool progTrack,bool joinTrack,POWERMODE mode);
|
||||||
static void setPower(POWERMODE mode) {setMainPower(mode); setProgPower(mode);}
|
static void setPower(POWERMODE mode) {setMainPower(mode); setProgPower(mode);}
|
||||||
static void setMainPower(POWERMODE mode) {setPower2(false,mode);}
|
static void setMainPower(POWERMODE mode) {setPower2(false,false,mode);}
|
||||||
static void setProgPower(POWERMODE mode) {setPower2(true,mode);}
|
static void setProgPower(POWERMODE mode) {setPower2(true,false,mode);}
|
||||||
|
static void setJoinPower(POWERMODE mode) {setPower2(false,true,mode);}
|
||||||
|
static void setTrackPower(bool setProg, bool setJoin, POWERMODE mode, byte thistrack);
|
||||||
|
|
||||||
|
|
||||||
static const int16_t MAX_TRACKS=8;
|
static const int16_t MAX_TRACKS=8;
|
||||||
static bool setTrackMode(byte track, TRACK_MODE mode, int16_t DCaddr=0);
|
static bool setTrackMode(byte track, TRACK_MODE mode, int16_t DCaddr=0);
|
||||||
|
@ -79,12 +85,25 @@ class TrackManager {
|
||||||
static void sampleCurrent();
|
static void sampleCurrent();
|
||||||
static void reportGauges(Print* stream);
|
static void reportGauges(Print* stream);
|
||||||
static void reportCurrent(Print* stream);
|
static void reportCurrent(Print* stream);
|
||||||
|
static void reportPowerChange(Print* stream, byte thistrack);
|
||||||
static void reportObsoleteCurrent(Print* stream);
|
static void reportObsoleteCurrent(Print* stream);
|
||||||
static void streamTrackState(Print* stream, byte t);
|
static void streamTrackState(Print* stream, byte t);
|
||||||
|
static bool isPowerOn(byte t);
|
||||||
|
static bool isProg(byte t);
|
||||||
|
static byte returnMode(byte t);
|
||||||
|
static int16_t returnDCAddr(byte t);
|
||||||
|
static const char* getModeName(byte Mode);
|
||||||
|
|
||||||
static int16_t joinRelay;
|
static int16_t joinRelay;
|
||||||
static bool progTrackSyncMain; // true when prog track is a siding switched to main
|
static bool progTrackSyncMain; // true when prog track is a siding switched to main
|
||||||
static bool progTrackBoosted; // true when prog track is not current limited
|
static bool progTrackBoosted; // true when prog track is not current limited
|
||||||
|
|
||||||
|
#ifdef DEBUG_ADC
|
||||||
|
public:
|
||||||
|
#else
|
||||||
|
private:
|
||||||
|
#endif
|
||||||
|
static MotorDriver* track[MAX_TRACKS];
|
||||||
|
|
||||||
private:
|
private:
|
||||||
static void addTrack(byte t, MotorDriver* driver);
|
static void addTrack(byte t, MotorDriver* driver);
|
||||||
|
@ -93,8 +112,6 @@ class TrackManager {
|
||||||
static POWERMODE mainPowerGuess;
|
static POWERMODE mainPowerGuess;
|
||||||
static void applyDCSpeed(byte t);
|
static void applyDCSpeed(byte t);
|
||||||
|
|
||||||
static MotorDriver* track[MAX_TRACKS];
|
|
||||||
static TRACK_MODE trackMode[MAX_TRACKS];
|
|
||||||
static int16_t trackDCAddr[MAX_TRACKS]; // dc address if TRACK_MODE_DC or TRACK_MODE_DCX
|
static int16_t trackDCAddr[MAX_TRACKS]; // dc address if TRACK_MODE_DC or TRACK_MODE_DCX
|
||||||
#ifdef ARDUINO_ARCH_ESP32
|
#ifdef ARDUINO_ARCH_ESP32
|
||||||
static byte tempProgTrack; // holds the prog track number during join
|
static byte tempProgTrack; // holds the prog track number during join
|
||||||
|
|
|
@ -250,6 +250,7 @@
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
tt = (Turnout *)new ServoTurnout(id, vpin, thrownPosition, closedPosition, profile, closed);
|
tt = (Turnout *)new ServoTurnout(id, vpin, thrownPosition, closedPosition, profile, closed);
|
||||||
|
DIAG(F("Turnout 0x%x size %d size %d"), tt, sizeof(Turnout),sizeof(struct TurnoutData));
|
||||||
IODevice::writeAnalogue(vpin, closed ? closedPosition : thrownPosition, PCA9685::Instant);
|
IODevice::writeAnalogue(vpin, closed ? closedPosition : thrownPosition, PCA9685::Instant);
|
||||||
return tt;
|
return tt;
|
||||||
#else
|
#else
|
||||||
|
|
|
@ -69,10 +69,12 @@ protected:
|
||||||
uint16_t id;
|
uint16_t id;
|
||||||
} _turnoutData; // 3 bytes
|
} _turnoutData; // 3 bytes
|
||||||
|
|
||||||
|
#ifndef DISABLE_EEPROM
|
||||||
// Address in eeprom of first byte of the _turnoutData struct (containing the closed flag).
|
// Address in eeprom of first byte of the _turnoutData struct (containing the closed flag).
|
||||||
// Set to zero if the object has not been saved in EEPROM, e.g. for newly created Turnouts, and
|
// Set to zero if the object has not been saved in EEPROM, e.g. for newly created Turnouts, and
|
||||||
// for all LCN turnouts.
|
// for all LCN turnouts.
|
||||||
uint16_t _eepromAddress = 0;
|
uint16_t _eepromAddress = 0;
|
||||||
|
#endif
|
||||||
|
|
||||||
// Pointer to next turnout on linked list.
|
// Pointer to next turnout on linked list.
|
||||||
Turnout *_nextTurnout = 0;
|
Turnout *_nextTurnout = 0;
|
||||||
|
|
268
Turntables.cpp
Normal file
268
Turntables.cpp
Normal file
|
@ -0,0 +1,268 @@
|
||||||
|
/*
|
||||||
|
* © 2023 Peter Cole
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* This file is part of CommandStation-EX
|
||||||
|
*
|
||||||
|
* 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/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "defines.h"
|
||||||
|
#include <Arduino.h>
|
||||||
|
#include "Turntables.h"
|
||||||
|
#include "StringFormatter.h"
|
||||||
|
#include "CommandDistributor.h"
|
||||||
|
#include "EXRAIL2.h"
|
||||||
|
#include "DCC.h"
|
||||||
|
|
||||||
|
// No turntable support without HAL
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Protected static data
|
||||||
|
*/
|
||||||
|
Turntable *Turntable::_firstTurntable = 0;
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Public static data
|
||||||
|
*/
|
||||||
|
int Turntable::turntablelistHash = 0;
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Protected static functions
|
||||||
|
*/
|
||||||
|
// Add new turntable to end of list
|
||||||
|
|
||||||
|
void Turntable::add(Turntable *tto) {
|
||||||
|
if (!_firstTurntable) {
|
||||||
|
_firstTurntable = tto;
|
||||||
|
} else {
|
||||||
|
Turntable *ptr = _firstTurntable;
|
||||||
|
for ( ; ptr->_nextTurntable!=0; ptr=ptr->_nextTurntable) {}
|
||||||
|
ptr->_nextTurntable = tto;
|
||||||
|
}
|
||||||
|
turntablelistHash++;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Add a position
|
||||||
|
void Turntable::addPosition(uint8_t idx, uint16_t value, uint16_t angle) {
|
||||||
|
_turntablePositions.insert(idx, value, angle);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Get value for position
|
||||||
|
uint16_t Turntable::getPositionValue(uint8_t position) {
|
||||||
|
TurntablePosition* currentPosition = _turntablePositions.getHead();
|
||||||
|
while (currentPosition) {
|
||||||
|
if (currentPosition->index == position) {
|
||||||
|
return currentPosition->data;
|
||||||
|
}
|
||||||
|
currentPosition = currentPosition->next;
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Get value for position
|
||||||
|
uint16_t Turntable::getPositionAngle(uint8_t position) {
|
||||||
|
TurntablePosition* currentPosition = _turntablePositions.getHead();
|
||||||
|
while (currentPosition) {
|
||||||
|
if (currentPosition->index == position) {
|
||||||
|
return currentPosition->angle;
|
||||||
|
}
|
||||||
|
currentPosition = currentPosition->next;
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Get the count of positions associated with the turntable
|
||||||
|
uint8_t Turntable::getPositionCount() {
|
||||||
|
TurntablePosition* currentPosition = _turntablePositions.getHead();
|
||||||
|
uint8_t count = 0;
|
||||||
|
while (currentPosition) {
|
||||||
|
count++;
|
||||||
|
currentPosition = currentPosition->next;
|
||||||
|
}
|
||||||
|
return count;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Public static functions
|
||||||
|
*/
|
||||||
|
// Find turntable from list
|
||||||
|
Turntable *Turntable::get(uint16_t id) {
|
||||||
|
for (Turntable *tto = _firstTurntable; tto != nullptr; tto = tto->_nextTurntable)
|
||||||
|
if (tto->_turntableData.id == id) return tto;
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Find turntable via Vpin
|
||||||
|
Turntable *Turntable::getByVpin(VPIN vpin) {
|
||||||
|
for (Turntable *tto = _firstTurntable; tto != nullptr; tto = tto->_nextTurntable) {
|
||||||
|
if (tto->isEXTT()) {
|
||||||
|
EXTTTurntable *exttTto = static_cast<EXTTTurntable*>(tto);
|
||||||
|
if (exttTto->getVpin() == vpin) {
|
||||||
|
return tto;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return nullptr;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Get the current position for turntable with the specified ID
|
||||||
|
uint8_t Turntable::getPosition(uint16_t id) {
|
||||||
|
Turntable *tto = get(id);
|
||||||
|
if (!tto) return false;
|
||||||
|
return tto->getPosition();
|
||||||
|
}
|
||||||
|
|
||||||
|
// Got the moving state of the specified turntable
|
||||||
|
bool Turntable::ttMoving(uint16_t id) {
|
||||||
|
Turntable *tto = get(id);
|
||||||
|
if (!tto) return false;
|
||||||
|
return tto->isMoving();
|
||||||
|
}
|
||||||
|
|
||||||
|
// Initiate a turntable move
|
||||||
|
bool Turntable::setPosition(uint16_t id, uint8_t position, uint8_t activity) {
|
||||||
|
#if defined(DIAG_IO)
|
||||||
|
DIAG(F("Rotate turntable %d to position %d, activity %d)"), id, position, activity);
|
||||||
|
#endif
|
||||||
|
Turntable *tto = Turntable::get(id);
|
||||||
|
if (!tto) return false;
|
||||||
|
if (tto->isMoving()) return false;
|
||||||
|
bool ok = tto->setPositionInternal(position, activity);
|
||||||
|
|
||||||
|
if (ok) {
|
||||||
|
// We only deal with broadcasts for DCC turntables here, EXTT in the device driver
|
||||||
|
if (!tto->isEXTT()) {
|
||||||
|
CommandDistributor::broadcastTurntable(id, position, false);
|
||||||
|
}
|
||||||
|
// Trigger EXRAIL rotateEvent for both types here if changed
|
||||||
|
#if defined(EXRAIL_ACTIVE)
|
||||||
|
bool rotated = false;
|
||||||
|
if (position != tto->_previousPosition) rotated = true;
|
||||||
|
RMFT2::rotateEvent(id, rotated);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
return ok;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* EXTTTurntable - EX-Turntable device.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
// Private constructor
|
||||||
|
EXTTTurntable::EXTTTurntable(uint16_t id, VPIN vpin) :
|
||||||
|
Turntable(id, TURNTABLE_EXTT)
|
||||||
|
{
|
||||||
|
_exttTurntableData.vpin = vpin;
|
||||||
|
}
|
||||||
|
|
||||||
|
using DevState = IODevice::DeviceStateEnum;
|
||||||
|
|
||||||
|
// Create function
|
||||||
|
Turntable *EXTTTurntable::create(uint16_t id, VPIN vpin) {
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
Turntable *tto = get(id);
|
||||||
|
if (tto) {
|
||||||
|
if (tto->isType(TURNTABLE_EXTT)) {
|
||||||
|
EXTTTurntable *extt = (EXTTTurntable *)tto;
|
||||||
|
extt->_exttTurntableData.vpin = vpin;
|
||||||
|
return tto;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (!IODevice::exists(vpin)) return nullptr;
|
||||||
|
if (IODevice::getStatus(vpin) == DevState::DEVSTATE_FAILED) return nullptr;
|
||||||
|
if (Turntable::getByVpin(vpin)) return nullptr;
|
||||||
|
tto = (Turntable *)new EXTTTurntable(id, vpin);
|
||||||
|
DIAG(F("Turntable 0x%x size %d size %d"), tto, sizeof(Turntable), sizeof(struct TurntableData));
|
||||||
|
return tto;
|
||||||
|
#else
|
||||||
|
(void)id;
|
||||||
|
(void)vpin;
|
||||||
|
return NULL;
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
void EXTTTurntable::print(Print *stream) {
|
||||||
|
StringFormatter::send(stream, F("<i %d EXTURNTABLE %d>\n"), _turntableData.id, _exttTurntableData.vpin);
|
||||||
|
}
|
||||||
|
|
||||||
|
// EX-Turntable specific code for moving to the specified position
|
||||||
|
bool EXTTTurntable::setPositionInternal(uint8_t position, uint8_t activity) {
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
int16_t value;
|
||||||
|
if (position == 0) {
|
||||||
|
value = 0; // Position 0 is just to send activities
|
||||||
|
} else {
|
||||||
|
if (activity > 1) return false; // If sending a position update, only phase changes valid (0|1)
|
||||||
|
value = getPositionValue(position); // Get position value from position list
|
||||||
|
}
|
||||||
|
if (position > 0 && !value) return false; // Return false if it's not a valid position
|
||||||
|
// Set position via device driver
|
||||||
|
_previousPosition = _turntableData.position;
|
||||||
|
_turntableData.position = position;
|
||||||
|
EXTurntable::writeAnalogue(_exttTurntableData.vpin, value, activity);
|
||||||
|
#else
|
||||||
|
(void)position;
|
||||||
|
#endif
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* DCCTurntable - DCC Turntable device.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
// Private constructor
|
||||||
|
DCCTurntable::DCCTurntable(uint16_t id) : Turntable(id, TURNTABLE_DCC) {}
|
||||||
|
|
||||||
|
// Create function
|
||||||
|
Turntable *DCCTurntable::create(uint16_t id) {
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
Turntable *tto = get(id);
|
||||||
|
if (!tto) {
|
||||||
|
tto = (Turntable *)new DCCTurntable(id);
|
||||||
|
DIAG(F("Turntable 0x%x size %d size %d"), tto, sizeof(Turntable), sizeof(struct TurntableData));
|
||||||
|
}
|
||||||
|
return tto;
|
||||||
|
#else
|
||||||
|
(void)id;
|
||||||
|
return NULL;
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
void DCCTurntable::print(Print *stream) {
|
||||||
|
StringFormatter::send(stream, F("<i %d DCCTURNTABLE>\n"), _turntableData.id);
|
||||||
|
}
|
||||||
|
|
||||||
|
// EX-Turntable specific code for moving to the specified position
|
||||||
|
bool DCCTurntable::setPositionInternal(uint8_t position, uint8_t activity) {
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
int16_t value = getPositionValue(position);
|
||||||
|
if (position == 0 || !value) return false; // Return false if it's not a valid position
|
||||||
|
// Set position via device driver
|
||||||
|
int16_t addr=value>>3;
|
||||||
|
int16_t subaddr=(value>>1) & 0x03;
|
||||||
|
bool active=value & 0x01;
|
||||||
|
_previousPosition = _turntableData.position;
|
||||||
|
_turntableData.position = position;
|
||||||
|
DCC::setAccessory(addr, subaddr, active);
|
||||||
|
#else
|
||||||
|
(void)position;
|
||||||
|
#endif
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
243
Turntables.h
Normal file
243
Turntables.h
Normal file
|
@ -0,0 +1,243 @@
|
||||||
|
/*
|
||||||
|
* © 2023 Peter Cole
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* This file is part of CommandStation-EX
|
||||||
|
*
|
||||||
|
* 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/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef TURNTABLES_H
|
||||||
|
#define TURNTABLES_H
|
||||||
|
|
||||||
|
#include <Arduino.h>
|
||||||
|
#include "IODevice.h"
|
||||||
|
#include "StringFormatter.h"
|
||||||
|
|
||||||
|
// No turntable support without HAL
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
|
||||||
|
// Turntable type definitions
|
||||||
|
// EXTT = EX-Turntable
|
||||||
|
// DCC = DCC accessory turntables - to be added later
|
||||||
|
enum {
|
||||||
|
TURNTABLE_EXTT = 0,
|
||||||
|
TURNTABLE_DCC = 1,
|
||||||
|
};
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* Turntable positions.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
struct TurntablePosition {
|
||||||
|
uint8_t index;
|
||||||
|
uint16_t data;
|
||||||
|
uint16_t angle;
|
||||||
|
TurntablePosition* next;
|
||||||
|
|
||||||
|
TurntablePosition(uint8_t idx, uint16_t value, uint16_t angle) : index(idx), data(value), angle(angle), next(nullptr) {}
|
||||||
|
};
|
||||||
|
|
||||||
|
class TurntablePositionList {
|
||||||
|
public:
|
||||||
|
TurntablePositionList() : head(nullptr) {}
|
||||||
|
|
||||||
|
void insert(uint8_t idx, uint16_t value, uint16_t angle) {
|
||||||
|
TurntablePosition* newPosition = new TurntablePosition(idx, value, angle);
|
||||||
|
if(!head) {
|
||||||
|
head = newPosition;
|
||||||
|
} else {
|
||||||
|
newPosition->next = head;
|
||||||
|
head = newPosition;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
TurntablePosition* getHead() {
|
||||||
|
return head;
|
||||||
|
}
|
||||||
|
|
||||||
|
private:
|
||||||
|
TurntablePosition* head;
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* Turntable - Base class for turntables.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
|
||||||
|
class Turntable {
|
||||||
|
protected:
|
||||||
|
/*
|
||||||
|
* Object data
|
||||||
|
*/
|
||||||
|
|
||||||
|
// Data common to all turntable types
|
||||||
|
struct TurntableData {
|
||||||
|
union {
|
||||||
|
struct {
|
||||||
|
bool hidden : 1;
|
||||||
|
bool turntableType : 1;
|
||||||
|
uint8_t position : 6; // Allows up to 63 positions including 0/home
|
||||||
|
};
|
||||||
|
uint8_t flags;
|
||||||
|
};
|
||||||
|
uint16_t id;
|
||||||
|
} _turntableData;
|
||||||
|
|
||||||
|
// Pointer to next turntable object
|
||||||
|
Turntable *_nextTurntable = 0;
|
||||||
|
|
||||||
|
// Linked list for positions
|
||||||
|
TurntablePositionList _turntablePositions;
|
||||||
|
|
||||||
|
// Store the previous position to allow checking for changes
|
||||||
|
uint8_t _previousPosition = 0;
|
||||||
|
|
||||||
|
// Store the current state of the turntable
|
||||||
|
bool _isMoving = false;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Constructor
|
||||||
|
*/
|
||||||
|
Turntable(uint16_t id, uint8_t turntableType) {
|
||||||
|
_turntableData.id = id;
|
||||||
|
_turntableData.turntableType = turntableType;
|
||||||
|
_turntableData.hidden = false;
|
||||||
|
_turntableData.position = 0;
|
||||||
|
add(this);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Static data
|
||||||
|
*/
|
||||||
|
static Turntable *_firstTurntable;
|
||||||
|
static int _turntablelistHash;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Virtual functions
|
||||||
|
*/
|
||||||
|
virtual bool setPositionInternal(uint8_t position, uint8_t activity) = 0;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Static functions
|
||||||
|
*/
|
||||||
|
static void add(Turntable *tto);
|
||||||
|
|
||||||
|
public:
|
||||||
|
static Turntable *get(uint16_t id);
|
||||||
|
static Turntable *getByVpin(VPIN vpin);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Static data
|
||||||
|
*/
|
||||||
|
static int turntablelistHash;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Public base class functions
|
||||||
|
*/
|
||||||
|
inline uint8_t getPosition() { return _turntableData.position; }
|
||||||
|
inline bool isHidden() { return _turntableData.hidden; }
|
||||||
|
inline void setHidden(bool h) {_turntableData.hidden=h; }
|
||||||
|
inline bool isType(uint8_t type) { return _turntableData.turntableType == type; }
|
||||||
|
inline bool isEXTT() const { return _turntableData.turntableType == TURNTABLE_EXTT; }
|
||||||
|
inline uint16_t getId() { return _turntableData.id; }
|
||||||
|
inline Turntable *next() { return _nextTurntable; }
|
||||||
|
void printState(Print *stream);
|
||||||
|
void addPosition(uint8_t idx, uint16_t value, uint16_t angle);
|
||||||
|
uint16_t getPositionValue(uint8_t position);
|
||||||
|
uint16_t getPositionAngle(uint8_t position);
|
||||||
|
uint8_t getPositionCount();
|
||||||
|
bool isMoving() { return _isMoving; }
|
||||||
|
void setMoving(bool moving) { _isMoving=moving; }
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Virtual functions
|
||||||
|
*/
|
||||||
|
virtual void print(Print *stream) {
|
||||||
|
(void)stream; // suppress compiler warnings
|
||||||
|
}
|
||||||
|
virtual ~Turntable() {} // Destructor
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Public static functions
|
||||||
|
*/
|
||||||
|
inline static bool exists(uint16_t id) { return get(id) != 0; }
|
||||||
|
static bool setPosition(uint16_t id, uint8_t position, uint8_t activity=0);
|
||||||
|
static uint8_t getPosition(uint16_t id);
|
||||||
|
static bool ttMoving(uint16_t id);
|
||||||
|
inline static Turntable *first() { return _firstTurntable; }
|
||||||
|
static bool printAll(Print *stream) {
|
||||||
|
bool gotOne = false;
|
||||||
|
for (Turntable *tto = _firstTurntable; tto != 0; tto = tto->_nextTurntable)
|
||||||
|
if (!tto->isHidden()) {
|
||||||
|
gotOne = true;
|
||||||
|
StringFormatter::send(stream, F("<I %d %d>\n"), tto->getId(), tto->getPosition());
|
||||||
|
}
|
||||||
|
return gotOne;
|
||||||
|
}
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* EXTTTurntable - EX-Turntable device.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
class EXTTTurntable : public Turntable {
|
||||||
|
private:
|
||||||
|
// EXTTTurntableData contains device specific data
|
||||||
|
struct EXTTTurntableData {
|
||||||
|
VPIN vpin;
|
||||||
|
} _exttTurntableData;
|
||||||
|
|
||||||
|
// Constructor
|
||||||
|
EXTTTurntable(uint16_t id, VPIN vpin);
|
||||||
|
|
||||||
|
public:
|
||||||
|
// Create function
|
||||||
|
static Turntable *create(uint16_t id, VPIN vpin);
|
||||||
|
void print(Print *stream) override;
|
||||||
|
VPIN getVpin() const { return _exttTurntableData.vpin; }
|
||||||
|
|
||||||
|
protected:
|
||||||
|
// EX-Turntable specific code for setting position
|
||||||
|
bool setPositionInternal(uint8_t position, uint8_t activity) override;
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* DCCTurntable - DCC accessory Turntable device.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
class DCCTurntable : public Turntable {
|
||||||
|
private:
|
||||||
|
// Constructor
|
||||||
|
DCCTurntable(uint16_t id);
|
||||||
|
|
||||||
|
public:
|
||||||
|
// Create function
|
||||||
|
static Turntable *create(uint16_t id);
|
||||||
|
void print(Print *stream) override;
|
||||||
|
|
||||||
|
protected:
|
||||||
|
// DCC specific code for setting position
|
||||||
|
bool setPositionInternal(uint8_t position, uint8_t activity=0) override;
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
|
@ -235,6 +235,10 @@ int WiThrottle::getLocoId(byte * cmd) {
|
||||||
void WiThrottle::multithrottle(RingStream * stream, byte * cmd){
|
void WiThrottle::multithrottle(RingStream * stream, byte * cmd){
|
||||||
char throttleChar=cmd[1];
|
char throttleChar=cmd[1];
|
||||||
int locoid=getLocoId(cmd+3); // -1 for *
|
int locoid=getLocoId(cmd+3); // -1 for *
|
||||||
|
if (locoid > 10239 || locoid < -1) {
|
||||||
|
StringFormatter::send(stream, F("No valid DCC loco %d\n"), locoid);
|
||||||
|
return;
|
||||||
|
}
|
||||||
byte * aval=cmd;
|
byte * aval=cmd;
|
||||||
while(*aval !=';' && *aval !='\0') aval++;
|
while(*aval !=';' && *aval !='\0') aval++;
|
||||||
if (*aval) aval+=2; // skip ;>
|
if (*aval) aval+=2; // skip ;>
|
||||||
|
@ -527,10 +531,13 @@ void WiThrottle::sendRoster(Print* stream) {
|
||||||
rosterSent=true;
|
rosterSent=true;
|
||||||
#ifdef EXRAIL_ACTIVE
|
#ifdef EXRAIL_ACTIVE
|
||||||
StringFormatter::send(stream,F("RL%d"), RMFT2::rosterNameCount);
|
StringFormatter::send(stream,F("RL%d"), RMFT2::rosterNameCount);
|
||||||
for (int16_t r=0;r<RMFT2::rosterNameCount;r++) {
|
for (int16_t r=0;;r++) {
|
||||||
int16_t cabid=GETHIGHFLASHW(RMFT2::rosterIdList,r*2);
|
int16_t cabid=GETHIGHFLASHW(RMFT2::rosterIdList,r*2);
|
||||||
StringFormatter::send(stream,F("]\\[%S}|{%d}|{%c"),
|
if (cabid == INT16_MAX)
|
||||||
RMFT2::getRosterName(cabid),cabid,cabid<128?'S':'L');
|
break;
|
||||||
|
if (cabid > 0)
|
||||||
|
StringFormatter::send(stream,F("]\\[%S}|{%d}|{%c"),
|
||||||
|
RMFT2::getRosterName(cabid),cabid,cabid<128?'S':'L');
|
||||||
}
|
}
|
||||||
StringFormatter::send(stream,F("\n"));
|
StringFormatter::send(stream,F("\n"));
|
||||||
#else
|
#else
|
||||||
|
@ -544,14 +551,14 @@ void WiThrottle::sendRoutes(Print* stream) {
|
||||||
// first pass automations
|
// first pass automations
|
||||||
for (int ix=0;;ix+=2) {
|
for (int ix=0;;ix+=2) {
|
||||||
int16_t id =GETHIGHFLASHW(RMFT2::automationIdList,ix);
|
int16_t id =GETHIGHFLASHW(RMFT2::automationIdList,ix);
|
||||||
if (id==0) break;
|
if (id==INT16_MAX) break;
|
||||||
const FSH * desc=RMFT2::getRouteDescription(id);
|
const FSH * desc=RMFT2::getRouteDescription(id);
|
||||||
StringFormatter::send(stream,F("]\\[A%d}|{%S}|{4"),id,desc);
|
StringFormatter::send(stream,F("]\\[A%d}|{%S}|{4"),id,desc);
|
||||||
}
|
}
|
||||||
// second pass routes.
|
// second pass routes.
|
||||||
for (int ix=0;;ix+=2) {
|
for (int ix=0;;ix+=2) {
|
||||||
int16_t id=GETHIGHFLASHW(RMFT2::routeIdList,ix);
|
int16_t id=GETHIGHFLASHW(RMFT2::routeIdList,ix);
|
||||||
if (id==0) break;
|
if (id==INT16_MAX) break;
|
||||||
const FSH * desc=RMFT2::getRouteDescription(id);
|
const FSH * desc=RMFT2::getRouteDescription(id);
|
||||||
StringFormatter::send(stream,F("]\\[R%d}|{%S}|{2"),id,desc);
|
StringFormatter::send(stream,F("]\\[R%d}|{%S}|{2"),id,desc);
|
||||||
}
|
}
|
||||||
|
@ -567,9 +574,13 @@ void WiThrottle::sendFunctions(Print* stream, byte loco) {
|
||||||
myLocos[loco].functionToggles=1<<2; // F2 (HORN) is a non-toggle
|
myLocos[loco].functionToggles=1<<2; // F2 (HORN) is a non-toggle
|
||||||
|
|
||||||
#ifdef EXRAIL_ACTIVE
|
#ifdef EXRAIL_ACTIVE
|
||||||
const char * functionNames=(char *) RMFT2::getRosterFunctions(locoid);
|
const FSH * functionNames= RMFT2::getRosterFunctions(locoid);
|
||||||
if (!functionNames) {
|
if (functionNames == NULL) {
|
||||||
// no roster, use non-exrail presets as above
|
// no roster entry for locoid, try to find default entry
|
||||||
|
functionNames= RMFT2::getRosterFunctions(0);
|
||||||
|
}
|
||||||
|
if (functionNames == NULL) {
|
||||||
|
// no default roster entry either, use non-exrail presets as above
|
||||||
}
|
}
|
||||||
else if (GETFLASH(functionNames)=='\0') {
|
else if (GETFLASH(functionNames)=='\0') {
|
||||||
// "" = Roster but no functions given
|
// "" = Roster but no functions given
|
||||||
|
@ -584,7 +595,7 @@ void WiThrottle::sendFunctions(Print* stream, byte loco) {
|
||||||
fkeys=0;
|
fkeys=0;
|
||||||
bool firstchar=true;
|
bool firstchar=true;
|
||||||
for (int fx=0;;fx++) {
|
for (int fx=0;;fx++) {
|
||||||
char c=GETFLASH(functionNames+fx);
|
char c=GETFLASH((char *)functionNames+fx);
|
||||||
if (c=='\0') {
|
if (c=='\0') {
|
||||||
fkeys++;
|
fkeys++;
|
||||||
break;
|
break;
|
||||||
|
|
|
@ -1,5 +1,7 @@
|
||||||
/*
|
/*
|
||||||
© 2021, Harald Barth.
|
© 2023 Paul M. Antoine
|
||||||
|
© 2021 Harald Barth
|
||||||
|
© 2023 Nathan Kellenicki
|
||||||
|
|
||||||
This file is part of CommandStation-EX
|
This file is part of CommandStation-EX
|
||||||
|
|
||||||
|
@ -20,6 +22,7 @@
|
||||||
#if defined(ARDUINO_ARCH_ESP32)
|
#if defined(ARDUINO_ARCH_ESP32)
|
||||||
#include <vector>
|
#include <vector>
|
||||||
#include "defines.h"
|
#include "defines.h"
|
||||||
|
#include "ESPmDNS.h"
|
||||||
#include <WiFi.h>
|
#include <WiFi.h>
|
||||||
#include "esp_wifi.h"
|
#include "esp_wifi.h"
|
||||||
#include "WifiESP32.h"
|
#include "WifiESP32.h"
|
||||||
|
@ -105,11 +108,18 @@ void wifiLoop(void *){
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
char asciitolower(char in) {
|
||||||
|
if (in <= 'Z' && in >= 'A')
|
||||||
|
return in - ('Z' - 'z');
|
||||||
|
return in;
|
||||||
|
}
|
||||||
|
|
||||||
bool WifiESP::setup(const char *SSid,
|
bool WifiESP::setup(const char *SSid,
|
||||||
const char *password,
|
const char *password,
|
||||||
const char *hostname,
|
const char *hostname,
|
||||||
int port,
|
int port,
|
||||||
const byte channel) {
|
const byte channel,
|
||||||
|
const bool forceAP) {
|
||||||
bool havePassword = true;
|
bool havePassword = true;
|
||||||
bool haveSSID = true;
|
bool haveSSID = true;
|
||||||
bool wifiUp = false;
|
bool wifiUp = false;
|
||||||
|
@ -137,7 +147,8 @@ bool WifiESP::setup(const char *SSid,
|
||||||
if (strncmp(yourNetwork, password, 13) == 0 || strncmp("", password, 13) == 0)
|
if (strncmp(yourNetwork, password, 13) == 0 || strncmp("", password, 13) == 0)
|
||||||
havePassword = false;
|
havePassword = false;
|
||||||
|
|
||||||
if (haveSSID && havePassword) {
|
if (haveSSID && havePassword && !forceAP) {
|
||||||
|
WiFi.setHostname(hostname); // Strangely does not work unless we do it HERE!
|
||||||
WiFi.mode(WIFI_STA);
|
WiFi.mode(WIFI_STA);
|
||||||
#ifdef SERIAL_BT_COMMANDS
|
#ifdef SERIAL_BT_COMMANDS
|
||||||
WiFi.setSleep(true);
|
WiFi.setSleep(true);
|
||||||
|
@ -174,16 +185,20 @@ bool WifiESP::setup(const char *SSid,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
if (!haveSSID) {
|
if (!haveSSID || forceAP) {
|
||||||
// prepare all strings
|
// prepare all strings
|
||||||
String strSSID("DCC_");
|
String strSSID(forceAP ? SSid : "DCCEX_");
|
||||||
String strPass("PASS_");
|
String strPass(forceAP ? password : "PASS_");
|
||||||
String strMac = WiFi.macAddress();
|
if (!forceAP) {
|
||||||
strMac.remove(0,9);
|
String strMac = WiFi.macAddress();
|
||||||
strMac.replace(":","");
|
strMac.remove(0,9);
|
||||||
strMac.replace(":","");
|
strMac.replace(":","");
|
||||||
strSSID.concat(strMac);
|
strMac.replace(":","");
|
||||||
strPass.concat(strMac);
|
// convert mac addr hex chars to lower case to be compatible with AT software
|
||||||
|
std::transform(strMac.begin(), strMac.end(), strMac.begin(), asciitolower);
|
||||||
|
strSSID.concat(strMac);
|
||||||
|
strPass.concat(strMac);
|
||||||
|
}
|
||||||
|
|
||||||
WiFi.mode(WIFI_AP);
|
WiFi.mode(WIFI_AP);
|
||||||
#ifdef SERIAL_BT_COMMANDS
|
#ifdef SERIAL_BT_COMMANDS
|
||||||
|
@ -209,6 +224,15 @@ bool WifiESP::setup(const char *SSid,
|
||||||
// no idea to go on
|
// no idea to go on
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Now Wifi is up, register the mDNS service
|
||||||
|
if(!MDNS.begin(hostname)) {
|
||||||
|
DIAG(F("Wifi setup failed to start mDNS"));
|
||||||
|
}
|
||||||
|
if(!MDNS.addService("withrottle", "tcp", 2560)) {
|
||||||
|
DIAG(F("Wifi setup failed to add withrottle service to mDNS"));
|
||||||
|
}
|
||||||
|
|
||||||
server = new WiFiServer(port); // start listening on tcp port
|
server = new WiFiServer(port); // start listening on tcp port
|
||||||
server->begin();
|
server->begin();
|
||||||
// server started here
|
// server started here
|
||||||
|
|
|
@ -1,5 +1,6 @@
|
||||||
/*
|
/*
|
||||||
* © 2021, Harald Barth.
|
* © 2021 Harald Barth
|
||||||
|
* © 2023 Nathan Kellenicki
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
*
|
*
|
||||||
|
@ -31,7 +32,8 @@ public:
|
||||||
const char *wifiPassword,
|
const char *wifiPassword,
|
||||||
const char *hostname,
|
const char *hostname,
|
||||||
const int port,
|
const int port,
|
||||||
const byte channel);
|
const byte channel,
|
||||||
|
const bool forceAP);
|
||||||
static void loop();
|
static void loop();
|
||||||
private:
|
private:
|
||||||
};
|
};
|
||||||
|
|
|
@ -2,6 +2,7 @@
|
||||||
* © 2021 Fred Decker
|
* © 2021 Fred Decker
|
||||||
* © 2020-2022 Harald Barth
|
* © 2020-2022 Harald Barth
|
||||||
* © 2020-2022 Chris Harlow
|
* © 2020-2022 Chris Harlow
|
||||||
|
* © 2023 Nathan Kellenicki
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -52,10 +53,32 @@ Stream * WifiInterface::wifiStream;
|
||||||
|
|
||||||
#if (defined(ARDUINO_AVR_MEGA) || defined(ARDUINO_AVR_MEGA2560))
|
#if (defined(ARDUINO_AVR_MEGA) || defined(ARDUINO_AVR_MEGA2560))
|
||||||
#define NUM_SERIAL 3
|
#define NUM_SERIAL 3
|
||||||
|
#define SERIAL1 Serial1
|
||||||
|
#define SERIAL3 Serial3
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if defined(ARDUINO_ARCH_STM32)
|
||||||
|
// Handle serial ports availability on STM32 for variants!
|
||||||
|
// #undef NUM_SERIAL
|
||||||
|
#if defined(ARDUINO_NUCLEO_F401RE) || defined(ARDUINO_NUCLEO_F411RE)
|
||||||
|
#define NUM_SERIAL 3
|
||||||
|
#define SERIAL1 Serial1
|
||||||
|
#define SERIAL3 Serial6
|
||||||
|
#elif defined(ARDUINO_NUCLEO_F446RE)
|
||||||
|
#define NUM_SERIAL 3
|
||||||
|
#define SERIAL1 Serial3
|
||||||
|
#define SERIAL3 Serial5
|
||||||
|
#elif defined(ARDUINO_NUCLEO_F413ZH) || defined(ARDUINO_NUCLEO_F429ZI) || defined(ARDUINO_NUCLEO_F446ZE) || defined(ARDUINO_NUCLEO_F412ZG)
|
||||||
|
#define NUM_SERIAL 2
|
||||||
|
#define SERIAL1 Serial6
|
||||||
|
#else
|
||||||
|
#warning This variant of Nucleo not yet explicitly supported
|
||||||
|
#endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifndef NUM_SERIAL
|
#ifndef NUM_SERIAL
|
||||||
#define NUM_SERIAL 1
|
#define NUM_SERIAL 1
|
||||||
|
#define SERIAL1 Serial1
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
bool WifiInterface::setup(long serial_link_speed,
|
bool WifiInterface::setup(long serial_link_speed,
|
||||||
|
@ -63,7 +86,8 @@ bool WifiInterface::setup(long serial_link_speed,
|
||||||
const FSH *wifiPassword,
|
const FSH *wifiPassword,
|
||||||
const FSH *hostname,
|
const FSH *hostname,
|
||||||
const int port,
|
const int port,
|
||||||
const byte channel) {
|
const byte channel,
|
||||||
|
const bool forceAP) {
|
||||||
|
|
||||||
wifiSerialState wifiUp = WIFI_NOAT;
|
wifiSerialState wifiUp = WIFI_NOAT;
|
||||||
|
|
||||||
|
@ -75,27 +99,34 @@ bool WifiInterface::setup(long serial_link_speed,
|
||||||
(void) hostname;
|
(void) hostname;
|
||||||
(void) port;
|
(void) port;
|
||||||
(void) channel;
|
(void) channel;
|
||||||
|
(void) forceAP;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
// See if the WiFi is attached to the first serial port
|
||||||
#if NUM_SERIAL > 0 && !defined(SERIAL1_COMMANDS)
|
#if NUM_SERIAL > 0 && !defined(SERIAL1_COMMANDS)
|
||||||
Serial1.begin(serial_link_speed);
|
SERIAL1.begin(serial_link_speed);
|
||||||
wifiUp = setup(Serial1, wifiESSID, wifiPassword, hostname, port, channel);
|
wifiUp = setup(SERIAL1, wifiESSID, wifiPassword, hostname, port, channel, forceAP);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// Other serials are tried, depending on hardware.
|
// Other serials are tried, depending on hardware.
|
||||||
|
// Currently only the Arduino Mega 2560 has usable Serial2 (Nucleo-64 boards use Serial 2 for console!)
|
||||||
|
#if defined(ARDUINO_AVR_MEGA2560)
|
||||||
#if NUM_SERIAL > 1 && !defined(SERIAL2_COMMANDS)
|
#if NUM_SERIAL > 1 && !defined(SERIAL2_COMMANDS)
|
||||||
if (wifiUp == WIFI_NOAT)
|
if (wifiUp == WIFI_NOAT)
|
||||||
{
|
{
|
||||||
Serial2.begin(serial_link_speed);
|
Serial2.begin(serial_link_speed);
|
||||||
wifiUp = setup(Serial2, wifiESSID, wifiPassword, hostname, port, channel);
|
wifiUp = setup(Serial2, wifiESSID, wifiPassword, hostname, port, channel, forceAP);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
|
// We guess here that in all architctures that have a Serial3
|
||||||
|
// we can use it for our purpose.
|
||||||
#if NUM_SERIAL > 2 && !defined(SERIAL3_COMMANDS)
|
#if NUM_SERIAL > 2 && !defined(SERIAL3_COMMANDS)
|
||||||
if (wifiUp == WIFI_NOAT)
|
if (wifiUp == WIFI_NOAT)
|
||||||
{
|
{
|
||||||
Serial3.begin(serial_link_speed);
|
SERIAL3.begin(serial_link_speed);
|
||||||
wifiUp = setup(Serial3, wifiESSID, wifiPassword, hostname, port, channel);
|
wifiUp = setup(SERIAL3, wifiESSID, wifiPassword, hostname, port, channel, forceAP);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
@ -113,7 +144,7 @@ bool WifiInterface::setup(long serial_link_speed,
|
||||||
}
|
}
|
||||||
|
|
||||||
wifiSerialState WifiInterface::setup(Stream & setupStream, const FSH* SSid, const FSH* password,
|
wifiSerialState WifiInterface::setup(Stream & setupStream, const FSH* SSid, const FSH* password,
|
||||||
const FSH* hostname, int port, byte channel) {
|
const FSH* hostname, int port, byte channel, bool forceAP) {
|
||||||
wifiSerialState wifiState;
|
wifiSerialState wifiState;
|
||||||
static uint8_t ntry = 0;
|
static uint8_t ntry = 0;
|
||||||
ntry++;
|
ntry++;
|
||||||
|
@ -122,7 +153,7 @@ wifiSerialState WifiInterface::setup(Stream & setupStream, const FSH* SSid, con
|
||||||
|
|
||||||
DIAG(F("++ Wifi Setup Try %d ++"), ntry);
|
DIAG(F("++ Wifi Setup Try %d ++"), ntry);
|
||||||
|
|
||||||
wifiState = setup2( SSid, password, hostname, port, channel);
|
wifiState = setup2( SSid, password, hostname, port, channel, forceAP);
|
||||||
|
|
||||||
if (wifiState == WIFI_NOAT) {
|
if (wifiState == WIFI_NOAT) {
|
||||||
LCD(4, F("WiFi no AT chip"));
|
LCD(4, F("WiFi no AT chip"));
|
||||||
|
@ -146,7 +177,7 @@ wifiSerialState WifiInterface::setup(Stream & setupStream, const FSH* SSid, con
|
||||||
#pragma GCC diagnostic ignored "-Wunused-parameter"
|
#pragma GCC diagnostic ignored "-Wunused-parameter"
|
||||||
#endif
|
#endif
|
||||||
wifiSerialState WifiInterface::setup2(const FSH* SSid, const FSH* password,
|
wifiSerialState WifiInterface::setup2(const FSH* SSid, const FSH* password,
|
||||||
const FSH* hostname, int port, byte channel) {
|
const FSH* hostname, int port, byte channel, bool forceAP) {
|
||||||
bool ipOK = false;
|
bool ipOK = false;
|
||||||
bool oldCmd = false;
|
bool oldCmd = false;
|
||||||
|
|
||||||
|
@ -169,7 +200,21 @@ wifiSerialState WifiInterface::setup2(const FSH* SSid, const FSH* password,
|
||||||
|
|
||||||
// Display the AT version information
|
// Display the AT version information
|
||||||
StringFormatter::send(wifiStream, F("AT+GMR\r\n"));
|
StringFormatter::send(wifiStream, F("AT+GMR\r\n"));
|
||||||
checkForOK(2000, true, false); // Makes this visible on the console
|
if (checkForOK(2000, F("AT version:"), true, false)) {
|
||||||
|
char version[] = "0.0.0.0";
|
||||||
|
for (int i=0; i<8;i++) {
|
||||||
|
while(!wifiStream->available());
|
||||||
|
version[i]=wifiStream->read();
|
||||||
|
StringFormatter::printEscape(version[i]);
|
||||||
|
if ((version[0] == '0') ||
|
||||||
|
(version[0] == '2' && version[2] == '0') ||
|
||||||
|
(version[0] == '2' && version[2] == '2' && version[4] == '0' && version[6] == '0')) {
|
||||||
|
SSid = F("DCCEX_SAYS_BROKEN_FIRMWARE");
|
||||||
|
forceAP = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
checkForOK(2000, true, false);
|
||||||
|
|
||||||
#ifdef DONT_TOUCH_WIFI_CONF
|
#ifdef DONT_TOUCH_WIFI_CONF
|
||||||
DIAG(F("DONT_TOUCH_WIFI_CONF was set: Using existing config"));
|
DIAG(F("DONT_TOUCH_WIFI_CONF was set: Using existing config"));
|
||||||
|
@ -199,7 +244,7 @@ wifiSerialState WifiInterface::setup2(const FSH* SSid, const FSH* password,
|
||||||
if (!checkForOK(1000, F("0.0.0.0"), true,false))
|
if (!checkForOK(1000, F("0.0.0.0"), true,false))
|
||||||
ipOK = true;
|
ipOK = true;
|
||||||
}
|
}
|
||||||
} else {
|
} else if (!forceAP) {
|
||||||
// SSID was configured, so we assume station (client) mode.
|
// SSID was configured, so we assume station (client) mode.
|
||||||
if (oldCmd) {
|
if (oldCmd) {
|
||||||
// AT command early version supports CWJAP/CWSAP
|
// AT command early version supports CWJAP/CWSAP
|
||||||
|
@ -259,14 +304,19 @@ wifiSerialState WifiInterface::setup2(const FSH* SSid, const FSH* password,
|
||||||
|
|
||||||
i=0;
|
i=0;
|
||||||
do {
|
do {
|
||||||
if (STRNCMP_P(yourNetwork, (const char*)password, 13) == 0) {
|
if (!forceAP) {
|
||||||
// unconfigured
|
if (STRNCMP_P(yourNetwork, (const char*)password, 13) == 0) {
|
||||||
StringFormatter::send(wifiStream, F("AT+CWSAP%s=\"DCCEX_%s\",\"PASS_%s\",%d,4\r\n"),
|
// unconfigured
|
||||||
oldCmd ? "" : "_CUR", macTail, macTail, channel);
|
StringFormatter::send(wifiStream, F("AT+CWSAP%s=\"DCCEX_%s\",\"PASS_%s\",%d,4\r\n"),
|
||||||
|
oldCmd ? "" : "_CUR", macTail, macTail, channel);
|
||||||
|
} else {
|
||||||
|
// password configured by user
|
||||||
|
StringFormatter::send(wifiStream, F("AT+CWSAP%s=\"DCCEX_%s\",\"%S\",%d,4\r\n"), oldCmd ? "" : "_CUR",
|
||||||
|
macTail, password, channel);
|
||||||
|
}
|
||||||
} else {
|
} else {
|
||||||
// password configured by user
|
StringFormatter::send(wifiStream, F("AT+CWSAP%s=\"%S\",\"%S\",%d,4\r\n"),
|
||||||
StringFormatter::send(wifiStream, F("AT+CWSAP%s=\"DCCEX_%s\",\"%S\",%d,4\r\n"), oldCmd ? "" : "_CUR",
|
oldCmd ? "" : "_CUR", SSid, password, channel);
|
||||||
macTail, password, channel);
|
|
||||||
}
|
}
|
||||||
} while (!checkForOK(WIFI_CONNECT_TIMEOUT, true) && i++<2); // do twice if necessary but ignore failure as AP mode may still be ok
|
} while (!checkForOK(WIFI_CONNECT_TIMEOUT, true) && i++<2); // do twice if necessary but ignore failure as AP mode may still be ok
|
||||||
if (i >= 2)
|
if (i >= 2)
|
||||||
|
|
|
@ -1,6 +1,7 @@
|
||||||
/*
|
/*
|
||||||
* © 2020-2021 Chris Harlow
|
* © 2020-2021 Chris Harlow
|
||||||
* © 2020, Harald Barth.
|
* © 2020, Harald Barth.
|
||||||
|
* © 2023 Nathan Kellenicki
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
|
@ -36,17 +37,18 @@ public:
|
||||||
const FSH *wifiPassword,
|
const FSH *wifiPassword,
|
||||||
const FSH *hostname,
|
const FSH *hostname,
|
||||||
const int port,
|
const int port,
|
||||||
const byte channel);
|
const byte channel,
|
||||||
|
const bool forceAP);
|
||||||
static void loop();
|
static void loop();
|
||||||
static void ATCommand(HardwareSerial * stream,const byte *command);
|
static void ATCommand(HardwareSerial * stream,const byte *command);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
static wifiSerialState setup(Stream &setupStream, const FSH *SSSid, const FSH *password,
|
static wifiSerialState setup(Stream &setupStream, const FSH *SSSid, const FSH *password,
|
||||||
const FSH *hostname, int port, byte channel);
|
const FSH *hostname, int port, byte channel, bool forceAP);
|
||||||
static Stream *wifiStream;
|
static Stream *wifiStream;
|
||||||
static DCCEXParser parser;
|
static DCCEXParser parser;
|
||||||
static wifiSerialState setup2(const FSH *SSSid, const FSH *password,
|
static wifiSerialState setup2(const FSH *SSSid, const FSH *password,
|
||||||
const FSH *hostname, int port, byte channel);
|
const FSH *hostname, int port, byte channel, bool forceAP);
|
||||||
static bool checkForOK(const unsigned int timeout, bool echo, bool escapeEcho = true);
|
static bool checkForOK(const unsigned int timeout, bool echo, bool escapeEcho = true);
|
||||||
static bool checkForOK(const unsigned int timeout, const FSH *waitfor, bool echo, bool escapeEcho = true);
|
static bool checkForOK(const unsigned int timeout, const FSH *waitfor, bool echo, bool escapeEcho = true);
|
||||||
static bool connected;
|
static bool connected;
|
||||||
|
|
|
@ -1,9 +1,10 @@
|
||||||
/*
|
/*
|
||||||
* © 2022 Paul M. Antoine
|
* © 2022 Paul M. Antoine
|
||||||
* © 2021 Neil McKechnie
|
* © 2021 Neil McKechnie
|
||||||
* © 2020-2021 Harald Barth
|
* © 2020-2023 Harald Barth
|
||||||
* © 2020-2021 Fred Decker
|
* © 2020-2021 Fred Decker
|
||||||
* © 2020-2021 Chris Harlow
|
* © 2020-2021 Chris Harlow
|
||||||
|
* © 2023 Nathan Kellenicki
|
||||||
*
|
*
|
||||||
* This file is part of CommandStation-EX
|
* This file is part of CommandStation-EX
|
||||||
*
|
*
|
||||||
|
@ -27,6 +28,16 @@ The configuration file for DCC-EX Command Station
|
||||||
|
|
||||||
**********************************************************************/
|
**********************************************************************/
|
||||||
|
|
||||||
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
// If you want to add your own motor driver definition(s), add them here
|
||||||
|
// For example MY_SHIELD with display name "MINE":
|
||||||
|
// (remove comment start and end marker if you want to edit and use that)
|
||||||
|
/*
|
||||||
|
#define MY_SHIELD F("MINE"), \
|
||||||
|
new MotorDriver( 3, 12, UNUSED_PIN, 9, A0, 5.08, 3000, A4), \
|
||||||
|
new MotorDriver(11, 13, UNUSED_PIN, 8, A1, 5.08, 1500, A5)
|
||||||
|
*/
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
// NOTE: Before connecting these boards and selecting one in this software
|
// NOTE: Before connecting these boards and selecting one in this software
|
||||||
// check the quick install guides!!! Some of these boards require a voltage
|
// check the quick install guides!!! Some of these boards require a voltage
|
||||||
|
@ -34,19 +45,34 @@ The configuration file for DCC-EX Command Station
|
||||||
// the correct resistor could damage the sense pin on your Arduino or destroy
|
// the correct resistor could damage the sense pin on your Arduino or destroy
|
||||||
// the device.
|
// the device.
|
||||||
//
|
//
|
||||||
// DEFINE MOTOR_SHIELD_TYPE BELOW ACCORDING TO THE FOLLOWING TABLE:
|
// DEFINE MOTOR_SHIELD_TYPE BELOW. THESE ARE EXAMPLES. FULL LIST IN MotorDrivers.h
|
||||||
//
|
//
|
||||||
// STANDARD_MOTOR_SHIELD : Arduino Motor shield Rev3 based on the L298 with 18V 2A per channel
|
// STANDARD_MOTOR_SHIELD : Arduino Motor shield Rev3 based on the L298 with 18V 2A per channel
|
||||||
// POLOLU_MOTOR_SHIELD : Pololu MC33926 Motor Driver (not recommended for prog track)
|
// POLOLU_MOTOR_SHIELD : Pololu MC33926 Motor Driver (not recommended for prog track)
|
||||||
// POLOLU_TB9051FTG : Pololu Dual TB9051FTG Motor Driver
|
|
||||||
// FUNDUMOTO_SHIELD : Fundumoto Shield, no current sensing (not recommended, no short protection)
|
// FUNDUMOTO_SHIELD : Fundumoto Shield, no current sensing (not recommended, no short protection)
|
||||||
// FIREBOX_MK1 : The Firebox MK1
|
// FIREBOX_MK1 : The Firebox MK1
|
||||||
// FIREBOX_MK1S : The Firebox MK1S
|
// FIREBOX_MK1S : The Firebox MK1S
|
||||||
// IBT_2_WITH_ARDUINO : Arduino Motor Shield for PROG and IBT-2 for MAIN
|
// IBT_2_WITH_ARDUINO : Arduino Motor Shield for PROG and IBT-2 for MAIN
|
||||||
|
// EX8874_SHIELD : DCC-EX TI DRV8874 based motor shield
|
||||||
// |
|
// |
|
||||||
// +-----------------------v
|
// +-----------------------v
|
||||||
//
|
//
|
||||||
#define MOTOR_SHIELD_TYPE STANDARD_MOTOR_SHIELD
|
#define MOTOR_SHIELD_TYPE STANDARD_MOTOR_SHIELD
|
||||||
|
//
|
||||||
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
//
|
||||||
|
// If you want to restrict the maximum current LOWER than what your
|
||||||
|
// motor shield can provide, you can do that here. For example if you
|
||||||
|
// have a motor shield that can provide 5A and your power supply can
|
||||||
|
// only provide 2.5A then you should restict the maximum current to
|
||||||
|
// 2.25A (90% of 2.5A) so that DCC-EX does shut off the track before
|
||||||
|
// your PS does shut DCC-EX. MAX_CURRENT is in mA so for this example
|
||||||
|
// it would be 2250, adjust the number according to your PS. If your
|
||||||
|
// PS has a higher rating than your motor shield you do not need this.
|
||||||
|
// You can use this as well if you are cautious and your trains do not
|
||||||
|
// need full current.
|
||||||
|
// #define MAX_CURRENT 2250
|
||||||
|
//
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
//
|
//
|
||||||
// The IP port to talk to a WIFI or Ethernet shield.
|
// The IP port to talk to a WIFI or Ethernet shield.
|
||||||
|
@ -98,6 +124,11 @@ The configuration file for DCC-EX Command Station
|
||||||
// this line exists or not. If you need to use an alternate channel (we recommend
|
// this line exists or not. If you need to use an alternate channel (we recommend
|
||||||
// using only 1,6, or 11) you may change it here.
|
// using only 1,6, or 11) you may change it here.
|
||||||
#define WIFI_CHANNEL 1
|
#define WIFI_CHANNEL 1
|
||||||
|
//
|
||||||
|
// WIFI_FORCE_AP: If you'd like to specify your own WIFI_SSID in AP mode, set this
|
||||||
|
// true. Otherwise it is assumed that you'd like to connect to an existing network
|
||||||
|
// with that SSID.
|
||||||
|
#define WIFI_FORCE_AP false
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
//
|
//
|
||||||
|
@ -128,7 +159,7 @@ The configuration file for DCC-EX Command Station
|
||||||
//OR define OLED_DRIVER width,height[,address] in pixels (address auto detected if not supplied)
|
//OR define OLED_DRIVER width,height[,address] in pixels (address auto detected if not supplied)
|
||||||
// 128x32 or 128x64 I2C SSD1306-based devices are supported.
|
// 128x32 or 128x64 I2C SSD1306-based devices are supported.
|
||||||
// Use 132,64 for a SH1106-based I2C device with a 128x64 display.
|
// Use 132,64 for a SH1106-based I2C device with a 128x64 display.
|
||||||
// #define OLED_DRIVER 128,32,0x3c
|
// #define OLED_DRIVER 0x3c,128,32
|
||||||
|
|
||||||
// Define scroll mode as 0, 1 or 2
|
// Define scroll mode as 0, 1 or 2
|
||||||
// * #define SCROLLMODE 0 is scroll continuous (fill screen if poss),
|
// * #define SCROLLMODE 0 is scroll continuous (fill screen if poss),
|
||||||
|
@ -141,7 +172,7 @@ The configuration file for DCC-EX Command Station
|
||||||
//
|
//
|
||||||
// If you do not need the EEPROM at all, you can disable all the code that saves
|
// If you do not need the EEPROM at all, you can disable all the code that saves
|
||||||
// data in the EEPROM. You might want to do that if you are in a Arduino UNO
|
// data in the EEPROM. You might want to do that if you are in a Arduino UNO
|
||||||
// and want to use the EX-RAIL automation. Otherwise you do not have enough RAM
|
// and want to use the EXRAIL automation. Otherwise you do not have enough RAM
|
||||||
// to do that. Of course, then none of the EEPROM related commands work.
|
// to do that. Of course, then none of the EEPROM related commands work.
|
||||||
//
|
//
|
||||||
// EEPROM does not work on ESP32. So on ESP32, EEPROM will always be disabled,
|
// EEPROM does not work on ESP32. So on ESP32, EEPROM will always be disabled,
|
||||||
|
@ -149,6 +180,17 @@ The configuration file for DCC-EX Command Station
|
||||||
//
|
//
|
||||||
// #define DISABLE_EEPROM
|
// #define DISABLE_EEPROM
|
||||||
|
|
||||||
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
// DISABLE PROG
|
||||||
|
//
|
||||||
|
// If you do not need programming capability, you can disable all programming related
|
||||||
|
// commands. You might want to do that if you are using an Arduino UNO and still want
|
||||||
|
// to use EXRAIL automation, as the Uno is lacking in RAM and Flash to run both.
|
||||||
|
//
|
||||||
|
// Note this disables all programming functionality, including EXRAIL.
|
||||||
|
//
|
||||||
|
// #define DISABLE_PROG
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
// REDEFINE WHERE SHORT/LONG ADDR break is. According to NMRA the last short address
|
// REDEFINE WHERE SHORT/LONG ADDR break is. According to NMRA the last short address
|
||||||
// is 127 and the first long address is 128. There are manufacturers which have
|
// is 127 and the first long address is 128. There are manufacturers which have
|
||||||
|
@ -224,5 +266,15 @@ The configuration file for DCC-EX Command Station
|
||||||
//
|
//
|
||||||
//#define SERIAL_BT_COMMANDS
|
//#define SERIAL_BT_COMMANDS
|
||||||
|
|
||||||
|
// SABERTOOTH
|
||||||
|
//
|
||||||
|
// This is a very special option and only useful if you happen to have a
|
||||||
|
// sabertooth motor controller from dimension engineering configured to
|
||||||
|
// take commands from and ESP32 via serial at 9600 baud from GPIO17 (TX)
|
||||||
|
// and GPIO16 (RX, currently unused).
|
||||||
|
// The number defined is the DCC address for which speed controls are sent
|
||||||
|
// to the sabertooth controller _as_well_. Default: Undefined.
|
||||||
|
//
|
||||||
|
//#define SABERTOOTH 1
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////////////////////
|
||||||
|
|
169
config.h.txt
169
config.h.txt
|
@ -1,169 +0,0 @@
|
||||||
/**********************************************************************
|
|
||||||
|
|
||||||
Config.h
|
|
||||||
COPYRIGHT (c) 2013-2016 Gregg E. Berman
|
|
||||||
COPYRIGHT (c) 2020 Fred Decker
|
|
||||||
|
|
||||||
The configuration file for DCC++ EX Command Station
|
|
||||||
|
|
||||||
**********************************************************************/
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
// NOTE: Before connecting these boards and selecting one in this software
|
|
||||||
// check the quick install guides!!! Some of these boards require a voltage
|
|
||||||
// generating resitor on the current sense pin of the device. Failure to select
|
|
||||||
// the correct resistor could damage the sense pin on your Arduino or destroy
|
|
||||||
// the device.
|
|
||||||
//
|
|
||||||
// DEFINE MOTOR_SHIELD_TYPE BELOW ACCORDING TO THE FOLLOWING TABLE:
|
|
||||||
//
|
|
||||||
// STANDARD_MOTOR_SHIELD : Arduino Motor shield Rev3 based on the L298 with 18V 2A per channel
|
|
||||||
// POLOLU_MOTOR_SHIELD : Pololu MC33926 Motor Driver (not recommended for prog track)
|
|
||||||
// FUNDUMOTO_SHIELD : Fundumoto Shield, no current sensing (not recommended, no short protection)
|
|
||||||
// FIREBOX_MK1 : The Firebox MK1
|
|
||||||
// FIREBOX_MK1S : The Firebox MK1S
|
|
||||||
// |
|
|
||||||
// +-----------------------v
|
|
||||||
//
|
|
||||||
// #define STANDARD_MOTOR_SHIELD F("STANDARD_MOTOR_SHIELD"),
|
|
||||||
// new MotorDriver(3, 12, UNUSED_PIN, 9, A0, 0.488, 1500, UNUSED_PIN),
|
|
||||||
// new MotorDriver(11, 13, UNUSED_PIN, 8, A1, 0.488, 1500, UNUSED_PIN)
|
|
||||||
|
|
||||||
#define MOTOR_SHIELD_TYPE STANDARD_MOTOR_SHIELD
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// The IP port to talk to a WIFI or Ethernet shield.
|
|
||||||
//
|
|
||||||
#define IP_PORT 2560
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// NOTE: Only supported on Arduino Mega
|
|
||||||
// Set to false if you not even want it on the Arduino Mega
|
|
||||||
//
|
|
||||||
//#define ENABLE_WIFI true
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// DEFINE WiFi Parameters (only in effect if WIFI is on)
|
|
||||||
//
|
|
||||||
// If DONT_TOUCH_WIFI_CONF is set, all WIFI config will be done with
|
|
||||||
// the <+> commands and this sketch will not change anything over
|
|
||||||
// AT commands and the other WIFI_* defines below do not have any effect.
|
|
||||||
//#define DONT_TOUCH_WIFI_CONF
|
|
||||||
//
|
|
||||||
// WIFI_SSID is the network name IF you want to use your existing home network.
|
|
||||||
// Do NOT change this if you want to use the WiFi in Access Point (AP) mode.
|
|
||||||
//
|
|
||||||
// If you do NOT set the WIFI_SSID, the WiFi chip will first try
|
|
||||||
// to connect to the previously configured network and if that fails
|
|
||||||
// fall back to Access Point mode. The SSID of the AP will be
|
|
||||||
// automatically set to DCCEX_*.
|
|
||||||
//
|
|
||||||
// Your SSID may not conain ``"'' (double quote, ASCII 0x22).
|
|
||||||
#define WIFI_SSID "Your network name"
|
|
||||||
//
|
|
||||||
// WIFI_PASSWORD is the network password for your home network or if
|
|
||||||
// you want to change the password from default AP mode password
|
|
||||||
// to the AP password you want.
|
|
||||||
// Your password may not conain ``"'' (double quote, ASCII 0x22).
|
|
||||||
#define WIFI_PASSWORD "deadcafe"
|
|
||||||
//
|
|
||||||
// WIFI_HOSTNAME: You probably don't need to change this
|
|
||||||
#define WIFI_HOSTNAME "dccex"
|
|
||||||
//
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// Wifi connect timeout in milliseconds. Default is 14000 (14 seconds). You only need
|
|
||||||
// to set this if you have an extremely slow Wifi router.
|
|
||||||
//
|
|
||||||
#define WIFI_CONNECT_TIMEOUT 14000
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// ENABLE_ETHERNET: Set to true if you have an Arduino Ethernet card (wired). This
|
|
||||||
// is not for Wifi. You will then need the Arduino Ethernet library as well
|
|
||||||
//
|
|
||||||
//#define ENABLE_ETHERNET true
|
|
||||||
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// DEFINE STATIC IP ADDRESS *OR* COMMENT OUT TO USE DHCP
|
|
||||||
//
|
|
||||||
//#define IP_ADDRESS { 192, 168, 1, 31 }
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// DEFINE MAC ADDRESS ARRAY FOR ETHERNET COMMUNICATIONS INTERFACE
|
|
||||||
//
|
|
||||||
// Uncomment to use with Ethernet Shields
|
|
||||||
//
|
|
||||||
// Ethernet Shields do not have have a MAC address in hardware. There may be one on
|
|
||||||
// a sticker on the Shield that you should use. Otherwise choose one of the ones below
|
|
||||||
// Be certain that no other device on your network has this same MAC address!
|
|
||||||
//
|
|
||||||
// 52:b8:8a:8e:ce:21
|
|
||||||
// e3:e9:73:e1:db:0d
|
|
||||||
// 54:2b:13:52:ac:0c
|
|
||||||
|
|
||||||
// NOTE: This is not used with ESP8266 WiFi modules.
|
|
||||||
|
|
||||||
//#define MAC_ADDRESS { 0x52, 0xB8, 0x8A, 0x8E, 0xCE, 0x21 } // MAC address of your networking card found on the sticker on your card or take one from above
|
|
||||||
|
|
||||||
//
|
|
||||||
// #define MAC_ADDRESS { 0xDE, 0xAD, 0xBE, 0xEF, 0xFE, 0xEF }
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// DEFINE LCD SCREEN USAGE BY THE BASE STATION
|
|
||||||
//
|
|
||||||
// Note: This feature requires an I2C enabled LCD screen using a Hitachi HD44780
|
|
||||||
// controller and a PCF8574 based I2C 'backpack',
|
|
||||||
// OR an I2C Oled screen based on SSD1306 (128x64 or 128x32) controller,
|
|
||||||
// OR an I2C Oled screen based on SH1106 (132x64) controller.
|
|
||||||
// To enable, uncomment one of the lines below
|
|
||||||
|
|
||||||
// define LCD_DRIVER for I2C LCD address 0x3f,16 cols, 2 rows
|
|
||||||
//#define LCD_DRIVER {SubBus_4,0x27},20,4
|
|
||||||
|
|
||||||
//OR define OLED_DRIVER width,height in pixels (address auto detected)
|
|
||||||
#if defined(ARDUINO_ARCH_STM32)
|
|
||||||
#define OLED_DRIVER 0x3c, 128, 64
|
|
||||||
#else
|
|
||||||
#define OLED_DRIVER {SubBus_0,0x3c}, 128, 32
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#define SCROLLMODE 1
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
// DISABLE EEPROM
|
|
||||||
//
|
|
||||||
// If you do not need the EEPROM at all, you can disable all the code that saves
|
|
||||||
// data in the EEPROM. You might want to do that if you are in a Arduino UNO
|
|
||||||
// and want to use the EX-RAIL automation. Otherwise you do not have enough RAM
|
|
||||||
// to do that. Of course, then none of the EEPROM related commands work.
|
|
||||||
//
|
|
||||||
#define DISABLE_EEPROM
|
|
||||||
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// DEFINE TURNOUTS/ACCESSORIES FOLLOW NORM RCN-213
|
|
||||||
//
|
|
||||||
// According to norm RCN-213 a DCC packet with a 1 is closed/straight
|
|
||||||
// and one with a 0 is thrown/diverging. In DCC++ Classic, and in previous
|
|
||||||
// versions of DCC++EX, a turnout throw command was implemented in the packet as
|
|
||||||
// '1' and a close command as '0'. The #define below makes the states
|
|
||||||
// match with the norm. But we don't want to cause havoc on existent layouts,
|
|
||||||
// so we define this only for new installations. If you don't want this,
|
|
||||||
// don't add it to your config.h.
|
|
||||||
//#define DCC_TURNOUTS_RCN_213
|
|
||||||
|
|
||||||
// The following #define likewise inverts the behaviour of the <a> command
|
|
||||||
// for triggering DCC Accessory Decoders, so that <a addr subaddr 0> generates a
|
|
||||||
// DCC packet with D=1 (close turnout) and <a addr subaddr 1> generates D=0
|
|
||||||
// (throw turnout).
|
|
||||||
//#define DCC_ACCESSORY_RCN_213
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////////////////////
|
|
31
defines.h
31
defines.h
|
@ -144,10 +144,9 @@
|
||||||
#define DISABLE_EEPROM
|
#define DISABLE_EEPROM
|
||||||
#endif
|
#endif
|
||||||
// STM32 support for native I2C is awaiting development
|
// STM32 support for native I2C is awaiting development
|
||||||
#ifndef I2C_USE_WIRE
|
// #ifndef I2C_USE_WIRE
|
||||||
#define I2C_USE_WIRE
|
// #define I2C_USE_WIRE
|
||||||
#endif
|
// #endif
|
||||||
|
|
||||||
|
|
||||||
/* TODO when ready
|
/* TODO when ready
|
||||||
#elif defined(ARDUINO_ARCH_RP2040)
|
#elif defined(ARDUINO_ARCH_RP2040)
|
||||||
|
@ -183,6 +182,15 @@
|
||||||
#define WIFI_ON false
|
#define WIFI_ON false
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifndef WIFI_FORCE_AP
|
||||||
|
#define WIFI_FORCE_AP false
|
||||||
|
#else
|
||||||
|
#if WIFI_FORCE_AP==true || WIFI_FORCE_AP==false
|
||||||
|
#else
|
||||||
|
#error WIFI_FORCE_AP needs to be true or false
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
#if ENABLE_ETHERNET
|
#if ENABLE_ETHERNET
|
||||||
#if defined(HAS_ENOUGH_MEMORY)
|
#if defined(HAS_ENOUGH_MEMORY)
|
||||||
#define ETHERNET_ON true
|
#define ETHERNET_ON true
|
||||||
|
@ -205,8 +213,21 @@
|
||||||
//
|
//
|
||||||
#define WIFI_SERIAL_LINK_SPEED 115200
|
#define WIFI_SERIAL_LINK_SPEED 115200
|
||||||
|
|
||||||
|
////////////////////////////////////////////////////////////////////////////////
|
||||||
|
//
|
||||||
|
// Define symbol IO_NO_HAL to reduce FLASH footprint when HAL features not required
|
||||||
|
// The HAL is disabled by default on Nano and Uno platforms, because of limited flash space.
|
||||||
|
//
|
||||||
|
#if defined(ARDUINO_AVR_NANO) || defined(ARDUINO_AVR_UNO)
|
||||||
|
#if defined(DISABLE_DIAG) && defined(DISABLE_EEPROM) && defined(DISABLE_PROG)
|
||||||
|
#warning you have sacrificed DIAG for HAL
|
||||||
|
#else
|
||||||
|
#define IO_NO_HAL
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
#if __has_include ( "myAutomation.h")
|
#if __has_include ( "myAutomation.h")
|
||||||
#if defined(HAS_ENOUGH_MEMORY) || defined(DISABLE_EEPROM)
|
#if defined(HAS_ENOUGH_MEMORY) || defined(DISABLE_EEPROM) || defined(DISABLE_PROG)
|
||||||
#define EXRAIL_ACTIVE
|
#define EXRAIL_ACTIVE
|
||||||
#else
|
#else
|
||||||
#define EXRAIL_WARNING
|
#define EXRAIL_WARNING
|
||||||
|
|
13
install_via_powershell.cmd
Normal file
13
install_via_powershell.cmd
Normal file
|
@ -0,0 +1,13 @@
|
||||||
|
@ECHO OFF
|
||||||
|
|
||||||
|
FOR /f "tokens=*" %%a IN ('powershell Get-ExecutionPolicy -Scope CurrentUser') DO SET PS_POLICY=%%a
|
||||||
|
|
||||||
|
IF NOT %PS_POLICY=="Bypass" (
|
||||||
|
powershell Set-ExecutionPolicy -Scope CurrentUser Bypass
|
||||||
|
)
|
||||||
|
|
||||||
|
powershell %~dp0%installer.ps1
|
||||||
|
|
||||||
|
IF NOT %PS_POLICY=="Bypass" (
|
||||||
|
powershell Set-ExecutionPolicy -Scope CurrentUser %PS_POLICY%
|
||||||
|
)
|
540
installer.ps1
Normal file
540
installer.ps1
Normal file
|
@ -0,0 +1,540 @@
|
||||||
|
<#
|
||||||
|
# © 2023 Peter Cole
|
||||||
|
#
|
||||||
|
# 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/>.
|
||||||
|
#>
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
For script errors set ExecutionPolicy:
|
||||||
|
Set-ExecutionPolicy -Scope CurrentUser -ExecutionPolicy Bypass
|
||||||
|
############################################>
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Optional command line parameters:
|
||||||
|
$buildDirectory - specify an existing directory rather than generating a new unique one
|
||||||
|
$configDirectory - specify a directory containing existing files as per $configFiles
|
||||||
|
############################################>
|
||||||
|
Param(
|
||||||
|
[Parameter()]
|
||||||
|
[String]$buildDirectory,
|
||||||
|
[Parameter()]
|
||||||
|
[String]$configDirectory
|
||||||
|
)
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Define global parameters here such as known URLs etc.
|
||||||
|
############################################>
|
||||||
|
$installerVersion = "v0.0.8"
|
||||||
|
$configFiles = @("config.h", "myAutomation.h", "myHal.cpp", "mySetup.h")
|
||||||
|
$wifiBoards = @("arduino:avr:mega", "esp32:esp32:esp32")
|
||||||
|
$userDirectory = $env:USERPROFILE + "\"
|
||||||
|
$gitHubAPITags = "https://api.github.com/repos/DCC-EX/CommandStation-EX/git/refs/tags"
|
||||||
|
$gitHubURLPrefix = "https://github.com/DCC-EX/CommandStation-EX/archive/"
|
||||||
|
if ((Get-WmiObject win32_operatingsystem | Select-Object osarchitecture).osarchitecture -eq "64-bit") {
|
||||||
|
$arduinoCLIURL = "https://downloads.arduino.cc/arduino-cli/arduino-cli_latest_Windows_64bit.zip"
|
||||||
|
$arduinoCLIZip = $userDirectory + "Downloads\" + "arduino-cli_latest_Windows_64bit.zip"
|
||||||
|
} else {
|
||||||
|
$arduinoCLIURL = "https://downloads.arduino.cc/arduino-cli/arduino-cli_latest_Windows_32bit.zip"
|
||||||
|
$arduinoCLIZip = $userDirectory + "Downloads\" + "arduino-cli_latest_Windows_32bit.zip"
|
||||||
|
}
|
||||||
|
$arduinoCLIDirectory = $userDirectory + "arduino-cli"
|
||||||
|
$arduinoCLI = $arduinoCLIDirectory + "\arduino-cli.exe"
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
List of supported devices with FQBN in case clones used that aren't detected
|
||||||
|
############################################>
|
||||||
|
$supportedDevices = @(
|
||||||
|
@{
|
||||||
|
name = "Arduino Mega or Mega 2560"
|
||||||
|
fqbn = "arduino:avr:mega"
|
||||||
|
},
|
||||||
|
@{
|
||||||
|
name = "Arduino Nano"
|
||||||
|
fqbn = "arduino:avr:nano"
|
||||||
|
},
|
||||||
|
@{
|
||||||
|
name = "Arduino Uno"
|
||||||
|
fqbn = "arduino:avr:uno"
|
||||||
|
},
|
||||||
|
@{
|
||||||
|
name = "ESP32 Dev Module"
|
||||||
|
fqbn = "esp32:esp32:esp32"
|
||||||
|
}
|
||||||
|
)
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
List of supported displays
|
||||||
|
############################################>
|
||||||
|
$displayList = @(
|
||||||
|
@{
|
||||||
|
option = "LCD 16 columns x 2 rows"
|
||||||
|
configLine = "#define LCD_DRIVER 0x27,16,2"
|
||||||
|
},
|
||||||
|
@{
|
||||||
|
option = "LCD 16 columns x 4 rows"
|
||||||
|
configLine = "#define LCD_DRIVER 0x27,16,4"
|
||||||
|
},
|
||||||
|
@{
|
||||||
|
option = "OLED 128 x 32"
|
||||||
|
configLine = "#define OLED_DRIVER 128,32"
|
||||||
|
},
|
||||||
|
@{
|
||||||
|
option = "OLED 128 x 64"
|
||||||
|
configLine = "#define OLED_DRIVER 128,64"
|
||||||
|
}
|
||||||
|
)
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Basics of config.h
|
||||||
|
############################################>
|
||||||
|
$configLines = @(
|
||||||
|
"/*",
|
||||||
|
"This config.h file was generated by the DCC-EX PowerShell installer $installerVersion",
|
||||||
|
"*/",
|
||||||
|
"",
|
||||||
|
"// Define standard motor shield",
|
||||||
|
"#define MOTOR_SHIELD_TYPE STANDARD_MOTOR_SHIELD",
|
||||||
|
""
|
||||||
|
)
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Set default action for progress indicators, warnings, and errors
|
||||||
|
############################################>
|
||||||
|
$global:ProgressPreference = "SilentlyContinue"
|
||||||
|
$global:WarningPreference = "SilentlyContinue"
|
||||||
|
$global:ErrorActionPreference = "SilentlyContinue"
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
If $buildDirectory not provided, generate a new time/date stamp based directory to use
|
||||||
|
############################################>
|
||||||
|
if (!$PSBoundParameters.ContainsKey('buildDirectory')) {
|
||||||
|
$buildDate = Get-Date -Format 'yyyyMMdd-HHmmss'
|
||||||
|
$buildDirectory = $userDirectory + "EX-CommandStation-Installer\" + $buildDate
|
||||||
|
}
|
||||||
|
$commandStationDirectory = $buildDirectory + "\CommandStation-EX"
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Write out intro message and prompt to continue
|
||||||
|
############################################>
|
||||||
|
@"
|
||||||
|
Welcome to the DCC-EX PowerShell installer for EX-CommandStation ($installerVersion)
|
||||||
|
|
||||||
|
Current installer options:
|
||||||
|
|
||||||
|
- EX-CommandStation will be built in $commandStationDirectory
|
||||||
|
- Arduino CLI will downloaded and extracted to $arduinoCLIDirectory
|
||||||
|
|
||||||
|
Before continuing, please ensure:
|
||||||
|
|
||||||
|
- Your computer is connected to the internet
|
||||||
|
- The device you wish to install EX-CommandStation on is connected to a USB port
|
||||||
|
|
||||||
|
This installer will obtain the Arduino CLI (if not already present), and then download and install your chosen version of EX-CommandStation
|
||||||
|
|
||||||
|
"@
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Prompt user to confirm all is ready to proceed
|
||||||
|
############################################>
|
||||||
|
$confirmation = Read-Host "Enter 'Y' or 'y' then press <Enter> to confirm you are ready to proceed, any other key to exit"
|
||||||
|
if ($confirmation -ne "Y" -and $confirmation -ne "y") {
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
See if we have the Arduino CLI already, otherwise download and extract it
|
||||||
|
############################################>
|
||||||
|
if (!(Test-Path -PathType Leaf -Path $arduinoCLI)) {
|
||||||
|
if (!(Test-Path -PathType Container -Path $arduinoCLIDirectory)) {
|
||||||
|
try {
|
||||||
|
New-Item -ItemType Directory -Path $arduinoCLIDirectory | Out-Null
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Arduino CLI does not exist and cannot create directory $arduinoCLIDirectory"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
}
|
||||||
|
Write-Output "`r`nDownloading and extracting Arduino CLI"
|
||||||
|
try {
|
||||||
|
Invoke-WebRequest -Uri $arduinoCLIURL -OutFile $arduinoCLIZip
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to download Arduino CLI"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
try {
|
||||||
|
Expand-Archive -Path $arduinoCLIZip -DestinationPath $arduinoCLIDirectory -Force
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to extract Arduino CLI"
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
Write-Output "`r`nArduino CLI already downloaded, ensuring it is up to date and you have a board connected"
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Make sure Arduino CLI core index updated and list of boards populated
|
||||||
|
############################################>
|
||||||
|
# Need to do an initial board list to download everything first
|
||||||
|
try {
|
||||||
|
& $arduinoCLI core update-index | Out-Null
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to update Arduino CLI core index"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
# Need to do an initial board list to download everything first
|
||||||
|
try {
|
||||||
|
& $arduinoCLI board list | Out-Null
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to update Arduino CLI board list"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Identify available board(s)
|
||||||
|
############################################>
|
||||||
|
try {
|
||||||
|
$boardList = & $arduinoCLI board list --format jsonmini | ConvertFrom-Json
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to obtain list of boards"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Get user to select board
|
||||||
|
############################################>
|
||||||
|
if ($boardList.count -eq 0) {
|
||||||
|
Write-Output "Could not find any attached devices, please ensure your device is plugged in to a USB port and Windows recognises it"
|
||||||
|
Exit
|
||||||
|
} else {
|
||||||
|
@"
|
||||||
|
|
||||||
|
Devices attached to COM ports:
|
||||||
|
------------------------------
|
||||||
|
"@
|
||||||
|
|
||||||
|
$boardSelect = 1
|
||||||
|
foreach ($board in $boardList) {
|
||||||
|
if ($board.matching_boards.name) {
|
||||||
|
$boardName = $board.matching_boards.name
|
||||||
|
} else {
|
||||||
|
$boardName = "Unknown device"
|
||||||
|
}
|
||||||
|
$port = $board.port.address
|
||||||
|
Write-Output "$boardSelect - $boardName on port $port"
|
||||||
|
$boardSelect++
|
||||||
|
}
|
||||||
|
Write-Output "$boardSelect - Exit"
|
||||||
|
$userSelection = 0
|
||||||
|
do {
|
||||||
|
[int]$userSelection = Read-Host "`r`nSelect the device to use from the list above"
|
||||||
|
} until (
|
||||||
|
(($userSelection -ge 1) -and ($userSelection -le ($boardList.count + 1)))
|
||||||
|
)
|
||||||
|
if ($userSelection -eq ($boardList.count + 1)) {
|
||||||
|
Write-Output "Exiting installer"
|
||||||
|
Exit
|
||||||
|
} else {
|
||||||
|
$selectedBoard = $userSelection - 1
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
If the board is unknown, need to choose which one
|
||||||
|
############################################>
|
||||||
|
if ($null -eq $boardList[$selectedBoard].matching_boards.name) {
|
||||||
|
Write-Output "The device selected is unknown, these boards are supported:`r`n"
|
||||||
|
$deviceSelect = 1
|
||||||
|
foreach ($device in $supportedDevices) {
|
||||||
|
Write-Output "$deviceSelect - $($supportedDevices[$deviceSelect - 1].name)"
|
||||||
|
$deviceSelect++
|
||||||
|
}
|
||||||
|
Write-Output "$deviceSelect - Exit"
|
||||||
|
$userSelection = 0
|
||||||
|
do {
|
||||||
|
[int]$userSelection = Read-Host "Select the board type from the list above"
|
||||||
|
} until (
|
||||||
|
(($userSelection -ge 1) -and ($userSelection -le ($supportedDevices.count + 1)))
|
||||||
|
)
|
||||||
|
if ($userSelection -eq ($supportedDevices.count + 1)) {
|
||||||
|
Write-Output "Exiting installer"
|
||||||
|
Exit
|
||||||
|
} else {
|
||||||
|
$deviceName = $supportedDevices[$userSelection - 1].name
|
||||||
|
$deviceFQBN = $supportedDevices[$userSelection - 1].fqbn
|
||||||
|
$devicePort = $boardList[$selectedBoard].port.address
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
$deviceName = $boardList[$selectedBoard].matching_boards.name
|
||||||
|
$deviceFQBN = $boardList[$selectedBoard].matching_boards.fqbn
|
||||||
|
$devicePort = $boardList[$selectedBoard].port.address
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Get the list of tags
|
||||||
|
############################################>
|
||||||
|
try {
|
||||||
|
$gitHubTags = Invoke-RestMethod -Uri $gitHubAPITags
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to obtain list of available EX-CommandStation versions"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Get our GitHub tag list in a hash so we can sort by version numbers and extract just the ones we want
|
||||||
|
############################################>
|
||||||
|
$versionMatch = ".*?v(\d+)\.(\d+).(\d+)-(.*)"
|
||||||
|
$tagList = @{}
|
||||||
|
foreach ($tag in $gitHubTags) {
|
||||||
|
$tagHash = @{}
|
||||||
|
$tagHash["Ref"] = $tag.ref
|
||||||
|
$version = $tag.ref.split("/")[2]
|
||||||
|
$null = $version -match $versionMatch
|
||||||
|
$tagHash["Major"] = [int]$Matches[1]
|
||||||
|
$tagHash["Minor"] = [int]$Matches[2]
|
||||||
|
$tagHash["Patch"] = [int]$Matches[3]
|
||||||
|
$tagHash["Type"] = $Matches[4]
|
||||||
|
$tagList.Add($version, $tagHash)
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Get latest two Prod and Devel for user to select
|
||||||
|
############################################>
|
||||||
|
$userList = @{}
|
||||||
|
$prodCount = 1
|
||||||
|
$devCount = 1
|
||||||
|
$select = 1
|
||||||
|
foreach ($tag in $tagList.Keys | Sort-Object {$tagList[$_]["Major"]},{$tagList[$_]["Minor"]},{$tagList[$_]["Patch"]} -Descending) {
|
||||||
|
if (($tagList[$tag]["Type"] -eq "Prod") -and $prodCount -le 2) {
|
||||||
|
$userList[$select] = $tag
|
||||||
|
$select++
|
||||||
|
$prodCount++
|
||||||
|
} elseif (($tagList[$tag]["Type"] -eq "Devel") -and $devCount -le 2) {
|
||||||
|
$userList[$select] = $tag
|
||||||
|
$select++
|
||||||
|
$devCount++
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Display options for user to select and get the selection
|
||||||
|
############################################>
|
||||||
|
@"
|
||||||
|
|
||||||
|
Available EX-CommandStation versions:
|
||||||
|
-------------------------------------
|
||||||
|
"@
|
||||||
|
foreach ($selection in $userList.Keys | Sort-Object $selection) {
|
||||||
|
Write-Output "$selection - $($userList[$selection])"
|
||||||
|
}
|
||||||
|
Write-Output "5 - Exit"
|
||||||
|
$userSelection = 0
|
||||||
|
do {
|
||||||
|
[int]$userSelection = Read-Host "`r`nSelect the version to install from the list above (1 - 5)"
|
||||||
|
} until (
|
||||||
|
(($userSelection -ge 1) -and ($userSelection -le 5))
|
||||||
|
)
|
||||||
|
if ($userSelection -eq 5) {
|
||||||
|
Write-Output "Exiting installer"
|
||||||
|
Exit
|
||||||
|
} else {
|
||||||
|
$downloadURL = $gitHubURLPrefix + $tagList[$userList[$userSelection]]["Ref"] + ".zip"
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Create build directory if it doesn't exist, or fail
|
||||||
|
############################################>
|
||||||
|
if (!(Test-Path -PathType Container -Path $buildDirectory)) {
|
||||||
|
try {
|
||||||
|
New-Item -ItemType Directory -Path $buildDirectory | Out-Null
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Could not create build directory $buildDirectory"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Download the chosen version to the build directory
|
||||||
|
############################################>
|
||||||
|
$downladFile = $buildDirectory + "\CommandStation-EX.zip"
|
||||||
|
Write-Output "Downloading and extracting $($userList[$userSelection])"
|
||||||
|
try {
|
||||||
|
Invoke-WebRequest -Uri $downloadURL -OutFile $downladFile
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Error downloading EX-CommandStation zip file"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
If folder exists, bail out and tell user
|
||||||
|
############################################>
|
||||||
|
if (Test-Path -PathType Container -Path "$buildDirectory\CommandStation-EX") {
|
||||||
|
Write-Output "EX-CommandStation directory already exists, please ensure you have copied any user files then delete manually: $buildDirectory\CommandStation-EX"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Extract and rename to CommandStation-EX to allow building
|
||||||
|
############################################>
|
||||||
|
try {
|
||||||
|
Expand-Archive -Path $downladFile -DestinationPath $buildDirectory -Force
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to extract EX-CommandStation zip file"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
$folderName = $buildDirectory + "\CommandStation-EX-" + ($userList[$userSelection] -replace "^v", "")
|
||||||
|
try {
|
||||||
|
Rename-Item -Path $folderName -NewName $commandStationDirectory
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Could not rename folder"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
If config directory provided, copy files here
|
||||||
|
############################################>
|
||||||
|
if ($PSBoundParameters.ContainsKey('configDirectory')) {
|
||||||
|
if (Test-Path -PathType Container -Path $configDirectory) {
|
||||||
|
foreach ($file in $configFiles) {
|
||||||
|
if (Test-Path -PathType Leaf -Path "$configDirectory\$file") {
|
||||||
|
Copy-Item -Path "$configDirectory\$file" -Destination "$commandStationDirectory\$file"
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
Write-Output "User provided configuration directory $configDirectory does not exist, skipping"
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
If no config directory provided, prompt for display option
|
||||||
|
############################################>
|
||||||
|
Write-Output "`r`nIf you have an LCD or OLED display connected, you can configure it here`r`n"
|
||||||
|
Write-Output "1 - I have no display, skip this step"
|
||||||
|
$displaySelect = 2
|
||||||
|
foreach ($display in $displayList) {
|
||||||
|
Write-Output "$displaySelect - $($displayList[$displaySelect - 2].option)"
|
||||||
|
$displaySelect++
|
||||||
|
}
|
||||||
|
Write-Output "$($displayList.Count + 2) - Exit"
|
||||||
|
do {
|
||||||
|
[int]$displayChoice = Read-Host "`r`nSelect a display option"
|
||||||
|
} until (
|
||||||
|
($displayChoice -ge 1 -and $displayChoice -le ($displayList.Count + 2))
|
||||||
|
)
|
||||||
|
if ($displayChoice -eq ($displayList.Count + 2)) {
|
||||||
|
Exit
|
||||||
|
} elseif ($displayChoice -ge 2) {
|
||||||
|
$configLines+= "// Display configuration"
|
||||||
|
$configLines+= "$($displayList[$displayChoice - 2].configLine)"
|
||||||
|
$configLines+= "#define SCROLLMODE 1 // Alternate between pages"
|
||||||
|
}
|
||||||
|
<############################################
|
||||||
|
If device supports WiFi, prompt to configure
|
||||||
|
############################################>
|
||||||
|
if ($wifiBoards.Contains($deviceFQBN)) {
|
||||||
|
Write-Output "`r`nYour chosen board supports WiFi`r`n"
|
||||||
|
Write-Output "1 - I don't want WiFi, skip this step
|
||||||
|
2 - Configure my device as an access point I will connect to directly
|
||||||
|
3 - Configure my device to connect to my home WiFi network
|
||||||
|
4 - Exit"
|
||||||
|
do {
|
||||||
|
[int]$wifiChoice = Read-Host "`r`nSelect a WiFi option"
|
||||||
|
} until (
|
||||||
|
($wifiChoice -ge 1 -and $wifiChoice -le 4)
|
||||||
|
)
|
||||||
|
if ($wifiChoice -eq 4) {
|
||||||
|
Exit
|
||||||
|
} elseif ($wifiChoice -ne 1) {
|
||||||
|
$configLines+= ""
|
||||||
|
$configLines+= "// WiFi configuration"
|
||||||
|
$configLines+= "#define ENABLE_WIFI true"
|
||||||
|
$configLines+= "#define IP_PORT 2560"
|
||||||
|
$configLines+= "#define WIFI_HOSTNAME ""dccex"""
|
||||||
|
$configLines+= "#define WIFI_CHANNEL 1"
|
||||||
|
if ($wifiChoice -eq 2) {
|
||||||
|
$configLines+= "#define WIFI_SSID ""Your network name"""
|
||||||
|
$configLines+= "#define WIFI_PASSWORD ""Your network passwd"""
|
||||||
|
}
|
||||||
|
if ($wifiChoice -eq 3) {
|
||||||
|
$wifiSSID = Read-Host "Please enter the SSID of your home network here"
|
||||||
|
$wifiPassword = Read-Host "Please enter your home network WiFi password here"
|
||||||
|
$configLines+= "#define WIFI_SSID ""$($wifiSSID)"""
|
||||||
|
$configLines+= "#define WIFI_PASSWORD ""$($wifiPassword)"""
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Write out config.h to a file here only if config directory not provided
|
||||||
|
############################################>
|
||||||
|
$configH = $commandStationDirectory + "\config.h"
|
||||||
|
try {
|
||||||
|
$configLines | Out-File -FilePath $configH -Encoding ascii
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Error writing config file to $configH"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Install core libraries for the platform
|
||||||
|
############################################>
|
||||||
|
$platformArray = $deviceFQBN.split(":")
|
||||||
|
$platform = $platformArray[0] + ":" + $platformArray[1]
|
||||||
|
try {
|
||||||
|
& $arduinoCLI core install $platform
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Error install core libraries"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
|
||||||
|
<############################################
|
||||||
|
Upload the sketch to the selected board
|
||||||
|
############################################>
|
||||||
|
#$arduinoCLI upload -b fqbn -p port $commandStationDirectory
|
||||||
|
Write-Output "Compiling and uploading to $deviceName on $devicePort"
|
||||||
|
try {
|
||||||
|
$output = & $arduinoCLI compile -b $deviceFQBN -u -t -p $devicePort $commandStationDirectory --format jsonmini | ConvertFrom-Json
|
||||||
|
}
|
||||||
|
catch {
|
||||||
|
Write-Output "Failed to compile"
|
||||||
|
Exit
|
||||||
|
}
|
||||||
|
if ($output.success -eq "True") {
|
||||||
|
Write-Output "`r`nCongratulations! DCC-EX EX-CommandStation $($userList[$userSelection]) has been installed on your $deviceName`r`n"
|
||||||
|
} else {
|
||||||
|
Write-Output "`r`nThere was an error installing $($userList[$userSelection]) on your $($deviceName), please take note of the errors provided:`r`n"
|
||||||
|
if ($null -ne $output.compiler_err) {
|
||||||
|
Write-Output "Compiler error: $($output.compiler_err)`r`n"
|
||||||
|
}
|
||||||
|
if ($null -ne $output.builder_result) {
|
||||||
|
Write-Output "Builder result: $($output.builder_result)`r`n"
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
Write-Output "`r`nPress any key to exit the installer"
|
||||||
|
[void][System.Console]::ReadKey($true)
|
25
installer.sh
25
installer.sh
|
@ -1,7 +1,7 @@
|
||||||
#!/bin/bash
|
#!/bin/bash
|
||||||
|
|
||||||
#
|
#
|
||||||
# © 2022 Harald Barth
|
# © 2022,2023 Harald Barth
|
||||||
#
|
#
|
||||||
# This file is part of CommandStation-EX
|
# This file is part of CommandStation-EX
|
||||||
#
|
#
|
||||||
|
@ -29,14 +29,33 @@ ACLI="./bin/arduino-cli"
|
||||||
|
|
||||||
function need () {
|
function need () {
|
||||||
type -p $1 > /dev/null && return
|
type -p $1 > /dev/null && return
|
||||||
|
dpkg -l $1 2>&1 | egrep ^ii >/dev/null && return
|
||||||
sudo apt-get install $1
|
sudo apt-get install $1
|
||||||
type -p $1 > /dev/null && return
|
type -p $1 > /dev/null && return
|
||||||
echo "Could not install $1, abort"
|
echo "Could not install $1, abort"
|
||||||
exit 255
|
exit 255
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
need git
|
need git
|
||||||
|
|
||||||
|
if cat /etc/issue | egrep '^Raspbian' 2>&1 >/dev/null ; then
|
||||||
|
# we are on a raspi where we do not support graphical
|
||||||
|
unset DISPLAY
|
||||||
|
fi
|
||||||
|
|
||||||
|
if [ x$DISPLAY != x ] ; then
|
||||||
|
# we have DISPLAY, do the graphic thing
|
||||||
|
need python3-tk
|
||||||
|
need python3.8-venv
|
||||||
|
mkdir -p ~/ex-installer/venv
|
||||||
|
python3 -m venv ~/ex-installer/venv
|
||||||
|
cd ~/ex-installer/venv || exit 255
|
||||||
|
source ./bin/activate
|
||||||
|
git clone https://github.com/DCC-EX/EX-Installer
|
||||||
|
cd EX-Installer || exit 255
|
||||||
|
pip3 install -r requirements.txt
|
||||||
|
exec python3 -m ex_installer
|
||||||
|
fi
|
||||||
if test -d `basename "$DCCEXGITURL"` ; then
|
if test -d `basename "$DCCEXGITURL"` ; then
|
||||||
: assume we are almost there
|
: assume we are almost there
|
||||||
cd `basename "$DCCEXGITURL"` || exit 255
|
cd `basename "$DCCEXGITURL"` || exit 255
|
||||||
|
@ -69,10 +88,10 @@ else
|
||||||
# need to do this config better
|
# need to do this config better
|
||||||
cp -p config.example.h config.h
|
cp -p config.example.h config.h
|
||||||
fi
|
fi
|
||||||
need curl
|
|
||||||
if test -x "$ACLI" ; then
|
if test -x "$ACLI" ; then
|
||||||
: all well
|
: all well
|
||||||
else
|
else
|
||||||
|
need curl
|
||||||
curl "$ACLIINSTALL" > acliinstall.sh
|
curl "$ACLIINSTALL" > acliinstall.sh
|
||||||
chmod +x acliinstall.sh
|
chmod +x acliinstall.sh
|
||||||
./acliinstall.sh
|
./acliinstall.sh
|
||||||
|
|
|
@ -24,6 +24,7 @@
|
||||||
//#include "IO_TouchKeypad.h // Touch keypad with 16 keys
|
//#include "IO_TouchKeypad.h // Touch keypad with 16 keys
|
||||||
//#include "IO_EXTurntable.h" // Turntable-EX turntable controller
|
//#include "IO_EXTurntable.h" // Turntable-EX turntable controller
|
||||||
//#include "IO_EXFastClock.h" // FastClock driver
|
//#include "IO_EXFastClock.h" // FastClock driver
|
||||||
|
//#include "IO_PCA9555.h" // 16-bit I/O expander (NXP & Texas Instruments).
|
||||||
|
|
||||||
//==========================================================================
|
//==========================================================================
|
||||||
// The function halSetup() is invoked from CS if it exists within the build.
|
// The function halSetup() is invoked from CS if it exists within the build.
|
||||||
|
@ -51,7 +52,7 @@ void halSetup() {
|
||||||
// Create a 20x4 LCD display device as display number 2
|
// Create a 20x4 LCD display device as display number 2
|
||||||
// (line 0 is written by EX-RAIL 'SCREEN(2, 0, "text")').
|
// (line 0 is written by EX-RAIL 'SCREEN(2, 0, "text")').
|
||||||
|
|
||||||
// HALDisplay<LiquidCrystal>(2, 0x27, 20, 4);
|
// HALDisplay<LiquidCrystal>::create(2, 0x27, 20, 4);
|
||||||
|
|
||||||
|
|
||||||
//=======================================================================
|
//=======================================================================
|
||||||
|
|
101
platformio.ini
101
platformio.ini
|
@ -20,18 +20,17 @@ default_envs =
|
||||||
ESP32
|
ESP32
|
||||||
Nucleo-F411RE
|
Nucleo-F411RE
|
||||||
Nucleo-F446RE
|
Nucleo-F446RE
|
||||||
Teensy3.2
|
Teensy3_2
|
||||||
Teensy3.5
|
Teensy3_5
|
||||||
Teensy3.6
|
Teensy3_6
|
||||||
Teensy4.0
|
Teensy4_0
|
||||||
Teensy4.1
|
Teensy4_1
|
||||||
src_dir = .
|
src_dir = .
|
||||||
include_dir = .
|
include_dir = .
|
||||||
|
|
||||||
[env]
|
[env]
|
||||||
build_flags = -Wall -Wextra
|
build_flags = -Wall -Wextra
|
||||||
monitor_filters = time
|
; monitor_filters = time
|
||||||
; lib_deps = adafruit/Adafruit ST7735 and ST7789 Library @ ^1.10.0
|
|
||||||
|
|
||||||
[env:samd21-dev-usb]
|
[env:samd21-dev-usb]
|
||||||
platform = atmelsam
|
platform = atmelsam
|
||||||
|
@ -53,14 +52,14 @@ monitor_speed = 115200
|
||||||
monitor_echo = yes
|
monitor_echo = yes
|
||||||
build_flags = -std=c++17
|
build_flags = -std=c++17
|
||||||
|
|
||||||
[env:Arduino M0]
|
[env:Arduino-M0]
|
||||||
platform = atmelsam
|
platform = atmelsam
|
||||||
board = mzeroUSB
|
board = mzeroUSB
|
||||||
framework = arduino
|
framework = arduino
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
monitor_speed = 115200
|
monitor_speed = 115200
|
||||||
monitor_echo = yes
|
monitor_echo = yes
|
||||||
build_flags = -std=c++17 ; -DI2C_USE_WIRE -DDIAG_LOOPTIMES -DDIAG_IO
|
build_flags = -std=c++17
|
||||||
|
|
||||||
[env:mega2560-debug]
|
[env:mega2560-debug]
|
||||||
platform = atmelavr
|
platform = atmelavr
|
||||||
|
@ -72,7 +71,7 @@ lib_deps =
|
||||||
SPI
|
SPI
|
||||||
monitor_speed = 115200
|
monitor_speed = 115200
|
||||||
monitor_echo = yes
|
monitor_echo = yes
|
||||||
build_flags = -DDIAG_IO=2 -DDIAG_LOOPTIMES
|
build_flags = -DDIAG_IO=2 -DDIAG_LOOPTIMES
|
||||||
|
|
||||||
[env:mega2560-no-HAL]
|
[env:mega2560-no-HAL]
|
||||||
platform = atmelavr
|
platform = atmelavr
|
||||||
|
@ -108,7 +107,7 @@ lib_deps =
|
||||||
SPI
|
SPI
|
||||||
monitor_speed = 115200
|
monitor_speed = 115200
|
||||||
monitor_echo = yes
|
monitor_echo = yes
|
||||||
build_flags = ; -DDIAG_LOOPTIMES
|
build_flags =
|
||||||
|
|
||||||
[env:mega328]
|
[env:mega328]
|
||||||
platform = atmelavr
|
platform = atmelavr
|
||||||
|
@ -173,6 +172,8 @@ board = esp32dev
|
||||||
framework = arduino
|
framework = arduino
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
build_flags = -std=c++17
|
build_flags = -std=c++17
|
||||||
|
monitor_speed = 115200
|
||||||
|
monitor_echo = yes
|
||||||
|
|
||||||
[env:Nucleo-F411RE]
|
[env:Nucleo-F411RE]
|
||||||
platform = ststm32
|
platform = ststm32
|
||||||
|
@ -188,11 +189,76 @@ platform = ststm32
|
||||||
board = nucleo_f446re
|
board = nucleo_f446re
|
||||||
framework = arduino
|
framework = arduino
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
build_flags = -std=c++17 -Os -g2 -Wunused-variable -DDIAG_LOOPTIMES ; -DDIAG_IO
|
build_flags = -std=c++17 -Os -g2 -Wunused-variable
|
||||||
monitor_speed = 115200
|
monitor_speed = 115200
|
||||||
monitor_echo = yes
|
monitor_echo = yes
|
||||||
|
|
||||||
[env:Teensy3.2]
|
; Experimental - no reason this should not work, but not
|
||||||
|
; tested as yet
|
||||||
|
;
|
||||||
|
[env:Nucleo-F401RE]
|
||||||
|
platform = ststm32
|
||||||
|
board = nucleo_f401re
|
||||||
|
framework = arduino
|
||||||
|
lib_deps = ${env.lib_deps}
|
||||||
|
build_flags = -std=c++17 -Os -g2 -Wunused-variable
|
||||||
|
monitor_speed = 115200
|
||||||
|
monitor_echo = yes
|
||||||
|
|
||||||
|
; Commented out by default as the F13ZH has variant files
|
||||||
|
; but NOT the nucleo_f413zh.json file which needs to be
|
||||||
|
; installed before you can let PlatformIO see this
|
||||||
|
;
|
||||||
|
; [env:Nucleo-F413ZH]
|
||||||
|
; platform = ststm32
|
||||||
|
; board = nucleo_f413zh
|
||||||
|
; framework = arduino
|
||||||
|
; lib_deps = ${env.lib_deps}
|
||||||
|
; build_flags = -std=c++17 -Os -g2 -Wunused-variable
|
||||||
|
; monitor_speed = 115200
|
||||||
|
; monitor_echo = yes
|
||||||
|
|
||||||
|
; Commented out by default as the F446ZE needs variant files
|
||||||
|
; installed before you can let PlatformIO see this
|
||||||
|
;
|
||||||
|
; [env:Nucleo-F446ZE]
|
||||||
|
; platform = ststm32
|
||||||
|
; board = nucleo_f446ze
|
||||||
|
; framework = arduino
|
||||||
|
; lib_deps = ${env.lib_deps}
|
||||||
|
; build_flags = -std=c++17 -Os -g2 -Wunused-variable
|
||||||
|
; monitor_speed = 115200
|
||||||
|
; monitor_echo = yes
|
||||||
|
|
||||||
|
; Commented out by default as the F412ZG needs variant files
|
||||||
|
; installed before you can let PlatformIO see this
|
||||||
|
;
|
||||||
|
; [env:Nucleo-F412ZG]
|
||||||
|
; platform = ststm32
|
||||||
|
; board = blah_f412zg
|
||||||
|
; framework = arduino
|
||||||
|
; lib_deps = ${env.lib_deps}
|
||||||
|
; build_flags = -std=c++17 -Os -g2 -Wunused-variable
|
||||||
|
; monitor_speed = 115200
|
||||||
|
; monitor_echo = yes
|
||||||
|
; upload_protocol = stlink
|
||||||
|
|
||||||
|
; Experimental - Ethernet work still in progress
|
||||||
|
;
|
||||||
|
; [env:Nucleo-F429ZI]
|
||||||
|
; platform = ststm32
|
||||||
|
; board = nucleo_f429zi
|
||||||
|
; framework = arduino
|
||||||
|
; lib_deps = ${env.lib_deps}
|
||||||
|
; arduino-libraries/Ethernet @ ^2.0.1
|
||||||
|
; stm32duino/STM32Ethernet @ ^1.3.0
|
||||||
|
; stm32duino/STM32duino LwIP @ ^2.1.2
|
||||||
|
; build_flags = -std=c++17 -Os -g2 -Wunused-variable
|
||||||
|
; monitor_speed = 115200
|
||||||
|
; monitor_echo = yes
|
||||||
|
; upload_protocol = stlink
|
||||||
|
|
||||||
|
[env:Teensy3_2]
|
||||||
platform = teensy
|
platform = teensy
|
||||||
board = teensy31
|
board = teensy31
|
||||||
framework = arduino
|
framework = arduino
|
||||||
|
@ -200,7 +266,7 @@ build_flags = -std=c++17 -Os -g2
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
lib_ignore = NativeEthernet
|
lib_ignore = NativeEthernet
|
||||||
|
|
||||||
[env:Teensy3.5]
|
[env:Teensy3_5]
|
||||||
platform = teensy
|
platform = teensy
|
||||||
board = teensy35
|
board = teensy35
|
||||||
framework = arduino
|
framework = arduino
|
||||||
|
@ -208,7 +274,7 @@ build_flags = -std=c++17 -Os -g2
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
lib_ignore = NativeEthernet
|
lib_ignore = NativeEthernet
|
||||||
|
|
||||||
[env:Teensy3.6]
|
[env:Teensy3_6]
|
||||||
platform = teensy
|
platform = teensy
|
||||||
board = teensy36
|
board = teensy36
|
||||||
framework = arduino
|
framework = arduino
|
||||||
|
@ -216,7 +282,7 @@ build_flags = -std=c++17 -Os -g2
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
lib_ignore = NativeEthernet
|
lib_ignore = NativeEthernet
|
||||||
|
|
||||||
[env:Teensy4.0]
|
[env:Teensy4_0]
|
||||||
platform = teensy
|
platform = teensy
|
||||||
board = teensy40
|
board = teensy40
|
||||||
framework = arduino
|
framework = arduino
|
||||||
|
@ -224,11 +290,10 @@ build_flags = -std=c++17 -Os -g2
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
lib_ignore = NativeEthernet
|
lib_ignore = NativeEthernet
|
||||||
|
|
||||||
[env:Teensy4.1]
|
[env:Teensy4_1]
|
||||||
platform = teensy
|
platform = teensy
|
||||||
board = teensy41
|
board = teensy41
|
||||||
framework = arduino
|
framework = arduino
|
||||||
build_flags = -std=c++17 -Os -g2
|
build_flags = -std=c++17 -Os -g2
|
||||||
lib_deps = ${env.lib_deps}
|
lib_deps = ${env.lib_deps}
|
||||||
lib_ignore =
|
lib_ignore =
|
||||||
|
|
||||||
|
|
76
version.h
76
version.h
|
@ -3,8 +3,76 @@
|
||||||
|
|
||||||
#include "StringFormatter.h"
|
#include "StringFormatter.h"
|
||||||
|
|
||||||
|
#define VERSION "5.1.16"
|
||||||
#define VERSION "4.2.41"
|
// 5.1.16 - Remove I2C address from EXTT_TURNTABLE macro to work with MUX, requires separate HAL macro to create
|
||||||
|
// 5.1.15 - LCC/Adapter support and Exrail feature-compile-out.
|
||||||
|
// 5.1.14 - Fixed IFTTPOSITION
|
||||||
|
// 5.1.13 - Changed turntable broadcast from i to I due to server string conflict
|
||||||
|
// 5.1.12 - Added Power commands <0 A> & <1 A> etc. and update to <=>
|
||||||
|
// Added EXRAIL SET_POWER(track, ON/OFF)
|
||||||
|
// Fixed a problem whereby <1 MAIN> also powered on PROG track
|
||||||
|
// Added functions to TrackManager.cpp to allow UserAddin code for power display on OLED/LCD
|
||||||
|
// Added - returnMode(byte t), returnDCAddr(byte t) & getModeName(byte Mode)
|
||||||
|
// 5.1.11 - STM32F4xx revised I2C clock setup, no correctly sets clock and has fully variable frequency selection
|
||||||
|
// 5.1.10 - STM32F4xx DCCEXanalogWrite to handle PWM generation for TrackManager DC/DCX
|
||||||
|
// - STM32F4xx DCC 58uS timer now using non-PWM output timers where possible
|
||||||
|
// - ESP32 brakeCanPWM check now detects UNUSED_PIN
|
||||||
|
// - ARM architecture brakeCanPWM now uses digitalPinHasPWM()
|
||||||
|
// - STM32F4xx shadowpin extensions to handle pins on ports D, E and F
|
||||||
|
// 5.1.9 - Fixed IO_PCA9555'h to work with PCA9548 mux, tested OK
|
||||||
|
// 5.1.8 - STM32Fxx ADCee extension to support ADCs #2 and #3
|
||||||
|
// 5.1.7 - Fix turntable broadcasts for non-movement activities and <JP> result
|
||||||
|
// 5.1.6 - STM32F4xx native I2C driver added
|
||||||
|
// 5.1.5 - Added turntable object and EXRAIL commands
|
||||||
|
// - <I ...>, <JO ...>, <JP ...> - turntable commands
|
||||||
|
// - DCC_TURNTABLE, EXTT_TURNTABLE, IFTTPOSITION, ONROTATE, ROTATE, ROTATE_DCC, TT_ADDPOSITION, WAITFORTT EXRAIL
|
||||||
|
// 5.1.4 - Added ONOVERLOAD & AFTEROVERLOAD to EXRAIL
|
||||||
|
// 5.1.3 - Make parser more fool proof
|
||||||
|
// 5.1.2 - Bugfix: ESP32 30ms off time
|
||||||
|
// 5.1.1 - Check bad AT firmware version
|
||||||
|
// - Update IO_PCA9555.h reflecting IO_MCP23017.h changes to support PCA9548 mux
|
||||||
|
// 5.0.1 - Bugfix: execute 30ms off time before rejoin
|
||||||
|
// 5.0.0 - Make 4.2.69 the 5.0.0 release
|
||||||
|
// 4.2.69 - Bugfix: Make <!> work in DC mode
|
||||||
|
// 4.2.68 - Rename track mode OFF to NONE
|
||||||
|
// 4.2.67 - AVR: Pin specific timer register seting
|
||||||
|
// - Protect Uno user from choosing DC(X)
|
||||||
|
// - More Nucleo variant defines
|
||||||
|
// - GPIO PCA9555 / TCA9555 support
|
||||||
|
// 4.2.66 - Throttle inrush current by applying PWM to brake pin when
|
||||||
|
// fault pin goes active
|
||||||
|
// 4.2.65 - new config WIFI_FORCE_AP option
|
||||||
|
// 4.2.63 - completely new overcurrent detection
|
||||||
|
// - ESP32 protect from race in RMT code
|
||||||
|
// 4.2.62 - Update IO_RotaryEncoder.h to ignore sending current position
|
||||||
|
// - Update IO_EXTurntable.h to remove forced I2C clock speed
|
||||||
|
// - Show device offline if EX-Turntable not connected
|
||||||
|
// 4.2.61 - MAX_CURRENT restriction (caps motor shield value)
|
||||||
|
// 4.2.60 - Add mDNS capability to ESP32 for autodiscovery
|
||||||
|
// 4.2.59 - Fix: AP SSID was DCC_ instead of DCCEX_
|
||||||
|
// 4.2.58 - Start motordriver as soon as possible but without waveform
|
||||||
|
// 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()
|
||||||
|
// 4.2.55 - Optimize analog read for AVR
|
||||||
|
// 4.2.54 - EX8874 shield in config.example.h
|
||||||
|
// - Fix: Better warnings for pin number errors
|
||||||
|
// - Fix: Default roster list possible in Withrottle and <jR>
|
||||||
|
// - Fix: Pin handling supports pins up to 254
|
||||||
|
// 4.2.53 - Fix: Fault pin handling made more straight forward
|
||||||
|
// 4.2.52 - Experimental support for sabertooth motor controller on ESP32
|
||||||
|
// 4.2.51 - Add DISABLE_PROG to disable programming to save RAM/Flash
|
||||||
|
// 4.2.50 - Fixes: estop all, turnout eeprom, cab ID check
|
||||||
|
// 4.2.49 - Exrail SPEED take notice of external direction change
|
||||||
|
// 4.2.48 - BROADCAST/WITHROTTLE Exrail macros
|
||||||
|
// 4.2.47 - Correct response to <JA 0>
|
||||||
|
// 4.2.46 - Support boards with inverted fault pin
|
||||||
|
// 4.2.45 - Add ONCLOCKMINS to FastClock to allow hourly repeat events
|
||||||
|
// 4.2.44 - Add PowerShell installer EX-CommandStation-installer.exe
|
||||||
|
// 4.2.43 - Fix STM32 set right port mode bits for analog
|
||||||
|
// 4.2.42 - Added EXRAIL TURNOUTL Macro definition
|
||||||
// 4.2.41 - Move HAl startup to ASAP in setup()
|
// 4.2.41 - Move HAl startup to ASAP in setup()
|
||||||
// - Fix DNOU8 output pin setup to all LOW
|
// - Fix DNOU8 output pin setup to all LOW
|
||||||
// 4.2.40 - Automatically detect conflicting default I2C devices and disable
|
// 4.2.40 - Automatically detect conflicting default I2C devices and disable
|
||||||
|
@ -72,6 +140,10 @@
|
||||||
// 4.2.11 Exrail IFLOCO feature added
|
// 4.2.11 Exrail IFLOCO feature added
|
||||||
// 4.2.10 SIGNAL/SIGNALH bug fix as they were inverted
|
// 4.2.10 SIGNAL/SIGNALH bug fix as they were inverted
|
||||||
// IO_EXIOExpander.h input speed optimisation
|
// IO_EXIOExpander.h input speed optimisation
|
||||||
|
// ONCLOCK and ONCLOCKTIME command added to EXRAIL for EX-FastCLock
|
||||||
|
// <JC> Serial command added for EX-FastClock
|
||||||
|
// <jC> Broadcast added for EX-FastClock
|
||||||
|
// IO_EXFastClock.h added for I2C FastClock connection
|
||||||
// 4.2.9 duinoNodes support
|
// 4.2.9 duinoNodes support
|
||||||
// 4.2.8 HIGHMEM (EXRAIL support beyond 64kb)
|
// 4.2.8 HIGHMEM (EXRAIL support beyond 64kb)
|
||||||
// Withrottle connect/disconnect improvements
|
// Withrottle connect/disconnect improvements
|
||||||
|
|
Loading…
Reference in New Issue
Block a user