_SlaveID_loop1.h 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687
  1. if(!digitalRead(CAN_INTpin)) // If pin 2 is low, read receive buffer
  2. {
  3. CAN0.readMsgBuf(&CANrxId, &CANlen, CANrxBuf); // Read data: len = data length, buf = data byte(s)
  4. Serial.print("#4444 read ID: ");
  5. Serial.print(CANrxId, HEX);
  6. Serial.print(" Data: ");
  7. /* #if defined(HAS_LCD1602)
  8. lcd.setCursor(0,0);
  9. lcd.print("ID: ");
  10. lcd.print(CANrxId, HEX);
  11. lcd.setCursor(0,1);
  12. lcd.print(" Data: ");
  13. #endif
  14. */
  15. /* #if defined(HAS_TFT_ILI9163C)
  16. DISPLAY_DEV.setCursor(0,40);
  17. DISPLAY_DEV.print("ID: ");
  18. DISPLAY_DEV.print(CANrxId, HEX);
  19. DISPLAY_DEV.setCursor(0,50);
  20. DISPLAY_DEV.print(" Data: ");
  21. #endif
  22. */
  23. for(int i = 0; i<CANlen; i++) // Print each byte of the data
  24. {
  25. if(CANrxBuf[i] < 0x10) // If data byte is less than 0x10, add a leading zero
  26. {
  27. Serial.print("0");
  28. // #if defined(HAS_LCD1602)
  29. // lcd.print("0");
  30. // #endif
  31. // #if defined(HAS_TFT_ILI9163C)
  32. // DISPLAY_DEV.print("0");
  33. // #endif
  34. }
  35. Serial.print(CANrxBuf[i], HEX);
  36. Serial.print(" ");
  37. /* #if defined(HAS_LCD1602)
  38. lcd.print(CANrxBuf[i], HEX);
  39. lcd.print(" ");
  40. #endif
  41. */
  42. // #if defined(HAS_TFT_ILI9163C)
  43. // DISPLAY_DEV.print(CANrxBuf[i], HEX);
  44. // DISPLAY_DEV.print(" ");
  45. // #endif
  46. // if(_Slave_Ports_queue_task_type_LIST[i]) {
  47. // Serial.print(" ["); Serial.print(_Slave_Ports_queue_task_type_LIST[i]); Serial.print("] ");
  48. // }
  49. }
  50. Serial.println();
  51. }
  52. //EOF CAN
  53. /*TODO
  54. #if defined(HAS_LCD1602)
  55. // delay(LCDtim);
  56. //lcd.setCursor(0,1);
  57. lcd.print(lcdPattern);
  58. //lcd.print(lcdPos % 10);
  59. if(lcdPos == 16) {
  60. //lcd.print("N");
  61. lcd.setCursor(0,1);
  62. lcdPos = 0;
  63. if(lcdPattern==".") lcdPattern = "-" ;
  64. else lcdPattern = "." ;
  65. }
  66. lcdPos ++;
  67. #endif
  68. */
  69. // #if defined(HAS_TFT_ILI9163C)
  70. // delay(LCDtim);
  71. // display.setCursor(0,60);
  72. // display.print("loop....");
  73. // #endif