diff --git a/DCCEXParser.cpp b/DCCEXParser.cpp index 0d8b537..185c87d 100644 --- a/DCCEXParser.cpp +++ b/DCCEXParser.cpp @@ -352,7 +352,9 @@ void DCCEXParser::parse(Print *stream, byte *com, RingStream * ringStream) break; if (params == 1) // Write new loco id (clearing consist and managing short/long) DCC::setLocoId(p[0],callback_Wloco); - else // WRITE CV ON PROG + else if (params == 4) // WRITE CV ON PROG + DCC::writeCVByte(p[0], p[1], callback_W4); + else // WRITE CV ON PROG DCC::writeCVByte(p[0], p[1], callback_W); return; @@ -947,7 +949,14 @@ void DCCEXParser::commitAsyncReplyStream() { void DCCEXParser::callback_W(int16_t result) { StringFormatter::send(getAsyncReplyStream(), - F("\n"), stashP[2], stashP[3], stashP[0], result == 1 ? stashP[1] : -1); + F("\n"), stashP[0], result == 1 ? stashP[1] : -1); + commitAsyncReplyStream(); +} + +void DCCEXParser::callback_W4(int16_t result) +{ + StringFormatter::send(getAsyncReplyStream(), + F("\n"), stashP[2], stashP[3], stashP[0], result == 1 ? stashP[1] : -1); commitAsyncReplyStream(); }