CS7000: radio: added transmission of 1750Hz tone

platform/drivers/baseband/HR_C6000.cpp

@@ -88,4 +88,6 @@ void HR_C6000::sendTone(const uint32_t freq, const uint8_t deviation)
     writeCfgRegister(0xAF, 0x11);         // Set the same code to be sent six times (2 codes per register)
     writeCfgRegister(0xAE, 0x11);
     writeCfgRegister(0xAD, 0x11);
+    writeCfgRegister(0x60, 0x00);         // Disable FM transmission
+    writeCfgRegister(0x60, 0x80);         // Enable FM transmission, start sending the tone
 }

platform/drivers/baseband/radio_CS7000.cpp

@@ -340,6 +340,8 @@ void radio_enableTx()
             // a new transmission.
             if(config->txToneEn)
                 C6000.setTxCtcss(config->txTone, 0x20);
+            else if(config->toneEn)
+                C6000.sendTone(1750, 0x1E);
             else
                 C6000.disableTones();