Convert WPILib RTR flag to candlelib

Author: LandryNorris

src/main/native/include/rev/CANMessage.h

@@ -36,6 +36,9 @@
 #include <iostream>
 #include <chrono>
 
+#define EXTENDED_ID_MASK 0x40000000
+#define REMOTE_FRAME_MASK 0x80000000
+
 namespace rev {
 namespace usb {
 
@@ -178,6 +181,7 @@ class CANMessage {
     uint8_t m_size;
     uint32_t m_messageId;
     uint32_t m_timestamp;
+    bool m_is_remote;
     bool m_isNew{true};
 };
 

src/main/native/include/rev/Drivers/CandleWinUSB/CandleWinUSBDeviceThread.h

@@ -53,6 +53,9 @@
 #include <hal/simulation/CanData.h>
 #include <hal/CAN.h>
 
+#define CANDLE_EXTENDED_ID_MASK 0x80000000
+#define CANDLE_REMOTE_FRAME_MASK 0x40000000
+
 namespace rev {
 namespace usb {
 
@@ -169,8 +172,20 @@ class CandleWinUSBDeviceThread :public DriverDeviceThread {
         if (el.m_intervalMs <= 1 || (now - el.m_prevTimestamp >= std::chrono::milliseconds(el.m_intervalMs)) ) {
             candle_frame_t frame;
             frame.can_dlc = el.m_msg.GetSize();
-            // set extended id flag
-            frame.can_id = el.m_msg.GetMessageId() | 0x80000000;
+
+            uint32_t messageId = el.m_msg.GetMessageId();
+
+            bool isExtended = true; // FRC CAN is always extended
+            bool isRtr = messageId & REMOTE_FRAME_MASK;
+
+            frame.can_id = messageId;
+            if(isExtended) {
+            	frame.can_id |= CANDLE_EXTENDED_ID_MASK;
+            }
+            if(isRtr) {
+                frame.can_id |= CANDLE_REMOTE_FRAME_MASK;
+            }
+
             memcpy(frame.data, el.m_msg.GetData(), frame.can_dlc);
             frame.timestamp_us = now.time_since_epoch().count() / 1000;