uavcan.equipment.ahrs.MagneticFieldStrength2.h 5.3 KB

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