vkweigher.WeigherStatus.c 2.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159
  1. #define CANARD_DSDLC_INTERNAL
  2. #include <vkweigher.WeigherStatus.h>
  3. #include <string.h>
  4. #ifdef CANARD_DSDLC_TEST_BUILD
  5. #include <test_helpers.h>
  6. #endif
  7. uint32_t vkweigher_WeigherStatus_encode(struct vkweigher_WeigherStatus* msg, uint8_t* buffer
  8. #if CANARD_ENABLE_TAO_OPTION
  9. , bool tao
  10. #endif
  11. ) {
  12. uint32_t bit_ofs = 0;
  13. memset(buffer, 0, VKWEIGHER_WEIGHERSTATUS_MAX_SIZE);
  14. _vkweigher_WeigherStatus_encode(buffer, &bit_ofs, msg,
  15. #if CANARD_ENABLE_TAO_OPTION
  16. tao
  17. #else
  18. true
  19. #endif
  20. );
  21. return ((bit_ofs+7)/8);
  22. }
  23. /*
  24. return true if the decode is invalid
  25. */
  26. bool vkweigher_WeigherStatus_decode(const CanardRxTransfer* transfer, struct vkweigher_WeigherStatus* msg) {
  27. #if CANARD_ENABLE_TAO_OPTION
  28. if (transfer->tao && (transfer->payload_len > VKWEIGHER_WEIGHERSTATUS_MAX_SIZE)) {
  29. return true; /* invalid payload length */
  30. }
  31. #endif
  32. uint32_t bit_ofs = 0;
  33. if (_vkweigher_WeigherStatus_decode(transfer, &bit_ofs, msg,
  34. #if CANARD_ENABLE_TAO_OPTION
  35. transfer->tao
  36. #else
  37. true
  38. #endif
  39. )) {
  40. return true; /* invalid payload */
  41. }
  42. const uint32_t byte_len = (bit_ofs+7U)/8U;
  43. #if CANARD_ENABLE_TAO_OPTION
  44. // if this could be CANFD then the dlc could indicating more bytes than
  45. // we actually have
  46. if (!transfer->tao) {
  47. return byte_len > transfer->payload_len;
  48. }
  49. #endif
  50. return byte_len != transfer->payload_len;
  51. }
  52. #ifdef CANARD_DSDLC_TEST_BUILD
  53. struct vkweigher_WeigherStatus sample_vkweigher_WeigherStatus_msg(void) {
  54. struct vkweigher_WeigherStatus msg;
  55. msg.weight = (uint32_t)random_bitlen_unsigned_val(32);
  56. msg.rate = (uint16_t)random_bitlen_unsigned_val(16);
  57. msg.status = (uint8_t)random_bitlen_unsigned_val(8);
  58. msg.gx = (int16_t)random_bitlen_signed_val(16);
  59. msg.gy = (int16_t)random_bitlen_signed_val(16);
  60. msg.gz = (int16_t)random_bitlen_signed_val(16);
  61. msg.ax = (int16_t)random_bitlen_signed_val(16);
  62. msg.ay = (int16_t)random_bitlen_signed_val(16);
  63. msg.az = (int16_t)random_bitlen_signed_val(16);
  64. for (size_t i=0; i < 4; i++) {
  65. msg.Q[i] = random_float_val();
  66. }
  67. return msg;
  68. }
  69. #endif