mirror of
https://github.com/peterantypas/maiana.git
synced 2025-05-15 23:10:11 -07:00
125 lines
2.4 KiB
C++
125 lines
2.4 KiB
C++
/*
|
|
Copyright (c) 2016-2020 Peter Antypas
|
|
|
|
This file is part of the MAIANA™ transponder firmware.
|
|
|
|
The firmware 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 <https://www.gnu.org/licenses/>
|
|
*/
|
|
|
|
|
|
#include "DataTerminal.hpp"
|
|
#include "Events.hpp"
|
|
#include "Utils.hpp"
|
|
#include "bsp.hpp"
|
|
|
|
static char __rxbuff[80];
|
|
static uint8_t __rxpos = 0;
|
|
|
|
void termInputCB(char c);
|
|
|
|
DataTerminal &DataTerminal::instance()
|
|
{
|
|
static DataTerminal __instance;
|
|
return __instance;
|
|
}
|
|
|
|
void DataTerminal::init()
|
|
{
|
|
bsp_set_terminal_input_callback(termInputCB);
|
|
}
|
|
|
|
DataTerminal::DataTerminal()
|
|
: mCmdBuffPos(0)
|
|
{
|
|
mCmdTokens.reserve(5);
|
|
EventQueue::instance().addObserver(this, DEBUG_EVENT|PROPR_NMEA_SENTENCE);
|
|
}
|
|
|
|
void DataTerminal::processEvent(const Event &e)
|
|
{
|
|
switch (e.type) {
|
|
case DEBUG_EVENT:
|
|
#ifdef MULTIPLEXED_OUTPUT
|
|
write("DEBUG", e.debugMessage.buffer);
|
|
#endif
|
|
break;
|
|
case PROPR_NMEA_SENTENCE:
|
|
#ifdef MULTIPLEXED_OUTPUT
|
|
write("NMEA", e.nmeaBuffer.sentence);
|
|
#else
|
|
write(e.nmeaBuffer.sentence);
|
|
#endif
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
#ifdef MULTIPLEXED_OUTPUT
|
|
|
|
void DataTerminal::write(const char *cls, const char* s)
|
|
{
|
|
bsp_write_char('[');
|
|
bsp_write_string(cls);
|
|
bsp_write_char(']');
|
|
bsp_write_string(s);
|
|
}
|
|
|
|
#else
|
|
|
|
void DataTerminal::write(const char* s)
|
|
{
|
|
bsp_write_string(s);
|
|
}
|
|
#endif
|
|
|
|
|
|
|
|
void DataTerminal::_write(const char *s)
|
|
{
|
|
#ifdef MULTIPLEXED_OUTPUT
|
|
write("", s);
|
|
#else
|
|
write(s);
|
|
#endif
|
|
}
|
|
|
|
|
|
void termInputCB(char c)
|
|
{
|
|
if ( c == '\r' )
|
|
{
|
|
return;
|
|
}
|
|
|
|
__rxbuff[__rxpos++] = c;
|
|
if ( __rxpos >= sizeof __rxbuff )
|
|
{
|
|
__rxpos = 0;
|
|
}
|
|
else if ( c == '\n' )
|
|
{
|
|
__rxbuff[__rxpos++] = 0;
|
|
Event *e = EventPool::instance().newEvent(COMMAND_EVENT);
|
|
strlcpy(e->command.buffer, __rxbuff, sizeof e->command.buffer);
|
|
EventQueue::instance().push(e);
|
|
__rxpos = 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
|