Browse Source

update

master
zhaohe 2 years ago
parent
commit
961a2ac2e5
  1. 9
      components/step_motor_45/step_motor_45.cpp

9
components/step_motor_45/step_motor_45.cpp

@ -53,6 +53,7 @@ void StepMotor45::initialize(cfg_t cfg) {
ZASSERT(m_zeroPinZGPIO != NULL); ZASSERT(m_zeroPinZGPIO != NULL);
m_zeroPinZGPIO->initAsInput(cfg.zeroPin, ZGPIO::kMode_pullup, ZGPIO::kIRQ_noIrq, cfg.zeroPinMirror); m_zeroPinZGPIO->initAsInput(cfg.zeroPin, ZGPIO::kMode_pullup, ZGPIO::kIRQ_noIrq, cfg.zeroPinMirror);
} }
setdriverpinstate(1, 1, 1, 1);
return; return;
} }
@ -175,7 +176,7 @@ void StepMotor45::schedule() {
m_off += direction; m_off += direction;
if (m_off < 0) { if (m_off < 0) {
m_off = MAX_STEP_TABLE_OFF; 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; m_off = 0;
} }
@ -249,4 +250,8 @@ void StepMotor45::setdriverpinstate(bool s1, bool s2, bool s3, bool s4) {
m_driverPinZGPIO[3]->setState(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);
}
Loading…
Cancel
Save