diff --git a/components/step_motor_45/step_motor_45.cpp b/components/step_motor_45/step_motor_45.cpp index 4abd164..10cbe4e 100644 --- a/components/step_motor_45/step_motor_45.cpp +++ b/components/step_motor_45/step_motor_45.cpp @@ -53,6 +53,7 @@ void StepMotor45::initialize(cfg_t cfg) { ZASSERT(m_zeroPinZGPIO != NULL); m_zeroPinZGPIO->initAsInput(cfg.zeroPin, ZGPIO::kMode_pullup, ZGPIO::kIRQ_noIrq, cfg.zeroPinMirror); } + setdriverpinstate(1, 1, 1, 1); return; } @@ -175,7 +176,7 @@ void StepMotor45::schedule() { m_off += direction; if (m_off < 0) { m_off = MAX_STEP_TABLE_OFF; - } else if (m_off >(int) MAX_STEP_TABLE_OFF) { + } else if (m_off > (int)MAX_STEP_TABLE_OFF) { m_off = 0; } @@ -249,4 +250,8 @@ void StepMotor45::setdriverpinstate(bool s1, bool s2, bool s3, bool s4) { m_driverPinZGPIO[3]->setState(s4); } -void StepMotor45::stop_motor() { m_state = kstop; } +void StepMotor45::stop_motor() { + m_state = kstop; + + setdriverpinstate(1, 1, 1, 1); +}