diff --git a/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp b/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp index 628e863..507f2c5 100644 --- a/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp +++ b/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp @@ -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;