1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195 |
- /*
- * Copyright 2005 Jeff Francis <jeff@gritch.org>
- *
- * This file is Copyright 2005 by the GPSD project
- * SPDX-License-Identifier: BSD-2-clause
- */
- /*
- Jeff Francis
- jeff@gritch.org
- Kind of a curses version of xgps for use with gpsd.
- */
- /*
- * The True North compass fails with current gpsd versions for reasons
- * the dev team has been unable to diagnose due to not having test hardware.
- * The support for it is conditioned out in order to simplify moving
- * to the new JSON-based protocol and reduce startup time.
- */
- #undef TRUENORTH
- /* ==================================================================
- These #defines should be modified if changing the number of fields
- to be displayed.
- ================================================================== */
- /* This defines how much overhead is contained in the 'datawin' window
- (eg, box around the window takes two lines). */
- #define DATAWIN_OVERHEAD 2
- /* This defines how much overhead is contained in the 'satellites'
- window (eg, box around the window takes two lines, plus the column
- headers take another line). */
- #define SATWIN_OVERHEAD 2
- /* This is how many display fields are output in the 'datawin' window
- when in GPS mode. Change this value if you add or remove fields
- from the 'datawin' window for the GPS mode. */
- #define DATAWIN_GPS_FIELDS 8
- /* Count of optional fields that we'll display if we have the room. */
- #define DATAWIN_OPTIONAL_FIELDS 7
- /* This is how many display fields are output in the 'datawin' window
- when in COMPASS mode. Change this value if you add or remove fields
- from the 'datawin' window for the COMPASS mode. */
- #define DATAWIN_COMPASS_FIELDS 6
- /* This is how far over in the 'datawin' window to indent the field
- descriptions. */
- #define DATAWIN_DESC_OFFSET 2
- /* This is how far over in the 'datawin' window to indent the field
- values. */
- #define DATAWIN_VALUE_OFFSET 17
- /* This is the width of the 'datawin' window. It's recommended to
- keep DATAWIN_WIDTH + SATELLITES_WIDTH <= 80 so it'll fit on a
- "standard" 80x24 screen. */
- #define DATAWIN_WIDTH 45
- /* This is the width of the 'satellites' window. It's recommended to
- keep DATAWIN_WIDTH + SATELLITES_WIDTH <= 80 so it'll fit on a
- "standard" 80x24 screen. */
- #define SATELLITES_WIDTH 35
- /* ================================================================
- You shouldn't have to modify any #define values below this line.
- ================================================================ */
- /* This is the minimum ysize we'll accept for the 'datawin' window in
- GPS mode. */
- #define MIN_GPS_DATAWIN_YSIZE (DATAWIN_GPS_FIELDS + DATAWIN_OVERHEAD)
- /* And the maximum ysize we'll try to use */
- #define MAX_GPS_DATAWIN_YSIZE (DATAWIN_GPS_FIELDS + DATAWIN_OPTIONAL_FIELDS + \
- DATAWIN_OVERHEAD)
- /* This is the minimum ysize we'll accept for the 'datawin' window in
- COMPASS mode. */
- #define MIN_COMPASS_DATAWIN_YSIZE (DATAWIN_COMPASS_FIELDS + DATAWIN_OVERHEAD)
- /* This is the maximum number of satellites gpsd can track. */
- #define MAX_POSSIBLE_SATS (MAXCHANNELS - 2)
- /* This is the maximum ysize we need for the 'satellites' window. */
- #define MAX_SATWIN_SIZE (MAX_POSSIBLE_SATS + SATWIN_OVERHEAD)
- /* Minimum xsize to display 3rd window with DOPs, etc. */
- #define MIN_ERRWIN_SIZE 100
- #include "gpsd_config.h" /* must be before all includes */
- #include <ctype.h>
- #include <curses.h>
- #include <errno.h>
- #include <math.h>
- #include <signal.h>
- #include <stdbool.h>
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <time.h>
- #include <unistd.h>
- #include "gps.h"
- #include "gps_json.h" /* for GPS_JSON_RESPONSE_MAX */
- #include "compiler.h" /* for UNUSED */
- #include "gpsdclient.h"
- #include "os_compat.h"
- #include "timespec.h"
- static struct gps_data_t gpsdata;
- static time_t status_timer; /* Time of last state change. */
- static int state = 0; /* or MODE_NO_FIX=1, MODE_2D=2, MODE_3D=3 */
- static float altfactor = METERS_TO_FEET;
- static float speedfactor = MPS_TO_MPH;
- static char *altunits = "ft";
- static char *speedunits = "mph";
- static struct fixsource_t source;
- static int debug;
- static WINDOW *datawin, *satellites, *messages;
- static bool raw_flag = false;
- static bool show_ecefs = false; /* taller screen, show ECEFs */
- static bool show_more_dops = false; /* tall screen, show more DOPs */
- static bool silent_flag = false;
- static bool magnetic_flag = false;
- static int window_ysize = 0;
- static int display_sats = 0; /* number of rows of sats to display */
- #ifdef TRUENORTH
- static bool compass_flag = false;
- #endif /* TRUENORTH */
- /* pseudo-signals indicating reason for termination */
- #define CGPS_QUIT 0 /* voluntary termination */
- #define GPS_GONE -1 /* GPS device went away */
- #define GPS_ERROR -2 /* low-level failure in GPS read */
- #define GPS_TIMEOUT -3 /* low-level failure in GPS waiting */
- /* range test an int, return 4 chars + NUL */
- static const char *int_to_str(int val, int min, int max)
- {
- static char buf[20];
- if (val < min || val > max) {
- return " n/a";
- }
- (void)snprintf(buf, sizeof(buf), "%4d", val);
- return buf;
- }
- /* range test an double, to tenths, return 5 chars + NUL */
- static const char *tenth_to_str(double val, double min, double max)
- {
- static char buf[20];
- if (0 == isfinite(val) ||
- val < min ||
- val > max) {
- return " n/a";
- }
- (void)snprintf(buf, sizeof(buf), "%5.1f", val);
- return buf;
- }
- /* format a DOP into a 5 char string, handle NAN, INFINITE */
- static char *dop_to_str(double dop)
- {
- static char buf[20];
- if (isfinite(dop) == 0) {
- return " n/a ";
- }
- (void)snprintf(buf, sizeof(buf), "%5.2f", dop);
- return buf;
- }
- /* format an EP into a string, handle NAN, INFINITE */
- static char *ep_to_str(double ep, double factor, char *units)
- {
- static char buf[20];
- double val;
- if (isfinite(ep) == 0) {
- return " n/a ";
- }
- /* somehow these go negative now and then... */
- val = fabs(ep * factor);
- if ( 100 <= val ) {
- (void)snprintf(buf, sizeof(buf), "+/-%5d %.3s", (int)val, units);
- } else {
- (void)snprintf(buf, sizeof(buf), "+/-%5.1f %.3s", val, units);
- }
- return buf;
- }
- /* format an ECEF p and v into a string, handle NAN, INFINITE */
- static char *ecef_to_str(double pos, double vel, double factor, char *units)
- {
- static char buf[128];
- if (isfinite(pos) == 0) {
- if (isfinite(vel) == 0) {
- return " n/a n/a ";
- } else {
- (void)snprintf(buf, sizeof(buf), " n/a %8.3f%.4s/s",
- vel * factor, units);
- }
- } else {
- (void)snprintf(buf, sizeof(buf), "% 14.3f%.4s %8.3f%.4s/s",
- pos * factor, units, vel * factor, units);
- }
- return buf;
- }
- /* Function to call when we're all done. Does a bit of clean-up. */
- static void die(int sig)
- {
- if (!isendwin())
- {
- /* Move the cursor to the bottom left corner. */
- (void)mvcur(0, COLS - 1, LINES - 1, 0);
- /* Put input attributes back the way they were. */
- (void)echo();
- /* Done with curses. */
- (void)endwin();
- }
- /* We're done talking to gpsd. */
- (void)gps_close(&gpsdata);
- switch (sig) {
- case CGPS_QUIT:
- break;
- case GPS_GONE:
- (void)fprintf(stderr, "cgps: GPS hung up.\n");
- break;
- case GPS_ERROR:
- (void)fprintf(stderr, "cgps: GPS read returned error\n");
- break;
- case GPS_TIMEOUT:
- (void)fprintf(stderr, "cgps: GPS timeout\n");
- break;
- default:
- (void)fprintf(stderr, "cgps: caught signal %d\n", sig);
- break;
- }
- /* Bye! */
- exit(EXIT_SUCCESS);
- }
- static enum deg_str_type deg_type = deg_dd;
- /* initialize curses and set up screen windows */
- static void windowsetup(void)
- {
- /* Set the window sizes per the following criteria:
- *
- * 1. Set the window size to display the maximum number of
- * satellites possible, but not more than can be fit in a
- * window the size of the GPS report window. We have to set
- * the limit that way because MAXCHANNELS has been made large
- * in order to prepare for survey-grade receivers..
- *
- * 2. If the screen size will not allow for the full complement of
- * satellites to be displayed, set the windows sizes smaller, but
- * not smaller than the number of lines necessary to display all of
- * the fields in the 'datawin'. The list of displayed satellites
- * will be truncated to fit the available window size. (TODO: If
- * the satellite list is truncated, omit the satellites not used to
- * obtain the current fix.)
- *
- * 3. If the screen is tall enough to display all possible
- * satellites (MAXCHANNELS - 2) with space still left at the bottom,
- * add a window at the bottom in which to scroll raw gpsd data.
- *
- * 4. If the screen is tall enough to display extra data, expand
- * data window down to show DOPs, ECEFs, etc.
- */
- int xsize, ysize;
- /* Fire up curses. */
- (void)initscr();
- (void)noecho();
- getmaxyx(stdscr, ysize, xsize);
- /* turn off cursor */
- curs_set(0);
- #ifdef TRUENORTH
- if (compass_flag) {
- if (ysize == MIN_COMPASS_DATAWIN_YSIZE) {
- raw_flag = false;
- window_ysize = MIN_COMPASS_DATAWIN_YSIZE;
- } else if (ysize > MIN_COMPASS_DATAWIN_YSIZE) {
- raw_flag = true;
- window_ysize = MIN_COMPASS_DATAWIN_YSIZE;
- } else {
- (void)mvprintw(0, 0,
- "Your screen must be at least 80x%d to run cgps.",
- MIN_COMPASS_DATAWIN_YSIZE);
- (void)refresh();
- (void)sleep(5);
- die(0);
- }
- } else
- #endif /* TRUENORTH */
- {
- if (ysize > MAX_GPS_DATAWIN_YSIZE + 10) {
- raw_flag = true;
- show_ecefs = true;
- show_more_dops = true;
- window_ysize = MAX_GPS_DATAWIN_YSIZE + 7;
- } else if (ysize > MAX_GPS_DATAWIN_YSIZE + 6) {
- raw_flag = true;
- show_ecefs = false;
- show_more_dops = true;
- window_ysize = MAX_GPS_DATAWIN_YSIZE + 4;
- } else if (ysize > MAX_GPS_DATAWIN_YSIZE) {
- raw_flag = true;
- show_ecefs = false;
- show_more_dops = false;
- window_ysize = MAX_GPS_DATAWIN_YSIZE;
- } else if (ysize == MAX_GPS_DATAWIN_YSIZE) {
- raw_flag = false;
- show_ecefs = false;
- show_more_dops = false;
- window_ysize = MAX_GPS_DATAWIN_YSIZE;
- } else if (ysize > MIN_GPS_DATAWIN_YSIZE) {
- raw_flag = true;
- show_ecefs = false;
- show_more_dops = false;
- window_ysize = MIN_GPS_DATAWIN_YSIZE;
- } else if (ysize == MIN_GPS_DATAWIN_YSIZE) {
- raw_flag = false;
- show_ecefs = false;
- show_more_dops = false;
- window_ysize = MIN_GPS_DATAWIN_YSIZE;
- } else {
- (void)mvprintw(0, 0,
- "Your screen must be at least 80x%d to run cgps.",
- MIN_GPS_DATAWIN_YSIZE);
- (void)refresh();
- (void)sleep(5);
- die(0);
- }
- display_sats = window_ysize - SATWIN_OVERHEAD - (int)raw_flag;
- }
- #ifdef TRUENORTH
- /* Set up the screen for either a compass or a gps receiver. */
- if (compass_flag) {
- /* We're a compass, set up accordingly. */
- int row = 1;
- datawin = newwin(window_ysize, DATAWIN_WIDTH, 0, 0);
- (void)nodelay(datawin, (bool) TRUE);
- if (raw_flag) {
- messages = newwin(0, 0, window_ysize, 0);
- (void)scrollok(messages, true);
- (void)wsetscrreg(messages, 0, ysize - (window_ysize));
- }
- (void)refresh();
- /* Do the initial field label setup. */
- (void)mvwprintw(datawin, row++, DATAWIN_DESC_OFFSET, "Time:");
- /* FIXME: prolly should be heading... */
- (void)mvwprintw(datawin, row++, DATAWIN_DESC_OFFSET, "Track:");
- (void)mvwprintw(datawin, row++, DATAWIN_DESC_OFFSET, "Pitch:");
- (void)mvwprintw(datawin, row++, DATAWIN_DESC_OFFSET, "Roll:");
- (void)mvwprintw(datawin, row++, DATAWIN_DESC_OFFSET, "Dip:");
- (void)mvwprintw(datawin, row++, DATAWIN_DESC_OFFSET, "Rcvr Type:");
- (void)wborder(datawin, 0, 0, 0, 0, 0, 0, 0, 0);
- } else
- #endif /* TRUENORTH */
- {
- /* We're a GPS, set up accordingly. */
- int row = 1;
- datawin = newwin(window_ysize, DATAWIN_WIDTH, 0, 0);
- satellites =
- newwin(window_ysize, SATELLITES_WIDTH, 0, DATAWIN_WIDTH);
- (void)nodelay(datawin, (bool) TRUE);
- if (raw_flag) {
- messages =
- newwin(ysize - (window_ysize), xsize, window_ysize, 0);
- (void)scrollok(messages, true);
- (void)wsetscrreg(messages, 0, ysize - (window_ysize));
- }
- (void)refresh();
- /* Do the initial field label setup. */
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Time:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Latitude:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Longitude:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Alt (HAE, MSL):");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Speed:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Track ");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Climb:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET, "Status:");
- /* Note that the following fields are exceptions to the
- * sizing rule. The minimum window size does not include these
- * fields, if the window is too small, they get excluded. This
- * may or may not change if/when the output for these fields is
- * fixed and/or people request their permanance. They're only
- * there in the first place because I arbitrarily thought they
- * sounded interesting. ;^) */
- if (window_ysize >= MAX_GPS_DATAWIN_YSIZE) {
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Long Err (XDOP, EPX):");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Lat Err (YDOP, EPY):");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Alt Err (VDOP, EPV):");
- if (show_more_dops) {
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "2D Err (HDOP, CEP):");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "3D Err (PDOP, SEP):");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Time Err (TDOP):");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Geo Err (GDOP):");
- }
- if (show_ecefs) {
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "ECEF X, VX:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "ECEF Y, VY:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "ECEF Z, VZ:");
- }
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Speed Err (EPS):");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Track Err (EPD):");
- /* it's actually esr that thought *these* were interesting */
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Time offset:");
- (void)mvwaddstr(datawin, row++, DATAWIN_DESC_OFFSET,
- "Grid Square:");
- }
- (void)wborder(datawin, 0, 0, 0, 0, 0, 0, 0, 0);
- /* PRN is not unique for all GNSS systems.
- * Each GNSS (GPS, GALILEO, BeiDou, etc.) numbers their PRN from 1.
- * What we really have here is USI, Universal Sat ID
- * The USI for each GNSS satellite is unique, starting at 1.
- * Not all GPS receivers compute the USI the same way. YMMV
- *
- * Javad (GREIS) GPS receivers compute USI this way:
- * GPS is USI 1-37, GLONASS 38-70, GALILEO 71-119, SBAS 120-142,
- * QZSS 193-197, BeiDou 211-247
- *
- * Geostar GPS receivers compute USI this way:
- * GPS is USI 1 to 32, SBAS is 33 to 64, GLONASS is 65 to 96 */
- (void)mvwaddstr(satellites, 1, 1,
- " PRN Elev Azim SNR Use ");
- (void)wborder(satellites, 0, 0, 0, 0, 0, 0, 0, 0);
- }
- }
- static void resize(int sig UNUSED)
- /* cope with terminal resize */
- {
- if (!isendwin())
- {
- (void)endwin();
- windowsetup();
- }
- }
- #ifdef TRUENORTH
- /* This gets called once for each new compass sentence. */
- static void update_compass_panel(struct gps_data_t *gpsdata)
- {
- char scr[128];
- int row = 1;
- /* Print time/date. */
- if (0 < gpsdata->fix.time.tv_sec) {
- (void)timespec_to_iso8601(gpsdata->fix.time, scr, sizeof(scr));
- } else
- (void)strlcpy(scr, "n/a", sizeof(scr));
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* Fill in the track. */
- /* FIXME: prolly should be heading... */
- if (isfinite(gpsdata->fix.track) != 0) {
- (void)snprintf(scr, sizeof(scr), "%.1f degrees", gpsdata->fix.track);
- } else
- (void)strlcpy(scr, "n/a", sizeof(scr));
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* Fill in the climb. */
- if (isfinite(gpsdata->fix.climb) != 0) {
- (void)snprintf(scr, sizeof(scr), "%.2f", gpsdata->fix.climb);
- } else
- (void)strlcpy(scr, "n/a", sizeof(scr));
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* Fill in the speed. */
- if (isfinite(gpsdata->fix.speed) != 0)
- (void)snprintf(scr, sizeof(scr), "%.2f", gpsdata->fix.speed);
- else
- (void)strlcpy(scr, "n/a", sizeof(scr));
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* Fill in the altitude. */
- if (isfinite(gpsdata->fix.altHAE) != 0)
- (void)snprintf(scr, sizeof(scr), "%.3f", gpsdata->fix.altHAE);
- else
- (void)strlcpy(scr, "n/a", sizeof(scr));
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* When we need to fill in receiver type again, do it here. */
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- (void)wrefresh(datawin);
- if (raw_flag && !silent_flag) {
- /* Be quiet if the user requests silence. */
- (void)waddstr(messages, message);
- (void)wrefresh(messages);
- }
- }
- #endif /* TRUENORTH */
- /* sort the skyviews
- * Used = Y first, then used = N
- * then sort by PRN
- */
- static int sat_cmp(const void *p1, const void *p2)
- {
- if ( ((struct satellite_t*)p2)->used - ((struct satellite_t*)p1)->used ) {
- return ((struct satellite_t*)p2)->used -
- ((struct satellite_t*)p1)->used;
- }
- return ((struct satellite_t*)p1)->PRN - ((struct satellite_t*)p2)->PRN;
- }
- /* This gets called once for each new GPS sentence. */
- static void update_gps_panel(struct gps_data_t *gpsdata, char *message)
- {
- int newstate;
- char scr[80];
- char buf1[20], buf2[20];
- /* This is for the satellite status display. Originally lifted from
- * xgps.c. Note that the satellite list may be truncated based on
- * available screen size, or may only show satellites used for the
- * fix. */
- (void)mvwprintw(satellites, 0, 19, "Seen %2d/Used %2d",
- gpsdata->satellites_visible,
- gpsdata->satellites_used);
- if (0 != (VERSION_SET &gpsdata->set)) {
- /* got version, check it */
- /* FIXME: expected API version not available ? */
- if (0 != strcmp(gpsdata->version.release, VERSION)) {
- (void)fprintf(stderr, "cgps: WARNING gpsd release %s, API: %d.%d, "
- "expected %s ",
- gpsdata->version.release,
- gpsdata->version.proto_major,
- gpsdata->version.proto_minor,
- VERSION);
- sleep(2);
- }
- }
- if (gpsdata->satellites_visible != 0) {
- int sat_no;
- int loop_end = (display_sats < gpsdata->satellites_visible) ? \
- display_sats : gpsdata->satellites_visible;
- qsort( gpsdata->skyview, gpsdata->satellites_visible,
- sizeof( struct satellite_t), sat_cmp);
- /* displayed all sats that fit, maybe all of them */
- for (sat_no = 0; sat_no < loop_end; sat_no++) {
- int column = 1; /* column to write to */
- char *gnssid;
- char sigid[2] = " ";
- char health = ' ';
- if ( 0 == gpsdata->skyview[sat_no].svid) {
- gnssid = " ";
- } else {
- switch (gpsdata->skyview[sat_no].gnssid) {
- default:
- gnssid = " ";
- break;
- case GNSSID_GPS:
- gnssid = "GP"; /* GPS */
- break;
- case GNSSID_SBAS:
- gnssid = "SB"; /* SBAS */
- break;
- case GNSSID_GAL:
- gnssid = "GA"; /* GALILEO */
- break;
- case GNSSID_BD:
- gnssid = "BD"; /* BeiDou */
- break;
- case GNSSID_IMES:
- gnssid = "IM"; /* IMES */
- break;
- case GNSSID_QZSS:
- gnssid = "QZ"; /* QZSS */
- break;
- case GNSSID_GLO:
- gnssid = "GL"; /* GLONASS */
- break;
- case GNSSID_IRNSS:
- gnssid = "IR"; // IRNSS
- break;
- }
- if (1 < gpsdata->skyview[sat_no].sigid &&
- 8 > gpsdata->skyview[sat_no].sigid) {
- /* Do not display L1, or missing */
- /* max is 8 */
- sigid[0] = '0' + gpsdata->skyview[sat_no].sigid;
- sigid[1] = '\0';
- }
- }
- (void)mvwaddstr(satellites, sat_no + 2, column, gnssid);
- column += 2;
- (void)mvwaddstr(satellites, sat_no + 2, column, sigid);
- /* no GPS uses PRN 0, NMEA 4.0 here
- * NMEA 4.0 uses 1-437 */
- column += 2;
- (void)mvwaddstr(satellites, sat_no + 2, column,
- int_to_str(gpsdata->skyview[sat_no].PRN,
- 1, 438));
- column += 5;
- (void)mvwaddstr(satellites, sat_no + 2, column,
- tenth_to_str(gpsdata->skyview[sat_no].elevation,
- -90.0, 90.0));
- column += 7;
- (void)mvwaddstr(satellites, sat_no + 2, column,
- tenth_to_str(gpsdata->skyview[sat_no].azimuth,
- 0.0, 359.0));
- column += 6;
- (void)mvwaddstr(satellites, sat_no + 2, column,
- tenth_to_str(gpsdata->skyview[sat_no].ss,
- 0.0, 254.0));
- column += 6;
- if (SAT_HEALTH_BAD == gpsdata->skyview[sat_no].health) {
- /* only mark known unhealthy */
- health = 'u';
- }
- (void)mvwprintw(satellites, sat_no + 2, column, " %c%c ",
- health,
- gpsdata->skyview[sat_no].used ? 'Y' : 'N');
- }
- /* Display More... ? */
- if (sat_no < gpsdata->satellites_visible) {
- /* Too many sats to show them all, tell the user. */
- (void)mvwprintw(satellites, sat_no + 2, 1, "%s", "More...");
- } else {
- /* Clear old data from the unused lines at bottom. */
- for ( ; sat_no < display_sats; sat_no++) {
- (void)mvwprintw(satellites, sat_no + 2, 1, "%-*s",
- SATELLITES_WIDTH - 3, "");
- }
- /* remove More... */
- (void)mvwhline(satellites, sat_no + 2, 1, 0, 8);
- }
- } else {
- int sat_no = 0;
- /* no sats, clear screen */
- for ( ; sat_no < display_sats; sat_no++) {
- (void)mvwprintw(satellites, sat_no + 2, 1, "%-*s",
- SATELLITES_WIDTH - 3, "");
- }
- /* remove More... */
- (void)mvwhline(satellites, sat_no + 2, 1, 0, 8);
- }
- /* turn off cursor */
- curs_set(0);
- /* Print time/date. with (leap_second) */
- if (0 < gpsdata->fix.time.tv_sec) {
- (void)timespec_to_iso8601(gpsdata->fix.time, scr, sizeof(scr));
- } else
- (void)strlcpy(scr, " n/a", sizeof(scr));
- (void)snprintf(buf1, sizeof(buf1), " (%u)", gpsdata->leap_seconds);
- (void)strlcat(scr, buf1, sizeof(scr));
- (void)mvwprintw(datawin, 1, DATAWIN_VALUE_OFFSET - 2, "%-*s", 26, scr);
- /* Fill in the latitude. */
- if (gpsdata->fix.mode >= MODE_2D) {
- deg_to_str2(deg_type, gpsdata->fix.latitude,
- scr, sizeof(scr), " N", " S");
- } else
- (void)strlcpy(scr, "n/a", sizeof(scr));
- (void)mvwprintw(datawin, 2, DATAWIN_VALUE_OFFSET, " %-*s", 25, scr);
- /* Fill in the longitude. */
- if (gpsdata->fix.mode >= MODE_2D) {
- deg_to_str2(deg_type, gpsdata->fix.longitude,
- scr, sizeof(scr), " E", " W");
- } else
- (void)strlcpy(scr, "n/a", sizeof(scr));
- (void)mvwprintw(datawin, 3, DATAWIN_VALUE_OFFSET, " %-*s", 25, scr);
- /* Fill in the altitudes. */
- if (gpsdata->fix.mode >= MODE_3D) {
- if (0 != isfinite(gpsdata->fix.altHAE))
- (void)snprintf(buf1, sizeof(buf1), "%11.3f,",
- gpsdata->fix.altHAE * altfactor);
- else
- (void)strlcpy(buf1, " n/a,", sizeof(buf1));
- if (0 != isfinite(gpsdata->fix.altMSL))
- (void)snprintf(buf2, sizeof(buf2), "%11.3f ",
- gpsdata->fix.altMSL * altfactor);
- else
- (void)strlcpy(buf2, " n/a ", sizeof(buf2));
- (void)strlcpy(scr, buf1, sizeof(scr));
- (void)strlcat(scr, buf2, sizeof(scr));
- (void)strlcat(scr, altunits, sizeof(scr));
- } else {
- (void)strlcpy(scr, " n/a, n/a ", sizeof(scr));
- }
- (void)mvwprintw(datawin, 4, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* Fill in the speed. */
- if (isfinite(gpsdata->fix.speed) != 0)
- (void)snprintf(scr, sizeof(scr), "%8.2f %s",
- gpsdata->fix.speed * speedfactor, speedunits);
- else
- (void)strlcpy(scr, " n/a", sizeof(scr));
- (void)mvwprintw(datawin, 5, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* Fill in the track. */
- if (!magnetic_flag) {
- (void)strlcpy(scr, " (true, var): ", sizeof(scr));
- } else {
- (void)strlcpy(scr, " (mag, var): ", sizeof(scr));
- }
- if (gpsdata->fix.mode >= MODE_2D && isfinite(gpsdata->fix.track) != 0) {
- char buf1[20], buf2[20];
- if (!magnetic_flag || isfinite(gpsdata->fix.magnetic_track) == 0) {
- (void)snprintf(buf1, sizeof(buf1), "%5.1f,",
- gpsdata->fix.track);
- } else {
- (void)snprintf(buf1, sizeof(buf1), "%5.1f,",
- gpsdata->fix.magnetic_track);
- }
- (void)strlcat(scr, buf1, sizeof(scr));
- if (0 != isfinite(gpsdata->fix.magnetic_var)) {
- (void)snprintf(buf2, sizeof(buf2), "%6.1f",
- gpsdata->fix.magnetic_var);
- (void)strlcat(scr, buf2, sizeof(scr));
- } else {
- (void)strlcat(scr, " ", sizeof(scr));
- }
- } else
- (void)strlcat(scr, " n/a", sizeof(scr));
- (void)mvwprintw(datawin, 6, DATAWIN_VALUE_OFFSET - 10, "%-*s deg",
- 32, scr);
- /* Fill in the rate of climb. */
- if (isfinite(gpsdata->fix.climb) != 0)
- (void)snprintf(scr, sizeof(scr), "%8.2f %s/min",
- gpsdata->fix.climb * altfactor * 60, altunits);
- else
- (void)strlcpy(scr, " n/a", sizeof(scr));
- (void)mvwprintw(datawin, 7, DATAWIN_VALUE_OFFSET, "%-*s", 27, scr);
- /* Fill in the GPS status and the time since the last state
- * change. */
- if (0 == gpsdata->online.tv_sec &&
- 0 == gpsdata->online.tv_nsec) {
- newstate = 0;
- (void)strlcpy(scr, "OFFLINE", sizeof(scr));
- } else {
- const char *fmt;
- const char *mod = "";
- newstate = gpsdata->fix.mode;
- switch (gpsdata->fix.status) {
- case STATUS_DGPS_FIX:
- mod = "DGPS ";
- break;
- case STATUS_RTK_FIX:
- mod = "RTK ";
- break;
- case STATUS_RTK_FLT:
- mod = "RTK ";
- break;
- case STATUS_DR:
- mod = "DR ";
- break;
- case STATUS_GNSSDR:
- mod = "GNSSDR ";
- break;
- case STATUS_TIME:
- mod = "FIXED ";
- break;
- case STATUS_PPS_FIX:
- mod = "P(Y) ";
- break;
- case STATUS_SIM:
- mod = "SIM ";
- break;
- default:
- /* ignore: */
- mod = "";
- break;
- }
- switch (gpsdata->fix.mode) {
- case MODE_2D:
- fmt = "2D %sFIX (%d secs)";
- break;
- case MODE_3D:
- if (STATUS_TIME == gpsdata->fix.status) {
- fmt = "%sSURVEYED (%d secs)";
- } else {
- fmt = "3D %sFIX (%d secs)";
- }
- break;
- default:
- fmt = "NO %sFIX (%d secs)";
- break;
- }
- (void)snprintf(scr, sizeof(scr), fmt, mod,
- (int)(time(NULL) - status_timer));
- }
- (void)mvwprintw(datawin, 8, DATAWIN_VALUE_OFFSET + 1, "%-*s", 26, scr);
- /* Note that the following fields are exceptions to the
- * sizing rule. The minimum window size does not include these
- * fields, if the window is too small, they get excluded. This
- * may or may not change if/when the output for these fields is
- * fixed and/or people request their permanence. They're only
- * there in the first place because I arbitrarily thought they
- * sounded interesting. ;^) */
- if (window_ysize >= (MIN_GPS_DATAWIN_YSIZE + 5)) {
- int row = 9;
- char *ep_str;
- char *dop_str;
- char *str;
- /* Fill in the estimated latitude position error, XDOP. */
- ep_str = ep_to_str(gpsdata->fix.epx, altfactor, altunits);
- dop_str = dop_to_str(gpsdata->dop.xdop);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8, "%s, %-*s",
- dop_str, 11, ep_str);
- /* Fill in the estimated longitude position error, YDOP. */
- ep_str = ep_to_str(gpsdata->fix.epy, altfactor, altunits);
- dop_str = dop_to_str(gpsdata->dop.ydop);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8, "%s, %-*s",
- dop_str, 11, ep_str);
- /* Fill in the estimated velocity error, VDOP. */
- ep_str = ep_to_str(gpsdata->fix.epv, altfactor, altunits);
- dop_str = dop_to_str(gpsdata->dop.vdop);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8, "%s, %-*s",
- dop_str, 11, ep_str);
- /* extra tall screen, show more DOPs */
- if (show_more_dops) {
- /* Fill in the estimated horizontal (2D) error, HDOP */
- ep_str = ep_to_str(gpsdata->fix.eph, altfactor, altunits);
- dop_str = dop_to_str(gpsdata->dop.hdop);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8,
- "%s, %-*s", dop_str, 11, ep_str);
- /* (spherical) position error, 3D error, PDOP */
- ep_str = ep_to_str(gpsdata->fix.sep, altfactor, altunits);
- dop_str = dop_to_str(gpsdata->dop.pdop);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8,
- "%s, %-*s", dop_str, 11, ep_str);
- /* time dilution of precision, TDOP */
- /* FIXME: time ep? */
- dop_str = dop_to_str(gpsdata->dop.tdop);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8, "%-*s",
- 18, dop_str);
- /* geometric dilution of precision, GDOP */
- /* FIXME: gdop ep? */
- dop_str = dop_to_str(gpsdata->dop.gdop);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8, "%-*s",
- 18, dop_str);
- }
- /* extra large screen, show ECEF */
- if (show_ecefs) {
- char *estr;
- /* Fill in the ECEF's. */
- estr = ecef_to_str(gpsdata->fix.ecef.x, gpsdata->fix.ecef.vx,
- 1, " m");
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET - 3, "%-*s",
- 27, estr);
- estr = ecef_to_str(gpsdata->fix.ecef.y, gpsdata->fix.ecef.vy,
- 1, " m");
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET - 3, "%-*s",
- 27, estr);
- estr = ecef_to_str(gpsdata->fix.ecef.z, gpsdata->fix.ecef.vz,
- 1, " m");
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET - 3, "%-*s",
- 27, estr);
- }
- /* Fill in the estimated speed error, EPS. */
- ep_str = ep_to_str(gpsdata->fix.eps, speedfactor, speedunits);
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8,
- "%-*s ", 14, ep_str);
- /* Fill in the estimated track error, EPD. */
- ep_str = ep_to_str(gpsdata->fix.epd, speedfactor, "deg");
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8, "%-*s ",
- 14, ep_str);
- /* Fill in the time offset, milliseconds. */
- if (0 < gpsdata->fix.time.tv_sec) {
- timespec_t ts_now, ts_diff;
- char ts_str[TIMESPEC_LEN];
- (void)clock_gettime(CLOCK_REALTIME, &ts_now);
- TS_SUB(&ts_diff, &ts_now, &gpsdata->fix.time);
- (void)snprintf(scr, sizeof(scr), "%s sec",
- timespec_str(&ts_diff, ts_str, sizeof(ts_str)));
- } else {
- (void)strlcpy(scr, " n/a", sizeof(scr));
- }
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 8, "%-*s", 18,
- scr);
- /* Fill in the grid square (esr thought *this* one was interesting). */
- if ((isfinite(gpsdata->fix.longitude) != 0 &&
- isfinite(gpsdata->fix.latitude) != 0))
- str = maidenhead(gpsdata->fix.latitude,gpsdata->fix.longitude);
- else
- str = "n/a";
- (void)mvwprintw(datawin, row++, DATAWIN_VALUE_OFFSET + 9, "%-*s",
- 18, str);
- }
- /* Be quiet if the user requests silence. */
- if (!silent_flag && raw_flag) {
- if (NULL != message) {
- size_t message_len = strlen(message);
- if (0 < message_len) {
- if ( '\r' == message[message_len - 1]) {
- /* remove any trailing \r */
- message[message_len - 1] = '\0';
- }
- (void)wprintw(messages, "\n%s", message);
- (void)wrefresh(messages);
- }
- }
- }
- /* Reset the status_timer if the state has changed. */
- if (newstate != state) {
- status_timer = time(NULL);
- state = newstate;
- }
- (void)wrefresh(datawin);
- (void)wrefresh(satellites);
- }
- static void usage(char *prog)
- {
- (void)fprintf(stderr,
- "Usage: %s [-h] [-l {d|m|s}] [-m] [-s] [-V] "
- "[server[:port:[device]]]\n\n"
- " -D debug-level Set debug level\n"
- " -h Show this help, then exit\n"
- " -l {d|m|s} Select lat/lon format\n"
- " d = DD.ddddddd\n"
- " m = DD MM.mmmmmm'\n"
- " s = DD MM' SS.sssss\"\n"
- " -m Display track as the estimated magnetic track\n"
- " Valid or USA (Lower 48 + AK) and Western Europe.\n"
- " -s Be silent (don't print raw gpsd data)\n"
- " -V Show version, then exit\n",
- prog);
- exit(EXIT_FAILURE);
- }
- /*
- * No protocol dependencies above this line
- */
- int main(int argc, char *argv[])
- {
- int option;
- unsigned int flags = WATCH_ENABLE;
- int wait_clicks = 0; /* cycles to wait before gpsd timeout */
- /* buffer to hold one JSON message */
- char message[GPS_JSON_RESPONSE_MAX];
- switch (gpsd_units()) {
- case imperial:
- altfactor = METERS_TO_FEET;
- altunits = "ft";
- speedfactor = MPS_TO_MPH;
- speedunits = "mph";
- break;
- case nautical:
- altfactor = METERS_TO_FEET;
- altunits = "ft";
- speedfactor = MPS_TO_KNOTS;
- speedunits = "kts";
- break;
- case metric:
- altfactor = 1;
- altunits = "m";
- speedfactor = MPS_TO_KPH;
- speedunits = "kph";
- break;
- default:
- /* leave the default alone */
- break;
- }
- /* Process the options. Print help if requested. */
- while ((option = getopt(argc, argv, "D:hl:msu:V")) != -1) {
- switch (option) {
- case 'D':
- debug = atoi(optarg);
- gps_enable_debug(debug, stderr);
- break;
- case 'm':
- magnetic_flag = true;
- break;
- case 's':
- silent_flag = true;
- break;
- case 'u':
- switch (optarg[0]) {
- case 'i':
- altfactor = METERS_TO_FEET;
- altunits = "ft";
- speedfactor = MPS_TO_MPH;
- speedunits = "mph";
- continue;
- case 'n':
- altfactor = METERS_TO_FEET;
- altunits = "ft";
- speedfactor = MPS_TO_KNOTS;
- speedunits = "knots";
- continue;
- case 'm':
- altfactor = 1;
- altunits = "m";
- speedfactor = MPS_TO_KPH;
- speedunits = "kph";
- continue;
- default:
- (void)fprintf(stderr, "Unknown -u argument: %s\n", optarg);
- }
- break;
- case 'V':
- (void)fprintf(stderr, "%s: %s (revision %s)\n",
- argv[0], VERSION, REVISION);
- exit(EXIT_SUCCESS);
- case 'l':
- switch (optarg[0]) {
- case 'd':
- deg_type = deg_dd;
- continue;
- case 'm':
- deg_type = deg_ddmm;
- continue;
- case 's':
- deg_type = deg_ddmmss;
- continue;
- default:
- (void)fprintf(stderr, "Unknown -l argument: %s\n", optarg);
- }
- break;
- case 'h':
- default:
- usage(argv[0]);
- break;
- }
- }
- /* Grok the server, port, and device. */
- if (optind < argc) {
- gpsd_source_spec(argv[optind], &source);
- } else
- gpsd_source_spec(NULL, &source);
- /* Open the stream to gpsd. */
- if (gps_open(source.server, source.port, &gpsdata) != 0) {
- (void)fprintf(stderr,
- "cgps: no gpsd running or network error: %d, %s\n",
- errno, gps_errstr(errno));
- exit(EXIT_FAILURE);
- }
- /* note: we're assuming BSD-style reliable signals here */
- (void)signal(SIGINT, die);
- (void)signal(SIGHUP, die);
- (void)signal(SIGWINCH, resize);
- windowsetup();
- status_timer = time(NULL);
- if (source.device != NULL)
- flags |= WATCH_DEVICE;
- (void)gps_stream(&gpsdata, flags, source.device);
- /* heart of the client */
- for (;;) {
- int c;
- /* wait 1/2 second for gpsd */
- if (!gps_waiting(&gpsdata, 500000)) {
- /* 240 tries at 0.5 seconds a try is a 2 minute timeout */
- if ( 240 < wait_clicks++ )
- die(GPS_TIMEOUT);
- } else {
- wait_clicks = 0;
- errno = 0;
- *message = '\0';
- if (gps_read(&gpsdata, message, sizeof(message)) == -1) {
- (void)fprintf(stderr, "cgps: socket error 4\n");
- die(errno == 0 ? GPS_GONE : GPS_ERROR);
- } else {
- /* Here's where updates go now that things are established. */
- #ifdef TRUENORTH
- if (compass_flag)
- update_compass_panel(&gpsdata);
- else
- #endif /* TRUENORTH */
- update_gps_panel(&gpsdata, message);
- }
- }
- /* Check for user input. */
- c = wgetch(datawin);
- switch (c) {
- /* Quit */
- case 'q':
- die(CGPS_QUIT);
- break;
- /* Toggle spewage of raw gpsd data. */
- case 's':
- silent_flag = !silent_flag;
- break;
- /* Clear the spewage area. */
- case 'c':
- (void)werase(messages);
- break;
- default:
- break;
- }
- }
- }
- // vim: set expandtab shiftwidth=4
|