mirror of https://github.com/markqvist/MMDVM.git
354 lines
11 KiB
C++
354 lines
11 KiB
C++
/*
|
|
* Copyright (C) 2016 by Jim McLaughlin KI6ZUM
|
|
* Copyright (C) 2016 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"
|
|
#include "Globals.h"
|
|
#include "IO.h"
|
|
|
|
#if defined(STM32F4XX) || defined(STM32F4)
|
|
|
|
/*
|
|
Pin definitions:
|
|
|
|
PTT PD8 output
|
|
COSLED PA7 output
|
|
LED PD15 output
|
|
COS PA5 input
|
|
ADC1 PA0 analog input
|
|
ADC2 PA1 analog input
|
|
DAC1 PA4 analog output
|
|
|
|
DSTAR PD12 output
|
|
DMR PD13 output
|
|
YSF PD14 output
|
|
P25 PD11 output
|
|
*/
|
|
|
|
#define PIN_COS GPIO_Pin_5
|
|
#define PORT_COS GPIOA
|
|
#define PIN_PTT GPIO_Pin_8
|
|
#define PORT_PTT GPIOD
|
|
#define PIN_COSLED GPIO_Pin_7
|
|
#define PORT_COSLED GPIOA
|
|
#define PIN_LED GPIO_Pin_15
|
|
#define PORT_LED GPIOD
|
|
#define PIN_ADC GPIO_Pin_0
|
|
#define PORT_ADC GPIOA
|
|
#define PIN_DAC GPIO_Pin_4
|
|
#define PORT_DAC GPIOA
|
|
|
|
#define PIN_P25 GPIO_Pin_11
|
|
#define PORT_P25 GPIOD
|
|
#define PIN_DSTAR GPIO_Pin_12
|
|
#define PORT_DSTAR GPIOD
|
|
#define PIN_DMR GPIO_Pin_13
|
|
#define PORT_DMR GPIOD
|
|
#define PIN_YSF GPIO_Pin_14
|
|
#define PORT_YSF GPIOD
|
|
|
|
const uint16_t DC_OFFSET = 2048U;
|
|
|
|
extern "C" {
|
|
void TIM2_IRQHandler() {
|
|
if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) {
|
|
TIM_ClearITPendingBit(TIM2, TIM_IT_Update);
|
|
io.interrupt();
|
|
}
|
|
}
|
|
}
|
|
|
|
void CIO::initInt()
|
|
{
|
|
GPIO_InitTypeDef GPIO_InitStruct;
|
|
|
|
// PTT pin
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_PTT;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_DOWN;
|
|
GPIO_Init(PORT_PTT, &GPIO_InitStruct);
|
|
|
|
// COSLED pin
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_COSLED;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_DOWN;
|
|
GPIO_Init(PORT_COSLED, &GPIO_InitStruct);
|
|
|
|
// LED pin
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_LED;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_DOWN;
|
|
GPIO_Init(PORT_LED, &GPIO_InitStruct);
|
|
|
|
// Init the input pins PIN_COS
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_COS;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IN;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_NOPULL;
|
|
GPIO_Init(PORT_COS, &GPIO_InitStruct);
|
|
|
|
// DSTAR pin
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_DSTAR;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_DOWN;
|
|
GPIO_Init(PORT_DSTAR, &GPIO_InitStruct);
|
|
|
|
// DMR pin
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_DMR;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_DOWN;
|
|
GPIO_Init(PORT_DMR, &GPIO_InitStruct);
|
|
|
|
// YSF pin
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_YSF;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_DOWN;
|
|
GPIO_Init(PORT_YSF, &GPIO_InitStruct);
|
|
|
|
// P25 pin
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
GPIO_InitStruct.GPIO_Pin = PIN_P25;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_DOWN;
|
|
GPIO_Init(PORT_P25, &GPIO_InitStruct);
|
|
}
|
|
|
|
void CIO::startInt()
|
|
{
|
|
if ((ADC_GetFlagStatus(ADC1, ADC_FLAG_EOC) != RESET))
|
|
io.interrupt();
|
|
|
|
// ADC1 PA0 analog input
|
|
// ADC2 PA1 analog input
|
|
// DAC1 PA4 analog output
|
|
|
|
// Init the ADC
|
|
GPIO_InitTypeDef GPIO_InitStruct;
|
|
ADC_InitTypeDef ADC_InitStructure;
|
|
ADC_CommonInitTypeDef ADC_CommonInitStructure;
|
|
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
ADC_CommonStructInit(&ADC_CommonInitStructure);
|
|
ADC_StructInit(&ADC_InitStructure);
|
|
|
|
// Enable ADC clock
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE);
|
|
#if defined(SEND_RSSI_DATA)
|
|
RCC_APB2PeriphClockCmd(RCC_APB2Periph_ADC1 | RCC_APB2Periph_ADC2, ENABLE);
|
|
#else
|
|
RCC_APB2PeriphClockCmd(RCC_APB2Periph_ADC1, ENABLE);
|
|
#endif
|
|
|
|
// For ADC1 on PA0, ADC2 on PA1
|
|
#if defined(SEND_RSSI_DATA)
|
|
GPIO_InitStruct.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1;
|
|
#else
|
|
GPIO_InitStruct.GPIO_Pin = GPIO_Pin_0;
|
|
#endif
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AN;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_NOPULL ;
|
|
GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
|
|
// Init ADCs in dual mode, div clock by two
|
|
ADC_CommonInitStructure.ADC_Mode = ADC_DualMode_RegSimult;
|
|
ADC_CommonInitStructure.ADC_Prescaler = ADC_Prescaler_Div2;
|
|
ADC_CommonInitStructure.ADC_DMAAccessMode = ADC_DMAAccessMode_Disabled;
|
|
ADC_CommonInitStructure.ADC_TwoSamplingDelay = ADC_TwoSamplingDelay_5Cycles;
|
|
ADC_CommonInit(&ADC_CommonInitStructure);
|
|
|
|
// Init ADC1 and ADC2: 12bit, single-conversion
|
|
ADC_InitStructure.ADC_Resolution = ADC_Resolution_12b;
|
|
ADC_InitStructure.ADC_ScanConvMode = DISABLE;
|
|
ADC_InitStructure.ADC_ContinuousConvMode = DISABLE;
|
|
ADC_InitStructure.ADC_ExternalTrigConvEdge = 0;
|
|
ADC_InitStructure.ADC_ExternalTrigConv = 0;
|
|
ADC_InitStructure.ADC_DataAlign = ADC_DataAlign_Right;
|
|
ADC_InitStructure.ADC_NbrOfConversion = 1;
|
|
|
|
ADC_Init(ADC1, &ADC_InitStructure);
|
|
|
|
ADC_EOCOnEachRegularChannelCmd(ADC1, ENABLE);
|
|
ADC_RegularChannelConfig(ADC1, ADC_Channel_0, 1, ADC_SampleTime_3Cycles);
|
|
|
|
// Enable ADC1
|
|
ADC_Cmd(ADC1, ENABLE);
|
|
|
|
#if defined(SEND_RSSI_DATA)
|
|
ADC_Init(ADC2, &ADC_InitStructure);
|
|
|
|
ADC_EOCOnEachRegularChannelCmd(ADC2, ENABLE);
|
|
ADC_RegularChannelConfig(ADC2, ADC_Channel_1, 1, ADC_SampleTime_3Cycles);
|
|
|
|
// Enable ADC2
|
|
ADC_Cmd(ADC2, ENABLE);
|
|
#endif
|
|
|
|
// Init the DAC
|
|
DAC_InitTypeDef DAC_InitStructure;
|
|
|
|
GPIO_StructInit(&GPIO_InitStruct);
|
|
DAC_StructInit(&DAC_InitStructure);
|
|
|
|
// GPIOA & D clock enable
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE);
|
|
|
|
// DAC Periph clock enable
|
|
RCC_APB1PeriphClockCmd(RCC_APB1Periph_DAC, ENABLE);
|
|
|
|
// GPIO CONFIGURATION of DAC Pins
|
|
GPIO_InitStruct.GPIO_Pin = GPIO_Pin_4;
|
|
GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AN;
|
|
GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_NOPULL;
|
|
GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
|
|
DAC_InitStructure.DAC_Trigger = DAC_Trigger_None;
|
|
DAC_InitStructure.DAC_WaveGeneration = DAC_WaveGeneration_None;
|
|
DAC_InitStructure.DAC_OutputBuffer = DAC_OutputBuffer_Enable;
|
|
DAC_Init(DAC_Channel_1, &DAC_InitStructure);
|
|
DAC_Cmd(DAC_Channel_1, ENABLE);
|
|
|
|
// Init the timer
|
|
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
|
|
|
|
TIM_TimeBaseInitTypeDef timerInitStructure;
|
|
TIM_TimeBaseStructInit (&timerInitStructure);
|
|
timerInitStructure.TIM_Prescaler = 1749; // 24 kHz
|
|
timerInitStructure.TIM_CounterMode = TIM_CounterMode_Up;
|
|
timerInitStructure.TIM_Period = 1;
|
|
timerInitStructure.TIM_ClockDivision = TIM_CKD_DIV1;
|
|
timerInitStructure.TIM_RepetitionCounter = 0;
|
|
TIM_TimeBaseInit(TIM2, &timerInitStructure);
|
|
TIM_Cmd(TIM2, ENABLE);
|
|
TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE);
|
|
|
|
NVIC_InitTypeDef nvicStructure;
|
|
nvicStructure.NVIC_IRQChannel = TIM2_IRQn;
|
|
nvicStructure.NVIC_IRQChannelPreemptionPriority = 0;
|
|
nvicStructure.NVIC_IRQChannelSubPriority = 1;
|
|
nvicStructure.NVIC_IRQChannelCmd = ENABLE;
|
|
NVIC_Init(&nvicStructure);
|
|
|
|
GPIO_ResetBits(PORT_COSLED, PIN_COSLED);
|
|
GPIO_SetBits(PORT_LED, PIN_LED);
|
|
}
|
|
|
|
void CIO::interrupt()
|
|
{
|
|
uint8_t control = MARK_NONE;
|
|
uint16_t sample = DC_OFFSET;
|
|
uint16_t rawRSSI = 0U;
|
|
|
|
m_txBuffer.get(sample, control);
|
|
|
|
// Send the value to the DAC
|
|
DAC_SetChannel1Data(DAC_Align_12b_R, sample);
|
|
|
|
// Read value from ADC1 and ADC2
|
|
if ((ADC_GetFlagStatus(ADC1, ADC_FLAG_EOC) == RESET)) {
|
|
// shouldn't be still in reset at this point so null the sample value?
|
|
sample = 0U;
|
|
} else {
|
|
sample = ADC_GetConversionValue(ADC1);
|
|
#if defined(SEND_RSSI_DATA)
|
|
rawRSSI = ADC_GetConversionValue(ADC2);
|
|
#endif
|
|
}
|
|
|
|
// trigger next ADC1
|
|
ADC_ClearFlag(ADC1, ADC_FLAG_EOC);
|
|
ADC_SoftwareStartConv(ADC1);
|
|
|
|
m_rxBuffer.put(sample, control);
|
|
m_rssiBuffer.put(rawRSSI);
|
|
|
|
m_watchdog++;
|
|
}
|
|
|
|
bool CIO::getCOSInt()
|
|
{
|
|
return GPIO_ReadOutputDataBit(PORT_COS, PIN_COS) == Bit_SET;
|
|
}
|
|
|
|
void CIO::setLEDInt(bool on)
|
|
{
|
|
GPIO_WriteBit(PORT_LED, PIN_LED, on ? Bit_SET : Bit_RESET);
|
|
}
|
|
|
|
void CIO::setPTTInt(bool on)
|
|
{
|
|
GPIO_WriteBit(PORT_PTT, PIN_PTT, on ? Bit_SET : Bit_RESET);
|
|
}
|
|
|
|
void CIO::setCOSInt(bool on)
|
|
{
|
|
GPIO_WriteBit(PORT_COSLED, PIN_COSLED, on ? Bit_SET : Bit_RESET);
|
|
}
|
|
|
|
void CIO::setDStarInt(bool on)
|
|
{
|
|
GPIO_WriteBit(PORT_DSTAR, PIN_DSTAR, on ? Bit_SET : Bit_RESET);
|
|
}
|
|
|
|
void CIO::setDMRInt(bool on)
|
|
{
|
|
GPIO_WriteBit(PORT_DMR, PIN_DMR, on ? Bit_SET : Bit_RESET);
|
|
}
|
|
|
|
void CIO::setYSFInt(bool on)
|
|
{
|
|
GPIO_WriteBit(PORT_YSF, PIN_YSF, on ? Bit_SET : Bit_RESET);
|
|
}
|
|
|
|
void CIO::setP25Int(bool on)
|
|
{
|
|
GPIO_WriteBit(PORT_P25, PIN_P25, on ? Bit_SET : Bit_RESET);
|
|
}
|
|
|
|
#endif
|
|
|