uavcan.protocol.NodeStatus.h 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108
  1. #pragma once
  2. #include <stdbool.h>
  3. #include <stdint.h>
  4. #include <canard.h>
  5. #define UAVCAN_PROTOCOL_NODESTATUS_MAX_SIZE 7
  6. #define UAVCAN_PROTOCOL_NODESTATUS_SIGNATURE (0xF0868D0C1A7C6F1ULL)
  7. #define UAVCAN_PROTOCOL_NODESTATUS_ID 341
  8. #define UAVCAN_PROTOCOL_NODESTATUS_MAX_BROADCASTING_PERIOD_MS 1000
  9. #define UAVCAN_PROTOCOL_NODESTATUS_MIN_BROADCASTING_PERIOD_MS 2
  10. #define UAVCAN_PROTOCOL_NODESTATUS_OFFLINE_TIMEOUT_MS 3000
  11. #define UAVCAN_PROTOCOL_NODESTATUS_HEALTH_OK 0
  12. #define UAVCAN_PROTOCOL_NODESTATUS_HEALTH_WARNING 1
  13. #define UAVCAN_PROTOCOL_NODESTATUS_HEALTH_ERROR 2
  14. #define UAVCAN_PROTOCOL_NODESTATUS_HEALTH_CRITICAL 3
  15. #define UAVCAN_PROTOCOL_NODESTATUS_MODE_OPERATIONAL 0
  16. #define UAVCAN_PROTOCOL_NODESTATUS_MODE_INITIALIZATION 1
  17. #define UAVCAN_PROTOCOL_NODESTATUS_MODE_MAINTENANCE 2
  18. #define UAVCAN_PROTOCOL_NODESTATUS_MODE_SOFTWARE_UPDATE 3
  19. #define UAVCAN_PROTOCOL_NODESTATUS_MODE_OFFLINE 7
  20. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  21. class uavcan_protocol_NodeStatus_cxx_iface;
  22. #endif
  23. struct uavcan_protocol_NodeStatus {
  24. #if defined(__cplusplus) && defined(DRONECAN_CXX_WRAPPERS)
  25. using cxx_iface = uavcan_protocol_NodeStatus_cxx_iface;
  26. #endif
  27. uint32_t uptime_sec;
  28. uint8_t health;
  29. uint8_t mode;
  30. uint8_t sub_mode;
  31. uint16_t vendor_specific_status_code;
  32. };
  33. #ifdef __cplusplus
  34. extern "C"
  35. {
  36. #endif
  37. uint32_t uavcan_protocol_NodeStatus_encode(struct uavcan_protocol_NodeStatus* msg, uint8_t* buffer
  38. #if CANARD_ENABLE_TAO_OPTION
  39. , bool tao
  40. #endif
  41. );
  42. bool uavcan_protocol_NodeStatus_decode(const CanardRxTransfer* transfer, struct uavcan_protocol_NodeStatus* msg);
  43. #if defined(CANARD_DSDLC_INTERNAL)
  44. static inline void _uavcan_protocol_NodeStatus_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_protocol_NodeStatus* msg, bool tao);
  45. static inline bool _uavcan_protocol_NodeStatus_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_protocol_NodeStatus* msg, bool tao);
  46. void _uavcan_protocol_NodeStatus_encode(uint8_t* buffer, uint32_t* bit_ofs, struct uavcan_protocol_NodeStatus* msg, bool tao) {
  47. (void)buffer;
  48. (void)bit_ofs;
  49. (void)msg;
  50. (void)tao;
  51. canardEncodeScalar(buffer, *bit_ofs, 32, &msg->uptime_sec);
  52. *bit_ofs += 32;
  53. canardEncodeScalar(buffer, *bit_ofs, 2, &msg->health);
  54. *bit_ofs += 2;
  55. canardEncodeScalar(buffer, *bit_ofs, 3, &msg->mode);
  56. *bit_ofs += 3;
  57. canardEncodeScalar(buffer, *bit_ofs, 3, &msg->sub_mode);
  58. *bit_ofs += 3;
  59. canardEncodeScalar(buffer, *bit_ofs, 16, &msg->vendor_specific_status_code);
  60. *bit_ofs += 16;
  61. }
  62. /*
  63. decode uavcan_protocol_NodeStatus, return true on failure, false on success
  64. */
  65. bool _uavcan_protocol_NodeStatus_decode(const CanardRxTransfer* transfer, uint32_t* bit_ofs, struct uavcan_protocol_NodeStatus* msg, bool tao) {
  66. (void)transfer;
  67. (void)bit_ofs;
  68. (void)msg;
  69. (void)tao;
  70. canardDecodeScalar(transfer, *bit_ofs, 32, false, &msg->uptime_sec);
  71. *bit_ofs += 32;
  72. canardDecodeScalar(transfer, *bit_ofs, 2, false, &msg->health);
  73. *bit_ofs += 2;
  74. canardDecodeScalar(transfer, *bit_ofs, 3, false, &msg->mode);
  75. *bit_ofs += 3;
  76. canardDecodeScalar(transfer, *bit_ofs, 3, false, &msg->sub_mode);
  77. *bit_ofs += 3;
  78. canardDecodeScalar(transfer, *bit_ofs, 16, false, &msg->vendor_specific_status_code);
  79. *bit_ofs += 16;
  80. return false; /* success */
  81. }
  82. #endif
  83. #ifdef CANARD_DSDLC_TEST_BUILD
  84. struct uavcan_protocol_NodeStatus sample_uavcan_protocol_NodeStatus_msg(void);
  85. #endif
  86. #ifdef __cplusplus
  87. } // extern "C"
  88. #ifdef DRONECAN_CXX_WRAPPERS
  89. #include <canard/cxx_wrappers.h>
  90. BROADCAST_MESSAGE_CXX_IFACE(uavcan_protocol_NodeStatus, UAVCAN_PROTOCOL_NODESTATUS_ID, UAVCAN_PROTOCOL_NODESTATUS_SIGNATURE, UAVCAN_PROTOCOL_NODESTATUS_MAX_SIZE);
  91. #endif
  92. #endif