usapack public
Dependents: optWingforHAPS_Eigen hexaTest_Eigen
Diff: UsaPack.hpp
- 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++) {