Mask out reserved bits when giving ID to candlelib

Author: LandryNorris

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

@@ -38,6 +38,7 @@
 
 #define EXTENDED_ID_MASK 0x40000000
 #define REMOTE_FRAME_MASK 0x80000000
+#define NON_RESERVED_ARB_ID_MASK 0x1FFFFFFF
 
 namespace rev {
 namespace usb {

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

@@ -173,7 +173,7 @@ class CandleWinUSBDeviceThread :public DriverDeviceThread {
             candle_frame_t frame;
             frame.can_dlc = el.m_msg.GetSize();
 
-            uint32_t messageId = el.m_msg.GetMessageId();
+            uint32_t messageId = el.m_msg.GetMessageId() & NON_RESERVED_ARB_ID_MASK;
 
             bool isExtended = true; // FRC CAN is always extended
             bool isRtr = messageId & REMOTE_FRAME_MASK;