_CAN_func.h 898 B

1234567891011121314151617181920212223242526
  1. void CAN_READ() {
  2. if(!digitalRead(CAN_INTpin)) // If pin 2 is low, read receive buffer
  3. {
  4. CAN0.readMsgBuf(&CANrxId, &CANlen, CANrxBuf); // Read data: len = data length, buf = data byte(s)
  5. Serial.print("#5555CAN_READ read ID: ");
  6. Serial.print(CANrxId, HEX);
  7. Serial.print(" Data: ");
  8. for(int i = 0; i<CANlen; i++) // Print each byte of the data
  9. {
  10. if(CANrxBuf[i] < 0x10) // If data byte is less than 0x10, add a leading zero
  11. {
  12. Serial.print("0");
  13. }
  14. Serial.print(CANrxBuf[i], HEX);
  15. Serial.print(" ");
  16. }
  17. Serial.println();
  18. } else Serial.println(" [CAN] [NOT][digitalRead(CAN_INTpin)] ");
  19. }