andry/EMS-ESP32
1
0
Fork 0
mirror of https://github.com/emsesp/EMS-ESP32.git synced 2025-12-09 17:29:50 +03:00
Code Issues Packages Projects Releases Wiki Activity

fix send_telegram TX_READ for EMS+

Browse Source
This commit is contained in:
MichaelDvP
2020-06-25 13:17:07 +02:00
parent f32f4ad469
commit ad7de09a62
1 changed files with 4 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
src/telegram.cpp
View File

@@ -300,7 +300,8 @@ void TxService::send_telegram(const QueuedTxTelegram & tx_telegram) {
} }
telegram_raw[1] = dest; telegram_raw[1] = dest;
uint8_t message_p = 0; // this is the position in the telegram where we want to put our message data uint8_t message_p = 0; // this is the position in the telegram where we want to put our message data
uint8_t message_p0 = 0; // this is the position of start of message data
if (telegram->type_id > 0xFF) { if (telegram->type_id > 0xFF) {
// it's EMS 2.0/+ // it's EMS 2.0/+
@@ -319,6 +320,7 @@ void TxService::send_telegram(const QueuedTxTelegram & tx_telegram) {
telegram_raw[5] = (telegram->type_id >> 8) - 1; // type, 1st byte, high-byte, subtract 0x100 telegram_raw[5] = (telegram->type_id >> 8) - 1; // type, 1st byte, high-byte, subtract 0x100
telegram_raw[6] = telegram->type_id & 0xFF; // type, 2nd byte, low-byte telegram_raw[6] = telegram->type_id & 0xFF; // type, 2nd byte, low-byte
message_p = 7; message_p = 7;
message_p0 = 1; // data[0] is in raw[4]
} }
} else { } else {
// EMS 1.0 // EMS 1.0
@@ -332,7 +334,7 @@ void TxService::send_telegram(const QueuedTxTelegram & tx_telegram) {
return; // too big return; // too big
} }
for (uint8_t i = 0; i < telegram->message_length; i++) { for (uint8_t i = message_p0; i < telegram->message_length; i++) {
telegram_raw[message_p++] = telegram->message_data[i]; telegram_raw[message_p++] = telegram->message_data[i];
} }