Add function and example to learn unknow ID

DogushC · DogushC · commit 2511335b09e1 · 2023-06-15T17:10:15.000+03:00
diff --git a/libraries/CezerioBlocks/examples/AskID/AskID.ino b/libraries/CezerioBlocks/examples/AskID/AskID.ino
@@ -0,0 +1,30 @@
+#include "cezerioBlocks.h"
+
+unsigned char timerFlag = 0;
+
+void setup()
+{
+  initCezerioBlocks();
+}
+
+void loop()
+{
+#if defined(CAN_RECEIVE_INTERRUPT_ENABLE)
+  if(!digitalRead(CAN_INT))
+  {
+  }
+#endif
+
+  if(timerFlag)
+  {
+  Serial.println(getBlockID(),HEX);
+  timerFlag = 0;
+  }
+}
+
+#if defined(TIMER_INTERRUPT_ENABLE)
+ISR(TIMER1_COMPA_vect)
+{
+  timerFlag = 1;
+}
+#endif
diff --git a/libraries/CezerioBlocks/src/cezerioBlocks.cpp b/libraries/CezerioBlocks/src/cezerioBlocks.cpp
@@ -793,6 +793,22 @@ void setBirrr(unsigned int birrrBlockID, unsigned char motorDirection, unsigned
   CAN.sendMsgBuf(birrrBlockID, 0, 7, sendData);
 }
 
+void createBlockDataRequestPacket(unsigned int requestMessageId)
+{
+  unsigned char sendData[4] = {SYNC_BYTE_START, 0x04, 0x00, SYNC_BYTE_STOP};
+  CAN.sendMsgBuf(requestMessageId, 0, 4, sendData);
+}
+
+uint16_t getBlockID()
+{
+  createBlockDataRequestPacket(MESSAGE_ID_REQUEST);
+
+  CAN.readMsgBuf(&rxId, &len, rxBuf);      // Read data: len = data length, buf = data byte(s)
+  unsigned char messageIDH = rxBuf[3];
+  unsigned char messageIDL = rxBuf[4];
+
+  return (messageIDH << 8 | messageIDL);
+}
 /*********************************************************************************************************
  *  END FILE
  *********************************************************************************************************/
diff --git a/libraries/CezerioBlocks/src/cezerioBlocks.h b/libraries/CezerioBlocks/src/cezerioBlocks.h
@@ -95,6 +95,8 @@ unsigned char hexToAscii(unsigned char hexData);
 /* INIT FUNCTIONS */
 void initCezerioBlocks(void);
 void initSmartBlue(void);
+void createBlockDataRequestPacket(unsigned int requestMessageId);
+uint16_t getBlockID();
 
 /* BLE FUNCTIONS */
 void getSmartBlueData(void);
