kopia lustrzana https://github.com/mobilinkd/NucleoTNC
140 wiersze
3.4 KiB
C++
140 wiersze
3.4 KiB
C++
// Copyright 2015-2021 Mobilinkd LLC <rob@mobilinkd.com>
|
|
// All rights reserved.
|
|
|
|
#include "ModulatorTask.hpp"
|
|
#include "HDLCEncoder.hpp"
|
|
#include "Modulator.hpp"
|
|
#include "M17Modulator.h"
|
|
#include "M17Encoder.h"
|
|
#include "Fsk9600Modulator.hpp"
|
|
#include "AFSKModulator.hpp"
|
|
#include "KissHardware.hpp"
|
|
#include "main.h"
|
|
#include "Log.h"
|
|
|
|
mobilinkd::tnc::SimplexPTT simplexPtt;
|
|
mobilinkd::tnc::MultiplexPTT multiplexPtt;
|
|
|
|
mobilinkd::tnc::Modulator* modulator;
|
|
mobilinkd::Encoder* encoder;
|
|
|
|
// DMA Conversion half complete.
|
|
extern "C" void HAL_DAC_ConvHalfCpltCallbackCh1(DAC_HandleTypeDef*) {
|
|
osEvent evt = osMessageGet(dacOutputQueueHandle, 0);
|
|
if (evt.status == osEventMessage) {
|
|
modulator->fill_first(evt.value.v);
|
|
} else {
|
|
modulator->empty_first();
|
|
}
|
|
}
|
|
|
|
extern "C" void HAL_DAC_ConvCpltCallbackCh1(DAC_HandleTypeDef*) {
|
|
osEvent evt = osMessageGet(dacOutputQueueHandle, 0);
|
|
if (evt.status == osEventMessage) {
|
|
modulator->fill_last(evt.value.v);
|
|
} else {
|
|
modulator->empty_last();
|
|
}
|
|
}
|
|
|
|
extern "C" void HAL_DAC_DMAUnderrunCallbackCh1(DAC_HandleTypeDef*) {
|
|
modulator->abort();
|
|
}
|
|
|
|
mobilinkd::tnc::Modulator& getModulator()
|
|
{
|
|
using namespace mobilinkd::tnc;
|
|
|
|
static AFSKModulator afsk1200modulator(dacOutputQueueHandle, &simplexPtt);
|
|
static Fsk9600Modulator fsk9600modulator(dacOutputQueueHandle, &simplexPtt);
|
|
static M17Modulator m17modulator(dacOutputQueueHandle, &simplexPtt);
|
|
|
|
switch (kiss::settings().modem_type)
|
|
{
|
|
case kiss::Hardware::ModemType::FSK9600:
|
|
return fsk9600modulator;
|
|
case kiss::Hardware::ModemType::AFSK1200:
|
|
return afsk1200modulator;
|
|
case kiss::Hardware::ModemType::M17:
|
|
return m17modulator;
|
|
default:
|
|
CxxErrorHandler();
|
|
}
|
|
}
|
|
|
|
mobilinkd::Encoder& getEncoder()
|
|
{
|
|
using namespace mobilinkd::tnc;
|
|
|
|
static hdlc::Encoder hdlcEncoder(hdlcOutputQueueHandle);
|
|
static mobilinkd::M17Encoder m17Encoder(hdlcOutputQueueHandle);
|
|
|
|
switch (kiss::settings().modem_type)
|
|
{
|
|
case kiss::Hardware::ModemType::FSK9600:
|
|
return hdlcEncoder;
|
|
case kiss::Hardware::ModemType::AFSK1200:
|
|
return hdlcEncoder;
|
|
case kiss::Hardware::ModemType::M17:
|
|
return m17Encoder;
|
|
default:
|
|
ERROR("Invalid modem type %d", int(kiss::settings().modem_type));
|
|
CxxErrorHandler();
|
|
}
|
|
}
|
|
|
|
void setPtt(PTT ptt)
|
|
{
|
|
switch (ptt) {
|
|
case PTT::SIMPLEX:
|
|
getModulator().set_ptt(&simplexPtt);
|
|
break;
|
|
case PTT::MULTIPLEX:
|
|
getModulator().set_ptt(&multiplexPtt);
|
|
break;
|
|
}
|
|
}
|
|
|
|
void updatePtt()
|
|
{
|
|
using namespace mobilinkd::tnc::kiss;
|
|
|
|
if (settings().options & KISS_OPTION_PTT_SIMPLEX)
|
|
getModulator().set_ptt(&simplexPtt);
|
|
else
|
|
getModulator().set_ptt(&multiplexPtt);
|
|
}
|
|
|
|
void updateModulator()
|
|
{
|
|
using namespace mobilinkd::tnc::kiss;
|
|
|
|
modulator = &getModulator();
|
|
encoder = &getEncoder();
|
|
modulator->init(settings());
|
|
updatePtt();
|
|
encoder->updateModulator();
|
|
encoder->update_settings();
|
|
}
|
|
|
|
void startModulatorTask(void const*)
|
|
{
|
|
using namespace mobilinkd::tnc::kiss;
|
|
|
|
// Wait until hardware is initialized before creating modulator.
|
|
osMutexWait(hardwareInitMutexHandle, osWaitForever);
|
|
|
|
while (true)
|
|
{
|
|
modulator = &(getModulator());
|
|
encoder = &(getEncoder());
|
|
|
|
updatePtt();
|
|
|
|
getModulator().init(settings());
|
|
|
|
encoder->update_settings();
|
|
encoder->run();
|
|
}
|
|
}
|