uavcan.equipment.camera_gimbal.AngularCommand.h 4.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113
  1. #pragma once
  2. #include <stdbool.h>
  3. #include <stdint.h>
  4. #include <canard.h>
  5. #include <uavcan.equipment.camera_gimbal.Mode.h>
  6. #define UAVCAN_EQUIPMENT_CAMERA_GIMBAL_ANGULARCOMMAND_MAX_SIZE 10
  7. #define UAVCAN_EQUIPMENT_CAMERA_GIMBAL_ANGULARCOMMAND_SIGNATURE (0x4AF6E57B2B2BE29CULL)
  8. #define UAVCAN_EQUIPMENT_CAMERA_GIMBAL_ANGULARCOMMAND_ID 1040
  9. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  10. class uavcan_equipment_camera_gimbal_AngularCommand_cxx_iface;
  11. #endif
  12. struct uavcan_equipment_camera_gimbal_AngularCommand {
  13. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  14. using cxx_iface = uavcan_equipment_camera_gimbal_AngularCommand_cxx_iface;
  15. #endif
  16. uint8_t gimbal_id;
  17. struct uavcan_equipment_camera_gimbal_Mode mode;
  18. float quaternion_xyzw[4];
  19. };
  20. #ifdef __cplusplus
  21. extern "C"
  22. {
  23. #endif
  24. uint32_t _uavcan_equipment_camera_gimbal_AngularCommand_encode(struct uavcan_equipment_camera_gimbal_AngularCommand* msg, uint8_t* buffer
  25. #if CANARD_ENABLE_TAO_OPTION
  26. , bool tao
  27. #endif
  28. );
  29. bool _uavcan_equipment_camera_gimbal_AngularCommand_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_camera_gimbal_AngularCommand* msg);
  30. static inline uint32_t uavcan_equipment_camera_gimbal_AngularCommand_encode(struct uavcan_equipment_camera_gimbal_AngularCommand* msg, uint8_t* buffer
  31. #if CANARD_ENABLE_TAO_OPTION
  32. , bool tao
  33. #endif
  34. ) {
  35. return _uavcan_equipment_camera_gimbal_AngularCommand_encode(msg, buffer
  36. #if CANARD_ENABLE_TAO_OPTION
  37. , tao
  38. #endif
  39. );
  40. }
  41. static inline bool uavcan_equipment_camera_gimbal_AngularCommand_decode(const CanardRxTransfer* transfer, struct uavcan_equipment_camera_gimbal_AngularCommand* msg) {
  42. return _uavcan_equipment_camera_gimbal_AngularCommand_decode(transfer, msg);
  43. }
  44. #if defined(CANARD_DSDLC_INTERNAL)
  45. static inline void __uavcan_equipment_camera_gimbal_AngularCommand_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_camera_gimbal_AngularCommand* msg, bool tao);
  46. static inline bool __uavcan_equipment_camera_gimbal_AngularCommand_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_camera_gimbal_AngularCommand* msg, bool tao);
  47. void __uavcan_equipment_camera_gimbal_AngularCommand_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_equipment_camera_gimbal_AngularCommand* msg, bool tao) {
  48. (void)buffer;
  49. (void)bit_ofs;
  50. (void)msg;
  51. (void)tao;
  52. canardEncodeScalar(buffer, *bit_ofs, 8, &msg->gimbal_id);
  53. *bit_ofs += 8;
  54. __uavcan_equipment_camera_gimbal_Mode_encode(buffer, bit_ofs, &msg->mode, false);
  55. for (size_t i=0; i < 4; i++) {
  56. {
  57. uint16_t float16_val = canardConvertNativeFloatToFloat16(msg->quaternion_xyzw[i]);
  58. canardEncodeScalar(buffer, *bit_ofs, 16, &float16_val);
  59. }
  60. *bit_ofs += 16;
  61. }
  62. }
  63. /*
  64. decode uavcan_equipment_camera_gimbal_AngularCommand, return true on failure, false on success
  65. */
  66. bool __uavcan_equipment_camera_gimbal_AngularCommand_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_equipment_camera_gimbal_AngularCommand* msg, bool tao) {
  67. (void)transfer;
  68. (void)bit_ofs;
  69. (void)msg;
  70. (void)tao;
  71. canardDecodeScalar(transfer, *bit_ofs, 8, false, &msg->gimbal_id);
  72. *bit_ofs += 8;
  73. if (__uavcan_equipment_camera_gimbal_Mode_decode(transfer, bit_ofs, &msg->mode, false)) {return true;}
  74. for (size_t i=0; i < 4; i++) {
  75. {
  76. uint16_t float16_val;
  77. canardDecodeScalar(transfer, *bit_ofs, 16, true, &float16_val);
  78. msg->quaternion_xyzw[i] = canardConvertFloat16ToNativeFloat(float16_val);
  79. }
  80. *bit_ofs += 16;
  81. }
  82. return false; /* success */
  83. }
  84. #endif
  85. #ifdef CANARD_DSDLC_TEST_BUILD
  86. struct uavcan_equipment_camera_gimbal_AngularCommand sample_uavcan_equipment_camera_gimbal_AngularCommand_msg(void);
  87. #endif
  88. #ifdef __cplusplus
  89. } // extern "C"
  90. #ifdef DRONECAN_CXX_WRAPPERS
  91. #include <canard/cxx_wrappers.h>
  92. BROADCAST_MESSAGE_CXX_IFACE(uavcan_equipment_camera_gimbal_AngularCommand, UAVCAN_EQUIPMENT_CAMERA_GIMBAL_ANGULARCOMMAND_ID, UAVCAN_EQUIPMENT_CAMERA_GIMBAL_ANGULARCOMMAND_SIGNATURE, UAVCAN_EQUIPMENT_CAMERA_GIMBAL_ANGULARCOMMAND_MAX_SIZE);
  93. #endif
  94. #endif