kopia lustrzana https://github.com/mobilinkd/NucleoTNC
141 wiersze
3.1 KiB
C++
141 wiersze
3.1 KiB
C++
// Copyright 2016 Rob Riggs <rob@mobilinkd.com>
|
|
// All rights reserved.
|
|
|
|
#include "AFSKTestTone.hpp"
|
|
#include "ModulatorTask.hpp"
|
|
#include "Modulator.hpp"
|
|
#include "KissHardware.hpp"
|
|
|
|
#include "stm32l4xx_hal.h"
|
|
|
|
extern RNG_HandleTypeDef hrng;
|
|
|
|
void startAfskToneTask(void const* arg)
|
|
{
|
|
using mobilinkd::tnc::AFSKTestTone;
|
|
|
|
auto test = static_cast<const AFSKTestTone*>(arg);
|
|
|
|
while (true) {
|
|
switch (test->state()) {
|
|
case AFSKTestTone::State::NONE:
|
|
osThreadYield();
|
|
break;
|
|
case AFSKTestTone::State::MARK:
|
|
case AFSKTestTone::State::SPACE:
|
|
case AFSKTestTone::State::BOTH:
|
|
test->fill();
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
uint32_t testToneTaskBuffer[ 256 ];
|
|
osStaticThreadDef_t testToneTaskControlBlock;
|
|
static osThreadStaticDef(testToneTask, startAfskToneTask, osPriorityIdle, 0,
|
|
256, testToneTaskBuffer, &testToneTaskControlBlock);
|
|
|
|
namespace mobilinkd { namespace tnc {
|
|
|
|
AFSKTestTone::AFSKTestTone()
|
|
{
|
|
testToneTask_ = osThreadCreate(osThread(testToneTask), this);
|
|
osThreadSuspend(testToneTask_);
|
|
}
|
|
|
|
void AFSKTestTone::transmit(State prev)
|
|
{
|
|
if (prev == State::NONE) {
|
|
osThreadResume(testToneTask_);
|
|
}
|
|
}
|
|
|
|
void AFSKTestTone::mark()
|
|
{
|
|
auto prev = state_;
|
|
state_ = State::MARK;
|
|
transmit(prev);
|
|
}
|
|
|
|
void AFSKTestTone::space()
|
|
{
|
|
auto prev = state_;
|
|
state_ = State::SPACE;
|
|
transmit(prev);
|
|
}
|
|
|
|
void AFSKTestTone::both()
|
|
{
|
|
auto prev = state_;
|
|
state_ = State::BOTH;
|
|
transmit(prev);
|
|
}
|
|
|
|
void AFSKTestTone::stop()
|
|
{
|
|
if (state_ == State::NONE) return;
|
|
|
|
state_ = State::NONE;
|
|
getModulator().abort();
|
|
osThreadSuspend(testToneTask_);
|
|
}
|
|
|
|
void AFSKTestTone::fill() const
|
|
{
|
|
static State current = State::SPACE;
|
|
static uint32_t random = 0;
|
|
static uint8_t counter = 0;
|
|
|
|
switch (state_) {
|
|
case AFSKTestTone::State::NONE:
|
|
return;
|
|
case AFSKTestTone::State::MARK:
|
|
if (kiss::settings().modem_type == kiss::Hardware::ModemType::M17)
|
|
{
|
|
getModulator().send(0x77);
|
|
}
|
|
else
|
|
{
|
|
getModulator().send(true);
|
|
}
|
|
break;
|
|
case AFSKTestTone::State::SPACE:
|
|
if (kiss::settings().modem_type == kiss::Hardware::ModemType::M17)
|
|
{
|
|
getModulator().send(0x22);
|
|
}
|
|
else
|
|
{
|
|
getModulator().send(false);
|
|
}
|
|
break;
|
|
case AFSKTestTone::State::BOTH:
|
|
if (kiss::settings().modem_type == kiss::Hardware::ModemType::M17)
|
|
{
|
|
if ((counter & 3) == 0)
|
|
{
|
|
auto status = HAL_RNG_GenerateRandomNumber(&hrng, &random);
|
|
if (status != HAL_OK)
|
|
{
|
|
WARN("RNG failure code %d", status);
|
|
}
|
|
}
|
|
getModulator().send(random & 0xFF);
|
|
random >>= 8;
|
|
counter += 1;
|
|
}
|
|
else
|
|
{
|
|
getModulator().send(current == State::SPACE);
|
|
current = (current == State::MARK ? State::SPACE : State::MARK);
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
}} // mobilinkd::tnc
|