d1f76042e1
bugfix for outgoing serial TPM2 message length
188 lines
6.2 KiB
C++
188 lines
6.2 KiB
C++
#include "wled.h"
|
|
|
|
/*
|
|
* Adalight and TPM2 handler
|
|
*/
|
|
|
|
enum class AdaState {
|
|
Header_A,
|
|
Header_d,
|
|
Header_a,
|
|
Header_CountHi,
|
|
Header_CountLo,
|
|
Header_CountCheck,
|
|
Data_Red,
|
|
Data_Green,
|
|
Data_Blue,
|
|
TPM2_Header_Type,
|
|
TPM2_Header_CountHi,
|
|
TPM2_Header_CountLo,
|
|
};
|
|
|
|
uint16_t currentBaud = 1152; //default baudrate 115200 (divided by 100)
|
|
|
|
void updateBaudRate(uint32_t rate){
|
|
uint16_t rate100 = rate/100;
|
|
if (rate100 == currentBaud || rate100 < 96) return;
|
|
currentBaud = rate100;
|
|
|
|
if (!pinManager.isPinAllocated(1) || pinManager.getPinOwner(1) == PinOwner::DebugOut){
|
|
Serial.print(F("Baud is now ")); Serial.println(rate);
|
|
}
|
|
|
|
Serial.flush();
|
|
Serial.begin(rate);
|
|
}
|
|
|
|
void handleSerial()
|
|
{
|
|
if (pinManager.isPinAllocated(3)) return;
|
|
|
|
#ifdef WLED_ENABLE_ADALIGHT
|
|
static auto state = AdaState::Header_A;
|
|
static uint16_t count = 0;
|
|
static uint16_t pixel = 0;
|
|
static byte check = 0x00;
|
|
static byte red = 0x00;
|
|
static byte green = 0x00;
|
|
|
|
while (Serial.available() > 0)
|
|
{
|
|
yield();
|
|
byte next = Serial.peek();
|
|
switch (state) {
|
|
case AdaState::Header_A:
|
|
if (next == 'A') state = AdaState::Header_d;
|
|
else if (next == 0xC9) { //TPM2 start byte
|
|
state = AdaState::TPM2_Header_Type;
|
|
}
|
|
else if (next == 'I') {
|
|
handleImprovPacket();
|
|
return;
|
|
} else if (next == 'v') {
|
|
Serial.print("WLED"); Serial.write(' '); Serial.println(VERSION);
|
|
|
|
} else if (next == 0xB0) {updateBaudRate( 115200);
|
|
} else if (next == 0xB1) {updateBaudRate( 230400);
|
|
} else if (next == 0xB2) {updateBaudRate( 460800);
|
|
} else if (next == 0xB3) {updateBaudRate( 500000);
|
|
} else if (next == 0xB4) {updateBaudRate( 576000);
|
|
} else if (next == 0xB5) {updateBaudRate( 921600);
|
|
} else if (next == 0xB6) {updateBaudRate(1000000);
|
|
} else if (next == 0xB7) {updateBaudRate(1500000);
|
|
|
|
} else if (next == 'l') { //RGB(W) LED data return as JSON array. Slow, but easy to use on the other end.
|
|
if (!pinManager.isPinAllocated(1) || pinManager.getPinOwner(1) == PinOwner::DebugOut){
|
|
uint16_t used = strip.getLengthTotal();
|
|
Serial.write('[');
|
|
for (uint16_t i=0; i<used; i+=1) {
|
|
Serial.print(strip.getPixelColor(i));
|
|
if (i != used-1) Serial.write(',');
|
|
}
|
|
Serial.println("]");
|
|
}
|
|
} else if (next == 'L') { //RGB LED data returned as bytes in tpm2 format. Faster, and slightly less easy to use on the other end.
|
|
if (!pinManager.isPinAllocated(1) || pinManager.getPinOwner(1) == PinOwner::DebugOut) {
|
|
Serial.write(0xC9); Serial.write(0xDA);
|
|
uint16_t used = strip.getLengthTotal();
|
|
uint16_t len = used*3;
|
|
Serial.write(highByte(len));
|
|
Serial.write(lowByte(len));
|
|
for (uint16_t i=0; i < used; i++) {
|
|
uint32_t c = strip.getPixelColor(i);
|
|
Serial.write(qadd8(W(c), R(c))); //R, add white channel to RGB channels as a simple RGBW -> RGB map
|
|
Serial.write(qadd8(W(c), G(c))); //G
|
|
Serial.write(qadd8(W(c), B(c))); //B
|
|
}
|
|
Serial.write(0x36); Serial.write('\n');
|
|
}
|
|
} else if (next == '{') { //JSON API
|
|
bool verboseResponse = false;
|
|
#ifdef WLED_USE_DYNAMIC_JSON
|
|
DynamicJsonDocument doc(JSON_BUFFER_SIZE);
|
|
#else
|
|
if (!requestJSONBufferLock(16)) return;
|
|
#endif
|
|
Serial.setTimeout(100);
|
|
DeserializationError error = deserializeJson(doc, Serial);
|
|
if (error) {
|
|
releaseJSONBufferLock();
|
|
return;
|
|
}
|
|
verboseResponse = deserializeState(doc.as<JsonObject>());
|
|
//only send response if TX pin is unused for other purposes
|
|
if (verboseResponse && (!pinManager.isPinAllocated(1) || pinManager.getPinOwner(1) == PinOwner::DebugOut)) {
|
|
doc.clear();
|
|
JsonObject state = doc.createNestedObject("state");
|
|
serializeState(state);
|
|
JsonObject info = doc.createNestedObject("info");
|
|
serializeInfo(info);
|
|
|
|
serializeJson(doc, Serial);
|
|
Serial.println();
|
|
}
|
|
releaseJSONBufferLock();
|
|
}
|
|
break;
|
|
case AdaState::Header_d:
|
|
if (next == 'd') state = AdaState::Header_a;
|
|
else state = AdaState::Header_A;
|
|
break;
|
|
case AdaState::Header_a:
|
|
if (next == 'a') state = AdaState::Header_CountHi;
|
|
else state = AdaState::Header_A;
|
|
break;
|
|
case AdaState::Header_CountHi:
|
|
pixel = 0;
|
|
count = next * 0x100;
|
|
check = next;
|
|
state = AdaState::Header_CountLo;
|
|
break;
|
|
case AdaState::Header_CountLo:
|
|
count += next + 1;
|
|
check = check ^ next ^ 0x55;
|
|
state = AdaState::Header_CountCheck;
|
|
break;
|
|
case AdaState::Header_CountCheck:
|
|
if (check == next) state = AdaState::Data_Red;
|
|
else state = AdaState::Header_A;
|
|
break;
|
|
case AdaState::TPM2_Header_Type:
|
|
state = AdaState::Header_A; //(unsupported) TPM2 command or invalid type
|
|
if (next == 0xDA) state = AdaState::TPM2_Header_CountHi; //TPM2 data
|
|
else if (next == 0xAA) Serial.write(0xAC); //TPM2 ping
|
|
break;
|
|
case AdaState::TPM2_Header_CountHi:
|
|
pixel = 0;
|
|
count = (next * 0x100) /3;
|
|
state = AdaState::TPM2_Header_CountLo;
|
|
break;
|
|
case AdaState::TPM2_Header_CountLo:
|
|
count += next /3;
|
|
state = AdaState::Data_Red;
|
|
break;
|
|
case AdaState::Data_Red:
|
|
red = next;
|
|
state = AdaState::Data_Green;
|
|
break;
|
|
case AdaState::Data_Green:
|
|
green = next;
|
|
state = AdaState::Data_Blue;
|
|
break;
|
|
case AdaState::Data_Blue:
|
|
byte blue = next;
|
|
if (!realtimeOverride) setRealtimePixel(pixel++, red, green, blue, 0);
|
|
if (--count > 0) state = AdaState::Data_Red;
|
|
else {
|
|
realtimeLock(realtimeTimeoutMs, REALTIME_MODE_ADALIGHT);
|
|
|
|
if (!realtimeOverride) strip.show();
|
|
state = AdaState::Header_A;
|
|
}
|
|
break;
|
|
}
|
|
Serial.read(); //discard the byte
|
|
}
|
|
#endif
|
|
}
|