| 1234567891011121314151617181920212223242526 |
- void CAN_READ() {
- if(!digitalRead(CAN_INTpin)) // If pin 2 is low, read receive buffer
- {
- CAN0.readMsgBuf(&CANrxId, &CANlen, CANrxBuf); // Read data: len = data length, buf = data byte(s)
- Serial.print("#5555CAN_READ read ID: ");
- Serial.print(CANrxId, HEX);
- Serial.print(" 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
- {
- Serial.print("0");
-
- }
- Serial.print(CANrxBuf[i], HEX);
- Serial.print(" ");
-
-
- }
- Serial.println();
-
- } else Serial.println(" [CAN] [NOT][digitalRead(CAN_INTpin)] ");
- }
|