mirror of
https://github.com/DCC-EX/CommandStation-EX.git
synced 2024-11-27 01:56:14 +01:00
Linear address <a> cmd
This commit is contained in:
parent
611838d60c
commit
3dede9eabe
|
@ -306,12 +306,33 @@ void DCCEXParser::parse(Print *stream, byte *com, bool blocking)
|
||||||
return;
|
return;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'a': // ACCESSORY <a ADDRESS SUBADDRESS ACTIVATE>
|
case 'a': // ACCESSORY <a ADDRESS SUBADDRESS ACTIVATE> or <a LINEARADDRESS ACTIVATE>
|
||||||
if (p[2] != (p[2] & 1))
|
{
|
||||||
return;
|
int address;
|
||||||
DCC::setAccessory(p[0], p[1], p[2] == 1);
|
byte subaddress;
|
||||||
|
byte activep;
|
||||||
|
if (params==2) { // <a LINEARADDRESS ACTIVATE>
|
||||||
|
address=(p[0] - 1) / 4 + 1;
|
||||||
|
subaddress=(p[0] - 1) % 4;
|
||||||
|
activep=1;
|
||||||
|
}
|
||||||
|
else if (params==3) { // <a ADDRESS SUBADDRESS ACTIVATE>
|
||||||
|
address=p[0];
|
||||||
|
subaddress=p[1];
|
||||||
|
activep=2;
|
||||||
|
}
|
||||||
|
else break; // invalid no of parameters
|
||||||
|
|
||||||
|
if (
|
||||||
|
((address & 0x01FF) != address) // invalid address (limit 9 bits )
|
||||||
|
|| ((subaddress & 0x03) != subaddress) // invalid subaddress (limit 2 bits )
|
||||||
|
|| ((p[activep] & 0x01) != p[activep]) // invalid activate 0|1
|
||||||
|
) break;
|
||||||
|
|
||||||
|
DCC::setAccessory(address, subaddress,p[activep]==1);
|
||||||
|
}
|
||||||
return;
|
return;
|
||||||
|
|
||||||
case 'T': // TURNOUT <T ...>
|
case 'T': // TURNOUT <T ...>
|
||||||
if (parseT(stream, params, p))
|
if (parseT(stream, params, p))
|
||||||
return;
|
return;
|
||||||
|
|
Loading…
Reference in New Issue
Block a user