|
@@ -6,6 +6,13 @@ void CAN_READ() {
|
|
|
Serial.print(CANrxId, HEX);
|
|
Serial.print(CANrxId, HEX);
|
|
|
Serial.print(" Data: [");Serial.print(CANlen); Serial.print("]");
|
|
Serial.print(" Data: [");Serial.print(CANlen); Serial.print("]");
|
|
|
|
|
|
|
|
|
|
+
|
|
|
|
|
+ if(CANlen == CAN_MSG_DATA8_LEN) {
|
|
|
|
|
+
|
|
|
|
|
+ DISPLAY__print_loop(DISPLAY_CURSOR_Y_CHARS_CAN_DEBUG, "CAN RECV DATA", 13, DISPLAY__print_loop_ACTION_ADD ) ;
|
|
|
|
|
+
|
|
|
|
|
+ } //if(CANlen == CAN_MSG_DATA8_LEN) {
|
|
|
|
|
+
|
|
|
for(int i = 0; i<CANlen; i++) // Print each byte of the data
|
|
for(int i = 0; i<CANlen; i++) // Print each byte of the data
|
|
|
{
|
|
{
|
|
|
if(CANrxBuf[i] < 0x10) // If data byte is less than 0x10, add a leading zero
|
|
if(CANrxBuf[i] < 0x10) // If data byte is less than 0x10, add a leading zero
|