usapack public

Dependents:   optWingforHAPS_Eigen hexaTest_Eigen

Revision:
4:844eff5a2fa8
Parent:
3:526f824b50ef
Child:
5:a1d8afaadb4d
diff -r 526f824b50ef -r 844eff5a2fa8 UsaPack.hpp
--- a/UsaPack.hpp	Mon Apr 26 11:33:25 2021 +0000
+++ b/UsaPack.hpp	Sun May 23 23:12:43 2021 +0000
@@ -47,6 +47,7 @@
             struct
             {
                 int _address;
+                int _checksum;
                 T raw_data;
             } address_package;
             char byte_data[sizeof(address_package)];
@@ -56,6 +57,14 @@
         _package package;
         package.address_package._address = address;
         package.address_package.raw_data = *send_data;
+        
+        int checksum = 0;
+        for (int i = 8; i < sizeof(_package); i++)
+        {
+            checksum += package.byte_data[i];
+        }
+        package._checksum = checksum;
+        
         CobsEncode(package.byte_data, (int)sizeof(_package), send_cobs_data);
         for (int i = 0; i < sizeof(_package)+2; i++)
         {