stm32/servo: Only initialise TIM5 if it is needed, to save power.

pull/1/head
Damien George 2018-11-28 12:06:24 +11:00
parent 4f25a8b6a4
commit 5f67b03e99
1 changed files with 4 additions and 2 deletions

View File

@ -63,8 +63,6 @@ typedef struct _pyb_servo_obj_t {
STATIC pyb_servo_obj_t pyb_servo_obj[PYB_SERVO_NUM];
void servo_init(void) {
timer_tim5_init();
// reset servo objects
for (int i = 0; i < PYB_SERVO_NUM; i++) {
pyb_servo_obj[i].base.type = &pyb_servo_type;
@ -133,6 +131,10 @@ STATIC void servo_init_channel(pyb_servo_obj_t *s) {
// GPIO configuration
mp_hal_pin_config(s->pin, MP_HAL_PIN_MODE_ALT, MP_HAL_PIN_PULL_NONE, GPIO_AF2_TIM5);
if (__HAL_RCC_TIM5_IS_CLK_DISABLED()) {
timer_tim5_init();
}
// PWM mode configuration
TIM_OC_InitTypeDef oc_init;
oc_init.OCMode = TIM_OCMODE_PWM1;