kopia lustrzana https://github.com/SP8EBC/ParaTNC
615 wiersze
25 KiB
C
615 wiersze
25 KiB
C
/*
|
|
* telemetry.c
|
|
*
|
|
* Created on: 01.07.2017
|
|
* Author: mateusz
|
|
*/
|
|
|
|
#include "aprs/telemetry.h"
|
|
#include "main.h"
|
|
#include "delay.h"
|
|
|
|
#include "ve_direct_protocol/parser.h"
|
|
|
|
#include "modbus_rtu/rtu_getters.h"
|
|
|
|
#include <main.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
uint16_t telemetry_counter = 0;
|
|
|
|
#ifdef PARAMETEO
|
|
#include "pwr_save.h"
|
|
|
|
const char * telemetry_vbatt_normal = "VBATT_GOOD";
|
|
const char * telemetry_vbatt_low = "VBATT_LOW";
|
|
const char * telemetry_vbatt_cutoff = "VBATT_CUTOFF";
|
|
const char * telemetry_vbatt_unknown = "VBATT_UNKNOWN";
|
|
|
|
#endif
|
|
|
|
void telemetry_send_chns_description_pv(const config_data_basic_t * const config_basic) {
|
|
|
|
// a buffer to assembly the 'call-ssid' string at the begining of the frame
|
|
char message_prefix_buffer[9];
|
|
|
|
memset(message_prefix_buffer, 0x00, 0x09);
|
|
|
|
sprintf(message_prefix_buffer, "%s-%d", config_basic->callsign, config_basic->ssid);
|
|
|
|
while (main_afsk.sending == 1);
|
|
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :PARM.Rx10min,Digi10min,BatAmps,BatVolt,PvVolt,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Digi10min,BatAmps,BatVolt,PvVolt,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Digi10min,BatAmps,BatVolt,PvVolt,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB", message_prefix_buffer);
|
|
else
|
|
return;
|
|
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
after_tx_lock = 1;
|
|
afsk_txStart(&main_afsk);
|
|
|
|
while (main_afsk.sending == 1);
|
|
|
|
delay_fixed(1200);
|
|
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :EQNS.0,1,0,0,1,0,0,0.07,-8,0,0.07,4,0,0.07,4", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:EQNS.0,1,0,0,1,0,0,0.07,-8,0,0.07,4,0,0.07,4", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:EQNS.0,1,0,0,1,0,0,0.07,-8,0,0.07,4,0,0.07,4", message_prefix_buffer);
|
|
else
|
|
return;
|
|
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
after_tx_lock = 1;
|
|
afsk_txStart(&main_afsk);
|
|
|
|
while (main_afsk.sending == 1);
|
|
|
|
delay_fixed(1200);
|
|
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :UNIT.Pkt,Pkt,A,V,V,Hi,Hi,Hi,Hi,Hi,Hi,Hi", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:UNIT.Pkt,Pkt,A,V,V,Hi,Hi,Hi,Hi,Hi,Hi,Hi", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:UNIT.Pkt,Pkt,A,V,V,Hi,Hi,Hi,Hi,Hi,Hi,Hi", message_prefix_buffer);
|
|
else
|
|
return;
|
|
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
after_tx_lock = 1;
|
|
afsk_txStart(&main_afsk);
|
|
|
|
delay_fixed(1200);
|
|
}
|
|
|
|
void telemetry_send_values_pv ( uint8_t rx_pkts,
|
|
uint8_t digi_pkts,
|
|
int16_t raw_battery_current,
|
|
uint16_t raw_battery_voltage,
|
|
uint16_t raw_pv_cell_voltage,
|
|
dallas_qf_t dallas_qf,
|
|
pressure_qf_t press_qf,
|
|
humidity_qf_t humid_qf,
|
|
wind_qf_t anemometer_qf)
|
|
{
|
|
// local variables with characters to be inserted to APRS telemetry frame
|
|
char qf = '0', degr = '0', nav = '0';
|
|
|
|
char pressure_qf_navaliable = '0';
|
|
char humidity_qf_navaliable = '0';
|
|
char anemometer_degradated = '0';
|
|
char anemometer_navble = '0';
|
|
|
|
uint8_t scaled_battery_current = 0;
|
|
uint8_t scaled_battery_voltage = 0;
|
|
uint8_t scaled_pvcell_volage = 0;
|
|
|
|
float phy_battery_current = 0.0f;
|
|
float phy_battery_voltage = 0.0f;
|
|
float phy_pvcell_voltage = 0.0f;
|
|
|
|
phy_battery_current = (float)raw_battery_current / 1000.0f;
|
|
phy_battery_voltage = (float)raw_battery_voltage / 1000.0f;
|
|
phy_pvcell_voltage = (float)raw_pv_cell_voltage / 1000.0f;
|
|
|
|
scaled_battery_current = (uint8_t) roundf((phy_battery_current + 8.0f) * 14.2857f);
|
|
scaled_battery_voltage = (uint8_t) roundf((phy_battery_voltage - 4.0f) * 14.2857f);
|
|
scaled_pvcell_volage = (uint8_t) roundf((phy_pvcell_voltage - 4.0f) * 14.2857f);
|
|
|
|
switch (dallas_qf) {
|
|
case DALLAS_QF_FULL:
|
|
qf = '1', degr = '0', nav = '0';
|
|
break;
|
|
case DALLAS_QF_DEGRADATED:
|
|
qf = '0', degr = '1', nav = '0';
|
|
break;
|
|
|
|
case DALLAS_QF_NOT_AVALIABLE:
|
|
qf = '0', degr = '0', nav = '1';
|
|
break;
|
|
|
|
default:
|
|
qf = '0', degr = '0', nav = '0';
|
|
break;
|
|
}
|
|
|
|
// set the quality factor for pressure
|
|
switch (press_qf) {
|
|
case PRESSURE_QF_NOT_AVALIABLE:
|
|
case PRESSURE_QF_UNKNOWN:
|
|
pressure_qf_navaliable = '1';
|
|
break;
|
|
default:
|
|
pressure_qf_navaliable = '0';
|
|
break;
|
|
}
|
|
|
|
switch (humid_qf) {
|
|
case HUMIDITY_QF_UNKNOWN:
|
|
case HUMIDITY_QF_NOT_AVALIABLE:
|
|
humidity_qf_navaliable = '1';
|
|
break;
|
|
default:
|
|
humidity_qf_navaliable = '0';
|
|
}
|
|
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c0", telemetry_counter++, rx_pkts, digi_pkts, scaled_battery_current, scaled_battery_voltage, scaled_pvcell_volage, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble);
|
|
|
|
|
|
if (telemetry_counter > 999)
|
|
telemetry_counter = 0;
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
after_tx_lock = 1;
|
|
while (main_ax25.dcd == 1);
|
|
|
|
afsk_txStart(&main_afsk);
|
|
|
|
}
|
|
|
|
void telemetry_send_status_pv(ve_direct_average_struct* avg, ve_direct_error_reason* last_error, ve_direct_system_state state, uint32_t master_time, uint16_t messages_count, uint16_t corrupted_messages_count) {
|
|
char string_buff_err[24], string_buff_state[23];
|
|
|
|
ve_direct_state_to_string(state, string_buff_state, 23);
|
|
ve_direct_error_to_string(*last_error, string_buff_err, 24);
|
|
|
|
main_own_aprs_msg_len = snprintf(main_own_aprs_msg, sizeof(main_own_aprs_msg), ">MT %lX, MC %lX, CMC %lX, IMIN %d, IMAX %d, %s, %s", master_time, (uint32_t)messages_count, (uint32_t)corrupted_messages_count, avg->min_battery_current, avg->max_battery_current, string_buff_state, string_buff_err);
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
afsk_txStart(&main_afsk);
|
|
|
|
main_wait_for_tx_complete();
|
|
|
|
avg->max_battery_current = 0;
|
|
avg->min_battery_current = 0;
|
|
*last_error = ERR_UNINITIALIZED;
|
|
}
|
|
////
|
|
|
|
/**
|
|
* Sends four frames with telemetry description
|
|
*/
|
|
void telemetry_send_chns_description(const config_data_basic_t * const config_basic, const config_data_mode_t * const config_mode) {
|
|
|
|
// a buffer to assembly the 'call-ssid' string at the begining of the frame
|
|
char message_prefix_buffer[9];
|
|
|
|
memset(message_prefix_buffer, 0x00, 0x09);
|
|
|
|
sprintf(message_prefix_buffer, "%s-%d", config_basic->callsign, config_basic->ssid);
|
|
|
|
// wait for any RF transmission to finish
|
|
main_wait_for_tx_complete();
|
|
|
|
// clear the output frame buffer
|
|
memset(main_own_aprs_msg, 0x00, sizeof(main_own_aprs_msg));
|
|
|
|
#ifdef STM32L471xx
|
|
if (config_mode->digi_viscous == 0) {
|
|
// prepare a frame with channel names depending on SSID
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :PARM.Rx10min,Tx10min,Digi10min,Vbatt,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Tx10min,Digi10min,Vbatt,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Tx10min,Digi10min,Vbatt,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", message_prefix_buffer);
|
|
else
|
|
return;
|
|
}
|
|
else {
|
|
// prepare a frame with channel names depending on SSID
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :PARM.Rx10min,Visc10min,Digi10min,Vbatt,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Visc10min,Digi10min,Vbatt,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Visc10min,Digi10min,Vbatt,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", message_prefix_buffer);
|
|
else
|
|
return;
|
|
}
|
|
#else
|
|
if (config_mode->digi_viscous == 0) {
|
|
// prepare a frame with channel names depending on SSID
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :PARM.Rx10min,Tx10min,Digi10min,HostTx10m,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Tx10min,Digi10min,HostTx10m,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Tx10min,Digi10min,HostTx10m,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB,VBATT_LOW", message_prefix_buffer);
|
|
else
|
|
return;
|
|
}
|
|
else {
|
|
// prepare a frame with channel names depending on SSID
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :PARM.Rx10min,Tx10min,Digi10min,Visc10min,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Tx10min,Digi10min,Visc10min,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:PARM.Rx10min,Tx10min,Digi10min,Visc10min,Tempre,DS_QF_FULL,DS_QF_DEGRAD,DS_QF_NAVBLE,QNH_QF_NAVBLE,HUM_QF_NAVBLE,WIND_QF_DEGR,WIND_QF_NAVB", message_prefix_buffer);
|
|
else
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
// place a null terminator at the end
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
|
|
// prepare transmission
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
after_tx_lock = 1;
|
|
|
|
// key up the transmitter and
|
|
afsk_txStart(&main_afsk);
|
|
|
|
main_wait_for_tx_complete();
|
|
|
|
delay_fixed(1500);
|
|
|
|
while (main_ax25.dcd == 1);
|
|
|
|
#ifdef STM32L471xx
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :EQNS.0,1,0,0,1,0,0,1,0,0,0.02,10,0,0.5,-50", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:EQNS.0,1,0,0,1,0,0,1,0,0,0.02,10,0,0.5,-50", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:EQNS.0,1,0,0,1,0,0,1,0,0,0.02,10,0,0.5,-50", message_prefix_buffer);
|
|
else
|
|
return;
|
|
#else
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :EQNS.0,1,0,0,1,0,0,1,0,0,1,0,0,0.5,-50", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:EQNS.0,1,0,0,1,0,0,1,0,0,1,0,0,0.5,-50", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:EQNS.0,1,0,0,1,0,0,1,0,0,1,0,0,0.5,-50", message_prefix_buffer);
|
|
else
|
|
return;
|
|
#endif
|
|
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
after_tx_lock = 1;
|
|
afsk_txStart(&main_afsk);
|
|
|
|
main_wait_for_tx_complete();
|
|
|
|
delay_fixed(1500);
|
|
|
|
while (main_ax25.dcd == 1);
|
|
|
|
#ifdef STM32L471xx
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :UNIT.Pkt,Pkt,Pkt,V,DegC,Hi,Hi,Hi,Hi,Hi,Hi,Hi,Hi", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:UNIT.Pkt,Pkt,Pkt,V,DegC,Hi,Hi,Hi,Hi,Hi,Hi,Hi,Hi", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:UNIT.Pkt,Pkt,Pkt,V,DegC,Hi,Hi,Hi,Hi,Hi,Hi,Hi,Hi", message_prefix_buffer);
|
|
else
|
|
return;
|
|
#else
|
|
if (config_basic->ssid == 0)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-6s :UNIT.Pkt,Pkt,Pkt,Pkt,DegC,Hi,Hi,Hi,Hi,Hi,Hi,Hi,Hi", config_basic->callsign);
|
|
else if (config_basic->ssid > 0 && config_basic->ssid < 10)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:UNIT.Pkt,Pkt,Pkt,Pkt,DegC,Hi,Hi,Hi,Hi,Hi,Hi,Hi,Hi", message_prefix_buffer);
|
|
else if (config_basic->ssid >= 10 && config_basic->ssid < 16)
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ":%-9s:UNIT.Pkt,Pkt,Pkt,Pkt,DegC,Hi,Hi,Hi,Hi,Hi,Hi,Hi,Hi", message_prefix_buffer);
|
|
else
|
|
return;
|
|
#endif
|
|
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
after_tx_lock = 1;
|
|
afsk_txStart(&main_afsk);
|
|
//
|
|
// main_wait_for_tx_complete();
|
|
//
|
|
// delay_fixed(1500);
|
|
//
|
|
// while (main_ax25.dcd == 1);
|
|
|
|
}
|
|
|
|
/**
|
|
* This function sends telemetry values in 'typical configuration' when VICTRON VE.direct protocol parser is not enabled.
|
|
*/
|
|
#ifdef STM32L471xx
|
|
void telemetry_send_values( uint8_t rx_pkts,
|
|
uint8_t tx_pkts,
|
|
uint8_t digi_pkts,
|
|
uint16_t vbatt_voltage,
|
|
uint8_t viscous_drop_pkts,
|
|
float temperature,
|
|
dallas_qf_t dallas_qf,
|
|
pressure_qf_t press_qf,
|
|
humidity_qf_t humid_qf,
|
|
wind_qf_t anemometer_qf,
|
|
int8_t cutoff_and_vbat_low,
|
|
const config_data_mode_t * const config_mode) {
|
|
|
|
uint8_t scaled_vbatt_voltage = 0;
|
|
|
|
// this is B+ voltage, which is scaled * 100 what means that 1152 equals to 11.52V
|
|
if (vbatt_voltage < 1511 && vbatt_voltage > 1000) {
|
|
// mininum value will be 10.01V (0x0) and maximum 15.11V (0xFF), with the step of .02V
|
|
scaled_vbatt_voltage = (uint8_t)((vbatt_voltage - 1000u) / 2u);
|
|
}
|
|
else if (vbatt_voltage > 1510) {
|
|
scaled_vbatt_voltage = 0xFF;
|
|
}
|
|
else {
|
|
;
|
|
}
|
|
|
|
|
|
#else
|
|
void telemetry_send_values( uint8_t rx_pkts,
|
|
uint8_t tx_pkts,
|
|
uint8_t digi_pkts,
|
|
uint8_t kiss_pkts,
|
|
uint8_t viscous_drop_pkts,
|
|
float temperature,
|
|
dallas_qf_t dallas_qf,
|
|
pressure_qf_t press_qf,
|
|
humidity_qf_t humid_qf,
|
|
wind_qf_t anemometer_qf,
|
|
const config_data_mode_t * const config_mode) {
|
|
#endif
|
|
|
|
// local variables with characters to be inserted to APRS telemetry frame
|
|
char qf = '0', degr = '0', nav = '0';
|
|
char pressure_qf_navaliable = '0';
|
|
char humidity_qf_navaliable = '0';
|
|
char anemometer_degradated = '0';
|
|
char anemometer_navble = '0';
|
|
char vbatt_low = '0';
|
|
|
|
// temperature scaled to 0x00-0xFF range for fifth telemetry channel.
|
|
// if _METEO mode is enabled this channel sends the temperaure measure by
|
|
// internal MS5611 or BME280. If _METEO is not enabled this channel
|
|
// could send Dallas DS18B20 masurements if this is enabled in station_config.h
|
|
uint8_t scaled_temperature = 0;
|
|
|
|
// get the quality factor for wind measurements
|
|
if (anemometer_qf == WIND_QF_DEGRADATED) {
|
|
anemometer_degradated = '1';
|
|
anemometer_navble = '0';
|
|
}
|
|
else if (anemometer_qf == WIND_QF_NOT_AVALIABLE) {
|
|
anemometer_degradated = '0';
|
|
anemometer_navble = '1';
|
|
}
|
|
else if (anemometer_qf == WIND_QF_UNKNOWN) {
|
|
anemometer_degradated = '1';
|
|
anemometer_navble = '1';
|
|
}
|
|
|
|
// scale the physical temperature and limit upper and lower boundary if
|
|
// it is required
|
|
if (temperature < -50.0f) {
|
|
scaled_temperature = (uint8_t)0;
|
|
}
|
|
else if (temperature > 70.0f) {
|
|
scaled_temperature = (uint8_t)255;
|
|
}
|
|
else {
|
|
scaled_temperature = (uint8_t)((temperature + 50.0f) * 2.0f);
|
|
}
|
|
|
|
// set the quality factor for dallas DS18B20
|
|
switch (dallas_qf) {
|
|
case DALLAS_QF_FULL:
|
|
qf = '1', degr = '0', nav = '0';
|
|
break;
|
|
case DALLAS_QF_DEGRADATED:
|
|
qf = '0', degr = '1', nav = '0';
|
|
break;
|
|
|
|
case DALLAS_QF_NOT_AVALIABLE:
|
|
qf = '0', degr = '0', nav = '1';
|
|
break;
|
|
|
|
default:
|
|
qf = '0', degr = '0', nav = '0';
|
|
break;
|
|
}
|
|
|
|
// set the quality factor for pressure
|
|
switch (press_qf) {
|
|
case PRESSURE_QF_NOT_AVALIABLE:
|
|
case PRESSURE_QF_UNKNOWN:
|
|
pressure_qf_navaliable = '1';
|
|
break;
|
|
default:
|
|
pressure_qf_navaliable = '0';
|
|
break;
|
|
}
|
|
|
|
switch (humid_qf) {
|
|
case HUMIDITY_QF_UNKNOWN:
|
|
case HUMIDITY_QF_NOT_AVALIABLE:
|
|
humidity_qf_navaliable = '1';
|
|
break;
|
|
default:
|
|
humidity_qf_navaliable = '0';
|
|
}
|
|
|
|
// telemetry won't be sent during cutoff anyway so this simplification is correct here
|
|
if (cutoff_and_vbat_low > 0) {
|
|
vbatt_low = '1';
|
|
}
|
|
|
|
// reset the buffer where the frame will be contructed and stored for transmission
|
|
memset(main_own_aprs_msg, 0x00, sizeof(main_own_aprs_msg));
|
|
|
|
#ifdef STM32L471xx
|
|
if (config_mode->digi_viscous == 0) {
|
|
// generate the telemetry frame from values
|
|
#ifdef _DALLAS_AS_TELEM
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c%c", telemetry_counter++, rx_pkts, tx_pkts, digi_pkts, scaled_vbatt_voltage, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble, vbatt_low);
|
|
#else
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c%c", telemetry_counter++, rx_pkts, tx_pkts, digi_pkts, scaled_vbatt_voltage, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble, vbatt_low);
|
|
#endif
|
|
}
|
|
else {
|
|
#ifdef _DALLAS_AS_TELEM
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c%c", telemetry_counter++, rx_pkts, viscous_drop_pkts, digi_pkts, scaled_vbatt_voltage, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble, vbatt_low);
|
|
#else
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c%c", telemetry_counter++, rx_pkts, viscous_drop_pkts, digi_pkts, scaled_vbatt_voltage, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble, vbatt_low);
|
|
#endif
|
|
}
|
|
#else
|
|
if (config_mode->digi_viscous == 0) {
|
|
// generate the telemetry frame from values
|
|
#ifdef _DALLAS_AS_TELEM
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c0", telemetry_counter++, rx_pkts, tx_pkts, digi_pkts, kiss_pkts, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble);
|
|
#else
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c0", telemetry_counter++, rx_pkts, tx_pkts, digi_pkts, kiss_pkts, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble);
|
|
#endif
|
|
}
|
|
else {
|
|
#ifdef _DALLAS_AS_TELEM
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c0", telemetry_counter++, rx_pkts, tx_pkts, digi_pkts, viscous_drop_pkts, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble);
|
|
#else
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, "T#%03d,%03d,%03d,%03d,%03d,%03d,%c%c%c%c%c%c%c0", telemetry_counter++, rx_pkts, tx_pkts, digi_pkts, viscous_drop_pkts, scaled_temperature, qf, degr, nav, pressure_qf_navaliable, humidity_qf_navaliable, anemometer_degradated, anemometer_navble);
|
|
#endif
|
|
}
|
|
#endif
|
|
|
|
// reset the frame counter if it overflowed
|
|
if (telemetry_counter > 999)
|
|
telemetry_counter = 0;
|
|
|
|
// put a null terminator at the end of frame (but it should be placed there anyway)
|
|
main_own_aprs_msg[main_own_aprs_msg_len] = 0;
|
|
|
|
// wait for completing any previous transmission (afsk_txStart will exit with failure if the modem is transmitting)
|
|
main_wait_for_tx_complete();
|
|
|
|
// prepare transmission of the frame
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
|
|
// ??
|
|
after_tx_lock = 1;
|
|
|
|
// check if RF channel is free from other transmissions and wait for the clearance if it is needed
|
|
while (main_ax25.dcd == 1);
|
|
|
|
// key up a transmitter and start transmission
|
|
afsk_txStart(&main_afsk);
|
|
|
|
}
|
|
|
|
void telemetry_send_status(void) {
|
|
memset(main_own_aprs_msg, 0x00, sizeof(main_own_aprs_msg));
|
|
#ifdef STM32L471xx
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ">ParaMETEO firmware %s-%s by SP8EBC - PV powered, fully outdoor, 3in1 APRS device", SW_VER, SW_DATE);
|
|
#else
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ">ParaTNC firmware %s-%s by SP8EBC", SW_VER, SW_DATE);
|
|
#endif
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
while (main_ax25.dcd == 1);
|
|
afsk_txStart(&main_afsk);
|
|
|
|
}
|
|
|
|
|
|
void telemetry_send_status_raw_values_modbus(void) {
|
|
#ifdef _MODBUS_RTU
|
|
uint8_t status_ln = 0;
|
|
|
|
rtu_get_raw_values_string(main_own_aprs_msg, OWN_APRS_MSG_LN, &status_ln);
|
|
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, status_ln);
|
|
while (main_ax25.dcd == 1);
|
|
afsk_txStart(&main_afsk);
|
|
main_wait_for_tx_complete();
|
|
#endif
|
|
}
|
|
|
|
void telemetry_send_status_powersave_cutoff(uint16_t battery_voltage, int8_t previous_cutoff, int8_t current_cutoff) {
|
|
const char *p, *c;
|
|
|
|
// telemetry_vbatt_unknown
|
|
|
|
if ((previous_cutoff & CURRENTLY_CUTOFF) != 0) {
|
|
p = telemetry_vbatt_cutoff;
|
|
}
|
|
else if ((previous_cutoff & CURRENTLY_VBATT_LOW) != 0) {
|
|
p = telemetry_vbatt_low;
|
|
}
|
|
else if (((previous_cutoff & CURRENTLY_CUTOFF) == 0) && (previous_cutoff & CURRENTLY_VBATT_LOW) == 0){
|
|
p = telemetry_vbatt_normal;
|
|
}
|
|
else {
|
|
p = telemetry_vbatt_unknown;
|
|
}
|
|
|
|
if ((current_cutoff & CURRENTLY_CUTOFF) != 0) {
|
|
c = telemetry_vbatt_cutoff;
|
|
}
|
|
else if ((current_cutoff & CURRENTLY_VBATT_LOW) != 0) {
|
|
c = telemetry_vbatt_low;
|
|
}
|
|
else if (((current_cutoff & CURRENTLY_CUTOFF) == 0) && (current_cutoff & CURRENTLY_VBATT_LOW) == 0){
|
|
c = telemetry_vbatt_normal;
|
|
}
|
|
else {
|
|
c = telemetry_vbatt_unknown;
|
|
}
|
|
|
|
main_wait_for_tx_complete();
|
|
|
|
memset(main_own_aprs_msg, 0x00, sizeof(main_own_aprs_msg));
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ">[powersave cutoff change][Vbatt: %dV][previous: %d - %s][currently: %d - %s]", battery_voltage, previous_cutoff, p, current_cutoff, c);
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
//while (main_ax25.dcd == 1);
|
|
afsk_txStart(&main_afsk);
|
|
main_wait_for_tx_complete();
|
|
|
|
}
|
|
|
|
void telemetry_send_status_powersave_registers(uint32_t register_last_sleep, uint32_t register_last_wakeup, uint32_t register_counters, uint32_t monitor, uint32_t last_sleep_time) {
|
|
main_wait_for_tx_complete();
|
|
|
|
memset(main_own_aprs_msg, 0x00, sizeof(main_own_aprs_msg));
|
|
main_own_aprs_msg_len = sprintf(main_own_aprs_msg, ">[powersave registers][last_sleep_ts: 0x%lX][last_wakeup_ts: 0x%lX][sleep_wakeup_cntrs: 0x%lX][monitor: 0x%lX][last_sleep_time: 0x%lX]",register_last_sleep, register_last_wakeup, register_counters, monitor, last_sleep_time);
|
|
ax25_sendVia(&main_ax25, main_own_path, main_own_path_ln, main_own_aprs_msg, main_own_aprs_msg_len);
|
|
//while (main_ax25.dcd == 1);
|
|
afsk_txStart(&main_afsk);
|
|
main_wait_for_tx_complete();
|
|
}
|
|
|