diff --git a/BSB_LAN/BSB_LAN.ino b/BSB_LAN/BSB_LAN.ino index 18f98124..45dd800c 100644 --- a/BSB_LAN/BSB_LAN.ino +++ b/BSB_LAN/BSB_LAN.ino @@ -1993,10 +1993,6 @@ void UpdateMaxDeviceList() { writeToEEPROM(CF_MAX_DEVADDR); } -void print_bus_send_failed(void) { - printlnToDebug(PSTR("bus send failed")); // to PC hardware serial I/F -} - void printPStr(uint_farptr_t outstr, uint16_t outstr_len) { for (uint16_t x=0;xSend(TYPE_QUR, c, msg, tx_msg) != BUS_OK) { - print_bus_send_failed(); + printlnToDebug(PSTR("bus send failed")); // to PC hardware serial I/F } else { if (msg[4+(bus->getBusType()*4)]!=TYPE_ERR) { // Decode the xmit telegram and send it to the PC serial interface @@ -5541,7 +5537,7 @@ void loop() { } int8_t return_value = bus->Send(type, c, msg, tx_msg, param, param_len, true); if (return_value != BUS_OK) { - print_bus_send_failed(); + printlnToDebug(PSTR("bus send failed")); // to PC hardware serial I/F } else { // Decode the xmit telegram and send it to the PC serial interface printTelegram(tx_msg, -1); diff --git a/BSB_LAN/include/print_telegram.h b/BSB_LAN/include/print_telegram.h index d22570bc..8552b8e1 100644 --- a/BSB_LAN/include/print_telegram.h +++ b/BSB_LAN/include/print_telegram.h @@ -719,6 +719,9 @@ void printTelegram(byte* msg, float query_line) { while (1) { i = findLine(query_line,i,&c); uint16_t dev_flags = get_cmdtbl_flags(i); + if (dev_flags & FL_NOSWAP_QUR) { + c=((c & 0xFF000000) >> 8) | ((c & 0x00FF0000) << 8) | (c & 0x0000FFFF); + } if (dev_flags & FL_SPECIAL_INF) { c=((c & 0xFF000000) >> 8) | ((c & 0x00FF0000) << 8) | (c & 0x0000FFFF); }