mirror of
https://github.com/portapack-mayhem/mayhem-firmware.git
synced 2024-12-15 12:38:11 +00:00
95f7eda9c5
Several old bugs squashed. On the APRS side, most notably, SSID numbers where shifted left twice, instead of once, and bits 5,6 where not properly set. On AX.25 side, the bit stuffing part of the encoder was not placing the zero bit on the right place. Finally, I changed APRS icon from ORANGE to GREEN, since even this may be a simple app, now it's doing its work as intended.
135 lines
2.8 KiB
C++
135 lines
2.8 KiB
C++
/*
|
|
* 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::NRZI_add_bit(const uint32_t bit) {
|
|
if (!bit)
|
|
current_bit ^= 1; // Zero: flip
|
|
|
|
current_byte <<= 1;
|
|
current_byte |= current_bit;
|
|
|
|
bit_counter++;
|
|
|
|
if (bit_counter == 8) {
|
|
bit_counter = 0;
|
|
*bb_data_ptr = current_byte;
|
|
bb_data_ptr++;
|
|
}
|
|
}
|
|
|
|
void AX25Frame::add_byte(uint8_t byte, bool is_flag, bool is_data)
|
|
{
|
|
bool bit;
|
|
|
|
if (is_data)
|
|
crc_ccitt.process_byte(byte);
|
|
|
|
for (uint32_t i = 0; i < 8; i++)
|
|
{
|
|
bit = (byte >> i) & 1;
|
|
|
|
NRZI_add_bit(bit);
|
|
|
|
if (bit)
|
|
{
|
|
ones_counter++;
|
|
if ((ones_counter == 5) && (!is_flag))
|
|
{
|
|
NRZI_add_bit(0);
|
|
ones_counter = 0;
|
|
}
|
|
}
|
|
else
|
|
ones_counter = 0;
|
|
}
|
|
}
|
|
|
|
void AX25Frame::flush()
|
|
{
|
|
if (bit_counter)
|
|
*bb_data_ptr = current_byte << (8 - bit_counter); //euquiq: This was 7 but there are 8 bits
|
|
};
|
|
|
|
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, false, false);
|
|
add_byte(checksum >> 8, false, false);
|
|
}
|
|
|
|
void AX25Frame::make_ui_frame(char * const address, const uint8_t control,
|
|
const uint8_t protocol, const std::string& info) {
|
|
|
|
size_t i;
|
|
|
|
bb_data_ptr = (uint16_t*)shared_memory.bb_data.data;
|
|
memset(bb_data_ptr, 0, sizeof(shared_memory.bb_data.data));
|
|
bit_counter = 0;
|
|
current_bit = 0;
|
|
current_byte = 0;
|
|
ones_counter = 0;
|
|
crc_ccitt.reset();
|
|
|
|
add_flag();
|
|
add_flag();
|
|
add_flag();
|
|
add_flag();
|
|
|
|
make_extended_field(address, 14);
|
|
add_data(control);
|
|
add_data(protocol);
|
|
|
|
for (i = 0; i < info.size(); i++)
|
|
add_data(info[i]);
|
|
|
|
add_checksum();
|
|
|
|
add_flag();
|
|
add_flag();
|
|
|
|
flush();
|
|
}
|
|
|
|
} /* namespace ax25 */
|