summaryrefslogtreecommitdiff
path: root/monitor_superstar2.c
blob: 50e64ff6673e1d3e76227e0d626717e434114242 (plain)
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
/* $Id$ */
#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 SUPERSTAR2_ENABLE
#include "driver_superstar2.h"
extern const struct gps_type_t superstar2_binary;
static WINDOW *satwin;

static bool superstar2_initialize(void)
{
	int i;

	/*@ -onlytrans @*/
	/* "heavily inspired" by monitor_nmea.c */
	if ((satwin  = derwin(devicewin, 15, 27, 7, 0)) == NULL)
		return false;
	(void)wborder(satwin, 0, 0, 0, 0, 0, 0, 0, 0),
	(void)syncok(satwin, true);
	(void)wattrset(satwin, A_BOLD);
	(void)mvwprintw(satwin, 1, 1, "Ch PRN  Az El S/N Fl U");
	for (i = 0; i < 12; i++)
		(void)mvwprintw(satwin, (int)(i+2), 1, "%2d",i);
	(void)mvwprintw(satwin, 14, 1, " Satellite Data & Status ");
	(void)wattrset(satwin, A_NORMAL);
	/*@ +onlytrans @*/

	return true;
}

static void display_superstar2_svinfo(unsigned char *buf, size_t data_len)
{
	int i;

	if (data_len != 67)
		return;

	for (i = 0; i < 12; i++) {
		/* get info for one channel/satellite */
		int off = i*5 + 5;
		unsigned char fl, porn, ss;
		char el;
		unsigned short az;

		/*@ +charint */
		if ((porn = (unsigned char)getub(buf, off) & 0x1f) == 0)
		    porn = ((unsigned char)getub(buf, off+3) >> 1) + 87;
		/*@ -charint */

		ss = (unsigned char)getub(buf, off+4);
		el = getsb(buf, off+1);
		az = (unsigned short)(getub(buf, off+2) +
				      ((getub(buf, off+3) & 0x1) << 1));
		fl = (unsigned char)getub(buf, off) & 0xe0;
		(void)wmove(satwin, i+2, 4);
		/*@ +charint */
		(void)wprintw(satwin, "%3u %3d %2d  %02d %02x %c",
			porn, az, el, ss, fl,
			((fl & 0x60) == 0x60)? 'Y' : ' ');
		/*@ -charint */
	}
	(void)wnoutrefresh(satwin);
	return;
}

static void superstar2_update(void)
{
	unsigned char *buf;
	size_t len;
	unsigned char type;

	buf = session.packet.outbuffer;
	len = session.packet.outbuflen;
	type = buf[SUPERSTAR2_TYPE_OFFSET];
	switch (type) {
		case SUPERSTAR2_SVINFO:
			display_superstar2_svinfo(buf, len-3);
			break;
		default:
			break;
	}
}

static int superstar2_command(char line[] UNUSED)
{
    return COMMAND_UNKNOWN;
}

static void superstar2_wrap(void)
{
}

const struct monitor_object_t superstar2_mmt = {
    .initialize = superstar2_initialize,
    .update = superstar2_update,
    .command = superstar2_command,
    .wrap = superstar2_wrap,
    .min_y = 23, .min_x = 80,	/* size of the device window */
    .driver = &superstar2_binary,
};
#endif