Add CANMessage deep comparison operators

ARMmbed · May 18, 2021 · b9f2367 · b9f2367
1 parent 7279ae2
commit b9f2367
Showing 1 changed file with 29 additions and 0 deletions.
diff --git a/drivers/include/drivers/interfaces/InterfaceCAN.h b/drivers/include/drivers/interfaces/InterfaceCAN.h
@@ -109,6 +109,35 @@ class CANMessage : public CAN_Message {
         id     = _id;
         memset(data, 0, 8);
     }
+
+    /**
+     * "Deep" comparison operator (ie: compare value of each data member)
+     */
+    bool 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 operator !=(const CANMessage &b) const
+    {
+        return !(*this == b);
+    }
 };
 
 /** @}*/