|
|
@ -22,6 +22,7 @@ void StepMotorCtrlModule::initialize(int moduleid, IStepperMotor* stepM, ZGPIO i |
|
|
|
m_state.dpos = 0; |
|
|
|
|
|
|
|
step_motor_active_cfg(); |
|
|
|
step_motor_enable(true); |
|
|
|
} |
|
|
|
void StepMotorCtrlModule::create_default_cfg(config_t& cfg) { |
|
|
|
memset(&cfg, 0, sizeof(cfg)); |
|
|
@ -204,6 +205,7 @@ int32_t StepMotorCtrlModule::step_motor_easy_move_to_zero() { |
|
|
|
befor_motor_move(); |
|
|
|
exec_move_to_io_task(0, -1); |
|
|
|
after_motor_move(); |
|
|
|
m_stepM1->setXACTUAL(0); |
|
|
|
}, |
|
|
|
[this]() { m_stepM1->stop(); }); |
|
|
|
return 0; |
|
|
|