Radio driver for MD-UV3x0 targets

replace/636949821785a6239d8392c458acd8062fce3220
Silvano Seva 2021-03-05 21:17:48 +01:00
rodzic 9610d0db07
commit a5120ffddc
6 zmienionych plików z 240 dodań i 32 usunięć

Wyświetl plik

@ -179,8 +179,11 @@ mduv380_src = src + stm32f405_src + ['platform/drivers/display/HX8353_MDx.cpp',
'platform/drivers/ADC/ADC1_MDx.c', 'platform/drivers/ADC/ADC1_MDx.c',
'platform/drivers/tones/toneGenerator_MDx.c', 'platform/drivers/tones/toneGenerator_MDx.c',
'platform/drivers/baseband/radio_UV3x0.c', 'platform/drivers/baseband/radio_UV3x0.c',
'platform/drivers/GPS/GPS_MDx.cpp', 'platform/drivers/GPS/GPS_MDx.c',
'platform/targets/MD-UV380/platform.c'] 'platform/targets/MD-UV380/platform.c',
'platform/drivers/baseband/AT1846S_UV3x0.c',
'platform/drivers/baseband/HR_C6000_UV3x0.c',
'platform/drivers/baseband/interfaces_UV3x0.c']
mduv380_inc = inc + stm32f405_inc + ['platform/targets/MD-UV380'] mduv380_inc = inc + stm32f405_inc + ['platform/targets/MD-UV380']
mduv380_def = def + stm32f405_def + {'PLATFORM_MDUV380': ''} mduv380_def = def + stm32f405_def + {'PLATFORM_MDUV380': ''}

Wyświetl plik

@ -43,13 +43,15 @@ float rssi; /* Current RSSI in dBm */
void _afCtrlInit() void _afCtrlInit()
{ {
#if defined(PLATFORM_MD3x0) #if defined(PLATFORM_MD3x0) || defined(PLATFORM_MDUV380)
gpio_setMode(SPK_MUTE, OUTPUT); gpio_setMode(SPK_MUTE, OUTPUT);
gpio_setMode(AMP_EN, OUTPUT); gpio_setMode(AUDIO_AMP_EN, OUTPUT);
gpio_setMode(FM_MUTE, OUTPUT);
gpio_setMode(MIC_PWR, OUTPUT); gpio_setMode(MIC_PWR, OUTPUT);
#ifdef PLATFORM_MD3x0
gpio_setMode(FM_MUTE, OUTPUT);
#endif
#elif defined(PLATFORM_GD77) || defined(PLATFORM_DM1801) #elif defined(PLATFORM_GD77) || defined(PLATFORM_DM1801)
gpio_setMode(AUDIO_AMP_EN, OUTPUT); gpio_setMode(AUDIO_AUDIO_AMP_EN, OUTPUT);
#endif #endif
} }
@ -57,20 +59,24 @@ void _afCtrlSpeaker(bool enable)
{ {
if(enable) if(enable)
{ {
#if defined(PLATFORM_MD3x0) #if defined(PLATFORM_MD3x0) || defined(PLATFORM_MDUV380)
gpio_setPin(AMP_EN); gpio_setPin(AUDIO_AMP_EN);
gpio_setPin(FM_MUTE);
gpio_clearPin(SPK_MUTE); gpio_clearPin(SPK_MUTE);
#ifdef PLATFORM_MD3x0
gpio_setPin(FM_MUTE);
#endif
#elif defined(PLATFORM_GD77) || defined(PLATFORM_DM1801) #elif defined(PLATFORM_GD77) || defined(PLATFORM_DM1801)
gpio_setPin(AUDIO_AMP_EN); gpio_setPin(AUDIO_AMP_EN);
#endif #endif
} }
else else
{ {
#if defined(PLATFORM_MD3x0) #if defined(PLATFORM_MD3x0) || defined(PLATFORM_MDUV380)
gpio_clearPin(AMP_EN); gpio_clearPin(AUDIO_AMP_EN);
gpio_clearPin(FM_MUTE);
gpio_setPin(SPK_MUTE); gpio_setPin(SPK_MUTE);
#ifdef PLATFORM_MD3x0
gpio_clearPin(FM_MUTE);
#endif
#elif defined(PLATFORM_GD77) || defined(PLATFORM_DM1801) #elif defined(PLATFORM_GD77) || defined(PLATFORM_DM1801)
gpio_clearPin(AUDIO_AMP_EN); gpio_clearPin(AUDIO_AMP_EN);
#endif #endif
@ -81,13 +87,13 @@ void _afCtrlMic(bool enable)
{ {
if(enable) if(enable)
{ {
#if defined(PLATFORM_MD3x0) #if defined(PLATFORM_MD3x0) || defined(PLATFORM_MDUV380)
gpio_setPin(MIC_PWR); gpio_setPin(MIC_PWR);
#endif #endif
} }
else else
{ {
#if defined(PLATFORM_MD3x0) #if defined(PLATFORM_MD3x0) || defined(PLATFORM_MDUV380)
gpio_clearPin(MIC_PWR); gpio_clearPin(MIC_PWR);
#endif #endif
} }

Wyświetl plik

@ -187,7 +187,7 @@ void AT1846S_setOpMode(const AT1846S_op_t mode)
{ {
if(mode == AT1846S_OP_DMR) if(mode == AT1846S_OP_DMR)
{ {
/* DMR mode */ /* TODO: DMR mode */
} }
else else
@ -213,6 +213,7 @@ void AT1846S_setFuncMode(const AT1846S_func_t mode)
uint16_t value = ((uint16_t) mode) << 5; uint16_t value = ((uint16_t) mode) << 5;
if(value > 0x0040) return; if(value > 0x0040) return;
_maskSetRegister(0x30, 0x0060, value); _maskSetRegister(0x30, 0x0060, value);
// i2c_writeReg16(0x44, 0x4ff);
} }
void AT1846S_enableTxCtcss(tone_t freq) void AT1846S_enableTxCtcss(tone_t freq)

Wyświetl plik

@ -18,68 +18,260 @@
* along with this program; if not, see <http://www.gnu.org/licenses/> * * along with this program; if not, see <http://www.gnu.org/licenses/> *
***************************************************************************/ ***************************************************************************/
#include <interfaces/platform.h>
#include <interfaces/radio.h> #include <interfaces/radio.h>
#include <interfaces/gpio.h>
#include <calibInfo_MDx.h>
#include <calibUtils.h>
#include <hwconfig.h>
#include "HR_C6000.h"
#include "AT1846S.h"
const mduv3x0Calib_t *calData; /* Pointer to calibration data */
int8_t currRxBand = -1; /* Current band for RX */
int8_t currTxBand = -1; /* Current band for TX */
uint8_t txpwr_lo = 0; /* APC voltage for TX output power control, low power */
uint8_t txpwr_hi = 0; /* APC voltage for TX output power control, high power */
tone_t tx_tone = 0;
tone_t rx_tone = 0;
enum opmode currOpMode; /* Current operating mode, needed for TX control */
/**
* \internal
* Function to identify the current band (VHF or UHF), given an input frequency.
*
* @param freq frequency in Hz.
* @return 0 if the frequency is in the VHF band,
* 1 if the frequency is in the UHF band,
* -1 if the band to which the frequency belongs is neither VHF nor UHF.
*/
int8_t _getBandFromFrequency(freq_t freq)
{
if((freq >= FREQ_LIMIT_VHF_LO) && (freq <= FREQ_LIMIT_VHF_HI)) return 0;
if((freq >= FREQ_LIMIT_UHF_LO) && (freq <= FREQ_LIMIT_UHF_HI)) return 1;
return -1;
}
void radio_init() void radio_init()
{ {
/*
* Load calibration data
*/
calData = ((const mduv3x0Calib_t *) platform_getCalibrationData());
/*
* Configure RTX GPIOs
*/
gpio_setMode(VHF_LNA_EN, OUTPUT);
gpio_setMode(UHF_LNA_EN, OUTPUT);
gpio_setMode(PA_EN_1, OUTPUT);
gpio_setMode(PA_EN_2, OUTPUT);
gpio_setMode(PA_SEL_SW, OUTPUT);
gpio_clearPin(VHF_LNA_EN);
gpio_clearPin(UHF_LNA_EN);
gpio_clearPin(PA_EN_1);
gpio_clearPin(PA_EN_2);
gpio_clearPin(PA_SEL_SW);
/* TODO: keep audio connected to HR_C6000, for volume control */
gpio_setMode(RX_AUDIO_MUX, OUTPUT);
gpio_setPin(RX_AUDIO_MUX);
/*
* Configure and enable DAC
*/
gpio_setMode(APC_REF, INPUT_ANALOG);
RCC->APB1ENR |= RCC_APB1ENR_DACEN;
DAC->CR = DAC_CR_EN1;
DAC->DHR12R1 = 0;
/*
* Configure AT1846S and HR_C6000
*/
AT1846S_init();
C6000_init();
} }
void radio_terminate() void radio_terminate()
{ {
radio_disableRtx();
C6000_terminate();
} }
void radio_setBandwidth(const enum bandwidth bw) void radio_setBandwidth(const enum bandwidth bw)
{ {
(void) bw; switch(bw)
{
case BW_12_5:
AT1846S_setBandwidth(AT1846S_BW_12P5);
break;
case BW_20:
case BW_25:
AT1846S_setBandwidth(AT1846S_BW_25);
break;
default:
break;
}
} }
void radio_setOpmode(const enum opmode mode) void radio_setOpmode(const enum opmode mode)
{ {
(void) mode; currOpMode = mode;
switch(mode)
{
case FM:
AT1846S_setOpMode(AT1846S_OP_FM);
C6000_fmMode();
break;
case DMR:
AT1846S_setOpMode(AT1846S_OP_DMR);
C6000_dmrMode();
break;
default:
break;
}
} }
void radio_setVcoFrequency(const freq_t frequency, const bool isTransmitting) void radio_setVcoFrequency(const freq_t frequency, const bool isTransmitting)
{ {
(void) frequency;
(void) isTransmitting; (void) isTransmitting;
AT1846S_setFrequency(frequency);
} }
void radio_setCSS(const tone_t rxCss, const tone_t txCss) void radio_setCSS(const tone_t rxCss, const tone_t txCss)
{ {
(void) rxCss; rx_tone = rxCss;
(void) txCss; tx_tone = txCss;
} }
bool radio_checkRxDigitalSquelch() bool radio_checkRxDigitalSquelch()
{ {
return false; return true;
} }
void radio_enableRx() void radio_enableRx()
{ {
gpio_clearPin(PA_EN_1);
gpio_clearPin(PA_EN_2);
gpio_clearPin(VHF_LNA_EN);
gpio_clearPin(UHF_LNA_EN);
DAC->DHR12R1 = 0;
if(currRxBand < 0) return;
AT1846S_setFuncMode(AT1846S_RX);
if(currRxBand == 0)
{
gpio_setPin(VHF_LNA_EN);
}
else
{
gpio_setPin(UHF_LNA_EN);
}
} }
void radio_enableTx(const float txPower, const bool enableCss) void radio_enableTx(const float txPower, const bool enableCss)
{ {
(void) txPower; gpio_clearPin(VHF_LNA_EN);
(void) enableCss; gpio_clearPin(UHF_LNA_EN);
gpio_clearPin(PA_EN_1);
gpio_clearPin(PA_EN_2);
if(currTxBand < 0) return;
/*
* TODO: increase granularity
*/
uint8_t power = (txPower > 1.0f) ? txpwr_hi : txpwr_lo;
DAC->DHR12L1 = power * 0xFF;
if(currOpMode == FM)
{
C6000_startAnalogTx();
}
AT1846S_setFuncMode(AT1846S_TX);
gpio_setPin(PA_EN_1);
if(currTxBand == 0)
{
gpio_clearPin(PA_SEL_SW);
}
else
{
gpio_setPin(PA_SEL_SW);
}
gpio_setPin(PA_EN_2);
if(enableCss)
{
AT1846S_enableTxCtcss(tx_tone);
}
} }
void radio_disableRtx() void radio_disableRtx()
{ {
gpio_clearPin(VHF_LNA_EN);
gpio_clearPin(UHF_LNA_EN);
gpio_clearPin(PA_EN_1);
gpio_clearPin(PA_EN_2);
AT1846S_disableCtcss();
AT1846S_setFuncMode(AT1846S_OFF);
C6000_stopAnalogTx();
} }
void radio_updateCalibrationParams(const rtxStatus_t* rtxCfg) void radio_updateCalibrationParams(const rtxStatus_t *rtxCfg)
{ {
(void) rtxCfg; currRxBand = _getBandFromFrequency(rtxCfg->rxFrequency);
currTxBand = _getBandFromFrequency(rtxCfg->txFrequency);
if((currRxBand < 0) || (currTxBand < 0)) return;
/* TCXO bias voltage */
uint8_t modBias = calData->vhfCal.freqAdjustMid;
if(currRxBand > 0) modBias = calData->uhfCal.freqAdjustMid;
C6000_setModOffset(modBias);
freq_t *txCalPoints = calData->vhfCal.txFreq;
uint8_t *loPwrCal = calData->vhfCal.txLowPower;
uint8_t *hiPwrCal = calData->vhfCal.txLowPower;
uint8_t *qRangeCal = (rtxCfg->opMode == FM) ?
calData->vhfCal.analogSendQrange : calData->vhfCal.sendQrange;
if(currTxBand > 0)
{
txCalPoints = calData->uhfCal.txFreq;
loPwrCal = calData->uhfCal.txLowPower;
hiPwrCal = calData->uhfCal.txLowPower;
qRangeCal = (rtxCfg->opMode == FM) ? calData->uhfCal.analogSendQrange
: calData->uhfCal.sendQrange;
}
/* APC voltage for TX output power control */
txpwr_lo = interpCalParameter(rtxCfg->txFrequency, txCalPoints, loPwrCal, 9);
txpwr_hi = interpCalParameter(rtxCfg->txFrequency, txCalPoints, hiPwrCal, 9);
/* HR_C6000 modulation amplitude */
uint8_t Q = interpCalParameter(rtxCfg->txFrequency, txCalPoints, qRangeCal, 9);
C6000_setModAmplitude(0, Q);
} }
float radio_getRssi(const freq_t rxFreq) float radio_getRssi(const freq_t rxFreq)
{ {
(void) rxFreq; (void) rxFreq;
return -100.0f;
uint16_t val = AT1846S_readRSSI();
int8_t rssi = -151 + (val >> 8);
return ((float) rssi);
} }

Wyświetl plik

@ -139,10 +139,10 @@
#define MOD2_BIAS GPIOA,5 #define MOD2_BIAS GPIOA,5
/* Audio control */ /* Audio control */
#define AMP_EN GPIOB,9 #define AUDIO_AMP_EN GPIOB,9
#define SPK_MUTE GPIOB,8 #define SPK_MUTE GPIOB,8
#define FM_MUTE GPIOE,13 #define FM_MUTE GPIOE,13
#define MIC_PWR GPIOA,14 #define MIC_PWR GPIOA,14
/* GPS, for the devices who have it */ /* GPS, for the devices who have it */
#define GPS_EN GPIOD,8 #define GPS_EN GPIOD,8

Wyświetl plik

@ -108,6 +108,8 @@
/* Audio control */ /* Audio control */
#define AUDIO_AMP_EN GPIOB,9 #define AUDIO_AMP_EN GPIOB,9
#define SPK_MUTE GPIOB,8 #define SPK_MUTE GPIOB,8
#define MIC_PWR GPIOA,13
#define RX_AUDIO_MUX GPIOD,9
/* GPS, for the devices who have it */ /* GPS, for the devices who have it */
#define GPS_EN GPIOA,9 #define GPS_EN GPIOA,9
@ -116,6 +118,10 @@
/* RTX stage control */ /* RTX stage control */
#define VHF_LNA_EN GPIOA,5 #define VHF_LNA_EN GPIOA,5
#define UHF_LNA_EN GPIOA,2 #define UHF_LNA_EN GPIOA,2
#define PA_EN_1 GPIOC,5
#define PA_EN_2 GPIOC,4
#define PA_SEL_SW GPIOC,6
#define APC_REF GPIOA,4
/* I2C for AT1846S */ /* I2C for AT1846S */
#define I2C_SDA GPIOC,9 #define I2C_SDA GPIOC,9