rs41: cal/conf via JSON v0.3

test
Zilog80 2023-10-03 15:34:43 +02:00
rodzic 4fa98b637a
commit 5c573317e9
1 zmienionych plików z 11 dodań i 3 usunięć

Wyświetl plik

@ -2132,25 +2132,33 @@ static int print_position(gpx_t *gpx, int ec) {
}
if (gpx->option.cal == 1) { // cal/conf
int _j;
if ( !gpx->calconf_sent && gpx->calconf_complete ) {
fprintf(stdout, ", \"rs41_calconf320\": \"");
/*
fprintf(stdout, ", \"rs41_calconf320h\": \""); // only constant/crc part
for (int _j = 0; _j < 50*16; _j++) {
fprintf(stdout, "%02X", gpx->calibytes[_j]);
}
*/
fprintf(stdout, ", \"rs41_calconf51x16\": \"");
for (_j = 0; _j < 51*16; _j++) {
fprintf(stdout, "%02X", gpx->calibytes[_j]);
}
fprintf(stdout, "\"");
gpx->calconf_sent = 1;
}
if (gpx->calconf_subfrm[0] == 0x32) {
fprintf(stdout, ", \"rs41_conf0x32\": \"");
for (int _j = 0; _j < 16; _j++) {
for (_j = 0; _j < 16; _j++) {
fprintf(stdout, "%02X", gpx->calconf_subfrm[1+_j]);
}
fprintf(stdout, "\"");
}
}
if (gpx->option.cal == 2) { // cal/conf
int _j;
fprintf(stdout, ", \"rs41_subfrm\": \"0x%02X:", gpx->calconf_subfrm[0]);
for (int _j = 0; _j < 16; _j++) {
for (_j = 0; _j < 16; _j++) {
fprintf(stdout, "%02X", gpx->calconf_subfrm[1+_j]);
}
fprintf(stdout, "\"");