diff --git a/meson.build b/meson.build
index d11062b3..6aec183a 100644
--- a/meson.build
+++ b/meson.build
@@ -12,6 +12,7 @@ project('OpenRTX', 'c',
## OpenRTX
openrtx_src = ['openrtx/src/bootstrap.c',
+ 'openrtx/src/bootstrap.c',
'openrtx/src/state.c',
'openrtx/src/ui.c',
'openrtx/src/threads.c']
@@ -177,6 +178,7 @@ md380_src = src + stm32f405_src + ['platform/drivers/display/HX83XX_MDx.c',
'platform/drivers/tones/toneGenerator_MDx.c',
'platform/drivers/baseband/pll_MD3x0.c',
'platform/drivers/baseband/rtx_MD3x0.c',
+ 'platform/drivers/baseband/HR-C5000_MD3x0.c',
'platform/targets/MD-380/platform.c',
'openrtx/src/graphics/graphics_rgb565.c']
diff --git a/platform/drivers/baseband/HR-C5000_MD3x0.c b/platform/drivers/baseband/HR-C5000_MD3x0.c
new file mode 100644
index 00000000..c8315052
--- /dev/null
+++ b/platform/drivers/baseband/HR-C5000_MD3x0.c
@@ -0,0 +1,264 @@
+/***************************************************************************
+ * Copyright (C) 2020 by Federico Amedeo Izzo IU2NUO, *
+ * Niccolò Izzo IU2KIN *
+ * Frederik Saraci IU2NRO *
+ * Silvano Seva IU2KWO *
+ * *
+ * 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 3 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, see *
+ ***************************************************************************/
+
+#include "HR-C5000_MD3x0.h"
+#include
+#include
+#include
+#include
+#include
+
+const uint8_t initSeq1[] = {0x00, 0x00, 0xFF, 0xB0, 0x00, 0x00, 0x00, 0x00};
+const uint8_t initSeq2[] =
+{
+ 0x00, 0x11, 0x80, 0x0A, 0x22, 0x01, 0x00, 0x00, 0x33, 0xEF, 0x00, 0xFF, 0xFF,
+ 0xFF, 0xF0, 0xF0, 0x10, 0x00, 0x00, 0x07, 0x3B, 0xF8, 0x0E, 0xFD, 0x40, 0xFF,
+ 0x00, 0x0B, 0x00, 0x00, 0x00, 0x04, 0x0B, 0x00, 0x17, 0x02, 0xFF, 0xE0, 0x28,
+ 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+};
+const uint8_t initSeq3[] =
+{
+ 0x01, 0x10, 0x69, 0x69, 0x96, 0x96, 0x96, 0x99, 0x99, 0x99, 0xA5, 0xA5, 0xAA,
+ 0xAA, 0xCC, 0xCC, 0x00, 0xF0, 0x01, 0xFF, 0x01, 0x0F
+};
+const uint8_t initSeq4[] = {0x01, 0x30, 0x30, 0x4E, 0x14, 0x1E, 0x1A, 0x30, 0x3D,
+ 0x50, 0x07, 0x60};
+const uint8_t initSeq5[] = {0x01, 0x40, 0x90, 0x03, 0x01, 0x02, 0x05, 0x07, 0xF0};
+const uint8_t initSeq6[] = {0x01, 0x50, 0x00, 0x00, 0x00, 0x00, 0x00};
+
+
+uint8_t _spiSendRecv(uint8_t value)
+{
+ gpio_clearPin(DMR_CLK);
+
+ uint8_t incoming = 0;
+ uint8_t cnt = 0;
+
+ for(; cnt < 8; cnt++)
+ {
+ gpio_setPin(DMR_CLK);
+
+ if(value & (0x80 >> cnt))
+ {
+ gpio_setPin(DMR_MOSI);
+ }
+ else
+ {
+ gpio_clearPin(DMR_MOSI);
+ }
+
+ delayUs(1);
+ gpio_clearPin(DMR_CLK);
+ incoming = (incoming << 1) | gpio_readPin(DMR_MISO);
+ delayUs(1);
+ }
+
+ return incoming;
+}
+
+void _writeReg(uint8_t type, uint8_t reg, uint8_t val)
+{
+ gpio_clearPin(DMR_CS);
+ (void) _spiSendRecv(type);
+ (void) _spiSendRecv(reg);
+ (void) _spiSendRecv(val);
+ gpio_setPin(DMR_CS);
+}
+
+void _sendSequence(const uint8_t *seq, uint8_t len)
+{
+ gpio_clearPin(DMR_CS);
+
+ uint8_t i = 0;
+ for(; i < len; i++)
+ {
+ (void) _spiSendRecv(seq[i]);
+ }
+
+ gpio_setPin(DMR_CS);
+}
+
+OS_ERR e;
+
+void C5000_init()
+{
+ gpio_setMode(DMR_CS, OUTPUT);
+ gpio_setMode(DMR_CLK, OUTPUT);
+ gpio_setMode(DMR_MOSI, OUTPUT);
+ gpio_setMode(DMR_MISO, OUTPUT);
+ gpio_setMode(DMR_SLEEP, OUTPUT);
+
+ gpio_setPin(DMR_CS);
+ gpio_setPin(DMR_SLEEP);
+
+ OSTimeDly(1, OS_OPT_TIME_DLY, &e);
+ gpio_clearPin(DMR_SLEEP);
+ C5000_dmrMode();
+ OSTimeDly(1, OS_OPT_TIME_DLY, &e);
+ C5000_fmMode();
+}
+
+void C5000_terminate()
+{
+}
+
+void C5000_dmrMode()
+{
+ _writeReg(0x00, 0x0A, 0x80);
+ _writeReg(0x00, 0x0B, 0x28);
+ _writeReg(0x00, 0x0C, 0x33);
+ OSTimeDly(1, OS_OPT_TIME_DLY, &e);
+ _writeReg(0x00, 0x0A, 0x00);
+ _writeReg(0x00, 0xB9, 0x32);
+ _writeReg(0x00, 0xBA, 0x22);
+ _writeReg(0x00, 0xBB, 0x11);
+ _writeReg(0x00, 0x10, 0x4F);
+ _writeReg(0x00, 0x40, 0x43);
+ _writeReg(0x00, 0x41, 0x40);
+ _writeReg(0x00, 0x07, 0x0B);
+ _writeReg(0x00, 0x08, 0xB8);
+ _writeReg(0x00, 0x09, 0x00);
+ _writeReg(0x00, 0x06, 0x21);
+ _sendSequence(initSeq1, sizeof(initSeq1));
+ _writeReg(0x00, 0x48, 0x00);
+ _writeReg(0x00, 0x47, 0x1F); /* This is 0x7F - freq_adj_mid */
+ _sendSequence(initSeq2, sizeof(initSeq2));
+ _writeReg(0x00, 0x00, 0x28);
+ OSTimeDly(1, OS_OPT_TIME_DLY, &e);
+
+ _writeReg(0x00, 0x14, 0x59);
+ _writeReg(0x00, 0x15, 0xF5);
+ _writeReg(0x00, 0x16, 0x21);
+ _sendSequence(initSeq3, sizeof(initSeq3));
+ _sendSequence(initSeq4, sizeof(initSeq4));
+ _sendSequence(initSeq5, sizeof(initSeq5));
+ _sendSequence(initSeq6, sizeof(initSeq6));
+ _writeReg(0x01, 0x52, 0x08);
+ _writeReg(0x01, 0x53, 0xEB);
+ _writeReg(0x01, 0x54, 0x78);
+ _writeReg(0x01, 0x45, 0x1E);
+ _writeReg(0x01, 0x37, 0x50);
+ _writeReg(0x01, 0x35, 0xFF);
+ _writeReg(0x00, 0x39, 0x02);
+ _writeReg(0x00, 0x3D, 0x0A);
+ _writeReg(0x00, 0x83, 0xFF);
+ _writeReg(0x00, 0x87, 0x00);
+ _writeReg(0x00, 0x65, 0x0A);
+ _writeReg(0x00, 0x1D, 0xFF);
+ _writeReg(0x00, 0x1E, 0xF1);
+ _writeReg(0x00, 0x1F, 0x10);
+ _writeReg(0x00, 0x0D, 0x8C);
+ _writeReg(0x00, 0x0E, 0x44);
+ _writeReg(0x00, 0x0F, 0xC8);
+ _writeReg(0x00, 0x37, 0xC2);
+ _writeReg(0x00, 0x25, 0x0E);
+ _writeReg(0x00, 0x26, 0xFD);
+ _writeReg(0x00, 0x64, 0x00);
+
+ _writeReg(0x01, 0x24, 0x00);
+ _writeReg(0x01, 0x25, 0x00);
+ _writeReg(0x01, 0x26, 0x00);
+ _writeReg(0x01, 0x27, 0x00);
+ _writeReg(0x00, 0x81, 0x19);
+ _writeReg(0x00, 0x85, 0x00);
+}
+
+void C5000_fmMode()
+{
+ _writeReg(0x00, 0x0A, 0x80);
+ _writeReg(0x00, 0x0B, 0x28);
+ _writeReg(0x00, 0x0C, 0x33);
+ OSTimeDly(1, OS_OPT_TIME_DLY, &e);
+ _writeReg(0x00, 0x0A, 0x00);
+ _writeReg(0x00, 0xB9, 0x33);
+ _writeReg(0x00, 0xBA, 0x22);
+ _writeReg(0x00, 0xBB, 0x11);
+ _writeReg(0x00, 0x10, 0x80);
+ _writeReg(0x00, 0x07, 0x0E);
+ _writeReg(0x00, 0x08, 0x10);
+ _writeReg(0x00, 0x09, 0x00);
+ _sendSequence(initSeq1, sizeof(initSeq1));
+ _writeReg(0x00, 0x06, 0x00);
+ _sendSequence(initSeq2, sizeof(initSeq2));
+ _writeReg(0x00, 0x48, 0x00);
+ _writeReg(0x00, 0x47, 0x1F); /* This is 0x7F - freq_adj_mid */
+ _writeReg(0x00, 0x0D, 0x8C);
+ _writeReg(0x00, 0x0E, 0x44);
+ _writeReg(0x00, 0x0F, 0xC8);
+ _writeReg(0x00, 0x25, 0x0E);
+ _writeReg(0x00, 0x26, 0xFE);
+ _writeReg(0x00, 0x83, 0xFF);
+ _writeReg(0x00, 0x87, 0x00);
+ _writeReg(0x00, 0x81, 0x00);
+ _writeReg(0x00, 0x60, 0x00);
+
+ _writeReg(0x00, 0x00, 0x28);
+}
+
+void C5000_activateAnalogTx()
+{
+ delayMs(51);
+ _writeReg(0x00, 0x25, 0x0E);
+
+ delayMs(15);
+ _writeReg(0x00, 0x0D, 0x8C);
+ _writeReg(0x00, 0x0E, 0x44);
+ _writeReg(0x00, 0x0F, 0xC8);
+ _writeReg(0x00, 0x25, 0x0E);
+ _writeReg(0x00, 0x26, 0xFE);
+ _writeReg(0x00, 0x83, 0xFF);
+ _writeReg(0x00, 0x87, 0x00);
+ _writeReg(0x00, 0x45, 0x32);
+ _writeReg(0x00, 0x46, 0x85);
+ _writeReg(0x00, 0x04, 0x1F);
+ _writeReg(0x00, 0x35, 0x1E);
+ _writeReg(0x00, 0x3F, 0x04);
+ _writeReg(0x00, 0x34, 0x3C);
+ _writeReg(0x00, 0x3E, 0x08);
+ _writeReg(0x00, 0x37, 0xC2);
+ _writeReg(0x01, 0x50, 0x00);
+ _writeReg(0x01, 0x51, 0x00);
+ _writeReg(0x00, 0x81, 0x00);
+ _writeReg(0x00, 0x60, 0x80);
+
+ delayMs(15);
+ _writeReg(0x00, 0x0E, 0x40);
+
+ delayMs(350);
+ _writeReg(0x00, 0x0E, 0x44);
+}
+
+void C5000_shutdownAnalogTx()
+{
+ delayMs(50);
+ _writeReg(0x00, 0x60, 0x80);
+ delayMs(270);
+ _writeReg(0x00, 0x0E, 0x44);
+ _writeReg(0x00, 0x60, 0x80);
+}
+
+void C5000_writeReg(uint8_t reg, uint8_t val)
+{
+}
+
+bool C5000_spiInUse()
+{
+ return (gpio_readPin(DMR_CS) == 0) ? true : false;
+}
diff --git a/platform/drivers/baseband/HR-C5000_MD3x0.h b/platform/drivers/baseband/HR-C5000_MD3x0.h
new file mode 100644
index 00000000..85a3d2ca
--- /dev/null
+++ b/platform/drivers/baseband/HR-C5000_MD3x0.h
@@ -0,0 +1,77 @@
+/***************************************************************************
+ * Copyright (C) 2020 by Federico Amedeo Izzo IU2NUO, *
+ * Niccolò Izzo IU2KIN *
+ * Frederik Saraci IU2NRO *
+ * Silvano Seva IU2KWO *
+ * *
+ * 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 3 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, see *
+ ***************************************************************************/
+
+#ifndef C5000_MD3x0_H
+#define C5000_MD3x0_H
+
+#include
+#include
+
+/**
+ * Driver for HR_C5000 chip in MD3x0 radios (MD380 and MD390)
+ *
+ * WARNING: the PLL and DMR chips share the SPI MOSI line, thus particular care
+ * has to be put to avoid them stomping reciprocally. This driver does not make
+ * any check if a SPI transfer is already in progress, deferring the correct bus
+ * management to higher level modules. However, a function returning true if the
+ * bus is currently in use by this driver is provided.
+ */
+
+/**
+ * Initialise the HR_C5000 driver.
+ */
+void C5000_init();
+
+/**
+ * Terminate the HR_C5000 driver.
+ */
+void C5000_terminate();
+
+/**
+ *
+ */
+void C5000_dmrMode();
+
+/**
+ *
+ */
+void C5000_fmMode();
+
+/**
+ *
+ */
+void C5000_activateAnalogTx();
+
+/**
+ *
+ */
+void C5000_shutdownAnalogTx();
+
+/**
+ *
+ */
+void C5000_writeReg(uint8_t reg, uint8_t val);
+
+/**
+ *
+ */
+bool C5000_spiInUse();
+
+#endif /* C5000_MD3x0_H */
diff --git a/platform/drivers/baseband/rtx_MD3x0.c b/platform/drivers/baseband/rtx_MD3x0.c
index c4ea981a..f2d5a3a2 100644
--- a/platform/drivers/baseband/rtx_MD3x0.c
+++ b/platform/drivers/baseband/rtx_MD3x0.c
@@ -24,6 +24,7 @@
#include "rtx.h"
#include "pll_MD3x0.h"
#include "ADC1_MDxx380.h"
+#include "HR-C5000_MD3x0.h"
const freq_t IF_FREQ = 49950000.0f; /* Intermediate frequency: 49.95MHz */
@@ -81,6 +82,11 @@ void rtx_init()
*/
gpio_setPin(PLL_PWR);
pll_init();
+
+ /*
+ * Configure HR_C5000
+ */
+ C5000_init();
}
void rtx_terminate()
@@ -124,14 +130,23 @@ void rtx_setFuncmode(enum funcmode mode)
gpio_clearPin(RF_APC_SW);
gpio_setPin(VCOVCC_SW);
pll_setFrequency(rxFreq - IF_FREQ, 5);
- _setMod2Bias(0x3c0); /* TODO use calibration */
- _setApcTv(0x956); /* TODO use calibration */
+ _setMod2Bias(0x60*4 + 0x600); /* TODO use calibration */
+ _setApcTv(0x956); /* TODO use calibration */
gpio_setPin(RX_STG_EN);
break;
case TX:
- /* TODO */
+ gpio_clearPin(RX_STG_EN);
+
+ gpio_setPin(RF_APC_SW);
+ gpio_clearPin(VCOVCC_SW);
+ pll_setFrequency(txFreq, 5);
+
+ _setMod2Bias(0x60*4 + 0x600); /* TODO use calibration */
+ _setApcTv(0x02);
+
+ gpio_setPin(TX_STG_EN);
break;
default:
diff --git a/tests/platform/MD380_FM_receiver.c b/tests/platform/MD380_FM_receiver.c
new file mode 100644
index 00000000..2c521656
--- /dev/null
+++ b/tests/platform/MD380_FM_receiver.c
@@ -0,0 +1,70 @@
+/***************************************************************************
+ * Copyright (C) 2020 by Federico Amedeo Izzo IU2NUO, *
+ * Niccolò Izzo IU2KIN *
+ * Frederik Saraci IU2NRO *
+ * Silvano Seva IU2KWO *
+ * *
+ * 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 3 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, see *
+ ***************************************************************************/
+
+#include
+#include
+#include
+#include
+#include "gpio.h"
+#include "delays.h"
+#include "rtx.h"
+#include "ADC1_MDxx380.h"
+#include "graphics.h"
+#include "platform.h"
+#include "hwconfig.h"
+
+int main(void)
+{
+ platform_init();
+
+ gpio_setMode(SPK_MUTE, OUTPUT);
+ gpio_setMode(AMP_EN, OUTPUT);
+ gpio_setMode(FM_MUTE, OUTPUT);
+
+ gpio_setPin(AMP_EN); /* Turn on audio amplifier */
+ gpio_setPin(FM_MUTE); /* Unmute path from AF_out to amplifier */
+ gpio_clearPin(SPK_MUTE); /* Unmute speaker */
+
+ rtx_init();
+ rtx_setRxFreq(430100000.0f);
+ rtx_setBandwidth(BW_25);
+ rtx_setOpmode(FM);
+ rtx_setFuncmode(RX);
+
+ gfx_init();
+ platform_setBacklightLevel(255);
+
+ color_t white = {255, 255, 255};
+ point_t origin = {0, SCREEN_HEIGHT / 9};
+ char buf[30] = {0};
+
+ while (1)
+ {
+ snprintf(sizeof(buf), buf, "RSSI level %f\n", rtx_getRssi());
+ gfx_clearScreen();
+ gfx_print(origin, buf, FONT_SIZE_3, TEXT_ALIGN_CENTER, white);
+ gfx_render();
+ while (gfx_renderingInProgress());
+ OS_ERR err;
+ OSTimeDlyHMSM(0u, 0u, 0u, 500u, OS_OPT_TIME_HMSM_STRICT, &err);
+ }
+
+ return 0;
+}
diff --git a/tests/platform/MD380_FM_transmitter.c b/tests/platform/MD380_FM_transmitter.c
new file mode 100644
index 00000000..2915bf49
--- /dev/null
+++ b/tests/platform/MD380_FM_transmitter.c
@@ -0,0 +1,76 @@
+/***************************************************************************
+ * Copyright (C) 2020 by Federico Amedeo Izzo IU2NUO, *
+ * Niccolò Izzo IU2KIN *
+ * Frederik Saraci IU2NRO *
+ * Silvano Seva IU2KWO *
+ * *
+ * 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 3 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, see *
+ ***************************************************************************/
+
+#include
+#include
+#include
+#include
+#include "gpio.h"
+#include "delays.h"
+#include "rtx.h"
+#include "ADC1_MDxx380.h"
+#include "graphics.h"
+#include "platform.h"
+#include "hwconfig.h"
+#include "HR-C5000_MD3x0.h"
+#include "toneGenerator_MDxx380.h"
+
+int main(void)
+{
+ platform_init();
+ toneGen_init();
+ toneGen_setToneFreq(77.0f);
+
+ gpio_setMode(SPK_MUTE, OUTPUT);
+ gpio_setMode(AMP_EN, OUTPUT);
+ gpio_setMode(FM_MUTE, OUTPUT);
+
+ gpio_setPin(AMP_EN); /* Turn on audio amplifier */
+ gpio_setPin(FM_MUTE); /* Unmute path from AF_out to amplifier */
+ gpio_clearPin(SPK_MUTE); /* Unmute speaker */
+
+ rtx_init();
+ rtx_setTxFreq(432950000.0f);
+ rtx_setBandwidth(BW_25);
+ rtx_setOpmode(FM);
+ rtx_setFuncmode(OFF);
+
+ gpio_setMode(GPIOE, 0, OUTPUT);
+ gpio_setMode(GPIOA, 14, OUTPUT);
+ gpio_setPin(GPIOA, 14);
+
+ while (1)
+ {
+ OS_ERR err;
+ gpio_setPin(GPIOE, 0);
+ rtx_setFuncmode(TX);
+ C5000_activateAnalogTx();
+// toneGen_toneOn();
+ OSTimeDlyHMSM(0u, 0u, 1u, 0u, OS_OPT_TIME_HMSM_STRICT, &err);
+// toneGen_toneOff();
+ C5000_shutdownAnalogTx();
+ rtx_setFuncmode(OFF);
+ gpio_clearPin(GPIOE, 0);
+
+ OSTimeDlyHMSM(0u, 0u, 3u, 0u, OS_OPT_TIME_HMSM_STRICT, &err);
+ }
+
+ return 0;
+}