mirror of
https://github.com/juribeparada/MMDVM_HS.git
synced 2025-12-06 07:12:08 +01:00
255 lines
7.3 KiB
C++
255 lines
7.3 KiB
C++
/*
|
|
* Copyright (C) 2016 by Jim McLaughlin KI6ZUM
|
|
* Copyright (C) 2016, 2017 by Andy Uribe CA6JAU
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
#include "Config.h"
|
|
|
|
#if defined(ADF7021)
|
|
|
|
#include "Globals.h"
|
|
#include "IO.h"
|
|
#include "ADF7021.h"
|
|
#include <math.h>
|
|
|
|
volatile uint32_t AD7021_control_byte;
|
|
volatile int AD7021_counter;
|
|
|
|
void dlybit(void)
|
|
{
|
|
volatile unsigned int delay;
|
|
for(delay = 0;delay<5;delay++);
|
|
}
|
|
|
|
void Send_AD7021_control()
|
|
{
|
|
for(AD7021_counter = 31; AD7021_counter >= 0; AD7021_counter--) {
|
|
if(bitRead(AD7021_control_byte, AD7021_counter) == HIGH)
|
|
io.SDATA_pin(HIGH);
|
|
else
|
|
io.SDATA_pin(LOW);
|
|
|
|
io.SCLK_pin(HIGH);
|
|
dlybit();
|
|
io.SCLK_pin(LOW);
|
|
dlybit();
|
|
}
|
|
|
|
io.SLE_pin(HIGH);
|
|
dlybit();
|
|
io.SLE_pin(LOW);
|
|
io.SDATA_pin(LOW);
|
|
}
|
|
|
|
void Send_REG0_RX()
|
|
{
|
|
uint32_t ADF7021_RX_REG0;
|
|
float divider;
|
|
uint8_t N_divider;
|
|
uint16_t F_divider;
|
|
|
|
divider = (m_frequency_rx - 100000) / (ADF7021_PFD / 2.0);
|
|
|
|
N_divider = floor(divider);
|
|
divider = (divider - N_divider) * 32768;
|
|
F_divider = floor(divider + 0.5);
|
|
|
|
ADF7021_RX_REG0 = (uint32_t)0b0000;
|
|
ADF7021_RX_REG0 |= (uint32_t)0b01011 << 27; // mux regulator/uart enabled/receive
|
|
ADF7021_RX_REG0 |= (uint32_t)N_divider << 19; //frequency;
|
|
ADF7021_RX_REG0 |= (uint32_t)F_divider << 4; //frequency;
|
|
|
|
AD7021_control_byte = ADF7021_RX_REG0;
|
|
Send_AD7021_control();
|
|
}
|
|
|
|
void Send_REG0_TX()
|
|
{
|
|
uint32_t ADF7021_TX_REG0;
|
|
float divider;
|
|
uint8_t N_divider;
|
|
uint16_t F_divider;
|
|
|
|
divider = m_frequency_tx / (ADF7021_PFD / 2.0);
|
|
|
|
N_divider = floor(divider);
|
|
divider = (divider - N_divider) * 32768;
|
|
F_divider = floor(divider + 0.5);
|
|
|
|
ADF7021_TX_REG0 = (uint32_t)0b0000; // register 0
|
|
ADF7021_TX_REG0 |= (uint32_t)0b01010 << 27; // mux regulator/uart enabled/transmit
|
|
ADF7021_TX_REG0 |= (uint32_t)N_divider << 19; //frequency;
|
|
ADF7021_TX_REG0 |= (uint32_t)F_divider << 4; //frequency;
|
|
|
|
AD7021_control_byte = ADF7021_TX_REG0;
|
|
Send_AD7021_control();
|
|
}
|
|
|
|
void CIO::ifConf()
|
|
{
|
|
uint32_t ADF7021_REG2 = 0;
|
|
uint32_t ADF7021_REG3 = 0;
|
|
uint32_t ADF7021_REG4 = 0;
|
|
uint32_t ADF7021_REG13 = 0;
|
|
|
|
if (m_dstarEnable) {
|
|
// Dev: 1200 Hz, symb rate = 4800
|
|
|
|
ADF7021_REG3 = 0x2A4C4193;
|
|
ADF7021_REG4 = 0x00A82A94;
|
|
ADF7021_REG13 = 0x0000000D;
|
|
|
|
ADF7021_REG2 = (uint32_t)0b00 << 28; // clock normal
|
|
ADF7021_REG2 |= (uint32_t)0b000101010 << 19; // deviation
|
|
ADF7021_REG2 |= (uint32_t)0b001 << 4; // modulation (GMSK)
|
|
}
|
|
else if (m_dmrEnable) {
|
|
// Dev: +1 symb 648 Hz, symb rate = 4800
|
|
|
|
ADF7021_REG3 = 0x2A4C80D3;
|
|
|
|
// K=32
|
|
ADF7021_REG4 = (uint32_t)0b0100 << 0; // register 4
|
|
ADF7021_REG4 |= (uint32_t)0b011 << 4; // mode, 4FSK
|
|
ADF7021_REG4 |= (uint32_t)0b0 << 7;
|
|
ADF7021_REG4 |= (uint32_t)0b11 << 8;
|
|
ADF7021_REG4 |= (uint32_t)393U << 10; // Disc BW
|
|
ADF7021_REG4 |= (uint32_t)65U << 20; // Post dem BW
|
|
ADF7021_REG4 |= (uint32_t)0b10 << 30; // IF filter
|
|
|
|
ADF7021_REG13 = 0x0000033D;
|
|
|
|
ADF7021_REG2 = (uint32_t)0b10 << 28; // invert data
|
|
ADF7021_REG2 |= (uint32_t)24U << 19; // deviation
|
|
ADF7021_REG2 |= (uint32_t)0b111 << 4; // modulation (4FSK)
|
|
}
|
|
else if (m_ysfEnable) {
|
|
// Dev: +1 symb 900 Hz, symb rate = 4800
|
|
|
|
ADF7021_REG3 = 0x2A4C80D3;
|
|
|
|
// K=28
|
|
ADF7021_REG4 = (uint32_t)0b0100 << 0; // register 4
|
|
ADF7021_REG4 |= (uint32_t)0b011 << 4; // mode, 4FSK
|
|
ADF7021_REG4 |= (uint32_t)0b0 << 7;
|
|
ADF7021_REG4 |= (uint32_t)0b11 << 8;
|
|
ADF7021_REG4 |= (uint32_t)344U << 10; // Disc BW
|
|
ADF7021_REG4 |= (uint32_t)65U << 20; // Post dem BW
|
|
ADF7021_REG4 |= (uint32_t)0b10 << 30; // IF filter
|
|
|
|
ADF7021_REG13 = 0x000003BD;
|
|
|
|
ADF7021_REG2 = (uint32_t)0b10 << 28; // invert data
|
|
ADF7021_REG2 |= (uint32_t)32U << 19; // deviation
|
|
ADF7021_REG2 |= (uint32_t)0b111 << 4; // modulation (4FSK)
|
|
}
|
|
else if (m_p25Enable) {
|
|
// Dev: +1 symb 600 Hz, symb rate = 4800
|
|
|
|
ADF7021_REG3 = 0x2A4C80D3;
|
|
|
|
// K=32
|
|
ADF7021_REG4 = (uint32_t)0b0100 << 0; // register 4
|
|
ADF7021_REG4 |= (uint32_t)0b011 << 4; // mode, 4FSK
|
|
ADF7021_REG4 |= (uint32_t)0b0 << 7;
|
|
ADF7021_REG4 |= (uint32_t)0b11 << 8;
|
|
ADF7021_REG4 |= (uint32_t)393U << 10; // Disc BW
|
|
ADF7021_REG4 |= (uint32_t)65U << 20; // Post dem BW
|
|
ADF7021_REG4 |= (uint32_t)0b10 << 30; // IF filter
|
|
|
|
ADF7021_REG13 = 0x000002DD;
|
|
|
|
ADF7021_REG2 = (uint32_t)0b10 << 28; // invert data
|
|
ADF7021_REG2 |= (uint32_t)22U << 19; // deviation
|
|
ADF7021_REG2 |= (uint32_t)0b111 << 4; // modulation (4FSK)
|
|
}
|
|
|
|
// VCO/OSCILLATOR (REG1)
|
|
if( (m_frequency_tx >= VHF_MIN) && (m_frequency_tx < VHF_MAX) )
|
|
AD7021_control_byte = 0x021F5041; // VHF, external VCO
|
|
else if( (m_frequency_tx >= UHF_MIN)&&(m_frequency_tx < UHF_MAX) )
|
|
AD7021_control_byte = 0x00575041; // UHF, internal VCO
|
|
|
|
Send_AD7021_control();
|
|
|
|
// TX/RX CLOCK (3)
|
|
AD7021_control_byte = ADF7021_REG3;
|
|
Send_AD7021_control();
|
|
|
|
// DEMOD (4)
|
|
AD7021_control_byte = ADF7021_REG4;
|
|
Send_AD7021_control();
|
|
|
|
// IF FILTER (5)
|
|
AD7021_control_byte = 0x000024F5;
|
|
Send_AD7021_control();
|
|
|
|
// MODULATION (2)
|
|
ADF7021_REG2 |= (uint32_t)0b0010; // register 2
|
|
ADF7021_REG2 |= (uint32_t)m_power << 13; // power level
|
|
ADF7021_REG2 |= (uint32_t)0b110001 << 7; // PA
|
|
AD7021_control_byte = ADF7021_REG2;
|
|
Send_AD7021_control();
|
|
|
|
// TEST MODE (disabled) (15)
|
|
AD7021_control_byte = 0x000E000F;
|
|
Send_AD7021_control();
|
|
|
|
// IF FINE CAL (fine cal, defaults) (6)
|
|
AD7021_control_byte = 0x05080B16;
|
|
Send_AD7021_control();
|
|
|
|
// AGC (auto, defaults) (9)
|
|
AD7021_control_byte = 0x000231E9; // auto
|
|
Send_AD7021_control();
|
|
|
|
// AFC (off, defaults) (10)
|
|
AD7021_control_byte = 0x3296472A; // off
|
|
Send_AD7021_control();
|
|
|
|
// SYNC WORD DET (11)
|
|
AD7021_control_byte = 0x0000003B;
|
|
Send_AD7021_control();
|
|
|
|
// SWD/THRESHOLD (12)
|
|
AD7021_control_byte = 0x0000010C;
|
|
Send_AD7021_control();
|
|
|
|
// 3FSK/4FSK DEMOD (13)
|
|
AD7021_control_byte = ADF7021_REG13;
|
|
Send_AD7021_control();
|
|
}
|
|
|
|
//======================================================================================================================
|
|
void CIO::setTX()
|
|
{
|
|
PTT_pin(HIGH);
|
|
LED_pin(LOW);
|
|
Send_REG0_TX();
|
|
}
|
|
|
|
//======================================================================================================================
|
|
void CIO::setRX()
|
|
{
|
|
PTT_pin(LOW);
|
|
LED_pin(HIGH);
|
|
delay_rx();
|
|
Send_REG0_RX();
|
|
}
|
|
|
|
#endif
|