|
@ -79,6 +79,10 @@ class StepMotorCtrlModule : public ZIModule, public ZIStepMotor { |
|
|
virtual int32_t step_motor_active_cfg() override; |
|
|
virtual int32_t step_motor_active_cfg() override; |
|
|
virtual int32_t step_motor_read_io_state(int32_t ioindex, int32_t* state) override; |
|
|
virtual int32_t step_motor_read_io_state(int32_t ioindex, int32_t* state) override; |
|
|
|
|
|
|
|
|
|
|
|
public: |
|
|
|
|
|
IStepperMotor* getMotor() { return m_stepM1; } |
|
|
|
|
|
config_t* getCfg() { return &m_cfg; } |
|
|
|
|
|
|
|
|
private: |
|
|
private: |
|
|
void inter_inverse_kinematics(int32_t motor_pos, int32_t& x); |
|
|
void inter_inverse_kinematics(int32_t motor_pos, int32_t& x); |
|
|
void inter_forward_kinematics(int32_t x, int32_t& motor_pos); |
|
|
void inter_forward_kinematics(int32_t x, int32_t& motor_pos); |
|
|