Diff: UsaPack.cpp

Revision:

4:844eff5a2fa8

Parent:

3:526f824b50ef

--- a/UsaPack.cpp	Mon Apr 26 11:33:25 2021 +0000
+++ b/UsaPack.cpp	Sun May 23 23:12:43 2021 +0000
@@ -38,22 +38,37 @@
 {
     char data[receive_size];
     CobsDecode(receive_buffer, receive_index-2, data);
-    union
+    union c4
     {
         char c[4];
         int a;
-    } _address;
+    };
+    c4 _address;
+    c4 _checksum;
     for (int i = 0; i < 4; i++)
     {
         _address.c[i] = data[i];
     }
+    for (int i = 0; i < 4; i++)
+    {
+        _checksum.c[i] = data[i+4];
+    }
     for (int i = 0; i < package_index; i++)
     {
         if (package_address[i] == _address.a)
         {
+            int checksum = 0;
             for (int j = 0; j < package_size[i]; j++)
             {
-                *((char*)(package_object[i])+j) = data[j+4];
+                checksum += data[j+8];
+            }
+            if (_checksum.a != checksum)
+            {
+                return;
+            }
+            for (int j = 0; j < package_size[i]; j++)
+            {
+                *((char*)(package_object[i])+j) = data[j+8];
             }
             break;
         }