Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-06 06:43:21 +08:00
Code Issues Actions 29 Packages Projects Releases Wiki Activity

oneshot:trigger exit early in no chan in oneshot

Browse Source
This commit is contained in:
David Sidrane
2017-04-19 18:23:03 -10:00
committed by Lorenz Meier
parent d21b6655d2
commit b885fd97f6
1 changed files with 21 additions and 18 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/stm32/drv_io_timer.c
+21 -18
View File
@@ -478,30 +478,33 @@ static inline void io_timer_set_PWM_mode(unsigned timer)
void io_timer_trigger(void) void io_timer_trigger(void)
{ {
int oneshots = io_timer_get_mode_channels(IOTimerChanMode_OneShot); int oneshots = io_timer_get_mode_channels(IOTimerChanMode_OneShot);
uint32_t action_cache[MAX_IO_TIMERS] = {0};
int actions = 0;
/* Pre-calculate the list of timers to Trigger */ if (oneshots != 0) {
uint32_t action_cache[MAX_IO_TIMERS] = {0};
int actions = 0;
for (int timer = 0; timer < MAX_IO_TIMERS; timer++) { /* Pre-calculate the list of timers to Trigger */
if (validate_timer_index(timer) == 0) {
int channels = get_timer_channels(timer);
if (oneshots & channels) { for (int timer = 0; timer < MAX_IO_TIMERS; timer++) {
action_cache[actions++] = io_timers[timer].base; if (validate_timer_index(timer) == 0) {
int channels = get_timer_channels(timer);
if (oneshots & channels) {
action_cache[actions++] = io_timers[timer].base;
}
} }
} }
/* Now do them all wit the shortest delay in between */
irqstate_t flags = px4_enter_critical_section();
for (actions = 0; action_cache[actions] != 0 && actions < MAX_IO_TIMERS; actions++) {
_REG32(action_cache[actions], STM32_GTIM_EGR_OFFSET) |= GTIM_EGR_UG;
}
px4_leave_critical_section(flags);
} }
/* Now do them all wit the shortest delay in between */
irqstate_t flags = px4_enter_critical_section();
for (actions = 0; action_cache[actions] != 0 && actions < MAX_IO_TIMERS; actions++) {
_REG32(action_cache[actions], STM32_GTIM_EGR_OFFSET) |= GTIM_EGR_UG;
}
px4_leave_critical_section(flags);
} }
int io_timer_init_timer(unsigned timer) int io_timer_init_timer(unsigned timer)