dronecan.remoteid.System.c 2.5 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879
  1. #define CANARD_DSDLC_INTERNAL
  2. #include <dronecan.remoteid.System.h>
  3. #include <string.h>
  4. #ifdef CANARD_DSDLC_TEST_BUILD
  5. #include <test_helpers.h>
  6. #endif
  7. uint32_t dronecan_remoteid_System_encode(struct dronecan_remoteid_System* 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, DRONECAN_REMOTEID_SYSTEM_MAX_SIZE);
  14. _dronecan_remoteid_System_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 dronecan_remoteid_System_decode(const CanardRxTransfer* transfer, struct dronecan_remoteid_System* msg) {
  27. #if CANARD_ENABLE_TAO_OPTION
  28. if (transfer->tao && (transfer->payload_len > DRONECAN_REMOTEID_SYSTEM_MAX_SIZE)) {
  29. return true; /* invalid payload length */
  30. }
  31. #endif
  32. uint32_t bit_ofs = 0;
  33. if (_dronecan_remoteid_System_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 dronecan_remoteid_System sample_dronecan_remoteid_System_msg(void) {
  54. struct dronecan_remoteid_System msg;
  55. msg.id_or_mac.len = (uint8_t)random_range_unsigned_val(0, 20);
  56. for (size_t i=0; i < msg.id_or_mac.len; i++) {
  57. msg.id_or_mac.data[i] = (uint8_t)random_bitlen_unsigned_val(8);
  58. }
  59. msg.operator_location_type = (uint8_t)random_bitlen_unsigned_val(8);
  60. msg.classification_type = (uint8_t)random_bitlen_unsigned_val(8);
  61. msg.operator_latitude = (int32_t)random_bitlen_signed_val(32);
  62. msg.operator_longitude = (int32_t)random_bitlen_signed_val(32);
  63. msg.area_count = (uint16_t)random_bitlen_unsigned_val(16);
  64. msg.area_radius = (uint16_t)random_bitlen_unsigned_val(16);
  65. msg.area_ceiling = random_float_val();
  66. msg.area_floor = random_float_val();
  67. msg.category_eu = (uint8_t)random_bitlen_unsigned_val(8);
  68. msg.class_eu = (uint8_t)random_bitlen_unsigned_val(8);
  69. msg.operator_altitude_geo = random_float_val();
  70. msg.timestamp = (uint32_t)random_bitlen_unsigned_val(32);
  71. return msg;
  72. }
  73. #endif