fleg
/
OpenRTX
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

HR_C6000: implemented transmission of single-frequency tones

This commit is contained in:
Silvano Seva 2024-10-27 10:37:44 +01:00
parent 5016884782
commit 2496d49ffc
3 changed files with 54 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
platform/drivers/baseband/HR_C6000.cpp
View File

@ -67,3 +67,25 @@ void HR_C6000::setRxCtcss(const tone_t tone)
writeCfgRegister(0xD2, 0xD0);
writeCfgRegister(0xD4, index); // Tone index
}
void HR_C6000::sendTone(const uint32_t freq, const uint8_t deviation)
{
uint32_t tone = (freq * 65536) / 32000;
// Set DTMF tone osc 1 to frequency of the required tone
writeReg16(C6000_SpiOpModes::CONFIG, 0x11A, (tone & 0xFF));
writeReg16(C6000_SpiOpModes::CONFIG, 0x11B, (tone >> 8) & 0xFF);
// Set DTMF tone osc 2 to frequency of the required tone
writeReg16(C6000_SpiOpModes::CONFIG, 0x122, (tone & 0xFF));
writeReg16(C6000_SpiOpModes::CONFIG, 0x123, (tone >> 8) & 0xFF);
writeCfgRegister(0xA1, 0x02); // Enable DTMF
writeCfgRegister(0xA0, deviation); // Set DTMF tone deviation
writeCfgRegister(0xA4, 0xFF); // Set the tone time to maximum
writeCfgRegister(0xA3, 0x00); // Set the tone gap to zero
writeCfgRegister(0xD1, 0x06); // Set the number of codes to six
writeCfgRegister(0xAF, 0x11); // Set the same code to be sent six times (2 codes per register)
writeCfgRegister(0xAE, 0x11);
writeCfgRegister(0xAD, 0x11);
}

30
platform/drivers/baseband/HR_C6000.h
View File

@ -81,6 +81,36 @@ public:
{
writeCfgRegister(0xA1, 0x00); // Disable all tones
}
/**
* Transmit a tone of a given frequency.
*
* @param freq: tone frequency in Hz.
* @param deviation: tone deviation.
*/
void sendTone(const uint32_t freq, const uint8_t deviation);
private:
/**
* Write a register with 16-bit address.
*
* @param opMode: "operating mode" specifier, see datasheet for details.
* @param addr: register address.
* @param value: value to be written.
*/
void writeReg16(const C6000_SpiOpModes opMode, const uint16_t addr, const uint8_t value)
{
uint8_t data[4];
data[0] = static_cast< uint8_t >(opMode) | 0x40;
data[2] = (addr >> 8) & 0x07;
data[1] = addr & 0xFF;
data[3] = value;
ScopedChipSelect cs(uSpi, uCs);
spi_send(uSpi, data, 4);
}
};
#endif /* HRC6000_H */

2
platform/drivers/baseband/HR_Cx000.h
View File

@ -263,6 +263,8 @@ private:
spi_send(uSpi, seq, len);
}
protected:
const struct spiDevice *uSpi;
const struct gpioPin uCs;
};