uavcan.equipment.ahrs.MagneticFieldStrength.h 5.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140
  1. #pragma once
  2. #include <stdbool.h>
  3. #include <stdint.h>
  4. #include <canard.h>
  5. #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_MAX_SIZE 25
  6. #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_SIGNATURE (0xE2A7D4A9460BC2F2ULL)
  7. #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_ID 1001
  8. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  9. class uavcan_equipment_ahrs_MagneticFieldStrength_cxx_iface;
  10. #endif
  11. struct uavcan_equipment_ahrs_MagneticFieldStrength {
  12. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  13. using cxx_iface = uavcan_equipment_ahrs_MagneticFieldStrength_cxx_iface;
  14. #endif
  15. float magnetic_field_ga[3];
  16. struct { uint8_t len; float data[9]; }magnetic_field_covariance;
  17. };
  18. #ifdef __cplusplus
  19. extern "C"
  20. {
  21. #endif
  22. uint32_t _uavcan_equipment_ahrs_MagneticFieldStrength_encode(struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, uint8_t* buffer
  23. #if CANARD_ENABLE_TAO_OPTION
  24. , bool tao
  25. #endif
  26. );
  27. bool _uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg);
  28. static inline uint32_t uavcan_equipment_ahrs_MagneticFieldStrength_encode(struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, uint8_t* buffer
  29. #if CANARD_ENABLE_TAO_OPTION
  30. , bool tao
  31. #endif
  32. ) {
  33. return _uavcan_equipment_ahrs_MagneticFieldStrength_encode(msg, buffer
  34. #if CANARD_ENABLE_TAO_OPTION
  35. , tao
  36. #endif
  37. );
  38. }
  39. static inline bool uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg) {
  40. return _uavcan_equipment_ahrs_MagneticFieldStrength_decode(transfer, msg);
  41. }
  42. #if defined(CANARD_DSDLC_INTERNAL)
  43. static inline void __uavcan_equipment_ahrs_MagneticFieldStrength_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao);
  44. static inline bool __uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao);
  45. void __uavcan_equipment_ahrs_MagneticFieldStrength_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao) {
  46. (void)buffer;
  47. (void)bit_ofs;
  48. (void)msg;
  49. (void)tao;
  50. for (size_t i=0; i < 3; i++) {
  51. {
  52. uint16_t float16_val = canardConvertNativeFloatToFloat16(msg->magnetic_field_ga[i]);
  53. canardEncodeScalar(buffer, *bit_ofs, 16, &float16_val);
  54. }
  55. *bit_ofs += 16;
  56. }
  57. #pragma GCC diagnostic push
  58. #pragma GCC diagnostic ignored "-Wtype-limits"
  59. const uint8_t magnetic_field_covariance_len = msg->magnetic_field_covariance.len > 9 ? 9 : msg->magnetic_field_covariance.len;
  60. #pragma GCC diagnostic pop
  61. if (!tao) {
  62. canardEncodeScalar(buffer, *bit_ofs, 4, &magnetic_field_covariance_len);
  63. *bit_ofs += 4;
  64. }
  65. for (size_t i=0; i < magnetic_field_covariance_len; i++) {
  66. {
  67. uint16_t float16_val = canardConvertNativeFloatToFloat16(msg->magnetic_field_covariance.data[i]);
  68. canardEncodeScalar(buffer, *bit_ofs, 16, &float16_val);
  69. }
  70. *bit_ofs += 16;
  71. }
  72. }
  73. /*
  74. decode uavcan_equipment_ahrs_MagneticFieldStrength, return true on failure, false on success
  75. */
  76. bool __uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao) {
  77. (void)transfer;
  78. (void)bit_ofs;
  79. (void)msg;
  80. (void)tao;
  81. for (size_t i=0; i < 3; i++) {
  82. {
  83. uint16_t float16_val;
  84. canardDecodeScalar(transfer, *bit_ofs, 16, true, &float16_val);
  85. msg->magnetic_field_ga[i] = canardConvertFloat16ToNativeFloat(float16_val);
  86. }
  87. *bit_ofs += 16;
  88. }
  89. if (!tao) {
  90. canardDecodeScalar(transfer, *bit_ofs, 4, false, &msg->magnetic_field_covariance.len);
  91. *bit_ofs += 4;
  92. } else {
  93. msg->magnetic_field_covariance.len = ((transfer->payload_len*8)-*bit_ofs)/16;
  94. }
  95. #pragma GCC diagnostic push
  96. #pragma GCC diagnostic ignored "-Wtype-limits"
  97. if (msg->magnetic_field_covariance.len > 9) {
  98. return true; /* invalid value */
  99. }
  100. #pragma GCC diagnostic pop
  101. for (size_t i=0; i < msg->magnetic_field_covariance.len; i++) {
  102. {
  103. uint16_t float16_val;
  104. canardDecodeScalar(transfer, *bit_ofs, 16, true, &float16_val);
  105. msg->magnetic_field_covariance.data[i] = canardConvertFloat16ToNativeFloat(float16_val);
  106. }
  107. *bit_ofs += 16;
  108. }
  109. return false; /* success */
  110. }
  111. #endif
  112. #ifdef CANARD_DSDLC_TEST_BUILD
  113. struct uavcan_equipment_ahrs_MagneticFieldStrength sample_uavcan_equipment_ahrs_MagneticFieldStrength_msg(void);
  114. #endif
  115. #ifdef __cplusplus
  116. } // extern "C"
  117. #ifdef DRONECAN_CXX_WRAPPERS
  118. #include <canard/cxx_wrappers.h>
  119. BROADCAST_MESSAGE_CXX_IFACE(uavcan_equipment_ahrs_MagneticFieldStrength, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_ID, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_SIGNATURE, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_MAX_SIZE);
  120. #endif
  121. #endif