rename states. launchpad -> pad, coast -> fast
[fw/altos] / aoview / aoview_monitor.c
1 /*
2  * Copyright © 2009 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; version 2 of the License.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License along
14  * with this program; if not, write to the Free Software Foundation, Inc.,
15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
16  */
17
18 #include "aoview.h"
19
20 static struct aoview_serial *monitor_serial;
21
22 #define MONITOR_LEN     1024
23
24 static char     monitor_line[MONITOR_LEN + 1];
25 static int      monitor_pos;
26
27 void
28 aoview_monitor_disconnect(void)
29 {
30         if (monitor_serial) {
31                 aoview_serial_close(monitor_serial);
32                 monitor_serial = NULL;
33         }
34         aoview_table_clear();
35         aoview_log_new();
36 }
37
38 static void
39 aoview_parse_string(char *target, int len, char *source)
40 {
41         strncpy(target, source, len-1);
42         target[len-1] = '\0';
43 }
44
45 static void
46 aoview_parse_int(int *target, char *source)
47 {
48         *target = strtol(source, NULL, 0);
49 }
50
51 static void
52 aoview_parse_pos(double *target, char *source)
53 {
54         int     deg;
55         double  min;
56         char    dir;
57         double  r;
58
59         if (sscanf(source, "%d°%lf'%c", &deg, &min, &dir) != 3) {
60                 *target = 0;
61                 return;
62         }
63         r = deg + min / 60.0;
64         if (dir == 'S' || dir == 'W')
65                 r = -r;
66         *target = r;
67 }
68
69 static void
70 aoview_monitor_parse(char *line)
71 {
72         char *saveptr;
73         char *words[64];
74         int nword;
75         struct aostate  state;
76
77         if (aoview_log_get_serial())
78                 aoview_log_printf ("%s\n", line);
79         for (nword = 0; nword < 64; nword++) {
80                 words[nword] = strtok_r(line, " \t\n", &saveptr);
81                 line = NULL;
82                 if (words[nword] == NULL)
83                         break;
84         }
85         if (nword < 36)
86                 return;
87         if (strcmp(words[0], "CALL") != 0)
88                 return;
89         aoview_parse_string(state.callsign, sizeof (state.callsign), words[1]);
90         aoview_parse_int(&state.serial, words[3]);
91         aoview_log_set_serial(state.serial);
92
93         aoview_parse_int(&state.rssi, words[5]);
94         aoview_parse_string(state.state, sizeof (state.state), words[9]);
95         aoview_parse_int(&state.tick, words[10]);
96         aoview_parse_int(&state.accel, words[12]);
97         aoview_parse_int(&state.pres, words[14]);
98         aoview_parse_int(&state.temp, words[16]);
99         aoview_parse_int(&state.batt, words[18]);
100         aoview_parse_int(&state.drogue, words[20]);
101         aoview_parse_int(&state.main, words[22]);
102         aoview_parse_int(&state.flight_accel, words[24]);
103         aoview_parse_int(&state.ground_accel, words[26]);
104         aoview_parse_int(&state.flight_vel, words[28]);
105         aoview_parse_int(&state.flight_pres, words[30]);
106         aoview_parse_int(&state.ground_pres, words[32]);
107         aoview_parse_int(&state.nsat, words[34]);
108         if (strcmp (words[36], "unlocked") != 0 && nword >= 40) {
109                 state.locked = 1;
110                 sscanf(words[36], "%d:%d:%d", &state.gps_time.hour, &state.gps_time.minute, &state.gps_time.second);
111                 aoview_parse_pos(&state.lat, words[37]);
112                 aoview_parse_pos(&state.lon, words[38]);
113                 sscanf(words[39], "%dm", &state.alt);
114         } else {
115                 state.locked = 0;
116                 state.gps_time.hour = state.gps_time.minute = state.gps_time.second = 0;
117                 state.lat = state.lon = 0;
118                 state.alt = 0;
119         }
120         aoview_state_notify(&state);
121 }
122
123 static void
124 aoview_monitor_callback(gpointer user_data,
125                         struct aoview_serial *serial,
126                         gint revents)
127 {
128         int     c;
129
130         if (revents & (G_IO_HUP|G_IO_ERR)) {
131                 aoview_monitor_disconnect();
132                 return;
133         }
134         if (revents & G_IO_IN) {
135                 for (;;) {
136                         c = aoview_serial_getc(serial);
137                         if (c == -1)
138                                 break;
139                         if (c == '\r')
140                                 continue;
141                         if (c == '\n') {
142                                 monitor_line[monitor_pos] = '\0';
143                                 if (monitor_pos)
144                                 aoview_monitor_parse(monitor_line);
145                                 monitor_pos = 0;
146                         } else if (monitor_pos < MONITOR_LEN)
147                                 monitor_line[monitor_pos++] = c;
148                 }
149         }
150 }
151
152 gboolean
153 aoview_monitor_connect(char *tty)
154 {
155         aoview_monitor_disconnect();
156         monitor_serial = aoview_serial_open(tty);
157         if (!monitor_serial)
158                 return FALSE;
159         aoview_serial_set_callback(monitor_serial,
160                                    aoview_monitor_callback,
161                                    monitor_serial,
162                                    NULL);
163         return TRUE;
164 }