Add CANMessage deep comparison operators

ARMmbed · May 16, 2021 · dfc1d3c · dfc1d3c
1 parent 7279ae2
commit dfc1d3c
Showing 1 changed file with 19 additions and 0 deletions.
diff --git a/drivers/include/drivers/interfaces/InterfaceCAN.h b/drivers/include/drivers/interfaces/InterfaceCAN.h
@@ -109,6 +109,25 @@ class CANMessage : public CAN_Message {
         id     = _id;
         memset(data, 0, 8);
     }
+
+    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);
+    }
 };
 
 /** @}*/