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.

122 lines
4.3 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
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 "basic_type.hpp"
  5. //
  6. namespace iflytop {
  7. using namespace std;
  8. class I_StepMotorCtrlModule {
  9. public:
  10. typedef enum { hbot, corexy } RobotType_t;
  11. typedef enum { kNormalStop, kBreakStop } StopType_t;
  12. /*******************************************************************************
  13. * ACTION *
  14. *******************************************************************************/
  15. #pragma pack(1)
  16. /*******************************************************************************
  17. * READ *
  18. *******************************************************************************/
  19. typedef struct {
  20. int32_t version;
  21. } version_t;
  22. typedef struct {
  23. uint8_t status;
  24. uint8_t io_state; // x_zero_io x_end_io
  25. int32_t x;
  26. } status_t;
  27. typedef struct {
  28. uint8_t status;
  29. uint8_t io_state; // x_zero_io x_end_io
  30. int32_t x;
  31. int32_t last_exec_status;
  32. } detailed_status_t;
  33. /*******************************************************************************
  34. * CFG *
  35. *******************************************************************************/
  36. typedef struct {
  37. s32 x_shaft;
  38. s32 distance_scale; // 0.001
  39. s32 ihold;
  40. s32 irun;
  41. u16 iholddelay;
  42. s32 acc;
  43. s32 dec;
  44. s32 maxspeed;
  45. s32 min_x;
  46. s32 max_x;
  47. //
  48. s32 shift_x;
  49. s32 run_to_zero_move_to_zero_max_d;
  50. s32 run_to_zero_leave_from_zero_max_d;
  51. s32 run_to_zero_speed;
  52. s32 run_to_zero_dec;
  53. } base_param_t;
  54. typedef struct {
  55. u8 index;
  56. s32 acc;
  57. s32 dec;
  58. s32 velocity;
  59. s32 x;
  60. } logic_point_t;
  61. typedef struct {
  62. base_param_t base_param;
  63. logic_point_t logic_point[5];
  64. } flash_config_t;
  65. #pragma pack()
  66. public:
  67. virtual bool isbusy() = 0;
  68. virtual int32_t get_last_exec_status() = 0;
  69. virtual int32_t move_to(int32_t x, action_cb_status_t status_cb) = 0;
  70. virtual int32_t move_by(int32_t dx, action_cb_status_t status_cb) = 0;
  71. virtual int32_t move_to(int32_t x, int32_t velocity, action_cb_status_t status_cb) = 0;
  72. virtual int32_t move_by(int32_t dx, int32_t velocity, action_cb_status_t status_cb) = 0;
  73. virtual int32_t move_to_zero(action_cb_status_t status_cb) = 0;
  74. virtual int32_t move_to_zero_with_calibrate(int32_t x, action_cb_status_t status_cb) = 0;
  75. virtual int32_t rotate(int32_t speed, int32_t lastforms, action_cb_status_t status_cb) = 0;
  76. virtual int32_t enable(bool venable) = 0;
  77. virtual int32_t stop(uint8_t stopType) = 0;
  78. virtual int32_t force_change_current_pos(int32_t x) = 0;
  79. virtual int32_t move_to_logic_point(int32_t logic_point_num, action_cb_status_t status_cb) = 0;
  80. virtual int32_t set_logic_point(int logic_point_num, int32_t x, int32_t vel, s32 acc, s32 dec) = 0;
  81. virtual int32_t get_logic_point(int logic_point_num, logic_point_t& logic_point) = 0;
  82. virtual int32_t flush() = 0;
  83. virtual int32_t factory_reset() = 0;
  84. virtual int32_t move_to_block(int32_t tox, int overtime = 0) = 0;
  85. virtual int32_t move_by_block(int32_t dx, int overtime = 0) = 0;
  86. virtual int32_t move_to_block(int32_t tox, int32_t velocity, int overtime = 0) = 0;
  87. virtual int32_t move_by_block(int32_t dx, int32_t velocity, int overtime = 0) = 0;
  88. virtual int32_t move_to_zero_block(int overtime = 0) = 0;
  89. virtual int32_t move_to_zero_with_calibrate_block(int32_t x, int overtime = 0) = 0;
  90. virtual int32_t read_version(version_t& version) = 0;
  91. virtual int32_t read_status(status_t& status) = 0;
  92. virtual int32_t read_detailed_status(detailed_status_t& debug_info) = 0;
  93. virtual int32_t read_pos(int32_t& pos) = 0;
  94. virtual int32_t read_pos() = 0;
  95. virtual bool read_zero_io_state() = 0;
  96. virtual int32_t set_base_param(const base_param_t& param) = 0;
  97. virtual int32_t get_base_param(base_param_t& param) = 0;
  98. ~I_StepMotorCtrlModule() {}
  99. };
  100. } // namespace iflytop