From 2c0b75b221410ea00f294dc91c251a14f4811ef2 Mon Sep 17 00:00:00 2001
From: Silvano Seva <silseva@fastwebnet.it>
Date: Sat, 5 Dec 2020 14:41:52 +0100
Subject: [PATCH] Added CTCSS TX tone

---
 platform/drivers/baseband/rtx_MD3x0.c | 11 ++++++++++-
 1 file changed, 10 insertions(+), 1 deletion(-)

diff --git a/platform/drivers/baseband/rtx_MD3x0.c b/platform/drivers/baseband/rtx_MD3x0.c
index 018f1b62..f9646c40 100644
--- a/platform/drivers/baseband/rtx_MD3x0.c
+++ b/platform/drivers/baseband/rtx_MD3x0.c
@@ -189,6 +189,14 @@ void _updateC5000IQparams()
     C5000_setModAmplitude(I, Q);
 }
 
+void _setCTCSS()
+{
+    if((rtxStatus.opMode == FM) && (rtxStatus.txTone != 0))
+    {
+        float tone = ((float) rtxStatus.txTone) / 10.0f;
+        toneGen_setToneFreq(tone);
+    }
+}
 
 
 void rtx_init()
@@ -350,9 +358,10 @@ void rtx_taskFunc()
         _setOpMode();
         _setBandwidth();
         _updateC5000IQparams();
+        _setCTCSS();
 
         /* TODO: temporarily force to RX mode if rtx is off. */
-        if(rtxStatus.opStatus == OFF) _enableRx();
+        if(rtxStatus.opStatus == OFF) _enableRxStage();
     }
 
     if(platform_getPttStatus() && (rtxStatus.opStatus != TX))