mirror of
https://github.com/eried/portapack-mayhem.git
synced 2025-05-10 10:45:17 -04:00
Started work on APRS (AX25)
This commit is contained in:
furrtek
parent
a35d9ee8a9
commit
8e99bccd41
21 changed files with 515 additions and 6220 deletions
44
firmware/application/protocols/aprs.cpp
Normal file
44
firmware/application/protocols/aprs.cpp
Normal file
|
|
@ -0,0 +1,44 @@
|
|||
/*
|
||||
* Copyright (C) 2014 Jared Boone, ShareBrained Technology, Inc.
|
||||
* Copyright (C) 2017 Furrtek
|
||||
*
|
||||
* This file is part of PortaPack.
|
||||
*
|
||||
* 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 2, 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; see the file COPYING. If not, write to
|
||||
* the Free Software Foundation, Inc., 51 Franklin Street,
|
||||
* Boston, MA 02110-1301, USA.
|
||||
*/
|
||||
|
||||
#include "aprs.hpp"
|
||||
#include "ax25.hpp"
|
||||
|
||||
#include "portapack_persistent_memory.hpp"
|
||||
|
||||
using namespace ax25;
|
||||
|
||||
namespace aprs {
|
||||
|
||||
void make_aprs_frame(char * address_dest, char * address_src) {
|
||||
AX25Frame frame;
|
||||
|
||||
char address[14] = { 0 };
|
||||
uint8_t info[7] = { 0 }; //{ 'F','U','R','R','T','E','K' };
|
||||
|
||||
memcpy(&address[0], address_dest, 6);
|
||||
memcpy(&address[7], address_src, 6);
|
||||
|
||||
frame.make_ui_frame(address, 0x03, 0xF0, info, sizeof(info));
|
||||
}
|
||||
|
||||
} /* namespace aprs */
|
||||
35
firmware/application/protocols/aprs.hpp
Normal file
35
firmware/application/protocols/aprs.hpp
Normal file
|
|
@ -0,0 +1,35 @@
|
|||
/*
|
||||
* Copyright (C) 2014 Jared Boone, ShareBrained Technology, Inc.
|
||||
* Copyright (C) 2017 Furrtek
|
||||
*
|
||||
* This file is part of PortaPack.
|
||||
*
|
||||
* 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 2, 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; see the file COPYING. If not, write to
|
||||
* the Free Software Foundation, Inc., 51 Franklin Street,
|
||||
* Boston, MA 02110-1301, USA.
|
||||
*/
|
||||
|
||||
#include <cstring>
|
||||
#include <string>
|
||||
|
||||
#ifndef __APRS_H__
|
||||
#define __APRS_H__
|
||||
|
||||
namespace aprs {
|
||||
|
||||
void make_aprs_frame();
|
||||
|
||||
} /* namespace aprs */
|
||||
|
||||
#endif/*__APRS_H__*/
|
||||
120
firmware/application/protocols/ax25.cpp
Normal file
120
firmware/application/protocols/ax25.cpp
Normal file
|
|
@ -0,0 +1,120 @@
|
|||
/*
|
||||
* Copyright (C) 2014 Jared Boone, ShareBrained Technology, Inc.
|
||||
* Copyright (C) 2017 Furrtek
|
||||
*
|
||||
* This file is part of PortaPack.
|
||||
*
|
||||
* 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 2, 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; see the file COPYING. If not, write to
|
||||
* the Free Software Foundation, Inc., 51 Franklin Street,
|
||||
* Boston, MA 02110-1301, USA.
|
||||
*/
|
||||
|
||||
#include "ax25.hpp"
|
||||
|
||||
#include "portapack_shared_memory.hpp"
|
||||
|
||||
namespace ax25 {
|
||||
|
||||
void AX25Frame::make_extended_field(char * const data, size_t length) {
|
||||
size_t i = 0;
|
||||
|
||||
for (i = 0; i < length - 1; i++)
|
||||
add_data(data[i] << 1);
|
||||
|
||||
add_data((data[i] << 1) | 1);
|
||||
}
|
||||
|
||||
void AX25Frame::add_byte(uint8_t byte, bool is_flag, bool is_data) {
|
||||
size_t i;
|
||||
|
||||
for (i = 0; i < 8; ) {
|
||||
|
||||
if (!(byte & 1)) {
|
||||
current_bit ^= 1; // Zero: flip
|
||||
ones_counter = 0;
|
||||
byte >>= 1;
|
||||
i++;
|
||||
} else {
|
||||
ones_counter++;
|
||||
if ((ones_counter == 5) && (!is_flag)) {
|
||||
current_bit ^= 1; // Stuff zero: flip
|
||||
ones_counter = 0;
|
||||
} else {
|
||||
byte >>= 1;
|
||||
i++;
|
||||
}
|
||||
}
|
||||
|
||||
if (is_data)
|
||||
crc_ccitt.process_bit(current_bit);
|
||||
current_byte <<= 1;
|
||||
current_byte |= current_bit;
|
||||
|
||||
if (bit_counter == 7) {
|
||||
bit_counter = 0;
|
||||
*bb_data_ptr = current_byte;
|
||||
bb_data_ptr++;
|
||||
} else {
|
||||
bit_counter++;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void AX25Frame::flush() {
|
||||
if (bit_counter)
|
||||
*bb_data_ptr = current_byte << (7 - bit_counter);
|
||||
};
|
||||
|
||||
void AX25Frame::add_flag() {
|
||||
add_byte(AX25_FLAG, true, false);
|
||||
};
|
||||
|
||||
void AX25Frame::add_data(uint8_t byte) {
|
||||
add_byte(byte, false, true);
|
||||
};
|
||||
|
||||
void AX25Frame::add_checksum() {
|
||||
auto checksum = crc_ccitt.checksum();
|
||||
add_byte(checksum >> 8, false, false);
|
||||
add_byte(checksum, false, false);
|
||||
}
|
||||
|
||||
void AX25Frame::make_ui_frame(char * const address, const uint8_t control,
|
||||
const uint8_t protocol, uint8_t * const info, size_t length) {
|
||||
|
||||
size_t i;
|
||||
|
||||
bb_data_ptr = shared_memory.bb_data.data;
|
||||
bit_counter = 0;
|
||||
current_bit = 0;
|
||||
current_byte = 0;
|
||||
ones_counter = 0;
|
||||
crc_ccitt.reset();
|
||||
|
||||
add_flag();
|
||||
|
||||
make_extended_field(address, 14);
|
||||
add_data(control);
|
||||
add_data(protocol);
|
||||
|
||||
for (i = 0; i < length; i++)
|
||||
add_data(info[i]);
|
||||
|
||||
add_checksum();
|
||||
add_flag();
|
||||
|
||||
flush();
|
||||
}
|
||||
|
||||
} /* namespace ax25 */
|
||||
68
firmware/application/protocols/ax25.hpp
Normal file
68
firmware/application/protocols/ax25.hpp
Normal file
|
|
@ -0,0 +1,68 @@
|
|||
/*
|
||||
* Copyright (C) 2014 Jared Boone, ShareBrained Technology, Inc.
|
||||
* Copyright (C) 2017 Furrtek
|
||||
*
|
||||
* This file is part of PortaPack.
|
||||
*
|
||||
* 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 2, 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; see the file COPYING. If not, write to
|
||||
* the Free Software Foundation, Inc., 51 Franklin Street,
|
||||
* Boston, MA 02110-1301, USA.
|
||||
*/
|
||||
|
||||
#include "crc.hpp"
|
||||
|
||||
#include <cstring>
|
||||
#include <string>
|
||||
|
||||
#ifndef __AX25_H__
|
||||
#define __AX25_H__
|
||||
|
||||
#define AX25_FLAG 0x7E
|
||||
|
||||
namespace ax25 {
|
||||
|
||||
enum protocol_id_t {
|
||||
X25_PLP = 0x01,
|
||||
COMP_TCPIP = 0x06,
|
||||
UNCOMP_TCPIP = 0x07,
|
||||
SEG_FRAG = 0x08,
|
||||
FLEXNET = 0xCE,
|
||||
NO_LAYER3 = 0xF0
|
||||
};
|
||||
|
||||
class AX25Frame {
|
||||
public:
|
||||
void make_ui_frame(char * const address, const uint8_t control, const uint8_t protocol,
|
||||
uint8_t * const info, size_t length);
|
||||
|
||||
private:
|
||||
void make_extended_field(char * const data, size_t length);
|
||||
void add_byte(uint8_t byte, bool is_flag, bool is_data);
|
||||
void add_data(uint8_t byte);
|
||||
void add_checksum();
|
||||
void add_flag();
|
||||
void flush();
|
||||
|
||||
uint8_t * bb_data_ptr { nullptr };
|
||||
uint8_t current_bit { 0 };
|
||||
uint8_t current_byte { 0 };
|
||||
size_t bit_counter { 0 };
|
||||
uint8_t ones_counter { 0 };
|
||||
|
||||
CRC<16> crc_ccitt { 0x1021, 0xFFFF };
|
||||
};
|
||||
|
||||
} /* namespace ax25 */
|
||||
|
||||
#endif/*__AX25_H__*/
|
||||
Loading…
Add table
Add a link
Reference in a new issue