#pragma once #include #include #include #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_MAX_SIZE 25 #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_SIGNATURE (0xE2A7D4A9460BC2F2ULL) #define UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_ID 1001 #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS) class uavcan_equipment_ahrs_MagneticFieldStrength_cxx_iface; #endif struct uavcan_equipment_ahrs_MagneticFieldStrength { #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS) using cxx_iface = uavcan_equipment_ahrs_MagneticFieldStrength_cxx_iface; #endif 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_MagneticFieldStrength_encode(struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, uint8_t* buffer #if CANARD_ENABLE_TAO_OPTION , bool tao #endif ); bool _uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg); static inline uint32_t uavcan_equipment_ahrs_MagneticFieldStrength_encode(struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, uint8_t* buffer #if CANARD_ENABLE_TAO_OPTION , bool tao #endif ) { return _uavcan_equipment_ahrs_MagneticFieldStrength_encode(msg, buffer #if CANARD_ENABLE_TAO_OPTION , tao #endif ); } static inline bool uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg) { return _uavcan_equipment_ahrs_MagneticFieldStrength_decode(transfer, msg); } #if defined(CANARD_DSDLC_INTERNAL) static inline void __uavcan_equipment_ahrs_MagneticFieldStrength_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao); static inline bool __uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao); void __uavcan_equipment_ahrs_MagneticFieldStrength_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao) { (void)buffer; (void)bit_ofs; (void)msg; (void)tao; 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_MagneticFieldStrength, return true on failure, false on success */ bool __uavcan_equipment_ahrs_MagneticFieldStrength_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_ahrs_MagneticFieldStrength* msg, bool tao) { (void)transfer; (void)bit_ofs; (void)msg; (void)tao; 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_MagneticFieldStrength sample_uavcan_equipment_ahrs_MagneticFieldStrength_msg(void); #endif #ifdef __cplusplus } // extern "C" #ifdef DRONECAN_CXX_WRAPPERS #include BROADCAST_MESSAGE_CXX_IFACE(uavcan_equipment_ahrs_MagneticFieldStrength, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_ID, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_SIGNATURE, UAVCAN_EQUIPMENT_AHRS_MAGNETICFIELDSTRENGTH_MAX_SIZE); #endif #endif