kopia lustrzana https://github.com/OpenRTX/OpenRTX
Radio driver for MD-UV3x0 targets
rodzic
9610d0db07
commit
a5120ffddc
|
@ -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': ''}
|
||||||
|
|
|
@ -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
|
||||||
}
|
}
|
||||||
|
|
|
@ -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)
|
||||||
|
|
|
@ -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);
|
||||||
}
|
}
|
||||||
|
|
|
@ -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
|
||||||
|
|
|
@ -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
|
||||||
|
|
Ładowanie…
Reference in New Issue