CFG? added
This commit is contained in:
@@ -794,6 +794,24 @@ bool parsePosQuery(const String& line) {
|
|||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Answers `CFG?` with speed and acceleration for every gauge.
|
||||||
|
// Emits one `CFG <id> <maxSpeed> <accel>` line per gauge, then replies `OK`.
|
||||||
|
bool parseCfgQuery(const String& line) {
|
||||||
|
if (line == "CFG?") {
|
||||||
|
for (uint8_t i = 0; i < GAUGE_COUNT; i++) {
|
||||||
|
CMD_PORT.print("CFG ");
|
||||||
|
CMD_PORT.print(i);
|
||||||
|
CMD_PORT.print(' ');
|
||||||
|
CMD_PORT.print((int)gauges[i].maxSpeed);
|
||||||
|
CMD_PORT.print(' ');
|
||||||
|
CMD_PORT.println((int)gauges[i].accel);
|
||||||
|
}
|
||||||
|
sendReply("OK");
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
// Answers the mandatory life question: are you there?
|
// Answers the mandatory life question: are you there?
|
||||||
// Reply: `PONG`.
|
// Reply: `PONG`.
|
||||||
bool parsePing(const String& line) {
|
bool parsePing(const String& line) {
|
||||||
@@ -1058,6 +1076,7 @@ void processLine(const String& line) {
|
|||||||
if (parseHome(line)) return;
|
if (parseHome(line)) return;
|
||||||
if (parseSweep(line)) return;
|
if (parseSweep(line)) return;
|
||||||
if (parsePosQuery(line)) return;
|
if (parsePosQuery(line)) return;
|
||||||
|
if (parseCfgQuery(line)) return;
|
||||||
if (parseLedQuery(line)) return;
|
if (parseLedQuery(line)) return;
|
||||||
if (parseLed(line)) return;
|
if (parseLed(line)) return;
|
||||||
if (parseBlink(line)) return;
|
if (parseBlink(line)) return;
|
||||||
|
|||||||
Reference in New Issue
Block a user