kopia lustrzana https://github.com/mikaelnousiainen/RS41ng
108 wiersze
4.1 KiB
C
108 wiersze
4.1 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include "utils.h"
|
|
#include "config.h"
|
|
#include "template.h"
|
|
|
|
size_t template_replace(char *dest, size_t dest_len, char *src, telemetry_data *data)
|
|
{
|
|
char *temp = malloc(dest_len);
|
|
if (temp == NULL) {
|
|
return 0;
|
|
}
|
|
|
|
char replacement[32];
|
|
|
|
strlcpy(replacement, CALLSIGN, sizeof(replacement));
|
|
strlcpy(temp, src, dest_len);
|
|
str_replace(dest, dest_len, temp, "$cs", replacement);
|
|
|
|
strlcpy(replacement, data->locator, 4 + 1);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$loc4", replacement);
|
|
|
|
strlcpy(replacement, data->locator, 6 + 1);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$loc6", replacement);
|
|
|
|
strlcpy(replacement, data->locator, 8 + 1);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$loc8", replacement);
|
|
|
|
strlcpy(replacement, data->locator, 12 + 1);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$loc12", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->battery_voltage_millivolts);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$bv", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->button_adc_value);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$bu", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->temperature_celsius_100 / 100);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$te", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->internal_temperature_celsius_100 / 100);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$ti", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->humidity_percentage_100 / 100);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$hu", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->pressure_mbar_100 / 100);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$pr", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%u", data->gps.time_of_week_millis);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$tow", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%02d", data->gps.hours);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$hh", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%02d", data->gps.minutes);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$mm", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%02d", data->gps.seconds);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$ss", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->gps.satellites_visible);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$sv", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%05d", data->gps.latitude_degrees_1000000 / 10000);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$lat", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%05d", data->gps.longitude_degrees_1000000 / 10000);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$lon", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->gps.altitude_mm / 1000);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$alt", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", (int) ((float) data->gps.ground_speed_cm_per_second * 3.6f / 100.0f));
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$gs", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%d", data->gps.climb_cm_per_second / 100);
|
|
strlcpy(temp, dest, dest_len);
|
|
str_replace(dest, dest_len, temp, "$cl", replacement);
|
|
|
|
snprintf(replacement, sizeof(replacement), "%03d", data->gps.heading_degrees_100000 / 100000);
|
|
strlcpy(temp, dest, dest_len);
|
|
size_t len = str_replace(dest, dest_len, temp, "$he", replacement);
|
|
|
|
free(temp);
|
|
|
|
return len;
|
|
}
|