vk_radar.radar.VehicleState.h 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134
  1. #pragma once
  2. #include <stdbool.h>
  3. #include <stdint.h>
  4. #include <canard.h>
  5. #define VK_RADAR_RADAR_VEHICLESTATE_MAX_SIZE 35
  6. #define VK_RADAR_RADAR_VEHICLESTATE_SIGNATURE (0xA42468B97604FCBCULL)
  7. #define VK_RADAR_RADAR_VEHICLESTATE_ID 24000
  8. #define VK_RADAR_RADAR_VEHICLESTATE_FLIGHT_STATE_GROUND 0
  9. #define VK_RADAR_RADAR_VEHICLESTATE_FLIGHT_STATE_ARMED 1
  10. #define VK_RADAR_RADAR_VEHICLESTATE_FLIGHT_STATE_FLYING 2
  11. #define VK_RADAR_RADAR_VEHICLESTATE_FLIGHT_STATE_LANDING 3
  12. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  13. class vk_radar_radar_VehicleState_cxx_iface;
  14. #endif
  15. struct vk_radar_radar_VehicleState {
  16. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  17. using cxx_iface = vk_radar_radar_VehicleState_cxx_iface;
  18. #endif
  19. uint32_t time_boot_ms;
  20. float q_enu_wxyz[4];
  21. float p_enu_m[3];
  22. uint16_t terrain_height_cm;
  23. uint8_t flight_state;
  24. uint8_t flags;
  25. };
  26. #ifdef __cplusplus
  27. extern "C"
  28. {
  29. #endif
  30. uint32_t _vk_radar_radar_VehicleState_encode(struct vk_radar_radar_VehicleState* msg, uint8_t* buffer
  31. #if CANARD_ENABLE_TAO_OPTION
  32. , bool tao
  33. #endif
  34. );
  35. bool _vk_radar_radar_VehicleState_decode(const CanardRxTransfer* transfer, struct vk_radar_radar_VehicleState* msg);
  36. static inline uint32_t vk_radar_radar_VehicleState_encode(struct vk_radar_radar_VehicleState* msg, uint8_t* buffer
  37. #if CANARD_ENABLE_TAO_OPTION
  38. , bool tao
  39. #endif
  40. ) {
  41. return _vk_radar_radar_VehicleState_encode(msg, buffer
  42. #if CANARD_ENABLE_TAO_OPTION
  43. , tao
  44. #endif
  45. );
  46. }
  47. static inline bool vk_radar_radar_VehicleState_decode(const CanardRxTransfer* transfer, struct vk_radar_radar_VehicleState* msg) {
  48. return _vk_radar_radar_VehicleState_decode(transfer, msg);
  49. }
  50. #if defined(CANARD_DSDLC_INTERNAL)
  51. static inline void __vk_radar_radar_VehicleState_encode(uint8_t* buffer, uint32_t* bit_ofs, struct vk_radar_radar_VehicleState* msg, bool tao);
  52. static inline bool __vk_radar_radar_VehicleState_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct vk_radar_radar_VehicleState* msg, bool tao);
  53. void __vk_radar_radar_VehicleState_encode(uint8_t* buffer, uint32_t* bit_ofs, struct vk_radar_radar_VehicleState* msg, bool tao) {
  54. (void)buffer;
  55. (void)bit_ofs;
  56. (void)msg;
  57. (void)tao;
  58. canardEncodeScalar(buffer, *bit_ofs, 32, &msg->time_boot_ms);
  59. *bit_ofs += 32;
  60. for (size_t i=0; i < 4; i++) {
  61. canardEncodeScalar(buffer, *bit_ofs, 32, &msg->q_enu_wxyz[i]);
  62. *bit_ofs += 32;
  63. }
  64. for (size_t i=0; i < 3; i++) {
  65. canardEncodeScalar(buffer, *bit_ofs, 32, &msg->p_enu_m[i]);
  66. *bit_ofs += 32;
  67. }
  68. canardEncodeScalar(buffer, *bit_ofs, 16, &msg->terrain_height_cm);
  69. *bit_ofs += 16;
  70. canardEncodeScalar(buffer, *bit_ofs, 3, &msg->flight_state);
  71. *bit_ofs += 3;
  72. canardEncodeScalar(buffer, *bit_ofs, 5, &msg->flags);
  73. *bit_ofs += 5;
  74. }
  75. /*
  76. decode vk_radar_radar_VehicleState, return true on failure, false on success
  77. */
  78. bool __vk_radar_radar_VehicleState_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct vk_radar_radar_VehicleState* msg, bool tao) {
  79. (void)transfer;
  80. (void)bit_ofs;
  81. (void)msg;
  82. (void)tao;
  83. canardDecodeScalar(transfer, *bit_ofs, 32, false, &msg->time_boot_ms);
  84. *bit_ofs += 32;
  85. for (size_t i=0; i < 4; i++) {
  86. canardDecodeScalar(transfer, *bit_ofs, 32, true, &msg->q_enu_wxyz[i]);
  87. *bit_ofs += 32;
  88. }
  89. for (size_t i=0; i < 3; i++) {
  90. canardDecodeScalar(transfer, *bit_ofs, 32, true, &msg->p_enu_m[i]);
  91. *bit_ofs += 32;
  92. }
  93. canardDecodeScalar(transfer, *bit_ofs, 16, false, &msg->terrain_height_cm);
  94. *bit_ofs += 16;
  95. canardDecodeScalar(transfer, *bit_ofs, 3, false, &msg->flight_state);
  96. *bit_ofs += 3;
  97. canardDecodeScalar(transfer, *bit_ofs, 5, false, &msg->flags);
  98. *bit_ofs += 5;
  99. return false; /* success */
  100. }
  101. #endif
  102. #ifdef CANARD_DSDLC_TEST_BUILD
  103. struct vk_radar_radar_VehicleState sample_vk_radar_radar_VehicleState_msg(void);
  104. #endif
  105. #ifdef __cplusplus
  106. } // extern "C"
  107. #ifdef DRONECAN_CXX_WRAPPERS
  108. #include <canard/cxx_wrappers.h>
  109. BROADCAST_MESSAGE_CXX_IFACE(vk_radar_radar_VehicleState, VK_RADAR_RADAR_VEHICLESTATE_ID, VK_RADAR_RADAR_VEHICLESTATE_SIGNATURE, VK_RADAR_RADAR_VEHICLESTATE_MAX_SIZE);
  110. #endif
  111. #endif