0d8518d31d
* FuriHal: fix gpio naming and add explicit pulls for vibro, speaker and ir_tx * Github: workflow event debug print * Github: proper PR head commit SHA extraction in get_env.py
141 lines
4.2 KiB
C
141 lines
4.2 KiB
C
#include <furi_hal_speaker.h>
|
|
#include <furi_hal_gpio.h>
|
|
#include <furi_hal_resources.h>
|
|
#include <furi_hal_power.h>
|
|
|
|
#include <stm32wbxx_ll_tim.h>
|
|
#include <furi_hal_cortex.h>
|
|
|
|
#define TAG "FuriHalSpeaker"
|
|
|
|
#define FURI_HAL_SPEAKER_TIMER TIM16
|
|
#define FURI_HAL_SPEAKER_CHANNEL LL_TIM_CHANNEL_CH1
|
|
#define FURI_HAL_SPEAKER_PRESCALER 500
|
|
#define FURI_HAL_SPEAKER_MAX_VOLUME 60
|
|
|
|
static FuriMutex* furi_hal_speaker_mutex = NULL;
|
|
|
|
// #define FURI_HAL_SPEAKER_NEW_VOLUME
|
|
|
|
void furi_hal_speaker_init() {
|
|
furi_assert(furi_hal_speaker_mutex == NULL);
|
|
furi_hal_speaker_mutex = furi_mutex_alloc(FuriMutexTypeNormal);
|
|
FURI_CRITICAL_ENTER();
|
|
LL_TIM_DeInit(FURI_HAL_SPEAKER_TIMER);
|
|
FURI_CRITICAL_EXIT();
|
|
FURI_LOG_I(TAG, "Init OK");
|
|
}
|
|
|
|
void furi_hal_speaker_deinit() {
|
|
furi_check(furi_hal_speaker_mutex != NULL);
|
|
LL_TIM_DeInit(FURI_HAL_SPEAKER_TIMER);
|
|
furi_hal_gpio_init(&gpio_speaker, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
|
|
furi_mutex_free(furi_hal_speaker_mutex);
|
|
furi_hal_speaker_mutex = NULL;
|
|
}
|
|
|
|
bool furi_hal_speaker_acquire(uint32_t timeout) {
|
|
furi_check(!FURI_IS_IRQ_MODE());
|
|
|
|
if(furi_mutex_acquire(furi_hal_speaker_mutex, timeout) == FuriStatusOk) {
|
|
furi_hal_power_insomnia_enter();
|
|
furi_hal_gpio_init_ex(
|
|
&gpio_speaker, GpioModeAltFunctionPushPull, GpioPullNo, GpioSpeedLow, GpioAltFn14TIM16);
|
|
return true;
|
|
} else {
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void furi_hal_speaker_release() {
|
|
furi_check(!FURI_IS_IRQ_MODE());
|
|
furi_check(furi_hal_speaker_is_mine());
|
|
|
|
furi_hal_speaker_stop();
|
|
furi_hal_gpio_init(&gpio_speaker, GpioModeAnalog, GpioPullDown, GpioSpeedLow);
|
|
furi_hal_power_insomnia_exit();
|
|
|
|
furi_check(furi_mutex_release(furi_hal_speaker_mutex) == FuriStatusOk);
|
|
}
|
|
|
|
bool furi_hal_speaker_is_mine() {
|
|
return (FURI_IS_IRQ_MODE()) ||
|
|
(furi_mutex_get_owner(furi_hal_speaker_mutex) == furi_thread_get_current_id());
|
|
}
|
|
|
|
static inline uint32_t furi_hal_speaker_calculate_autoreload(float frequency) {
|
|
uint32_t autoreload = (SystemCoreClock / FURI_HAL_SPEAKER_PRESCALER / frequency) - 1;
|
|
if(autoreload < 2) {
|
|
autoreload = 2;
|
|
} else if(autoreload > UINT16_MAX) {
|
|
autoreload = UINT16_MAX;
|
|
}
|
|
|
|
return autoreload;
|
|
}
|
|
|
|
static inline uint32_t furi_hal_speaker_calculate_compare(float volume) {
|
|
if(volume < 0) volume = 0;
|
|
if(volume > 1) volume = 1;
|
|
volume = volume * volume * volume;
|
|
|
|
#ifdef FURI_HAL_SPEAKER_NEW_VOLUME
|
|
uint32_t compare_value = volume * FURI_HAL_SPEAKER_MAX_VOLUME;
|
|
uint32_t clip_value = volume * LL_TIM_GetAutoReload(FURI_HAL_SPEAKER_TIMER) / 2;
|
|
if(compare_value > clip_value) {
|
|
compare_value = clip_value;
|
|
}
|
|
#else
|
|
uint32_t compare_value = volume * LL_TIM_GetAutoReload(FURI_HAL_SPEAKER_TIMER) / 2;
|
|
#endif
|
|
|
|
if(compare_value == 0) {
|
|
compare_value = 1;
|
|
}
|
|
|
|
return compare_value;
|
|
}
|
|
|
|
void furi_hal_speaker_start(float frequency, float volume) {
|
|
furi_check(furi_hal_speaker_is_mine());
|
|
|
|
if(volume <= 0) {
|
|
furi_hal_speaker_stop();
|
|
return;
|
|
}
|
|
|
|
LL_TIM_InitTypeDef TIM_InitStruct = {0};
|
|
TIM_InitStruct.Prescaler = FURI_HAL_SPEAKER_PRESCALER - 1;
|
|
TIM_InitStruct.Autoreload = furi_hal_speaker_calculate_autoreload(frequency);
|
|
LL_TIM_Init(FURI_HAL_SPEAKER_TIMER, &TIM_InitStruct);
|
|
|
|
LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {0};
|
|
TIM_OC_InitStruct.OCMode = LL_TIM_OCMODE_PWM1;
|
|
TIM_OC_InitStruct.OCState = LL_TIM_OCSTATE_ENABLE;
|
|
TIM_OC_InitStruct.CompareValue = furi_hal_speaker_calculate_compare(volume);
|
|
LL_TIM_OC_Init(FURI_HAL_SPEAKER_TIMER, FURI_HAL_SPEAKER_CHANNEL, &TIM_OC_InitStruct);
|
|
|
|
LL_TIM_EnableAllOutputs(FURI_HAL_SPEAKER_TIMER);
|
|
LL_TIM_EnableCounter(FURI_HAL_SPEAKER_TIMER);
|
|
}
|
|
|
|
void furi_hal_speaker_set_volume(float volume) {
|
|
furi_check(furi_hal_speaker_is_mine());
|
|
if(volume <= 0) {
|
|
furi_hal_speaker_stop();
|
|
return;
|
|
}
|
|
|
|
#if FURI_HAL_SPEAKER_CHANNEL == LL_TIM_CHANNEL_CH1
|
|
LL_TIM_OC_SetCompareCH1(FURI_HAL_SPEAKER_TIMER, furi_hal_speaker_calculate_compare(volume));
|
|
#else
|
|
#error Invalid channel
|
|
#endif
|
|
}
|
|
|
|
void furi_hal_speaker_stop() {
|
|
furi_check(furi_hal_speaker_is_mine());
|
|
LL_TIM_DisableAllOutputs(FURI_HAL_SPEAKER_TIMER);
|
|
LL_TIM_DisableCounter(FURI_HAL_SPEAKER_TIMER);
|
|
}
|