1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
|
/*
* monitor_tnt.c - gpsmon support for True North Revolution devices.
*
* This file is Copyright (c) 2010 by the GPSD project
* BSD terms apply: see the file COPYING in the distribution root for details.
*/
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <math.h>
#include <ctype.h>
#ifndef S_SPLINT_S
#include <unistd.h>
#endif /* S_SPLINT_S */
#include <stdarg.h>
#include <stdbool.h>
#include <assert.h>
#include "gpsd_config.h"
#ifdef HAVE_NCURSES_H
#include <ncurses.h>
#else
#include <curses.h>
#endif /* HAVE_NCURSES_H */
#include "gpsd.h"
#include "bits.h"
#include "gpsmon.h"
#ifdef TNT_ENABLE
extern const struct gps_type_t trueNorth;
static WINDOW *thtmwin;
static bool tnt_initialize(void)
{
/*@ -onlytrans @*/
thtmwin = derwin(devicewin, 6, 80, 0, 0);
(void)wborder(thtmwin, 0, 0, 0, 0, 0, 0, 0, 0),
(void)syncok(thtmwin, true);
(void)wattrset(thtmwin, A_BOLD);
(void)mvwaddstr(thtmwin, 0, 35, " PTNTHTM ");
(void)mvwaddstr(thtmwin, 1, 1, "Heading: ");
(void)mvwaddstr(thtmwin, 2, 1, "Pitch: ");
(void)mvwaddstr(thtmwin, 3, 1, "Roll: ");
(void)mvwaddstr(thtmwin, 4, 1, "Dip: ");
(void)mvwaddstr(thtmwin, 1, 40, "Magnetometer Status: ");
(void)mvwaddstr(thtmwin, 2, 40, "Pitch Status: ");
(void)mvwaddstr(thtmwin, 3, 40, "Roll Status ");
(void)mvwaddstr(thtmwin, 4, 40, "Horizontal Field: ");
(void)wattrset(thtmwin, A_NORMAL);
/*@ +onlytrans @*/
return true;
}
static void tnt_update(void)
{
/*
* We have to do our own field parsing because the way this
* gets valled, nmea_parse() is never called on the sentence.
*/
(void)nmea_parse((char *)session.packet.outbuffer, &session);
(void)mvwaddstr(thtmwin, 1, 19, session.driver.nmea.field[1]);
(void)mvwaddstr(thtmwin, 2, 19, session.driver.nmea.field[3]);
(void)mvwaddstr(thtmwin, 3, 19, session.driver.nmea.field[5]);
(void)mvwaddstr(thtmwin, 4, 19, session.driver.nmea.field[7]);
(void)mvwaddstr(thtmwin, 1, 61, session.driver.nmea.field[2]);
(void)mvwaddstr(thtmwin, 2, 61, session.driver.nmea.field[4]);
(void)mvwaddstr(thtmwin, 3, 61, session.driver.nmea.field[6]);
(void)mvwaddstr(thtmwin, 4, 61, session.driver.nmea.field[8]);
}
static int tnt_command(char line[])
{
/*
* Interpret a command line. Whatever characters the user types will
* be echoed in the command buffer at the top right of the display. When
* he/she presses enter the command line will be passed to this function
* for interpretation. Note: packet receipt is suspended while this
* function is executing.
*
* This method is optional. If you set the command method pointer to
* NULL, gpsmon will behave sanely, accepting no device-specific commands.
*
* It is a useful convention to use uppercase letters for
* driver-specific commands and leave lowercase ones for the
* generic gpsmon ones.
*/
/*
* Return COMMAND_UNKNOWN to tell gpsmon you can't interpret the line, and
* it will be passed to the generic command interpreter to be handled there.
* You can alse return COMMAND_MATCH to tell it you handled the command,
* or COMMAND_TERMINATE to tell gpsmon you handled it and gpsmon should
* terminate.
*/
return COMMAND_UNKNOWN;
}
static void tnt_wrap(void)
{
(void)delwin(thtmwin);
}
/*
* Use mmt = monitor method table as a suffix for naming these things
* Yours will need to be added to the monitor_objects table in gpsmon.c,
* then of course you need to link your module into gpsmon.
*/
const struct monitor_object_t tnt_mmt = {
.initialize = tnt_initialize,
.update = tnt_update,
.command = tnt_command,
.wrap = tnt_wrap,
.min_y = 6,.min_x = 80, /* size of the device window */
.driver = &trueNorth,
};
#endif /* TNT_ENABLE */
/*
* Helpers:
*
* bool monitor_control_send(unsigned char *buf, size_t len)
* Ship a packet payload to the device. Calls the driver send_control()
* method to add headers/trailers/checksum; also dumps the sent
* packet to the packet window, if the send_control() is playing
* nice by using session.msgbuf to assemble the message.
*
* void monitor_log(const char *fmt, ...)
* Write a message to the packet window. Safe if the packet window
* is not on screen.
*
* void monitor_complain(const char *fmt, ...)
* Post an error message to the command window, wait till user presses a key.
* You get to make sure the message will fit.
*
* void monitor_fixframe(WINDOW *win)
* Fix the frame of win to the right of the current location by redrawing
* ACS_VLINE there. Useful after doing wclrtoeol() and writing on the
* line.
*
* The libgpsd session object is accessible as the global variable 'session'.
*/
|
