mirror of https://github.com/hmatuschek/libsdr
Implemented trivial APRS decoder.
Hannes Matuschek
11 years ago
parent
acee3dc318
commit
36ac8d3cc1
@ -1,41 +0,0 @@
|
||||
#include "wavfile.hh"
|
||||
#include "autocast.hh"
|
||||
#include "interpolate.hh"
|
||||
#include "fsk.hh"
|
||||
#include "ax25.hh"
|
||||
#include "utils.hh"
|
||||
|
||||
|
||||
using namespace sdr;
|
||||
|
||||
|
||||
|
||||
int main(int argc, char *argv[]) {
|
||||
if (2 > argc) { std::cout << "USAGE: sdr_afsk1200 FILENAME" << std::endl; return -1; }
|
||||
|
||||
sdr::Logger::get().addHandler(
|
||||
new sdr::StreamLogHandler(std::cerr, sdr::LOG_DEBUG));
|
||||
|
||||
Queue &queue = Queue::get();
|
||||
|
||||
WavSource src(argv[1], 1024);
|
||||
if (! src.isOpen()) { std::cout << "Can not open file " << argv[1] << std::endl; return -1; }
|
||||
|
||||
AutoCast< int16_t > cast;
|
||||
FSKDetector demod(1200, 1200, 2200);
|
||||
BitStream bits(1200, BitStream::TRANSITION);
|
||||
AX25 decode;
|
||||
|
||||
src.connect(&cast);
|
||||
cast.connect(&demod);
|
||||
demod.connect(&bits);
|
||||
bits.connect(&decode);
|
||||
|
||||
Queue::get().addIdle(&src, &WavSource::next);
|
||||
src.addEOS(&queue, &Queue::stop);
|
||||
|
||||
Queue::get().start();
|
||||
Queue::get().wait();
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -0,0 +1,339 @@
|
||||
#include "aprs.hh"
|
||||
#include "logger.hh"
|
||||
|
||||
using namespace sdr;
|
||||
|
||||
|
||||
|
||||
/* ******************************************************************************************** *
|
||||
* Implementation of APRS
|
||||
* ******************************************************************************************** */
|
||||
APRS::APRS()
|
||||
: AX25()
|
||||
{
|
||||
// pass...
|
||||
}
|
||||
|
||||
void
|
||||
APRS::handleAX25Message(const AX25::Message &message) {
|
||||
// Skip non-UI frames
|
||||
if (0x03 != uint8_t(message.payload()[0])) {
|
||||
LogMessage msg(LOG_DEBUG);
|
||||
msg << "APRS: Skip non-UI frame (type="
|
||||
<< std::hex << int(uint8_t(message.payload()[0]))
|
||||
<< std::dec << "): " << message;
|
||||
Logger::get().log(msg);
|
||||
return;
|
||||
}
|
||||
// Skip frames woth level-3 protocol
|
||||
if (0xf0 != uint8_t(message.payload()[1])) {
|
||||
LogMessage msg(LOG_DEBUG);
|
||||
msg << "APRS: Skip invalid UI (pid="
|
||||
<< std::hex << int(uint8_t(message.payload()[1]))
|
||||
<< std::dec << "): " << message;
|
||||
Logger::get().log(msg);
|
||||
return;
|
||||
}
|
||||
// Construct APRS message
|
||||
Message msg(message);
|
||||
// Handle message
|
||||
this->handleAPRSMessage(msg);
|
||||
}
|
||||
|
||||
void
|
||||
APRS::handleAPRSMessage(const Message &message) {
|
||||
std::cerr << message << std::endl;
|
||||
}
|
||||
|
||||
|
||||
/* ******************************************************************************************** *
|
||||
* Implementation of APRS::Message
|
||||
* ******************************************************************************************** */
|
||||
bool __is_number(char c) {
|
||||
return (('0'<=c) && ('9'>=c));
|
||||
}
|
||||
|
||||
APRS::Message::Symbol
|
||||
__toSymbol(char table, char sym) {
|
||||
if ('/' == table) {
|
||||
switch (sym) {
|
||||
case 'P':
|
||||
case '!': return APRS::Message::POLICE;
|
||||
case '%':
|
||||
case '&':
|
||||
case '(':
|
||||
case 'B':
|
||||
case 'n':
|
||||
case '#': return APRS::Message::DIGI;
|
||||
case '[':
|
||||
case 'e':
|
||||
case '$': return APRS::Message::JOGGER;
|
||||
case 'X':
|
||||
case '^':
|
||||
case 'g':
|
||||
case '\'': return APRS::Message::AIRCRAFT;
|
||||
case '-': return APRS::Message::HOUSE;
|
||||
case 'b':
|
||||
case '<': return APRS::Message::MOTORCYCLE;
|
||||
case '=':
|
||||
case '*':
|
||||
case 'U':
|
||||
case 'j':
|
||||
case 'k':
|
||||
case 'u':
|
||||
case 'v':
|
||||
case '>': return APRS::Message::CAR;
|
||||
case 'Y':
|
||||
case 's':
|
||||
case 'C': return APRS::Message::BOAT;
|
||||
case 'O': return APRS::Message::BALLOON;
|
||||
case '_': return APRS::Message::WX;
|
||||
default: break;
|
||||
}
|
||||
} else if ('\\' == table) {
|
||||
switch (sym) {
|
||||
default: break;
|
||||
}
|
||||
}
|
||||
return APRS::Message::NONE;
|
||||
}
|
||||
|
||||
|
||||
APRS::Message::Message()
|
||||
: AX25::Message(), _hasLocation(false), _latitude(0), _longitude(0), _symbol(NONE),
|
||||
_hasTime(false), _time(::time(0))
|
||||
{
|
||||
// pass...
|
||||
}
|
||||
|
||||
APRS::Message::Message(const AX25::Message &msg)
|
||||
: AX25::Message(msg),
|
||||
_hasLocation(false), _latitude(0), _longitude(0), _symbol(NONE),
|
||||
_hasTime(false), _time(::time(0))
|
||||
{
|
||||
size_t offset = 2;
|
||||
// Dispatch by message type
|
||||
switch (_payload[offset]) {
|
||||
case '=':
|
||||
case '!':
|
||||
_hasLocation = true;
|
||||
offset++;
|
||||
break;
|
||||
case '/':
|
||||
case '@':
|
||||
_hasTime = true;
|
||||
_hasLocation = true;
|
||||
offset++;
|
||||
break;
|
||||
case ';':
|
||||
_hasTime = true;
|
||||
_hasLocation = true;
|
||||
// Skip ';', 9 char of object identifier and delimiter ('*' or '_').
|
||||
offset += 11;
|
||||
break;
|
||||
default:
|
||||
// On unknown message type -> store complete message as comment
|
||||
if (offset < _payload.size()) {
|
||||
_comment = _payload.substr(offset);
|
||||
offset += _comment.size();
|
||||
}
|
||||
return;
|
||||
}
|
||||
|
||||
if (_hasTime) {
|
||||
if (! _readTime(offset)) { return; }
|
||||
}
|
||||
if (_hasLocation) {
|
||||
if (! _readLocation(offset)) { return; }
|
||||
}
|
||||
// Remaining text is comment
|
||||
if (offset < _payload.size()) {
|
||||
_comment = _payload.substr(offset);
|
||||
offset += _comment.size();
|
||||
}
|
||||
}
|
||||
|
||||
bool
|
||||
APRS::Message::_readLocation(size_t &offset) {
|
||||
// Read latitude
|
||||
if(! _readLatitude(offset)) { return false; }
|
||||
|
||||
// Read symbol table
|
||||
char symbolTable = _payload[offset]; offset++;
|
||||
|
||||
// Read longitude
|
||||
if (! _readLongitude(offset)) { return false; }
|
||||
|
||||
// Read symbol
|
||||
_symbol = __toSymbol(symbolTable, _payload[offset]); offset++;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
bool
|
||||
APRS::Message::_readLatitude(size_t &offset)
|
||||
{
|
||||
// read degree
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
_latitude = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
_latitude = _latitude*10 + int(_payload[offset]-0x30); offset++;
|
||||
|
||||
// read mintues
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
double min = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
min = min*10 + int(_payload[offset]-0x30); offset++;
|
||||
|
||||
// check for '.'
|
||||
if ('.' != _payload[offset]) { return false; } offset++;
|
||||
|
||||
// read minutes decimal
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
double mindec = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
mindec = mindec*10 + int(_payload[offset]-0x30); offset++;
|
||||
min += mindec/100;
|
||||
|
||||
// Update degree
|
||||
_latitude += min/60;
|
||||
|
||||
// Process north/south indicator
|
||||
switch (_payload[offset]) {
|
||||
case 'N': offset++; break;
|
||||
case 'S': _latitude = -_latitude; offset++; break;
|
||||
default: return false; // <- on invalid indicator.
|
||||
}
|
||||
|
||||
// done.
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
bool
|
||||
APRS::Message::_readLongitude(size_t &offset) {
|
||||
// read degree
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
_longitude = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
_longitude = _longitude*10 + int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
_longitude = _longitude*10 + int(_payload[offset]-0x30); offset++;
|
||||
|
||||
// read minutes
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
double min = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
min = min*10 + int(_payload[offset]-0x30); offset++;
|
||||
|
||||
// skip '.'
|
||||
if ('.' != _payload[offset]) { return false; } offset++;
|
||||
|
||||
// Read minutes decimals
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
double mindec = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
mindec = mindec*10 + int(_payload[offset]-0x30); offset++;
|
||||
min += mindec/100;
|
||||
|
||||
// Update longitude
|
||||
_longitude += min/60;
|
||||
|
||||
// read east/west indicator
|
||||
switch (_payload[offset]) {
|
||||
case 'E': offset++; break;
|
||||
case 'W': offset++; _longitude = -_longitude; break;
|
||||
default: return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
bool
|
||||
APRS::Message::_readTime(size_t &offset) {
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
int a = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
a = a*10 + int(_payload[offset]-0x30); offset++;
|
||||
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
int b = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
b = b*10 + int(_payload[offset]-0x30); offset++;
|
||||
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
int c = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
c = c*10 + int(_payload[offset]-0x30); offset++;
|
||||
|
||||
// Determine type of date-time
|
||||
if ('z' == _payload[offset]) {
|
||||
// Alter current time in terms of UTC
|
||||
struct tm timeStruct = *gmtime(&_time);
|
||||
timeStruct.tm_mday = a;
|
||||
timeStruct.tm_hour = b;
|
||||
timeStruct.tm_min = c;
|
||||
// Update time-stamp
|
||||
_time = mktime(&timeStruct);
|
||||
offset++;
|
||||
} else if ('/' == _payload[offset]) {
|
||||
// Alter current time in terms of local time
|
||||
struct tm timeStruct = *localtime(&_time);
|
||||
timeStruct.tm_mday = a;
|
||||
timeStruct.tm_hour = b;
|
||||
timeStruct.tm_min = c;
|
||||
// Update time-stamp
|
||||
_time = mktime(&timeStruct);
|
||||
offset++;
|
||||
} else if ('h' == _payload[offset]) {
|
||||
// Alter current time in terms of local time
|
||||
struct tm timeStruct = *localtime(&_time);
|
||||
timeStruct.tm_hour = a;
|
||||
timeStruct.tm_min = b;
|
||||
timeStruct.tm_sec = c;
|
||||
// Update time-stamp
|
||||
_time = mktime(&timeStruct);
|
||||
offset++;
|
||||
} else if (('0' <= _payload[offset]) && (('9' >= _payload[offset]))) {
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
int d = int(_payload[offset]-0x30); offset++;
|
||||
if (! __is_number(_payload[offset])) { return false; }
|
||||
d = d*10 + int(_payload[offset]-0x30); offset++;
|
||||
// Alter current time in terms of local time
|
||||
struct tm timeStruct = *localtime(&_time);
|
||||
timeStruct.tm_mon = a;
|
||||
timeStruct.tm_mday = b;
|
||||
timeStruct.tm_hour = c;
|
||||
timeStruct.tm_min = d;
|
||||
// Update time-stamp
|
||||
_time = mktime(&timeStruct);
|
||||
} else {
|
||||
return false;
|
||||
}
|
||||
|
||||
// done...
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
std::ostream &
|
||||
sdr::operator <<(std::ostream &stream, const APRS::Message &message) {
|
||||
std::cerr << "APRS: " << message.from() << " > " << message.to();
|
||||
if (message.via().size()) {
|
||||
std::cerr << " via " << message.via()[0];
|
||||
for (size_t i=1; i<message.via().size(); i++) {
|
||||
std::cerr << ", " << message.via()[i];
|
||||
}
|
||||
}
|
||||
std::cerr << std::endl << " time: " << asctime(localtime(&message.time()));
|
||||
if (message.hasLocation()) {
|
||||
std::cerr << " location: " << message.latitude() << ", " << message.longitude()
|
||||
<< std::endl << " symbol: " << message.symbol() << std::endl;
|
||||
}
|
||||
if (message.hasComment()) {
|
||||
std::cerr << " comment: " << message.comment() << std::endl;
|
||||
}
|
||||
return stream;
|
||||
}
|
||||
@ -0,0 +1,66 @@
|
||||
#ifndef __SDR_APRS_HH__
|
||||
#define __SDR_APRS_HH__
|
||||
|
||||
#include "ax25.hh"
|
||||
#include <ctime>
|
||||
|
||||
|
||||
namespace sdr {
|
||||
|
||||
class APRS: public AX25
|
||||
{
|
||||
public:
|
||||
class Message: public AX25::Message
|
||||
{
|
||||
public:
|
||||
/** A small selection of possible symbols to display the station. */
|
||||
typedef enum {
|
||||
NONE, POLICE, DIGI, PHONE, AIRCRAFT, HOUSE, MOTORCYCLE, CAR, BBS, BALLOON, BUS,
|
||||
BOAT, JOGGER, WX
|
||||
} Symbol;
|
||||
|
||||
public:
|
||||
Message();
|
||||
Message(const AX25::Message &msg);
|
||||
Message(const Message &msg);
|
||||
|
||||
Message &operator=(const Message &other);
|
||||
|
||||
inline bool hasLocation() const { return _hasLocation; }
|
||||
inline double latitude() const { return _latitude; }
|
||||
inline double longitude() const { return _longitude; }
|
||||
inline Symbol symbol() const { return _symbol; }
|
||||
|
||||
inline const time_t &time() const { return _time; }
|
||||
|
||||
inline bool hasComment() const { return (0 != _comment.size()); }
|
||||
inline const std::string &comment() const { return _comment; }
|
||||
|
||||
protected:
|
||||
bool _readLocation(size_t &offset);
|
||||
bool _readLatitude(size_t &offset);
|
||||
bool _readLongitude(size_t &offset);
|
||||
bool _readTime(size_t &offset);
|
||||
|
||||
protected:
|
||||
bool _hasLocation;
|
||||
double _latitude;
|
||||
double _longitude;
|
||||
Symbol _symbol;
|
||||
bool _hasTime;
|
||||
time_t _time;
|
||||
std::string _comment;
|
||||
};
|
||||
|
||||
public:
|
||||
APRS();
|
||||
|
||||
void handleAX25Message(const AX25::Message &message);
|
||||
virtual void handleAPRSMessage(const Message &message);
|
||||
};
|
||||
|
||||
std::ostream& operator<<(std::ostream &stream, const APRS::Message &msg);
|
||||
|
||||
}
|
||||
|
||||
#endif // __SDR_APRS_HH__
|
||||
Loading…
Reference in New Issue