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.

156 lines
5.7 KiB

2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
1 year ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
  1. #pragma once
  2. #include <stdint.h>
  3. #include <functional>
  4. #include "errorcode.hpp"
  5. #include "module_type_index.hpp"
  6. namespace iflytop {
  7. using namespace std;
  8. #define REG_SET(reg, ...) _module_set_reg(param_id, &reg, val, ##__VA_ARGS__)
  9. #define REG_GET(reg) _module_get_reg(param_id, reg, val)
  10. #define REG_SET_FLOAT(reg, precision, ...) _module_set_reg_float(param_id, &reg, val, precision, ##__VA_ARGS__)
  11. #define REG_GET_FLOAT(reg, precision) _module_get_reg_float(param_id, reg, val, precision)
  12. #define ACTION_NONE 0
  13. #define PROCESS_REG(param_id, readaction, writeacton) \
  14. case param_id: { \
  15. if (read) { \
  16. return readaction; \
  17. } else { \
  18. return writeacton; \
  19. } \
  20. } break;
  21. #define ENABLE_MODULE(name, type, version) \
  22. const char *module_name = #name; \
  23. int32_t module_version = version; \
  24. int32_t module_type = type;
  25. #define MODULE_COMMON_PROCESS_REG_CB() \
  26. PROCESS_REG(kreg_module_version, /* */ REG_GET(module_version), ACTION_NONE); \
  27. PROCESS_REG(kreg_module_type, /* */ REG_GET(module_type), ACTION_NONE); \
  28. PROCESS_REG(kreg_module_status, /* */ module_get_status(&val), ACTION_NONE); \
  29. PROCESS_REG(kreg_module_errorcode, /* */ REG_GET(m_com_reg.module_errorcode), ACTION_NONE); \
  30. PROCESS_REG(kreg_module_initflag, /* */ module_get_inited_flag(&val), module_set_inited_flag(val)); \
  31. PROCESS_REG(kreg_module_errorbitflag0, /* */ REG_GET(m_com_reg.module_errorbitflag0), ACTION_NONE); \
  32. PROCESS_REG(kreg_module_enableflag, /* */ REG_GET(m_com_reg.module_enable), ACTION_NONE);
  33. typedef struct {
  34. int32_t module_errorcode;
  35. int32_t module_errorbitflag0;
  36. int32_t module_enable;
  37. } module_common_reg_t;
  38. class ModuleCMDExecStatus {
  39. public:
  40. int32_t exec_status = 0;
  41. int32_t exec_val[6] = {0};
  42. void set_exec_status(int32_t status, int32_t val0 = 0, int32_t val1 = 0, int32_t val2 = 0, int32_t val3 = 0, int32_t val4 = 0, int32_t val5 = 0) {
  43. exec_status = status;
  44. exec_val[0] = val0;
  45. exec_val[1] = val1;
  46. exec_val[2] = val2;
  47. exec_val[3] = val3;
  48. exec_val[4] = val4;
  49. exec_val[5] = val5;
  50. }
  51. };
  52. class ZIModule {
  53. int32_t m_inited_flag = 0;
  54. protected:
  55. module_common_reg_t m_com_reg;
  56. public:
  57. virtual ~ZIModule() {}
  58. virtual int32_t getid(int32_t *id) = 0;
  59. virtual int32_t getid() {
  60. int32_t id = 0;
  61. getid(&id);
  62. return id;
  63. };
  64. virtual int32_t module_ping() { return 0; };
  65. virtual int32_t module_stop() { return err::koperation_not_support; }
  66. virtual int32_t module_break() { return module_stop(); }
  67. virtual int32_t module_start() { return err::koperation_not_support; }
  68. virtual int32_t module_get_last_exec_status(int32_t *status) { return err::koperation_not_support; }
  69. virtual int32_t module_get_status(int32_t *status) = 0;
  70. virtual int32_t module_get_error(int32_t *iserror) {
  71. *iserror = m_com_reg.module_errorcode;
  72. return 0;
  73. }
  74. virtual int32_t module_clear_error() {
  75. m_com_reg.module_errorcode = 0;
  76. m_com_reg.module_errorbitflag0 = 0;
  77. return 0;
  78. }
  79. virtual int32_t module_enable(int32_t enable) { return err::koperation_not_support; }
  80. virtual int32_t module_xxx_reg(int32_t param_id, bool read, int32_t &val) { return err::koperation_not_support; }
  81. virtual int32_t module_set_reg(int32_t param_id, int32_t param_value) { return module_xxx_reg(param_id, false, param_value); }
  82. virtual int32_t module_get_reg(int32_t param_id, int32_t *param_value) { return module_xxx_reg(param_id, true, *param_value); }
  83. virtual int32_t module_readio(int32_t *io) { return err::koperation_not_support; }
  84. virtual int32_t module_writeio(int32_t idindex, int32_t io) { return err::koperation_not_support; }
  85. virtual int32_t module_read_adc(int32_t adcindex, int32_t *adc) { return err::koperation_not_support; }
  86. virtual int32_t module_read_raw(int32_t index, uint8_t *data, int32_t *len) { return err::koperation_not_support; }
  87. virtual int32_t module_set_inited_flag(int32_t flag) {
  88. m_inited_flag = flag;
  89. return 0;
  90. }
  91. virtual int32_t module_get_inited_flag(int32_t *flag) {
  92. *flag = m_inited_flag;
  93. return 0;
  94. }
  95. virtual int32_t module_get_inited_flag() { return m_inited_flag; }
  96. // kmodule_factory_reset = CMDID(1, 14), // para:{}, ack:{}
  97. // kmodule_flush_cfg = CMDID(1, 15), // para:{}, ack:{}
  98. // kmodule_active_cfg = CMDID(1, 16), // para:{}, ack:{}
  99. virtual int32_t module_factory_reset() { return err::koperation_not_support; }
  100. virtual int32_t module_flush_cfg() { return err::ksucc; }
  101. virtual int32_t module_active_cfg() { return err::ksucc; }
  102. virtual int32_t _module_set_reg(int32_t regoff, int32_t *regval, int32_t val, int32_t min = INT32_MIN, int32_t max = INT32_MAX) {
  103. if (val < min || val > max) {
  104. return err::kparam_out_of_range;
  105. }
  106. *regval = val;
  107. return 0;
  108. }
  109. virtual int32_t _module_get_reg(int32_t regoff, int32_t regval, int32_t &val) {
  110. val = regval;
  111. return 0;
  112. }
  113. virtual int32_t _module_set_reg_float(int32_t regoff, float *regval, int32_t val, float precision, int32_t min = INT32_MIN, int32_t max = INT32_MAX) {
  114. if (val < min || val > max) {
  115. return err::kparam_out_of_range;
  116. }
  117. *regval = val * precision;
  118. return 0;
  119. }
  120. virtual int32_t _module_get_reg_float(int32_t regoff, float regval, int32_t &val, float precision) {
  121. val = regval / precision;
  122. return 0;
  123. }
  124. public:
  125. };
  126. } // namespace iflytop