mirror of
https://github.com/eried/portapack-mayhem.git
synced 2025-07-29 01:29:03 -04:00
Added velocity/bearing ADS-B frame for tx
Added compass widget Manchester encoder
This commit is contained in:
furrtek
parent
c2a9ed7d9b
commit
0cbf9cd386
9 changed files with 290 additions and 121 deletions
|
|
@ -21,28 +21,29 @@
|
|||
*/
|
||||
|
||||
#include "adsb.hpp"
|
||||
#include "sine_table.hpp"
|
||||
|
||||
#include <math.h>
|
||||
|
||||
namespace adsb {
|
||||
|
||||
void make_frame_mode_s(ADSBFrame& frame, const uint32_t ICAO_address) {
|
||||
void make_frame_adsb(ADSBFrame& frame, const uint32_t ICAO_address) {
|
||||
frame.clear();
|
||||
frame.push_byte((17 << 3) | 5); // DF17 and CA
|
||||
frame.push_byte((DF_ADSB << 3) | 5); // DF and CA
|
||||
frame.push_byte(ICAO_address >> 16);
|
||||
frame.push_byte(ICAO_address >> 8);
|
||||
frame.push_byte(ICAO_address & 0xFF);
|
||||
}
|
||||
|
||||
void generate_frame_id(ADSBFrame& frame, const uint32_t ICAO_address, const std::string& callsign) {
|
||||
void encode_frame_id(ADSBFrame& frame, const uint32_t ICAO_address, const std::string& callsign) {
|
||||
std::string callsign_formatted(8, '_');
|
||||
uint64_t callsign_coded = 0;
|
||||
uint32_t c, s;
|
||||
char ch;
|
||||
|
||||
make_frame_mode_s(frame, ICAO_address);
|
||||
make_frame_adsb(frame, ICAO_address);
|
||||
|
||||
frame.push_byte(4 << 3); // TC = 4: Aircraft ID
|
||||
frame.push_byte(TC_IDENT << 3); // No aircraft category
|
||||
|
||||
// Translate and encode callsign
|
||||
for (c = 0; c < 8; c++) {
|
||||
|
|
@ -78,15 +79,39 @@ void generate_frame_id(ADSBFrame& frame, const uint32_t ICAO_address, const std:
|
|||
frame.make_CRC();
|
||||
}*/
|
||||
|
||||
void generate_frame_identity(ADSBFrame& frame, const uint32_t ICAO_address, const uint32_t code) {
|
||||
void encode_frame_squawk(ADSBFrame& frame, const uint32_t squawk) {
|
||||
uint32_t squawk_coded;
|
||||
|
||||
frame.clear();
|
||||
|
||||
frame.push_byte(21 << 3); // DF = 21
|
||||
frame.push_byte(DF_EHS_SQUAWK << 3); // DF
|
||||
frame.push_byte(0);
|
||||
|
||||
// 1337:
|
||||
frame.push_byte(0b00011100);
|
||||
frame.push_byte(0b00111101);
|
||||
// 12 11 10 9 8 7 6 5 4 3 2 1 0
|
||||
// 31 30 29 28 27 26 25 24 23 22 21 20 19
|
||||
// D4 B4 D2 B2 D1 B1 __ A4 C4 A2 C2 A1 C1
|
||||
// ABCD = code (octal, 0000~7777)
|
||||
|
||||
// FEDCBA9876543210
|
||||
// xAAAxBBBxCCCxDDD
|
||||
// x421x421x421x421
|
||||
|
||||
squawk_coded = ((squawk << 10) & 0x1000) | // D4
|
||||
((squawk << 1) & 0x0800) | // B4
|
||||
((squawk << 9) & 0x0400) | // D2
|
||||
((squawk << 0) & 0x0200) | // B2
|
||||
((squawk << 8) & 0x0100) | // D1
|
||||
((squawk >> 1) & 0x0080) | // B1
|
||||
|
||||
((squawk >> 9) & 0x0020) | // A4
|
||||
((squawk >> 2) & 0x0010) | // C4
|
||||
((squawk >> 10) & 0x0008) | // A2
|
||||
((squawk >> 3) & 0x0004) | // C2
|
||||
((squawk >> 11) & 0x0002) | // A1
|
||||
((squawk >> 4) & 0x0001); // C1
|
||||
|
||||
frame.push_byte(squawk_coded >> 5);
|
||||
frame.push_byte(squawk_coded << 3);
|
||||
|
||||
frame.make_CRC();
|
||||
}
|
||||
|
|
@ -116,41 +141,44 @@ int cpr_N(float lat, int is_odd) {
|
|||
return nl;
|
||||
}
|
||||
|
||||
void generate_frame_pos(ADSBFrame& frame, const uint32_t ICAO_address, const uint32_t altitude,
|
||||
// Decoding method (from dump1090):
|
||||
// index int j = floor(((59 * latcprE - 60 * latcprO) / 131072) + 0.50)
|
||||
// latE = DlatE * (cpr_mod(j, 60) + (latcprE / 131072))
|
||||
// latO = DlatO * (cpr_mod(j, 59) + (latcprO / 131072))
|
||||
// if latE >= 270 -> latE -= 360
|
||||
// if latO >= 270 -> latO -= 360
|
||||
// if (cpr_NL(latE) != cpr_NL(latO)) return;
|
||||
|
||||
// int ni = cpr_N(latE ,0);
|
||||
// int m = floor((((loncprE * (cpr_NL(latE) - 1)) - (loncprO * cpr_NL(latE))) / 131072) + 0.5)
|
||||
// lon = cpr_Dlon(latE, 0) * (cpr_mod(m, ni) + loncprE / 131072);
|
||||
// lat = latE;
|
||||
// ... or ...
|
||||
// int ni = cpr_N(latO ,0);
|
||||
// int m = floor((((loncprE * (cpr_NL(latO) - 1)) - (loncprO * cpr_NL(latO))) / 131072) + 0.5)
|
||||
// lon = cpr_Dlon(latO, 0) * (cpr_mod(m, ni) + loncprO / 131072);
|
||||
// lat = latO;
|
||||
// ... and ...
|
||||
// if (lon > 180) lon -= 360;
|
||||
|
||||
void encode_frame_pos(ADSBFrame& frame, const uint32_t ICAO_address, const uint32_t altitude,
|
||||
const float latitude, const float longitude, const uint32_t time_parity) {
|
||||
|
||||
uint32_t altitude_coded;
|
||||
uint32_t lat, lon;
|
||||
float delta_lat, yz, rlat, delta_lon, xz;
|
||||
|
||||
make_frame_mode_s(frame, ICAO_address);
|
||||
make_frame_adsb(frame, ICAO_address);
|
||||
|
||||
frame.push_byte(11 << 3); // TC = 11 (Airborne position)
|
||||
frame.push_byte(TC_AIRBORNE_POS << 3); // Bits 2~1: Surveillance Status, bit 0: NICsb
|
||||
|
||||
altitude_coded = (altitude + 1000) / 25; // 25ft precision, insert Q-bit (1)
|
||||
altitude_coded = ((altitude_coded & 0x7F0) << 1) | 0x10 | (altitude_coded & 0x0F);
|
||||
|
||||
altitude_coded = (altitude + 1000) / 25; // Can be coded in 100ft steps also
|
||||
frame.push_byte(altitude_coded >> 4); // Top-most altitude bits
|
||||
|
||||
// Decoding method (from dump1090):
|
||||
// index int j = floor(((59 * latcprE - 60 * latcprO) / 131072) + 0.50)
|
||||
// latE = DlatE * (cpr_mod(j, 60) + (latcprE / 131072))
|
||||
// latO = DlatO * (cpr_mod(j, 59) + (latcprO / 131072))
|
||||
// if latE >= 270 -> latE -= 360
|
||||
// if latO >= 270 -> latO -= 360
|
||||
// if (cpr_NL(latE) != cpr_NL(latO)) return;
|
||||
|
||||
// int ni = cpr_N(latE ,0);
|
||||
// int m = floor((((loncprE * (cpr_NL(latE) - 1)) - (loncprO * cpr_NL(latE))) / 131072) + 0.5)
|
||||
// lon = cpr_Dlon(latE, 0) * (cpr_mod(m, ni) + loncprE / 131072);
|
||||
// lat = latE;
|
||||
// ... or ...
|
||||
// int ni = cpr_N(latO ,0);
|
||||
// int m = floor((((loncprE * (cpr_NL(latO) - 1)) - (loncprO * cpr_NL(latO))) / 131072) + 0.5)
|
||||
// lon = cpr_Dlon(latO, 0) * (cpr_mod(m, ni) + loncprO / 131072);
|
||||
// lat = latO;
|
||||
// ... and ...
|
||||
// if (lon > 180) lon -= 360;
|
||||
|
||||
// CPR encoding
|
||||
// Info: http://antena.fe.uni-lj.si/literatura/Razno/Avionika/modes/CPRencoding.pdf
|
||||
// Info from: http://antena.fe.uni-lj.si/literatura/Razno/Avionika/modes/CPRencoding.pdf
|
||||
|
||||
delta_lat = 360.0 / ((4.0 * 15.0) - time_parity); // NZ = 15
|
||||
yz = floor(131072.0 * (cpr_mod(latitude, delta_lat) / delta_lat) + 0.5);
|
||||
|
|
@ -165,7 +193,7 @@ void generate_frame_pos(ADSBFrame& frame, const uint32_t ICAO_address, const uin
|
|||
lat = cpr_mod(yz, 131072.0);
|
||||
lon = cpr_mod(xz, 131072.0);
|
||||
|
||||
frame.push_byte((altitude_coded << 4) | ((uint32_t)time_parity << 2) | (lat >> 15));
|
||||
frame.push_byte((altitude_coded << 4) | ((uint32_t)time_parity << 2) | (lat >> 15)); // T = 0
|
||||
frame.push_byte(lat >> 7);
|
||||
frame.push_byte((lat << 1) | (lon >> 16));
|
||||
frame.push_byte(lon >> 8);
|
||||
|
|
@ -174,4 +202,35 @@ void generate_frame_pos(ADSBFrame& frame, const uint32_t ICAO_address, const uin
|
|||
frame.make_CRC();
|
||||
}
|
||||
|
||||
// speed is in knots
|
||||
// vertical rate is in ft/min
|
||||
void encode_frame_velo(ADSBFrame& frame, const uint32_t ICAO_address, const uint32_t speed,
|
||||
const float angle, const int32_t v_rate) {
|
||||
|
||||
int32_t velo_ew, velo_ns, v_rate_coded;
|
||||
uint32_t velo_ew_abs, velo_ns_abs, v_rate_coded_abs;
|
||||
|
||||
// To get NS and EW speeds from speed and bearing, a polar to cartesian conversion is enough
|
||||
velo_ew = static_cast<int32_t>(sin_f32(DEG_TO_RAD(angle) + (pi / 2)) * speed);
|
||||
velo_ns = static_cast<int32_t>(sin_f32(DEG_TO_RAD(angle)) * speed);
|
||||
|
||||
v_rate_coded = (v_rate / 64) + 1;
|
||||
|
||||
velo_ew_abs = abs(velo_ew);
|
||||
velo_ns_abs = abs(velo_ns);
|
||||
v_rate_coded_abs = abs(v_rate_coded);
|
||||
|
||||
make_frame_adsb(frame, ICAO_address);
|
||||
|
||||
frame.push_byte((TC_AIRBORNE_VELO << 3) | 1); // Subtype: 1 (subsonic)
|
||||
frame.push_byte(((velo_ew < 0 ? 1 : 0) << 2) | (velo_ew_abs >> 8));
|
||||
frame.push_byte(velo_ew_abs);
|
||||
frame.push_byte(((velo_ns < 0 ? 1 : 0) << 7) | (velo_ns_abs >> 3));
|
||||
frame.push_byte((velo_ns_abs << 5) | ((v_rate_coded < 0 ? 1 : 0) << 3) | (v_rate_coded_abs >> 6)); // VrSrc = 0
|
||||
frame.push_byte(v_rate_coded_abs << 2);
|
||||
frame.push_byte(0);
|
||||
|
||||
frame.make_CRC();
|
||||
}
|
||||
|
||||
} /* namespace adsb */
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue