Fixed setting of pwmWritePtr
This commit is contained in:
parent
b07c6c492a
commit
3229390848
|
@ -216,20 +216,21 @@ void pwmBrushlessMotorConfig(const timerHardware_t *timerHardware, uint8_t motor
|
||||||
void pwmFastPwmMotorConfig(const timerHardware_t *timerHardware, uint8_t motorIndex, uint16_t motorPwmRate, uint16_t idlePulse, uint8_t fastPwmProtocolType)
|
void pwmFastPwmMotorConfig(const timerHardware_t *timerHardware, uint8_t motorIndex, uint16_t motorPwmRate, uint16_t idlePulse, uint8_t fastPwmProtocolType)
|
||||||
{
|
{
|
||||||
uint32_t timerMhzCounter;
|
uint32_t timerMhzCounter;
|
||||||
|
pwmWriteFuncPtr pwmWritePtr;
|
||||||
|
|
||||||
switch (fastPwmProtocolType) {
|
switch (fastPwmProtocolType) {
|
||||||
default:
|
default:
|
||||||
case (PWM_TYPE_ONESHOT125):
|
case (PWM_TYPE_ONESHOT125):
|
||||||
timerMhzCounter = ONESHOT125_TIMER_MHZ;
|
timerMhzCounter = ONESHOT125_TIMER_MHZ;
|
||||||
motors[motorIndex]->pwmWritePtr = pwmWriteOneShot125;
|
pwmWritePtr = pwmWriteOneShot125;
|
||||||
break;
|
break;
|
||||||
case (PWM_TYPE_ONESHOT42):
|
case (PWM_TYPE_ONESHOT42):
|
||||||
timerMhzCounter = ONESHOT42_TIMER_MHZ;
|
timerMhzCounter = ONESHOT42_TIMER_MHZ;
|
||||||
motors[motorIndex]->pwmWritePtr = pwmWriteOneShot42;
|
pwmWritePtr = pwmWriteOneShot42;
|
||||||
break;
|
break;
|
||||||
case (PWM_TYPE_MULTISHOT):
|
case (PWM_TYPE_MULTISHOT):
|
||||||
timerMhzCounter = MULTISHOT_TIMER_MHZ;
|
timerMhzCounter = MULTISHOT_TIMER_MHZ;
|
||||||
motors[motorIndex]->pwmWritePtr = pwmWriteMultiShot;
|
pwmWritePtr = pwmWriteMultiShot;
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -239,6 +240,7 @@ void pwmFastPwmMotorConfig(const timerHardware_t *timerHardware, uint8_t motorIn
|
||||||
} else {
|
} else {
|
||||||
motors[motorIndex] = pwmOutConfig(timerHardware, timerMhzCounter, 0xFFFF, 0);
|
motors[motorIndex] = pwmOutConfig(timerHardware, timerMhzCounter, 0xFFFF, 0);
|
||||||
}
|
}
|
||||||
|
motors[motorIndex]->pwmWritePtr = pwmWritePtr;
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef USE_SERVOS
|
#ifdef USE_SERVOS
|
||||||
|
|
Loading…
Reference in New Issue