From 2a22a125bb565bdb0d444e63f53315708f0a4857 Mon Sep 17 00:00:00 2001
From: Ryzerth <whatsthetgeek@gmail.com>
Date: Sat, 24 Apr 2021 19:41:02 +0200
Subject: [PATCH] Fixed bug

---
 radio/src/main.cpp          | 4 ++++
 radio/src/radio_interface.h | 3 ++-
 2 files changed, 6 insertions(+), 1 deletion(-)

diff --git a/radio/src/main.cpp b/radio/src/main.cpp
index 8cabb0fd..62a0d390 100644
--- a/radio/src/main.cpp
+++ b/radio/src/main.cpp
@@ -163,6 +163,10 @@ private:
         if (code == RADIO_IFACE_CMD_GET_MODE) {
             *(int*)out = _this->demodId;
         }
+        else if (code == RADIO_IFACE_CMD_SET_MODE) {
+            int in = *(int*)in;
+            if (in != _this->demodId) { _this->selectDemodById(in); }
+        }
     }
 
     void selectDemod(Demodulator* demod) {
diff --git a/radio/src/radio_interface.h b/radio/src/radio_interface.h
index b1122ee7..91a23da1 100644
--- a/radio/src/radio_interface.h
+++ b/radio/src/radio_interface.h
@@ -1,7 +1,8 @@
 #pragma once
 
 enum {
-    RADIO_IFACE_CMD_GET_MODE
+    RADIO_IFACE_CMD_GET_MODE,
+    RADIO_IFACE_CMD_SET_MODE
 };
 
 enum {