diff --git a/platform/drivers/baseband/HR_C6000.cpp b/platform/drivers/baseband/HR_C6000.cpp index 41033ee7..5945b7c8 100644 --- a/platform/drivers/baseband/HR_C6000.cpp +++ b/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 } diff --git a/platform/drivers/baseband/radio_CS7000.cpp b/platform/drivers/baseband/radio_CS7000.cpp index 9ecacd59..524e697c 100644 --- a/platform/drivers/baseband/radio_CS7000.cpp +++ b/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();