From ebc7be39abd3999ba4ce95614093906dc247bdec Mon Sep 17 00:00:00 2001
From: Silvano Seva <silseva@fastwebnet.it>
Date: Wed, 21 Sep 2022 21:01:11 +0200
Subject: [PATCH] Implemented audio path management API in MDx audio driver

---
 platform/drivers/audio/audio_MDx.c           | 109 +++++++++++++++++--
 platform/drivers/tones/toneGenerator_MDx.cpp |   4 +-
 2 files changed, 104 insertions(+), 9 deletions(-)

diff --git a/platform/drivers/audio/audio_MDx.c b/platform/drivers/audio/audio_MDx.c
index b200179a..5686f759 100644
--- a/platform/drivers/audio/audio_MDx.c
+++ b/platform/drivers/audio/audio_MDx.c
@@ -18,11 +18,27 @@
  *   along with this program; if not, see <http://www.gnu.org/licenses/>   *
  ***************************************************************************/
 
-#include <interfaces/audio.h>
-#include <interfaces/gpio.h>
 #include <interfaces/delays.h>
+#include <interfaces/audio.h>
+#include <interfaces/radio.h>
+#include <interfaces/gpio.h>
 #include <hwconfig.h>
 
+static const uint8_t pathCompatibilityMatrix[9][9] =
+{
+    // MIC-SPK MIC-RTX MIC-MCU RTX-SPK RTX-RTX RTX-MCU MCU-SPK MCU-RTX MCU-MCU
+    {    0   ,   0   ,   0   ,   1   ,   0   ,   1   ,   1   ,   0   ,   1   },  // MIC-RTX
+    {    0   ,   0   ,   0   ,   0   ,   1   ,   1   ,   0   ,   0   ,   1   },  // MIC-SPK
+    {    0   ,   0   ,   0   ,   1   ,   1   ,   0   ,   1   ,   1   ,   0   },  // MIC-MCU
+    {    0   ,   1   ,   1   ,   0   ,   0   ,   0   ,   0   ,   1   ,   1   },  // RTX-SPK
+    {    1   ,   0   ,   1   ,   0   ,   0   ,   0   ,   1   ,   0   ,   1   },  // RTX-RTX
+    {    1   ,   1   ,   0   ,   0   ,   0   ,   0   ,   1   ,   1   ,   0   },  // RTX-MCU
+    {    0   ,   1   ,   1   ,   0   ,   1   ,   1   ,   0   ,   0   ,   0   },  // MCU-SPK
+    {    0   ,   0   ,   1   ,   1   ,   0   ,   1   ,   0   ,   0   ,   0   },  // MCU-RTX
+    {    1   ,   1   ,   0   ,   1   ,   1   ,   0   ,   0   ,   0   ,   0   }   // MCU-MCU
+};
+
+
 void audio_init()
 {
     gpio_setMode(SPK_MUTE,     OUTPUT);
@@ -33,26 +49,103 @@ void audio_init()
     #endif
     #endif
 
-    gpio_setPin(SPK_MUTE);          /* Speaker muted   */
+    gpio_setPin(SPK_MUTE);          // Speaker muted
     #ifndef PLATFORM_MD9600
-    gpio_clearPin(AUDIO_AMP_EN);    /* Audio PA off    */
+    gpio_clearPin(AUDIO_AMP_EN);    // Audio PA off
     #ifndef MDx_ENABLE_SWD
-    gpio_clearPin(MIC_PWR);         /* Mic preamp. off */
+    gpio_clearPin(MIC_PWR);         // Mic preamp. off
     #endif
     #endif
 }
 
 void audio_terminate()
 {
-    gpio_setPin(SPK_MUTE);          /* Speaker muted   */
+    gpio_setPin(SPK_MUTE);          // Speaker muted
     #ifndef PLATFORM_MD9600
-    gpio_clearPin(AUDIO_AMP_EN);    /* Audio PA off    */
+    gpio_clearPin(AUDIO_AMP_EN);    // Audio PA off
     #ifndef MDx_ENABLE_SWD
-    gpio_clearPin(MIC_PWR);         /* Mic preamp. off */
+    gpio_clearPin(MIC_PWR);         // Mic preamp. off
     #endif
     #endif
 }
 
+void audio_connect(const enum AudioSource source, const enum AudioSink sink)
+{
+    // If source is MIC, turn it on regardless of the sink
+    #if !defined(PLATFORM_MD9600) && !defined(MDx_ENABLE_SWD)
+    if(source == SOURCE_MIC) gpio_setPin(MIC_PWR);
+    #endif
+
+    if(sink == SINK_SPK)
+    {
+        switch(source)
+        {
+            case SOURCE_RTX:
+                radio_enableAfOutput();
+                break;
+
+            case SOURCE_MCU:
+                gpio_setMode(BEEP_OUT, ALTERNATE);
+                break;
+
+            default:
+                break;
+        }
+
+        // Anti-pop: unmute speaker after 10ms from amp. power on
+        #ifndef PLATFORM_MD9600
+        gpio_setPin(AUDIO_AMP_EN);
+        #endif
+        sleepFor(0, 10);
+        gpio_clearPin(SPK_MUTE);
+    }
+}
+
+void audio_disconnect(const enum AudioSource source, const enum AudioSink sink)
+{
+    // If source is MIC, turn it off regardless of the sink
+    #if !defined(PLATFORM_MD9600) && !defined(MDx_ENABLE_SWD)
+    if(source == SOURCE_MIC) gpio_clearPin(MIC_PWR);
+    #endif
+
+    if(sink == SINK_SPK)
+    {
+        gpio_setPin(SPK_MUTE);
+        #ifndef PLATFORM_MD9600
+        gpio_clearPin(AUDIO_AMP_EN);
+        #endif
+
+        switch(source)
+        {
+            case SOURCE_RTX:
+                radio_disableAfOutput();
+                break;
+
+            case SOURCE_MCU:
+                gpio_setMode(BEEP_OUT, INPUT);  // Set output to Hi-Z
+                break;
+
+            default:
+                break;
+        }
+    }
+}
+
+bool audio_checkPathCompatibility(const enum AudioSource p1Source,
+                                  const enum AudioSink   p1Sink,
+                                  const enum AudioSource p2Source,
+                                  const enum AudioSink   p2Sink)
+
+{
+    uint8_t p1Index = (p1Source * 3) + p1Sink;
+    uint8_t p2Index = (p2Source * 3) + p2Sink;
+
+    return pathCompatibilityMatrix[p1Index][p2Index] == 1;
+}
+
+
+
+
 void audio_enableMic()
 {
     #if !defined(PLATFORM_MD9600) && !defined(MDx_ENABLE_SWD)
diff --git a/platform/drivers/tones/toneGenerator_MDx.cpp b/platform/drivers/tones/toneGenerator_MDx.cpp
index c69e295c..36accee7 100644
--- a/platform/drivers/tones/toneGenerator_MDx.cpp
+++ b/platform/drivers/tones/toneGenerator_MDx.cpp
@@ -97,9 +97,11 @@ void toneGen_init()
      * Configure GPIOs:
      * - CTCSS output is on PC7 (on MD380), that is TIM3-CH2, AF2
      * - "beep" output is on PC8 (on MD380), that is TIM3-CH3, AF2
+     *
+     * NOTE: change of "beep" output gpio to alternate/input mode is handled by
+     * the audio driver.
      */
     gpio_setMode(CTCSS_OUT, ALTERNATE);
-    gpio_setMode(BEEP_OUT,  ALTERNATE);
     gpio_setAlternateFunction(CTCSS_OUT, 2);
     gpio_setAlternateFunction(BEEP_OUT,  2);