fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

kinetis:Bug fix PWM led update

Browse Source 
The code was forcing the CV reload, but not resettting the count
  this would cause short and long blinks during breathing.

  this change allows the CV to update at 50Hz (20 ms) asynchronously.
  So the LED update rate of 40Hz (25) will take effect on the next
  FTM counter change, end of the prescaler counting, after CnV register
  was written.update.
                   a   b   c   d
  LED PWM   ___-___-___-___-___-___-___-___-___-___
  LED Data  ____-____-____-____-____-____-____-____-
                 a    b    c    d
This commit is contained in:
David Sidrane 2018-09-11 13:40:15 -07:00 committed by Lorenz Meier
parent 16a23c5527
commit c41d7ebdd3
1 changed files with 2 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/drivers/kinetis/drv_led_pwm.cpp
View File

@ -203,10 +203,10 @@ led_pwm_timer_init(unsigned timer)
/*
* Note we do the Standard PWM Out init here
* default to updating at 50Hz
* default to updating at LED_PWM_RATE
*/
led_pwm_timer_set_rate(timer, 50);
led_pwm_timer_set_rate(timer, LED_PWM_RATE);
}
}
unsigned
@ -274,12 +274,7 @@ led_pwm_servo_set(unsigned channel, uint8_t cvalue)
value--;
}
irqstate_t flags = px4_enter_critical_section();
uint32_t save = rSC(timer);
rSC(timer) = save & ~(FTM_SC_CLKS_MASK);
REG(timer, KINETIS_FTM_CV_OFFSET(led_pwm_channels[channel].timer_channel - 1)) = value;
rSC(timer) = save;
px4_leave_critical_section(flags);
return 0;
}