|
@ -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); |
|
|
|
|
|
} |