Add CANMessage deep comparison operators

Author: AGlass0fMilk

drivers/include/drivers/interfaces/InterfaceCAN.h

@@ -109,6 +109,28 @@ class CANMessage : public CAN_Message {
         id     = _id;
         memset(data, 0, 8);
     }
+
+    /**
+     * "Deep" comparison operator (ie: compare value of each data member)
+     */
+    bool CANMessage::operator ==(const CANMessage &b) const {
+        if(id != b.id)
+            return false;
+        if(len != b.len)
+            return false;
+        if(format != b.format)
+            return false;
+        if(type != b.type)
+            return false;
+        if(memcmp(data, b.data, len) != 0)
+            return false;
+
+        return true;
+    }
+
+    bool CANMessage::operator !=(const CANMessage &b) const  {
+        return !(*this == b);
+    }
 };
 
 /** @}*/