| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146 |
- #pragma once
- #include <stdbool.h>
- #include <stdint.h>
- #include <canard.h>
- #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH2_MAX_SIZE 26
- #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH2_SIGNATURE (0xB6AC0C442430297EULL)
- #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH2_ID 1002
- #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
- class uavcan_equipment_ahrs_MagneticFieldStrength2_cxx_iface;
- #endif
- struct uavcan_equipment_ahrs_MagneticFieldStrength2 {
- #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
- using cxx_iface = uavcan_equipment_ahrs_MagneticFieldStrength2_cxx_iface;
- #endif
- uint8_t sensor_id;
- float magnetic_field_ga[3];
- struct { uint8_t len; float data[9]; }magnetic_field_covariance;
- };
- #ifdef __cplusplus
- extern "C"
- {
- #endif
- uint32_t _uavcan_equipment_ahrs_MagneticFieldStrength2_encode(struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg, uint8_t* buffer
- #if CANARD_ENABLE_TAO_OPTION
- , bool tao
- #endif
- );
- bool _uavcan_equipment_ahrs_MagneticFieldStrength2_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg);
- static inline uint32_t uavcan_equipment_ahrs_MagneticFieldStrength2_encode(struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg, uint8_t* buffer
- #if CANARD_ENABLE_TAO_OPTION
- , bool tao
- #endif
- ) {
- return _uavcan_equipment_ahrs_MagneticFieldStrength2_encode(msg, buffer
- #if CANARD_ENABLE_TAO_OPTION
- , tao
- #endif
- );
- }
- static inline bool uavcan_equipment_ahrs_MagneticFieldStrength2_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg) {
- return _uavcan_equipment_ahrs_MagneticFieldStrength2_decode(transfer, msg);
- }
- #if defined(CANARD_DSDLC_INTERNAL)
- static inline void __uavcan_equipment_ahrs_MagneticFieldStrength2_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg, bool tao);
- static inline bool __uavcan_equipment_ahrs_MagneticFieldStrength2_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg, bool tao);
- void __uavcan_equipment_ahrs_MagneticFieldStrength2_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg, bool tao) {
- (void)buffer;
- (void)bit_ofs;
- (void)msg;
- (void)tao;
- canardEncodeScalar(buffer, *bit_ofs, 8, &msg->sensor_id);
- *bit_ofs += 8;
- for (size_t i=0; i < 3; i++) {
- {
- uint16_t float16_val = canardConvertNativeFloatToFloat16(msg->magnetic_field_ga[i]);
- canardEncodeScalar(buffer, *bit_ofs, 16, &float16_val);
- }
- *bit_ofs += 16;
- }
- #pragma GCC diagnostic push
- #pragma GCC diagnostic ignored "-Wtype-limits"
- const uint8_t magnetic_field_covariance_len = msg->magnetic_field_covariance.len > 9 ? 9 : msg->magnetic_field_covariance.len;
- #pragma GCC diagnostic pop
- if (!tao) {
- canardEncodeScalar(buffer, *bit_ofs, 4, &magnetic_field_covariance_len);
- *bit_ofs += 4;
- }
- for (size_t i=0; i < magnetic_field_covariance_len; i++) {
- {
- uint16_t float16_val = canardConvertNativeFloatToFloat16(msg->magnetic_field_covariance.data[i]);
- canardEncodeScalar(buffer, *bit_ofs, 16, &float16_val);
- }
- *bit_ofs += 16;
- }
- }
- /*
- decode uavcan_equipment_ahrs_MagneticFieldStrength2, return true on failure, false on success
- */
- bool __uavcan_equipment_ahrs_MagneticFieldStrength2_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength2* msg, bool tao) {
- (void)transfer;
- (void)bit_ofs;
- (void)msg;
- (void)tao;
- canardDecodeScalar(transfer, *bit_ofs, 8, false, &msg->sensor_id);
- *bit_ofs += 8;
- for (size_t i=0; i < 3; i++) {
- {
- uint16_t float16_val;
- canardDecodeScalar(transfer, *bit_ofs, 16, true, &float16_val);
- msg->magnetic_field_ga[i] = canardConvertFloat16ToNativeFloat(float16_val);
- }
- *bit_ofs += 16;
- }
- if (!tao) {
- canardDecodeScalar(transfer, *bit_ofs, 4, false, &msg->magnetic_field_covariance.len);
- *bit_ofs += 4;
- } else {
- msg->magnetic_field_covariance.len = ((transfer->payload_len*8)-*bit_ofs)/16;
- }
- #pragma GCC diagnostic push
- #pragma GCC diagnostic ignored "-Wtype-limits"
- if (msg->magnetic_field_covariance.len > 9) {
- return true; /* invalid value */
- }
- #pragma GCC diagnostic pop
- for (size_t i=0; i < msg->magnetic_field_covariance.len; i++) {
- {
- uint16_t float16_val;
- canardDecodeScalar(transfer, *bit_ofs, 16, true, &float16_val);
- msg->magnetic_field_covariance.data[i] = canardConvertFloat16ToNativeFloat(float16_val);
- }
- *bit_ofs += 16;
- }
- return false; /* success */
- }
- #endif
- #ifdef CANARD_DSDLC_TEST_BUILD
- struct uavcan_equipment_ahrs_MagneticFieldStrength2 sample_uavcan_equipment_ahrs_MagneticFieldStrength2_msg(void);
- #endif
- #ifdef __cplusplus
- } // extern "C"
- #ifdef DRONECAN_CXX_WRAPPERS
- #include <canard/cxx_wrappers.h>
- BROADCAST_MESSAGE_CXX_IFACE(uavcan_equipment_ahrs_MagneticFieldStrength2, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH2_ID, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH2_SIGNATURE, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH2_MAX_SIZE);
- #endif
- #endif
|