From 664f8e7241ede9b9d5e96d42bc56b2c6627dd360 Mon Sep 17 00:00:00 2001 From: Felix Pankratz Date: Sun, 18 Sep 2022 16:10:11 +0200 Subject: [PATCH] code cleanup, fix timing offset due to delay --- metronome.c | 53 ++++++++++++++++++++++++++++++++++++++++++++--------- 1 file changed, 44 insertions(+), 9 deletions(-) diff --git a/metronome.c b/metronome.c index c469218..eec350e 100644 --- a/metronome.c +++ b/metronome.c @@ -5,7 +5,11 @@ #include #include -#define BPM_STEP_SIZE 0.5d +#define BPM_STEP_SIZE_FINE 0.5d +#define BPM_STEP_SIZE_COARSE 10.0d +#define BPM_BOUNDARY_LOW 10.0d +#define BPM_BOUNDARY_HIGH 300.0d +#define BEEP_DELAY_MS 50 typedef enum { EventTypeTick, @@ -64,7 +68,7 @@ static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queu static void timer_callback() { //UNUSED(metronome_state); furi_hal_speaker_start(440.0f, 1.0f); - furi_delay_ms(40); + furi_delay_ms(BEEP_DELAY_MS); furi_hal_speaker_stop(); } @@ -74,6 +78,39 @@ static void metronome_state_init(MetronomeState* const metronome_state) { metronome_state->timer = furi_timer_alloc(timer_callback, FuriTimerTypePeriodic, metronome_state); } +static uint32_t bpm_to_sleep_ticks(double bpm) { + // calculate time between beeps + uint32_t tps = furi_kernel_get_tick_frequency(); + double bps = (double)bpm / 60; + return (uint32_t)round(tps / bps) - ((BEEP_DELAY_MS/1000)*tps); +} + +static void update_timer(MetronomeState* metronome_state) { + if (furi_timer_is_running(metronome_state->timer)) { + furi_timer_stop(metronome_state->timer); + furi_timer_start( + metronome_state->timer, + bpm_to_sleep_ticks(metronome_state->bpm) + ); + } +} + +static void increase_bpm(MetronomeState* metronome_state, double amount) { + metronome_state->bpm += amount; + if(metronome_state->bpm > (double)BPM_BOUNDARY_HIGH) { + metronome_state->bpm = BPM_BOUNDARY_HIGH; + } + update_timer(metronome_state); +} + +static void decrease_bpm(MetronomeState* metronome_state, double amount) { + metronome_state->bpm -= amount; + if(metronome_state->bpm < (double)BPM_BOUNDARY_LOW) { + metronome_state->bpm = BPM_BOUNDARY_LOW; + } + update_timer(metronome_state); +} + int32_t metronome_app() { FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent)); @@ -108,23 +145,21 @@ int32_t metronome_app() { if(event.input.type == InputTypePress) { switch(event.input.key) { case InputKeyUp: + increase_bpm(metronome_state, BPM_STEP_SIZE_COARSE); break; case InputKeyDown: + decrease_bpm(metronome_state, BPM_STEP_SIZE_COARSE); break; case InputKeyRight: - metronome_state->bpm += (double)BPM_STEP_SIZE; + increase_bpm(metronome_state, BPM_STEP_SIZE_FINE); break; case InputKeyLeft: - metronome_state->bpm -= (double)BPM_STEP_SIZE; + decrease_bpm(metronome_state, BPM_STEP_SIZE_FINE); break; case InputKeyOk: metronome_state->playing = !metronome_state->playing; if (metronome_state->playing) { - // calculate time between beeps - uint32_t tps = furi_kernel_get_tick_frequency(); - double bps = (double)metronome_state->bpm / 60; - uint32_t ticks_to_sleep = (uint32_t)round(tps / bps); - furi_timer_start(metronome_state->timer, ticks_to_sleep); + furi_timer_start(metronome_state->timer, bpm_to_sleep_ticks(metronome_state->bpm)); } else { furi_timer_stop(metronome_state->timer); }