static void ubx_update(void)
{
unsigned char *buf;
size_t data_len;
unsigned short msgid;
buf = session.lexer.outbuffer;
msgid = (unsigned short)((buf[2] << 8) | buf[3]);
data_len = (size_t) getles16(buf, 4);
switch (msgid) {
case UBX_NAV_SVINFO:
display_nav_svinfo(&buf[6], data_len);
break;
case UBX_NAV_DOP:
display_nav_dop(&buf[6], data_len);
break;
case UBX_NAV_SOL:
display_nav_sol(&buf[6], data_len);
break;
default:
break;
}
#ifdef NTP_ENABLE
toff_update(ppswin, TOFF_LINE, TOFF_COLUMN + 6);
#endif /* NTP_ENABLE */
#ifdef PPS_ENABLE
pps_update(ppswin, PPS_LINE, PPS_COLUMN + 5);
#endif /* PPS_ENABLE */
}
static void nmea_update(void)
{
char **fields;
assert(cookedwin != NULL);
assert(nmeawin != NULL);
assert(gpgsawin != NULL);
assert(gpggawin != NULL);
assert(gprmcwin != NULL);
assert(gpgstwin != NULL);
/* can be NULL if packet was overlong */
fields = session.nmea.field;
if (session.lexer.outbuffer[0] == (unsigned char)'$'
&& fields != NULL && fields[0] != NULL) {
int ymax, xmax;
timestamp_t now;
getmaxyx(nmeawin, ymax, xmax);
assert(ymax > 0);
if (strstr(sentences, fields[0]) == NULL) {
char *s_end = sentences + strlen(sentences);
if ((int)(strlen(sentences) + strlen(fields[0])) < xmax - 2) {
*s_end++ = ' ';
(void)strlcpy(s_end, fields[0], NMEA_MAX);
} else {
*--s_end = '.';
*--s_end = '.';
*--s_end = '.';
}
(void)mvwaddstr(nmeawin, SENTENCELINE, 1, sentences);
}
/*
* If the interval between this and last update is
* the longest we've seen yet, boldify the corresponding
* tag.
*/
now = timestamp();
if (now > last_tick && (now - last_tick) > tick_interval) {
char *findme = strstr(sentences, fields[0]);
tick_interval = now - last_tick;
if (findme != NULL) {
(void)mvwchgat(nmeawin, SENTENCELINE, 1, xmax - 13, A_NORMAL, 0,
NULL);
(void)mvwchgat(nmeawin, SENTENCELINE, 1 + (findme - sentences),
(int)strlen(fields[0]), A_BOLD, 0, NULL);
}
}
last_tick = now;
if (strcmp(fields[0], "GPGSV") == 0
|| strcmp(fields[0], "GNGSV") == 0
|| strcmp(fields[0], "GLGSV") == 0) {
int i;
int nsats =
(session.gpsdata.satellites_visible <
MAXSATS) ? session.gpsdata.satellites_visible : MAXSATS;
for (i = 0; i < nsats; i++) {
(void)wmove(satwin, i + 2, 3);
(void)wprintw(satwin, " %3d %3d%3d %3.0f",
session.gpsdata.skyview[i].PRN,
session.gpsdata.skyview[i].azimuth,
session.gpsdata.skyview[i].elevation,
session.gpsdata.skyview[i].ss);
}
/* add overflow mark to the display */
if (nsats <= MAXSATS)
(void)mvwaddch(satwin, MAXSATS + 2, 18, ACS_HLINE);
else
(void)mvwaddch(satwin, MAXSATS + 2, 18, ACS_DARROW);
}
if (strcmp(fields[0], "GPRMC") == 0
|| strcmp(fields[0], "GNRMC") == 0
|| strcmp(fields[0], "GLRMC") == 0) {
/* time, lat, lon, course, speed */
(void)mvwaddstr(gprmcwin, 1, 12, fields[1]);
(void)mvwprintw(gprmcwin, 2, 12, "%12s %s", fields[3], fields[4]);
(void)mvwprintw(gprmcwin, 3, 12, "%12s %s", fields[5], fields[6]);
(void)mvwaddstr(gprmcwin, 4, 12, fields[7]);
(void)mvwaddstr(gprmcwin, 5, 12, fields[8]);
/* the status field, FAA code, and magnetic variation */
(void)mvwaddstr(gprmcwin, 6, 12, fields[2]);
(void)mvwaddstr(gprmcwin, 6, 25, fields[12]);
(void)mvwprintw(gprmcwin, 7, 12, "%-5s%s", fields[10],
fields[11]);
cooked_pvt(); /* cooked version of TPV */
}
if (strcmp(fields[0], "GPGSA") == 0
|| strcmp(fields[0], "GNGSA") == 0
|| strcmp(fields[0], "GLGSA") == 0) {
(void)mvwprintw(gpgsawin, MODE_LINE, 7, "%1s%s", fields[1], fields[2]);
monitor_satlist(gpgsawin, SATS_LINE, SATS_COL+6);
(void)mvwprintw(gpgsawin, DOP_LINE, 8, "%-5s", fields[16]);
(void)mvwprintw(gpgsawin, DOP_LINE, 16, "%-5s", fields[17]);
(void)mvwprintw(gpgsawin, DOP_LINE, 24, "%-5s", fields[15]);
monitor_fixframe(gpgsawin);
}
#ifdef NTP_ENABLE
toff_update(gpgsawin, TOFF_LINE, 7);
#endif /* NTP_ENABLE */
if (strcmp(fields[0], "GPGGA") == 0
|| strcmp(fields[0], "GNGGA") == 0
|| strcmp(fields[0], "GLGGA") == 0) {
(void)mvwprintw(gpggawin, 1, 12, "%-17s", fields[1]);
(void)mvwprintw(gpggawin, 2, 12, "%-17s", fields[2]);
(void)mvwprintw(gpggawin, 3, 12, "%-17s", fields[4]);
(void)mvwprintw(gpggawin, 4, 12, "%-17s", fields[9]);
(void)mvwprintw(gpggawin, 5, 12, "%1.1s", fields[6]);
(void)mvwprintw(gpggawin, 5, 22, "%2.2s", fields[7]);
(void)mvwprintw(gpggawin, 6, 12, "%-5.5s", fields[8]);
(void)mvwprintw(gpggawin, 7, 12, "%-5.5s", fields[11]);
}
if (strcmp(fields[0], "GPGST") == 0) {
(void)mvwprintw(gpgstwin, 1, 6, "%-10s", fields[1]);
(void)mvwprintw(gpgstwin, 1, 21, "%-8s", fields[2]);
(void)mvwprintw(gpgstwin, 2, 6, "%-10s", fields[3]);
(void)mvwprintw(gpgstwin, 2, 21, "%-8s", fields[4]);
(void)mvwprintw(gpgstwin, 3, 6, "%-10s", fields[5]);
(void)mvwprintw(gpgstwin, 3, 21, "%-8s", fields[6]);
(void)mvwprintw(gpgstwin, 4, 6, "%-10s", fields[7]);
(void)mvwprintw(gpgstwin, 4, 21, "%-8s", fields[8]);
}
}
#ifdef PPS_ENABLE
pps_update(gpgsawin, PPS_LINE, 6);
#endif /* PPS_ENABLE */
}
static void sirf_update(void)
{
int i, j, ch, sv;
unsigned char *buf;
size_t len;
uint8_t dgps;
char tbuf[JSON_DATE_MAX+1];
buf = session.lexer.outbuffer + 4;
len = session.lexer.outbuflen - 8;
switch (buf[0]) {
case 0x02: /* Measured Navigation Data */
(void)wmove(mid2win, 1, 6); /* ECEF position */
(void)wprintw(mid2win, "%8d %8d %8d", getbes32(buf, 1),
getbes32(buf, 5), getbes32(buf, 9));
(void)wmove(mid2win, 2, 6); /* ECEF velocity */
(void)wprintw(mid2win, "%8.1f %8.1f %8.1f",
(double)getbes16(buf, 13) / 8, (double)getbes16(buf,
15) / 8,
(double)getbes16(buf, 17) / 8);
decode_ecef((double)getbes32(buf, 1), (double)getbes32(buf, 5),
(double)getbes32(buf, 9), (double)getbes16(buf, 13) / 8,
(double)getbes16(buf, 15) / 8, (double)getbes16(buf,
17) / 8);
/* line 3 */
(void)wmove(mid2win, 3, 7);
(void)wprintw(mid2win, "%-24s",
unix_to_iso8601(session.gpsdata.fix.time, tbuf, sizeof(tbuf))
);
(void)wmove(mid2win, 3, 38);
(void)wattrset(mid2win, A_UNDERLINE);
if (ppstime_enabled)
(void)wprintw(mid2win, "%02d", leapseconds);
else
(void)wprintw(mid2win, "??");
(void)wattrset(mid2win, A_NORMAL);
/* line 4 */
/* HDOP */
(void)wmove(mid2win, 4, 59);
(void)wprintw(mid2win, "%4.1f", (double)getub(buf, 20) / 5);
/* Mode 1 */
(void)wmove(mid2win, 4, 69);
(void)wprintw(mid2win, "%02x", getub(buf, 19));
/* Mode 2 */
(void)wmove(mid2win, 4, 77);
(void)wprintw(mid2win, "%02x", getub(buf, 21));
/* SVs in fix */
(void)wmove(mid2win, 4, 6);
(void)wprintw(mid2win, "%2d = ",
(int)getub(buf, 28));
/* SV list */
(void)wmove(mid2win, 4, 10);
/* coverity_submit[tainted_data] */
for (i = 0; i < (int)getub(buf, 28); i++)
(void)wprintw(mid2win, " %2d", (int)getub(buf, 29 + i));
monitor_log("MND 0x02=");
break;
case 0x04: /* Measured Tracking Data */
ch = (int)getub(buf, 7);
for (i = 0; i < ch; i++) {
int az, el, state, off;
double cn;
off = 8 + 15 * i;
(void)wmove(mid4win, i + 2, 3);
sv = (int)getub(buf, off);
az = (int)getub(buf, off + 1) * 3 / 2;
el = (int)getub(buf, off + 2) / 2;
state = (int)getbeu16(buf, off + 3);
cn = 0;
for (j = 0; j < 10; j++)
cn += (int)getub(buf, off + 5 + j);
cn /= 10;
(void)wprintw(mid4win, " %3d %3d %2d %04x %4.1f %c",
sv, az, el, state, cn, state == 0xbf ? 'T' : ' ');
}
monitor_log("MTD 0x04=");
break;
#ifdef __UNUSED__
case 0x05: /* raw track data */
for (off = 1; off < len; off += 51) {
ch = getbeu32(buf, off);
(void)wmove(mid4win, ch + 2, 19);
cn = 0;
for (j = 0; j < 10; j++)
cn += getub(buf, off + 34 + j);
printw("%5.1f", (double)cn / 10);
printw("%9d%3d%5d", getbeu32(buf, off + 8),
(int)getbeu16(buf, off + 12), (int)getbeu16(buf, off + 14));
printw("%8.5f %10.5f", (double)getbeu32(buf, off + 16) / 65536,
(double)getbeu32(buf, off + 20) / 1024);
}
monitor_log("RTD 0x05=");
break;
#endif /* __UNUSED */
case 0x06: /* firmware version */
display(mid6win, 1, 1, "%s", buf + 1);
monitor_log("FV 0x06=");
break;
case 0x07: /* Response - Clock Status Data */
display(mid7win, 1, 5, "%2d", getub(buf, 7)); /* SVs */
display(mid7win, 1, 16, "%lu", getbeu32(buf, 8)); /* Clock ppstimes */
display(mid7win, 1, 29, "%lu", getbeu32(buf, 12)); /* Clock Bias */
display(mid7win, 2, 11, "%lu", getbeu32(buf, 16)); /* Estimated Time */
monitor_log("CSD 0x07=");
break;
case 0x08: /* 50 BPS data */
ch = (int)getub(buf, 1);
sv = (int)getub(buf, 2);
display(mid4win, ch + 2, 27, "%2d", sv);
subframe_enabled = true;
monitor_log("50B 0x08=");
break;
case 0x09: /* Throughput */
display(mid9win, 1, 6, "%.3f", (double)getbeu16(buf, 1) / 186); /*SegStatMax */
display(mid9win, 1, 18, "%.3f", (double)getbeu16(buf, 3) / 186); /*SegStatLat */
display(mid9win, 1, 31, "%.3f", (double)getbeu16(buf, 5) / 186); /*SegStatTime */
display(mid9win, 1, 42, "%3d", (int)getbeu16(buf, 7)); /* Last Millisecond */
monitor_log("THR 0x09=");
break;
case 0x0b: /* Command Acknowledgement */
monitor_log("ACK 0x0b=");
break;
case 0x0c: /* Command NAcknowledgement */
monitor_log("NAK 0x0c=");
break;
case 0x0d: /* Visible List */
display(mid13win, 1, 1, "%02d = ",
getub(buf, 1));
(void)wmove(mid13win, 1, 5);
for (i = 0; i < (int)getub(buf, 1); i++)
(void)wprintw(mid13win, " %d", getub(buf, 2 + 5 * i));
monitor_log("VL 0x0d=");
break;
case 0x13:
#define YESNO(n) (((int)getub(buf, n) != 0)?'Y':'N')
display(mid19win, 1, 20, "%d", getub(buf, 5)); /* Alt. hold mode */
display(mid19win, 2, 20, "%d", getub(buf, 6)); /* Alt. hold source */
display(mid19win, 3, 20, "%dm", (int)getbeu16(buf, 7)); /* Alt. source input */
if (getub(buf, 9) != (uint8_t) '\0')
display(mid19win, 4, 20, "%dsec", getub(buf, 10)); /* Degraded timeout */
else
display(mid19win, 4, 20, "N/A ");
display(mid19win, 5, 20, "%dsec", getub(buf, 11)); /* DR timeout */
display(mid19win, 6, 20, "%c", YESNO(12)); /* Track smooth mode */
display(mid19win, 7, 20, "%c", YESNO(13)); /* Static Nav. */
display(mid19win, 8, 20, "0x%x", getub(buf, 14)); /* 3SV Least Squares */
display(mid19win, 9, 20, "0x%x", getub(buf, 19)); /* DOP Mask mode */
display(mid19win, 10, 20, "0x%x", (int)getbeu16(buf, 20)); /* Nav. Elev. mask */
display(mid19win, 11, 20, "0x%x", getub(buf, 22)); /* Nav. Power mask */
display(mid19win, 12, 20, "0x%x", getub(buf, 27)); /* DGPS Source */
display(mid19win, 13, 20, "0x%x", getub(buf, 28)); /* DGPS Mode */
display(mid19win, 14, 20, "%dsec", getub(buf, 29)); /* DGPS Timeout */
display(mid19win, 1, 42, "%c", YESNO(34)); /* LP Push-to-Fix */
display(mid19win, 2, 42, "%dms", getbeu32(buf, 35)); /* LP On Time */
display(mid19win, 3, 42, "%d", getbeu32(buf, 39)); /* LP Interval */
display(mid19win, 4, 42, "%c", YESNO(43)); /* User Tasks enabled */
display(mid19win, 5, 42, "%d", getbeu32(buf, 44)); /* User Task Interval */
display(mid19win, 6, 42, "%c", YESNO(48)); /* LP Power Cycling Enabled */
display(mid19win, 7, 42, "%d", getbeu32(buf, 49)); /* LP Max Acq Search Time */
display(mid19win, 8, 42, "%d", getbeu32(buf, 53)); /* LP Max Off Time */
display(mid19win, 9, 42, "%c", YESNO(57)); /* APM Enabled */
display(mid19win, 10, 42, "%d", (int)getbeu16(buf, 58)); /* # of fixes */
display(mid19win, 11, 42, "%d", (int)getbeu16(buf, 60)); /* Time Between fixes */
display(mid19win, 12, 42, "%d", getub(buf, 62)); /* H/V Error Max */
display(mid19win, 13, 42, "%d", getub(buf, 63)); /* Response Time Max */
display(mid19win, 14, 42, "%d", getub(buf, 64)); /* Time/Accu & Duty Cycle Priority */
#undef YESNO
monitor_log("NP 0x13=");
break;
case 0x1b:
/******************************************************************
Not actually documented in any published materials before the
1.6 version of the SiRF binary protocol manual.
Here is what Chris Kuethe got from the SiRF folks,
(plus some corrections from the GpsPaSsion forums):
Start of message
----------------
Message ID 1 byte 27
Correction Source 1 byte 0=None, 1=SBAS, 2=Serial, 3=Beacon,
4=Software
total: 2 bytes
Middle part of message varies if using beacon or other:
-------------------------------------------------------
If Beacon:
Receiver Freq Hz 4 bytes
Bit rate BPS 1 byte
Status bit map 1 byte 01=Signal Valid,
02=Auto frequency detect
04=Auto bit rate detect
Signal Magnitude 4 bytes Note: in internal units
Signal Strength dB 2 bytes derived from Signal Magnitude
SNR dB 2 bytes
total: 14 bytes
If Not Beacon:
Correction Age[12] 1 byte x 12 Age in seconds in same order as follows
Reserved 2 bytes
total: 14 bytes
End of Message
--------------
Repeated 12 times (pad with 0 if less than 12 SV corrections):
SVID 1 byte
Correction (cm) 2 bytes (signed short)
total 3 x 12 = 36 bytes
******************************************************************/
dgps = getub(buf, 1);
display(mid27win, 1, 1, "%8s = ",
(CHECK_RANGE(dgpsvec, dgps) ? dgpsvec[dgps] : "???"));
(void)wmove(mid27win, 1, 11);
for (ch = 0; ch < SIRF_CHANNELS; ch++)
if (getub(buf, 16 + 3 * ch) != '\0')
(void)wprintw(mid27win, " %d", getub(buf, 16 + 3 * ch));
monitor_log("DST 0x1b=");
break;
case 0x1c: /* NL Measurement Data */
case 0x1d: /* NL DGPS Data */
case 0x1e: /* NL SV State Data */
case 0x1f: /* NL Initialized Data */
subframe_enabled = true;
monitor_log("NL 0x%02x=", buf[0]);
break;
case 0x29: /* Geodetic Navigation Data */
monitor_log("GND 0x29=");
break;
case 0x32: /* SBAS Parameters */
monitor_log("SBP 0x32=");
break;
case 0x34: /* PPS Time */
ppstime_enabled = true;
leapseconds = (int)getbeu16(buf, 8);
monitor_log("PPS 0x34=");
break;
case 0xff: /* Development Data */
while (len > 0 && buf[len - 1] == '\n')
len--;
while (len > 0 && buf[len - 1] == ' ')
len--;
buf[len] = '\0';
j = 1;
for (i = 0; verbpat[i] != NULL; i++)
if (str_starts_with((char *)(buf + 1), verbpat[i])) {
j = 0;
break;
}
if (j != 0)
monitor_log("%s\n", buf + 1);
monitor_log("DD 0xff=");
break;
default:
monitor_log("UNK 0x%02x=", buf[0]);
break;
}
#ifdef CONTROLSEND_ENABLE
/* elicit navigation parameters */
if (dispmode && (time(NULL) % 10 == 0)) {
(void)monitor_control_send((unsigned char *)"\x98\x00", 2);
}
#endif /* CONTROLSEND_ENABLE */
/* clear the 50bps data field every 6 seconds */
if (subframe_enabled && (time(NULL) % 6 == 0)) {
for (ch = 0; ch < SIRF_CHANNELS; ch++)
display(mid4win, ch + 2, 27, " ");
}
if (dispmode) {
(void)touchwin(mid19win);
(void)wnoutrefresh(mid19win);
}
#ifdef PPS_ENABLE
pps_update(mid7win, 2, 32);
#endif /* PPS_ENABLE */
}
