From 2b7fc6e150efec79ece703d43e52bc5c45bb04f6 Mon Sep 17 00:00:00 2001
From: Silvano Seva <silseva@fastwebnet.it>
Date: Thu, 8 Dec 2022 18:59:33 +0100
Subject: [PATCH] Implemented control of Module 17 MCP4551 digital wipers

---
 platform/drivers/baseband/radio_Mod17.cpp | 17 ++++++++++++++++-
 1 file changed, 16 insertions(+), 1 deletion(-)

diff --git a/platform/drivers/baseband/radio_Mod17.cpp b/platform/drivers/baseband/radio_Mod17.cpp
index 4c12cce1..a2c0ab1e 100644
--- a/platform/drivers/baseband/radio_Mod17.cpp
+++ b/platform/drivers/baseband/radio_Mod17.cpp
@@ -21,14 +21,23 @@
 #include <interfaces/platform.h>
 #include <interfaces/radio.h>
 #include <interfaces/gpio.h>
+#include <calibInfo_Mod17.h>
 #include <hwconfig.h>
+#include <MCP4551.h>
+
+enum  opstatus      radioStatus;   // Current operating status
+const mod17Calib_t *calData;       // Calibration data
 
-enum opstatus radioStatus;               // Current operating status
 
 void radio_init(const rtxStatus_t *rtxState)
 {
     (void) rtxState;
+
     radioStatus = OFF;
+    calData = reinterpret_cast< const mod17Calib_t * >(platform_getCalibrationData());
+
+    mcp4551_setWiper(SOFTPOT_TX, calData->tx_wiper);
+    mcp4551_setWiper(SOFTPOT_RX, calData->rx_wiper);
 }
 
 void radio_terminate()
@@ -66,12 +75,18 @@ void radio_enableRx()
 {
     radioStatus = RX;
     gpio_clearPin(PTT_OUT);
+
+    mcp4551_setWiper(SOFTPOT_TX, calData->tx_wiper);
+    mcp4551_setWiper(SOFTPOT_RX, calData->rx_wiper);
 }
 
 void radio_enableTx()
 {
     radioStatus = TX;
     gpio_setPin(PTT_OUT);
+
+    mcp4551_setWiper(SOFTPOT_TX, calData->tx_wiper);
+    mcp4551_setWiper(SOFTPOT_RX, calData->rx_wiper);
 }
 
 void radio_disableRtx()