1 files changed, 21 insertions, 7 deletions
diff --git a/src/audio/bt_audio_output.cpp b/src/audio/bt_audio_output.cpp
index 0c11481b..41c89069 100644
--- a/src/audio/bt_audio_output.cpp
+++ b/src/audio/bt_audio_output.cpp
@@ -21,6 +21,7 @@
 #include "i2c.hpp"
 #include "i2s_dac.hpp"
 #include "result.hpp"
+#include "tasks.hpp"
 #include "wm8523.hpp"
 
 [[maybe_unused]] static const char* kTag = "BTOUT";
@@ -28,8 +29,9 @@
 namespace audio {
 
 BluetoothAudioOutput::BluetoothAudioOutput(StreamBufferHandle_t s,
-                                           drivers::Bluetooth& bt)
-    : IAudioOutput(s), bluetooth_(bt) {}
+                                           drivers::Bluetooth& bt,
+                                           tasks::WorkerPool& p)
+    : IAudioOutput(s), bluetooth_(bt), bg_worker_(p), volume_(10) {}
 
 BluetoothAudioOutput::~BluetoothAudioOutput() {}
 
@@ -43,14 +45,16 @@ auto BluetoothAudioOutput::SetMode(Modes mode) -> void {
 
 auto BluetoothAudioOutput::SetVolumeImbalance(int_fast8_t balance) -> void {}
 
-auto BluetoothAudioOutput::SetVolume(uint16_t) -> void {}
+auto BluetoothAudioOutput::SetVolume(uint16_t v) -> void {
+  volume_ = std::clamp<uint16_t>(v, 0, 0x7f);
+}
 
 auto BluetoothAudioOutput::GetVolume() -> uint16_t {
-  return 0;
+  return volume_;
 }
 
 auto BluetoothAudioOutput::GetVolumePct() -> uint_fast8_t {
-  return 0;
+  return static_cast<uint_fast8_t>(static_cast<int>(volume_) * 100 / 0x7f);
 }
 
 auto BluetoothAudioOutput::GetVolumeDb() -> int_fast16_t {
@@ -58,11 +62,21 @@ auto BluetoothAudioOutput::GetVolumeDb() -> int_fast16_t {
 }
 
 auto BluetoothAudioOutput::AdjustVolumeUp() -> bool {
-  return false;
+  if (volume_ == 0x7f) {
+    return false;
+  }
+  volume_++;
+  bg_worker_.Dispatch<void>([&]() { bluetooth_.SetVolume(volume_); });
+  return true;
 }
 
 auto BluetoothAudioOutput::AdjustVolumeDown() -> bool {
-  return false;
+  if (volume_ == 0) {
+    return false;
+  }
+  volume_--;
+  bg_worker_.Dispatch<void>([&]() { bluetooth_.SetVolume(volume_); });
+  return true;
 }
 
 auto BluetoothAudioOutput::PrepareFormat(const Format& orig) -> Format {