kopia lustrzana https://github.com/DL7AD/pecanpico9
416 wiersze
11 KiB
C
416 wiersze
11 KiB
C
/* trackuino copyright (C) 2010 EA5HAV Javi
|
|
*
|
|
* 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
|
|
* 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, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
|
*/
|
|
#include "config.h"
|
|
#include "ax25.h"
|
|
#include "aprs.h"
|
|
#include <stdlib.h>
|
|
#include <math.h>
|
|
#include <string.h>
|
|
#include "debug.h"
|
|
|
|
#define METER_TO_FEET(m) (((m)*26876) / 8192)
|
|
|
|
static uint16_t loss_of_gps_counter = 0;
|
|
static uint16_t msg_id;
|
|
|
|
/**
|
|
* Transmit APRS position packet. The comments are filled with:
|
|
* - Static comment (can be set in config.h)
|
|
* - Battery voltage in mV
|
|
* - Solar voltage in mW (if tracker is solar-enabled)
|
|
* - Temperature in Celcius
|
|
* - Air pressure in Pascal
|
|
* - Number of satellites being used
|
|
* - Number of cycles where GPS has been lost (if applicable in cycle)
|
|
*/
|
|
void aprs_encode_position(ax25_t* packet, const aprs_conf_t *config, trackPoint_t *trackPoint)
|
|
{
|
|
char temp[22];
|
|
ptime_t date = trackPoint->time;
|
|
|
|
// Encode header
|
|
ax25_send_header(packet, config->callsign, config->ssid, config->path, packet->size > 0 ? 0 : config->preamble);
|
|
ax25_send_byte(packet, '/');
|
|
|
|
// 170915 = 17h:09m:15s zulu (not allowed in Status Reports)
|
|
chsnprintf(temp, sizeof(temp), "%02d%02d%02dh", date.hour, date.minute, date.second);
|
|
ax25_send_string(packet, temp);
|
|
|
|
// Latitude
|
|
uint32_t y = 380926 * (90 - trackPoint->gps_lat/10000000.0);
|
|
uint32_t y3 = y / 753571;
|
|
uint32_t y3r = y % 753571;
|
|
uint32_t y2 = y3r / 8281;
|
|
uint32_t y2r = y3r % 8281;
|
|
uint32_t y1 = y2r / 91;
|
|
uint32_t y1r = y2r % 91;
|
|
|
|
// Longitude
|
|
uint32_t x = 190463 * (180 + trackPoint->gps_lon/10000000.0);
|
|
uint32_t x3 = x / 753571;
|
|
uint32_t x3r = x % 753571;
|
|
uint32_t x2 = x3r / 8281;
|
|
uint32_t x2r = x3r % 8281;
|
|
uint32_t x1 = x2r / 91;
|
|
uint32_t x1r = x2r % 91;
|
|
|
|
// Altitude
|
|
uint32_t a = logf(METER_TO_FEET(trackPoint->gps_alt)) / logf(1.002f);
|
|
uint32_t a1 = a / 91;
|
|
uint32_t a1r = a % 91;
|
|
|
|
uint8_t gpsFix = trackPoint->gps_lock == GPS_LOCKED ? GSP_FIX_CURRENT : GSP_FIX_OLD;
|
|
uint8_t src = NMEA_SRC_GGA;
|
|
uint8_t origin = ORIGIN_PICO;
|
|
|
|
temp[0] = (config->symbol >> 8) & 0xFF;
|
|
temp[1] = y3+33;
|
|
temp[2] = y2+33;
|
|
temp[3] = y1+33;
|
|
temp[4] = y1r+33;
|
|
temp[5] = x3+33;
|
|
temp[6] = x2+33;
|
|
temp[7] = x1+33;
|
|
temp[8] = x1r+33;
|
|
temp[9] = config->symbol & 0xFF;
|
|
temp[10] = a1+33;
|
|
temp[11] = a1r+33;
|
|
temp[12] = ((gpsFix << 5) | (src << 3) | origin) + 33;
|
|
temp[13] = 0;
|
|
|
|
ax25_send_string(packet, temp);
|
|
|
|
// Comments
|
|
ax25_send_string(packet, "SATS ");
|
|
chsnprintf(temp, sizeof(temp), "%d", trackPoint->gps_sats);
|
|
ax25_send_string(packet, temp);
|
|
|
|
if(trackPoint->gps_lock == GPS_LOCKED) // GPS is locked
|
|
{
|
|
// TTFF (Time to first fix)
|
|
ax25_send_string(packet, " TTFF ");
|
|
chsnprintf(temp, sizeof(temp), "%d", trackPoint->gps_ttff);
|
|
ax25_send_string(packet, temp);
|
|
ax25_send_string(packet, "sec");
|
|
}
|
|
|
|
if(trackPoint->gps_lock == GPS_LOSS) { // No GPS lock
|
|
|
|
ax25_send_string(packet, " GPS LOSS ");
|
|
chsnprintf(temp, sizeof(temp), "%d", ++loss_of_gps_counter);
|
|
ax25_send_string(packet, temp);
|
|
|
|
} else if(trackPoint->gps_lock == GPS_LOWBATT) { // GPS switched off prematurely
|
|
|
|
ax25_send_string(packet, " GPS LOWBATT ");
|
|
chsnprintf(temp, sizeof(temp), "%d", ++loss_of_gps_counter);
|
|
ax25_send_string(packet, temp);
|
|
|
|
} else if(trackPoint->gps_lock == GPS_LOG) { // GPS position from log (because the tracker has been just switched on)
|
|
|
|
ax25_send_string(packet, " GPS FROM LOG");
|
|
loss_of_gps_counter = 0;
|
|
|
|
} else {
|
|
loss_of_gps_counter = 0;
|
|
}
|
|
|
|
ax25_send_byte(packet, '|');
|
|
|
|
// Sequence ID
|
|
uint32_t t = trackPoint->id & 0x1FFF;
|
|
temp[0] = t/91 + 33;
|
|
temp[1] = t%91 + 33;
|
|
temp[2] = 0;
|
|
ax25_send_string(packet, temp);
|
|
|
|
// Telemetry parameter
|
|
for(uint8_t i=0; i<5; i++) {
|
|
switch(config->tel[i]) {
|
|
case TEL_SATS: t = trackPoint->gps_sats; break;
|
|
case TEL_TTFF: t = trackPoint->gps_ttff; break;
|
|
case TEL_VBAT: t = trackPoint->adc_vbat; break;
|
|
case TEL_VSOL: t = trackPoint->adc_vsol; break;
|
|
case TEL_PBAT: t = trackPoint->adc_pbat+4096; break;
|
|
case TEL_RBAT: t = trackPoint->adc_rbat; break;
|
|
case TEL_HUM: t = trackPoint->air_hum; break;
|
|
case TEL_PRESS: t = trackPoint->air_press/125 - 40; break;
|
|
case TEL_TEMP: t = trackPoint->air_temp/10 + 1000; break;
|
|
}
|
|
|
|
temp[0] = t/91 + 33;
|
|
temp[1] = t%91 + 33;
|
|
ax25_send_string(packet, temp);
|
|
}
|
|
|
|
ax25_send_byte(packet, '|');
|
|
|
|
// Encode footer
|
|
ax25_send_footer(packet);
|
|
}
|
|
|
|
/**
|
|
* Transmit custom data packet (the methods aprs_encode_data allow multiple APRS packets in a row without preable being sent)
|
|
*/
|
|
void aprs_encode_init(ax25_t* packet, uint8_t* buffer, uint16_t size, mod_t mod)
|
|
{
|
|
packet->data = buffer;
|
|
packet->max_size = size;
|
|
packet->mod = mod;
|
|
|
|
// Encode APRS header
|
|
ax25_init(packet);
|
|
}
|
|
void aprs_encode_data_packet(ax25_t* packet, char packetType, const aprs_conf_t *config, uint8_t *data, size_t size, trackPoint_t *trackPoint)
|
|
{
|
|
char temp[13];
|
|
ptime_t date = trackPoint->time;
|
|
|
|
// Encode header
|
|
ax25_send_header(packet, config->callsign, config->ssid, config->path, packet->size > 0 ? 0 : config->preamble);
|
|
ax25_send_byte(packet, '/');
|
|
|
|
// 170915 = 17h:09m:15s zulu (not allowed in Status Reports)
|
|
chsnprintf(temp, sizeof(temp), "%02d%02d%02dh", date.hour, date.minute, date.second);
|
|
ax25_send_string(packet, temp);
|
|
|
|
// Latitude
|
|
uint32_t y = 380926 * (90 - trackPoint->gps_lat/10000000.0);
|
|
uint32_t y3 = y / 753571;
|
|
uint32_t y3r = y % 753571;
|
|
uint32_t y2 = y3r / 8281;
|
|
uint32_t y2r = y3r % 8281;
|
|
uint32_t y1 = y2r / 91;
|
|
uint32_t y1r = y2r % 91;
|
|
|
|
// Longitude
|
|
uint32_t x = 190463 * (180 + trackPoint->gps_lon/10000000.0);
|
|
uint32_t x3 = x / 753571;
|
|
uint32_t x3r = x % 753571;
|
|
uint32_t x2 = x3r / 8281;
|
|
uint32_t x2r = x3r % 8281;
|
|
uint32_t x1 = x2r / 91;
|
|
uint32_t x1r = x2r % 91;
|
|
|
|
// Altitude
|
|
uint32_t a = logf(METER_TO_FEET(trackPoint->gps_alt)) / logf(1.002f);
|
|
uint32_t a1 = a / 91;
|
|
uint32_t a1r = a % 91;
|
|
|
|
uint8_t gpsFix = trackPoint->gps_lock == GPS_LOCKED ? GSP_FIX_CURRENT : GSP_FIX_OLD;
|
|
uint8_t src = NMEA_SRC_GGA;
|
|
uint8_t origin = ORIGIN_PICO;
|
|
|
|
temp[0] = (config->symbol >> 8) & 0xFF;
|
|
temp[1] = y3+33;
|
|
temp[2] = y2+33;
|
|
temp[3] = y1+33;
|
|
temp[4] = y1r+33;
|
|
temp[5] = x3+33;
|
|
temp[6] = x2+33;
|
|
temp[7] = x1+33;
|
|
temp[8] = x1r+33;
|
|
temp[9] = config->symbol & 0xFF;
|
|
temp[10] = a1+33;
|
|
temp[11] = a1r+33;
|
|
temp[12] = ((gpsFix << 5) | (src << 3) | origin) + 33;
|
|
temp[13] = 0;
|
|
|
|
ax25_send_string(packet, temp);
|
|
ax25_send_byte(packet, packetType);
|
|
|
|
// Encode message
|
|
for(uint16_t i=0; i<size; i++)
|
|
ax25_send_byte(packet, data[i]);
|
|
|
|
// Encode footer
|
|
ax25_send_footer(packet);
|
|
}
|
|
uint32_t aprs_encode_finalize(ax25_t* packet)
|
|
{
|
|
scramble(packet);
|
|
nrzi_encode(packet);
|
|
return packet->size;
|
|
}
|
|
|
|
/**
|
|
* Transmit message packet
|
|
*/
|
|
void aprs_encode_message(ax25_t* packet, const aprs_conf_t *config, const char *receiver, const char *text)
|
|
{
|
|
char temp[10];
|
|
|
|
// Encode header
|
|
ax25_send_header(packet, config->callsign, config->ssid, config->path, packet->size > 0 ? 0 : config->preamble);
|
|
ax25_send_byte(packet, ':');
|
|
|
|
chsnprintf(temp, sizeof(temp), "%-9s", receiver);
|
|
ax25_send_string(packet, temp);
|
|
|
|
ax25_send_byte(packet, ':');
|
|
ax25_send_string(packet, text);
|
|
ax25_send_byte(packet, '{');
|
|
|
|
chsnprintf(temp, sizeof(temp), "%d", ++msg_id);
|
|
ax25_send_string(packet, temp);
|
|
|
|
// Encode footer
|
|
ax25_send_footer(packet);
|
|
}
|
|
|
|
/**
|
|
* Transmit APRS telemetry configuration
|
|
*/
|
|
void aprs_encode_telemetry_configuration(ax25_t* packet, const aprs_conf_t *config, const telemetry_conf_t type)
|
|
{
|
|
char temp[4];
|
|
|
|
// Encode header
|
|
ax25_send_header(packet, config->callsign, config->ssid, config->path, packet->size > 0 ? 0 : config->preamble);
|
|
ax25_send_byte(packet, ':'); // Message flag
|
|
|
|
// Callsign
|
|
ax25_send_string(packet, config->callsign);
|
|
ax25_send_byte(packet, '-');
|
|
chsnprintf(temp, sizeof(temp), "%d", config->ssid);
|
|
ax25_send_string(packet, temp);
|
|
|
|
// Padding
|
|
uint8_t length = strlen(config->callsign) + (config->ssid/10);
|
|
for(uint8_t i=length; i<7; i++)
|
|
ax25_send_string(packet, " ");
|
|
|
|
ax25_send_string(packet, ":"); // Message separator
|
|
|
|
switch(type) {
|
|
case CONF_PARM: // Telemetry parameter names
|
|
|
|
ax25_send_string(packet, "PARM.");
|
|
|
|
for(uint8_t i=0; i<5; i++) {
|
|
switch(config->tel[i]) {
|
|
case TEL_SATS: ax25_send_string(packet, "Sats"); break;
|
|
case TEL_TTFF: ax25_send_string(packet, "TTFF"); break;
|
|
case TEL_VBAT: ax25_send_string(packet, "Vbat"); break;
|
|
case TEL_VSOL: ax25_send_string(packet, "Vsol"); break;
|
|
case TEL_PBAT: ax25_send_string(packet, "Pbat"); break;
|
|
case TEL_RBAT: ax25_send_string(packet, "Rbat"); break;
|
|
case TEL_HUM: ax25_send_string(packet, "Humidity"); break;
|
|
case TEL_PRESS: ax25_send_string(packet, "Airpressure"); break;
|
|
case TEL_TEMP: ax25_send_string(packet, "Temperature"); break;
|
|
}
|
|
if(i < 4)
|
|
ax25_send_string(packet, ",");
|
|
}
|
|
|
|
break;
|
|
|
|
case CONF_UNIT: // Telemetry units
|
|
|
|
ax25_send_string(packet, "UNIT.");
|
|
|
|
for(uint8_t i=0; i<5; i++) {
|
|
switch(config->tel[i]) {
|
|
case TEL_SATS:
|
|
break; // No unit
|
|
|
|
case TEL_TTFF:
|
|
ax25_send_string(packet, "sec");
|
|
break;
|
|
|
|
case TEL_VBAT:
|
|
case TEL_VSOL:
|
|
ax25_send_string(packet, "V");
|
|
break;
|
|
|
|
case TEL_PBAT:
|
|
ax25_send_string(packet, "W");
|
|
break;
|
|
|
|
case TEL_RBAT:
|
|
ax25_send_string(packet, "Ohm");
|
|
break;
|
|
|
|
case TEL_HUM:
|
|
ax25_send_string(packet, "%");
|
|
break;
|
|
|
|
case TEL_PRESS:
|
|
ax25_send_string(packet, "Pa");
|
|
break;
|
|
|
|
case TEL_TEMP:
|
|
ax25_send_string(packet, "degC");
|
|
break;
|
|
}
|
|
if(i < 4)
|
|
ax25_send_string(packet, ",");
|
|
}
|
|
|
|
break;
|
|
|
|
case CONF_EQNS: // Telemetry conversion parameters
|
|
|
|
ax25_send_string(packet, "EQNS.");
|
|
|
|
for(uint8_t i=0; i<5; i++) {
|
|
switch(config->tel[i]) {
|
|
case TEL_SATS:
|
|
case TEL_TTFF:
|
|
ax25_send_string(packet, "0,1,0");
|
|
break;
|
|
|
|
case TEL_VBAT:
|
|
case TEL_VSOL:
|
|
case TEL_RBAT:
|
|
ax25_send_string(packet, "0,.001,0");
|
|
break;
|
|
|
|
case TEL_PBAT:
|
|
ax25_send_string(packet, "0,.001,-4.096");
|
|
break;
|
|
|
|
case TEL_HUM:
|
|
ax25_send_string(packet, "0,.1,0");
|
|
break;
|
|
|
|
case TEL_PRESS:
|
|
ax25_send_string(packet, "0,12.5,500");
|
|
break;
|
|
|
|
case TEL_TEMP:
|
|
ax25_send_string(packet, "0,.1,-100");
|
|
break;
|
|
}
|
|
if(i < 4)
|
|
ax25_send_string(packet, ",");
|
|
}
|
|
|
|
break;
|
|
|
|
case CONF_BITS:
|
|
ax25_send_string(packet, "BITS.11111111,");
|
|
ax25_send_string(packet, config->tel_comment);
|
|
break;
|
|
}
|
|
|
|
|
|
// Encode footer
|
|
ax25_send_footer(packet);
|
|
}
|
|
|