Flipper/Applications/Official/source-OLDER/grnch/musictracker/tracker_engine/speaker_hal.c

107 lines
3.0 KiB
C
Raw Normal View History

2022-12-29 06:30:12 +00:00
#include "speaker_hal.h"
#define FURI_HAL_SPEAKER_TIMER TIM16
#define FURI_HAL_SPEAKER_CHANNEL LL_TIM_CHANNEL_CH1
#define FURI_HAL_SPEAKER_PRESCALER 500
void tracker_speaker_play(float frequency, float pwm) {
uint32_t autoreload = (SystemCoreClock / FURI_HAL_SPEAKER_PRESCALER / frequency) - 1;
if(autoreload < 2) {
autoreload = 2;
} else if(autoreload > UINT16_MAX) {
autoreload = UINT16_MAX;
}
if(pwm < 0) pwm = 0;
if(pwm > 1) pwm = 1;
uint32_t compare_value = pwm * autoreload;
if(compare_value == 0) {
compare_value = 1;
}
if(LL_TIM_OC_GetCompareCH1(FURI_HAL_SPEAKER_TIMER) != compare_value) {
LL_TIM_OC_SetCompareCH1(FURI_HAL_SPEAKER_TIMER, compare_value);
}
if(LL_TIM_GetAutoReload(FURI_HAL_SPEAKER_TIMER) != autoreload) {
LL_TIM_SetAutoReload(FURI_HAL_SPEAKER_TIMER, autoreload);
if(LL_TIM_GetCounter(FURI_HAL_SPEAKER_TIMER) > autoreload) {
LL_TIM_SetCounter(FURI_HAL_SPEAKER_TIMER, 0);
}
}
LL_TIM_EnableAllOutputs(FURI_HAL_SPEAKER_TIMER);
}
void tracker_speaker_stop() {
LL_TIM_DisableAllOutputs(FURI_HAL_SPEAKER_TIMER);
}
void tracker_speaker_init() {
if(furi_hal_speaker_is_mine() || furi_hal_speaker_acquire(30)) {
furi_hal_speaker_start(200.0f, 0.01f);
tracker_speaker_stop();
}
}
void tracker_speaker_deinit() {
if(furi_hal_speaker_is_mine()) {
furi_hal_speaker_stop();
furi_hal_speaker_release();
}
}
static FuriHalInterruptISR tracker_isr;
static void* tracker_isr_context;
static void tracker_interrupt_cb(void* context) {
UNUSED(context);
if(LL_TIM_IsActiveFlag_UPDATE(TIM2)) {
LL_TIM_ClearFlag_UPDATE(TIM2);
if(tracker_isr) {
tracker_isr(tracker_isr_context);
}
}
}
void tracker_interrupt_init(float freq, FuriHalInterruptISR isr, void* context) {
tracker_isr = isr;
tracker_isr_context = context;
furi_hal_interrupt_set_isr(FuriHalInterruptIdTIM2, tracker_interrupt_cb, NULL);
LL_TIM_InitTypeDef TIM_InitStruct = {0};
// Prescaler to get 1kHz clock
TIM_InitStruct.Prescaler = SystemCoreClock / 1000000 - 1;
TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
// Auto reload to get freq Hz interrupt
TIM_InitStruct.Autoreload = (1000000 / freq) - 1;
TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV1;
LL_TIM_Init(TIM2, &TIM_InitStruct);
LL_TIM_EnableIT_UPDATE(TIM2);
LL_TIM_EnableAllOutputs(TIM2);
LL_TIM_EnableCounter(TIM2);
}
void tracker_interrupt_deinit() {
FURI_CRITICAL_ENTER();
LL_TIM_DeInit(TIM2);
FURI_CRITICAL_EXIT();
furi_hal_interrupt_set_isr(FuriHalInterruptIdTIM2, NULL, NULL);
}
void tracker_debug_init() {
furi_hal_gpio_init(&gpio_ext_pc3, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
}
void tracker_debug_set(bool value) {
furi_hal_gpio_write(&gpio_ext_pc3, value);
}
void tracker_debug_deinit() {
furi_hal_gpio_init(&gpio_ext_pc3, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
}