You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

74 lines
2.9 KiB

2 years ago
  1. #pragma once
  2. #include <stdint.h>
  3. #define ZPACKET_STRUCT(ordername, type, ...) \
  4. typedef struct { \
  5. __VA_ARGS__ \
  6. } ordername##_##type##_t
  7. #define ZPACKET_CMD_ACK(ordername, cmdpara, ackpara) \
  8. typedef struct { \
  9. cmdpara \
  10. } ordername##_##cmd##_t; \
  11. typedef struct { \
  12. ackpara \
  13. } ordername##_##ack##_t
  14. #define ZPACKET_CMD_ACK_AND_REPORT(ordername, cmdpara, ackpara, reportpara) \
  15. typedef struct { \
  16. cmdpara \
  17. } ordername##_##cmd##_t; \
  18. typedef struct { \
  19. ackpara \
  20. } ordername##_##ack##_t; \
  21. typedef struct { \
  22. reportpara \
  23. } ordername##_##report##_t
  24. #define PROCESS_PACKET(ordername, varid) \
  25. if (rxcmd->iscmd(ordername)) { \
  26. auto* cmd = rxcmd->get_data_as<ordername##_##cmd##_t>(); \
  27. auto* ack = (ordername##_##ack##_t*)m_txbuf; \
  28. auto cmdheader = rxcmd->get_cmdheader(); \
  29. uint32_t errorcode = 0; \
  30. if (cmd->id == varid) { \
  31. ack->id = cmd->id;
  32. #define END_PROCESS_PACKET() \
  33. if (errorcode == 0) { \
  34. m_cancmder->sendAck(rxcmd->get_cmdheader(), m_txbuf, sizeof(*ack)); \
  35. } else { \
  36. m_cancmder->sendErrorAck(rxcmd->get_cmdheader(), errorcode); \
  37. } \
  38. } \
  39. return; \
  40. }
  41. #define END_PP END_PROCESS_PACKET
  42. #define CMD(x) x
  43. #define ACK(x) x
  44. #define REPORT(x) x
  45. namespace iflytop {
  46. namespace zcr {
  47. #pragma pack(push, 1)
  48. typedef struct {
  49. uint16_t packetindex;
  50. uint16_t cmdid;
  51. uint8_t subcmdid;
  52. uint8_t packetType;
  53. uint8_t data[];
  54. } Cmdheader_t;
  55. #pragma pack(pop)
  56. typedef enum {
  57. kpt_cmd = 0,
  58. kpt_ack = 1,
  59. kpt_error_ack = 2,
  60. kpt_cmd_exec_status_report = 3,
  61. } PacketType_t;
  62. #define CMDID(cmdid, subcmdid) ((cmdid << 8) + subcmdid)
  63. } // namespace zcr
  64. } // namespace iflytop