89 lines
2.0 KiB
C++
89 lines
2.0 KiB
C++
#include <cmath>
|
|
|
|
#include "freertos/FreeRTOS.h"
|
|
#include "freertos/task.h"
|
|
#include "esp_log.h"
|
|
|
|
#include "volume.h"
|
|
#include "avrcp.h"
|
|
#include "twai.h"
|
|
|
|
#define VOLUME_TAG "APP_VOLUME"
|
|
|
|
// 0-127
|
|
static uint8_t volume;
|
|
// 0-127
|
|
static uint8_t remote_volume;
|
|
// 0-30
|
|
static uint8_t radio_volume;
|
|
|
|
static bool synced = true;
|
|
static _lock_t lock;
|
|
|
|
void volume_controller::set_from_radio(int v) {
|
|
ESP_LOGI(VOLUME_TAG, "Volume on radio updated: %i (0-30)", v);
|
|
// Update the radio volume
|
|
_lock_acquire(&lock);
|
|
radio_volume = v;
|
|
_lock_release(&lock);
|
|
|
|
if (!synced) {
|
|
ESP_LOGI(VOLUME_TAG, "Not updating internal and remote (SYNCING)");
|
|
// In this case we are still adjusting the volume of the car to match the remote/internal volume
|
|
// So we do not want to update these values based on the radio
|
|
return;
|
|
}
|
|
|
|
// Convert the 0 - 30 range of the radio to 0 - 127
|
|
uint8_t full_range = ceil(v * 4.2f);
|
|
ESP_LOGI(VOLUME_TAG, "Updating internal and remote to: %i (0-127)", full_range);
|
|
|
|
// Update the remote volume
|
|
avrcp::set_volume(full_range);
|
|
|
|
// @TODO Somehow make sure we actually the remote volume is actually set before updating the value
|
|
_lock_acquire(&lock);
|
|
volume = full_range;
|
|
remote_volume = full_range;
|
|
_lock_release(&lock);
|
|
}
|
|
|
|
void volume_controller::set_from_remote(int v) {
|
|
ESP_LOGI(VOLUME_TAG, "Volume on remote updated: %i (0-127)", v);
|
|
|
|
_lock_acquire(&lock);
|
|
remote_volume = v;
|
|
volume = v;
|
|
|
|
synced = false;
|
|
_lock_release(&lock);
|
|
}
|
|
|
|
uint8_t volume_controller::current() {
|
|
return volume;
|
|
}
|
|
|
|
static void correct_volume(void*) {
|
|
for (;;) {
|
|
if (!synced) {
|
|
uint8_t target = floor(volume / 4.2f);
|
|
|
|
if (radio_volume == target) {
|
|
ESP_LOGI(VOLUME_TAG, "SYNCED!");
|
|
_lock_acquire(&lock);
|
|
synced = true;
|
|
_lock_release(&lock);
|
|
} else {
|
|
ESP_LOGI(VOLUME_TAG, "Adjusting volume: %i", radio_volume < target);
|
|
twai::change_volume(radio_volume < target);
|
|
}
|
|
}
|
|
|
|
vTaskDelay(pdMS_TO_TICKS(30));
|
|
}
|
|
}
|
|
|
|
void volume_controller::init() {
|
|
xTaskCreatePinnedToCore(correct_volume, "Correct volume", 2048, nullptr, 0, nullptr, 1);
|
|
}
|