]>
Commit | Line | Data |
---|---|---|
b364d6bc QT |
1 | /* |
2 | * viking -- GPS Data and Topo Analyzer, Explorer, and Manager | |
3 | * | |
4 | * Copyright (C) 2003-2005, Evan Battaglia <gtoevan@gmx.net> | |
a482007a | 5 | * Copyright (C) 2006-2008, Quy Tonthat <qtonthat@gmail.com> |
b364d6bc QT |
6 | * |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
20 | * | |
21 | */ | |
22 | ||
58a642b6 GB |
23 | #ifdef HAVE_CONFIG_H |
24 | #include "config.h" | |
25 | #endif | |
26 | ||
b87d3952 | 27 | #include <stdlib.h> |
8c00358d | 28 | #ifdef HAVE_MATH_H |
b87d3952 | 29 | #include <math.h> |
8c00358d | 30 | #endif |
b364d6bc | 31 | #include "viking.h" |
5bfafde9 | 32 | #include "icons/icons.h" |
b364d6bc QT |
33 | #include "babel.h" |
34 | ||
99163c34 RN |
35 | #ifdef HAVE_UNISTD_H |
36 | #include <unistd.h> | |
37 | #endif | |
8c00358d | 38 | #ifdef HAVE_STRING_H |
b364d6bc | 39 | #include <string.h> |
8c00358d | 40 | #endif |
99163c34 | 41 | #include <glib/gstdio.h> |
b364d6bc | 42 | #include <glib/gprintf.h> |
4c77d5e0 | 43 | #include <glib/gi18n.h> |
001a86db | 44 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 | 45 | #include <gps.h> |
58a642b6 | 46 | #endif |
b364d6bc | 47 | |
56acdae0 QT |
48 | #if ! GLIB_CHECK_VERSION(2,14,0) |
49 | inline guint g_timeout_add_seconds(guint interval, GSourceFunc function, gpointer data) { | |
50 | return g_timeout_add(interval*1000, function, data); | |
51 | } | |
52 | #endif | |
53 | ||
b364d6bc | 54 | #define DISCONNECT_UPDATE_SIGNAL(vl, val) g_signal_handlers_disconnect_matched(vl, G_SIGNAL_MATCH_DATA, 0, 0, 0, 0, val) |
fdca5edb QT |
55 | static VikGpsLayer *vik_gps_layer_create (VikViewport *vp); |
56 | static void vik_gps_layer_realize ( VikGpsLayer *val, VikTreeview *vt, GtkTreeIter *layer_iter ); | |
57 | static void vik_gps_layer_free ( VikGpsLayer *val ); | |
58 | static void vik_gps_layer_draw ( VikGpsLayer *val, gpointer data ); | |
30a9c13f | 59 | static VikGpsLayer *vik_gps_layer_new ( VikViewport *vp ); |
b364d6bc | 60 | |
b364d6bc QT |
61 | static void gps_layer_marshall( VikGpsLayer *val, guint8 **data, gint *len ); |
62 | static VikGpsLayer *gps_layer_unmarshall( guint8 *data, gint len, VikViewport *vvp ); | |
158b3642 RN |
63 | static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerParamData data, VikViewport *vp, gboolean is_file_operation ); |
64 | static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id, gboolean is_file_operation ); | |
b364d6bc QT |
65 | |
66 | static void gps_layer_change_coord_mode ( VikGpsLayer *val, VikCoordMode mode ); | |
67 | static void gps_layer_add_menu_items( VikGpsLayer *vtl, GtkMenu *menu, gpointer vlp ); | |
68 | static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val_dest, GtkTreeIter *src_item_iter, GtkTreePath *dest_path ); | |
69 | ||
b364d6bc QT |
70 | static void gps_upload_cb( gpointer layer_and_vlp[2] ); |
71 | static void gps_download_cb( gpointer layer_and_vlp[2] ); | |
700b0908 QT |
72 | static void gps_empty_upload_cb( gpointer layer_and_vlp[2] ); |
73 | static void gps_empty_download_cb( gpointer layer_and_vlp[2] ); | |
74 | static void gps_empty_all_cb( gpointer layer_and_vlp[2] ); | |
001a86db | 75 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
22d1e285 | 76 | static void gps_empty_realtime_cb( gpointer layer_and_vlp[2] ); |
b87d3952 | 77 | static void gps_start_stop_tracking_cb( gpointer layer_and_vlp[2] ); |
001a86db | 78 | static void realtime_tracking_draw(VikGpsLayer *vgl, VikViewport *vp); |
58a642b6 | 79 | #endif |
b364d6bc | 80 | |
4136d029 RN |
81 | typedef enum {GARMIN_P = 0, MAGELLAN_P, DELORME_P, NAVILINK_P, NUM_PROTOCOLS} vik_gps_proto; |
82 | static gchar * params_protocols[] = {"Garmin", "Magellan", "DeLorme", "NAViLink", NULL}; | |
83 | static gchar * protocols_args[] = {"garmin", "magellan", "delbin", "navilink"}; | |
b364d6bc | 84 | /*#define NUM_PROTOCOLS (sizeof(params_protocols)/sizeof(params_protocols[0]) - 1) */ |
8d70f073 MA |
85 | #ifdef WINDOWS |
86 | static gchar * params_ports[] = {"com1", "usb:", NULL}; | |
87 | #else | |
7963d365 | 88 | static gchar * params_ports[] = {"/dev/ttyS0", "/dev/ttyS1", "/dev/ttyUSB0", "/dev/ttyUSB1", "usb:", NULL}; |
8d70f073 | 89 | #endif |
99163c34 RN |
90 | /* NUM_PORTS not actually used */ |
91 | /* #define NUM_PORTS (sizeof(params_ports)/sizeof(params_ports[0]) - 1) */ | |
bb8aed99 GB |
92 | /* Compatibility with previous versions */ |
93 | #ifdef WINDOWS | |
94 | static gchar * old_params_ports[] = {"com1", "usb:", NULL}; | |
95 | #else | |
96 | static gchar * old_params_ports[] = {"/dev/ttyS0", "/dev/ttyS1", "/dev/ttyUSB0", "/dev/ttyUSB1", "usb:", NULL}; | |
97 | #endif | |
98 | #define OLD_NUM_PORTS (sizeof(old_params_ports)/sizeof(old_params_ports[0]) - 1) | |
b364d6bc QT |
99 | typedef enum {GPS_DOWN=0, GPS_UP} gps_dir; |
100 | ||
101 | typedef struct { | |
102 | GMutex *mutex; | |
103 | gps_dir direction; | |
104 | gchar *port; | |
105 | gboolean ok; | |
106 | gint total_count; | |
107 | gint count; | |
108 | VikTrwLayer *vtl; | |
109 | gchar *cmd_args; | |
110 | gchar * window_title; | |
111 | GtkWidget *dialog; | |
112 | GtkWidget *status_label; | |
113 | GtkWidget *gps_label; | |
114 | GtkWidget *ver_label; | |
115 | GtkWidget *id_label; | |
116 | GtkWidget *wp_label; | |
117 | GtkWidget *progress_label; | |
118 | GtkWidget *trk_label; | |
119 | } GpsSession; | |
120 | static void gps_session_delete(GpsSession *sess); | |
121 | ||
58a642b6 GB |
122 | static gchar *params_groups[] = { |
123 | "Data Mode", | |
001a86db | 124 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
58a642b6 GB |
125 | "Realtime Tracking Mode", |
126 | #endif | |
127 | }; | |
128 | ||
b87d3952 QT |
129 | enum {GROUP_DATA_MODE, GROUP_REALTIME_MODE}; |
130 | ||
dc3a1898 QT |
131 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
132 | static gchar *params_vehicle_position[] = { | |
133 | "Keep vehicle at center", | |
134 | "Keep vehicle on screen", | |
135 | "Disable", | |
136 | NULL | |
137 | }; | |
138 | enum { | |
139 | VEHICLE_POSITION_CENTERED = 0, | |
140 | VEHICLE_POSITION_ON_SCREEN, | |
141 | VEHICLE_POSITION_NONE, | |
142 | }; | |
143 | #endif | |
144 | ||
b364d6bc | 145 | static VikLayerParam gps_layer_params[] = { |
4c77d5e0 | 146 | { "gps_protocol", VIK_LAYER_PARAM_UINT, GROUP_DATA_MODE, N_("GPS Protocol:"), VIK_LAYER_WIDGET_COMBOBOX, params_protocols, NULL}, |
ce37ab9b | 147 | { "gps_port", VIK_LAYER_PARAM_STRING, GROUP_DATA_MODE, N_("Serial Port:"), VIK_LAYER_WIDGET_COMBOBOX, params_ports, NULL}, |
b87d3952 | 148 | |
001a86db | 149 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
4c77d5e0 GB |
150 | { "record_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, N_("Recording tracks"), VIK_LAYER_WIDGET_CHECKBUTTON}, |
151 | { "center_start_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, N_("Jump to current position on start"), VIK_LAYER_WIDGET_CHECKBUTTON}, | |
dc3a1898 | 152 | { "moving_map_method", VIK_LAYER_PARAM_UINT, GROUP_REALTIME_MODE, N_("Moving Map Method:"), VIK_LAYER_WIDGET_RADIOGROUP_STATIC, params_vehicle_position, NULL}, |
4c77d5e0 GB |
153 | { "gpsd_host", VIK_LAYER_PARAM_STRING, GROUP_REALTIME_MODE, N_("Gpsd Host:"), VIK_LAYER_WIDGET_ENTRY}, |
154 | { "gpsd_port", VIK_LAYER_PARAM_STRING, GROUP_REALTIME_MODE, N_("Gpsd Port:"), VIK_LAYER_WIDGET_ENTRY}, | |
c5bc70c3 | 155 | { "gpsd_retry_interval", VIK_LAYER_PARAM_STRING, GROUP_REALTIME_MODE, N_("Gpsd Retry Interval (seconds):"), VIK_LAYER_WIDGET_ENTRY}, |
001a86db | 156 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
b364d6bc | 157 | }; |
58a642b6 GB |
158 | enum { |
159 | PARAM_PROTOCOL=0, PARAM_PORT, | |
001a86db | 160 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
c5bc70c3 | 161 | PARAM_REALTIME_REC, PARAM_REALTIME_CENTER_START, PARAM_VEHICLE_POSITION, PARAM_GPSD_HOST, PARAM_GPSD_PORT, PARAM_GPSD_RETRY_INTERVAL, |
001a86db | 162 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
58a642b6 | 163 | NUM_PARAMS}; |
b364d6bc QT |
164 | |
165 | VikLayerInterface vik_gps_layer_interface = { | |
166 | "GPS", | |
5bfafde9 | 167 | &vikgpslayer_pixbuf, |
b364d6bc QT |
168 | |
169 | NULL, | |
170 | 0, | |
171 | ||
172 | gps_layer_params, | |
173 | NUM_PARAMS, | |
b87d3952 QT |
174 | params_groups, |
175 | sizeof(params_groups)/sizeof(params_groups[0]), | |
b364d6bc | 176 | |
81ee8fa7 | 177 | VIK_MENU_ITEM_ALL, |
5a4a28bf | 178 | |
b364d6bc QT |
179 | (VikLayerFuncCreate) vik_gps_layer_create, |
180 | (VikLayerFuncRealize) vik_gps_layer_realize, | |
181 | (VikLayerFuncPostRead) NULL, | |
182 | (VikLayerFuncFree) vik_gps_layer_free, | |
183 | ||
184 | (VikLayerFuncProperties) NULL, | |
185 | (VikLayerFuncDraw) vik_gps_layer_draw, | |
186 | (VikLayerFuncChangeCoordMode) gps_layer_change_coord_mode, | |
187 | ||
20c7a3a0 QT |
188 | (VikLayerFuncSetMenuItemsSelection) NULL, |
189 | (VikLayerFuncGetMenuItemsSelection) NULL, | |
190 | ||
b364d6bc QT |
191 | (VikLayerFuncAddMenuItems) gps_layer_add_menu_items, |
192 | (VikLayerFuncSublayerAddMenuItems) NULL, | |
193 | ||
194 | (VikLayerFuncSublayerRenameRequest) NULL, | |
195 | (VikLayerFuncSublayerToggleVisible) NULL, | |
196 | ||
b364d6bc QT |
197 | (VikLayerFuncMarshall) gps_layer_marshall, |
198 | (VikLayerFuncUnmarshall) gps_layer_unmarshall, | |
199 | ||
200 | (VikLayerFuncSetParam) gps_layer_set_param, | |
201 | (VikLayerFuncGetParam) gps_layer_get_param, | |
202 | ||
203 | (VikLayerFuncReadFileData) NULL, | |
204 | (VikLayerFuncWriteFileData) NULL, | |
205 | ||
206 | (VikLayerFuncDeleteItem) NULL, | |
207 | (VikLayerFuncCopyItem) NULL, | |
208 | (VikLayerFuncPasteItem) NULL, | |
209 | (VikLayerFuncFreeCopiedItem) NULL, | |
210 | (VikLayerFuncDragDropRequest) gps_layer_drag_drop_request, | |
211 | }; | |
212 | ||
58a642b6 | 213 | enum {TRW_DOWNLOAD=0, TRW_UPLOAD, |
001a86db | 214 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
58a642b6 GB |
215 | TRW_REALTIME, |
216 | #endif | |
217 | NUM_TRW}; | |
218 | static gchar * trw_names[] = { | |
4c77d5e0 | 219 | N_("GPS Download"), N_("GPS Upload"), |
001a86db | 220 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
4c77d5e0 | 221 | N_("GPS Realtime Tracking"), |
58a642b6 GB |
222 | #endif |
223 | }; | |
b87d3952 | 224 | |
001a86db | 225 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 QT |
226 | typedef struct { |
227 | struct gps_data_t gpsd; | |
228 | VikGpsLayer *vgl; | |
229 | } VglGpsd; | |
230 | ||
231 | typedef struct { | |
c4e61875 | 232 | struct gps_fix_t fix; |
a2817d3c | 233 | gint satellites_used; |
b87d3952 QT |
234 | gboolean dirty; /* needs to be saved */ |
235 | } GpsFix; | |
001a86db | 236 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
b87d3952 | 237 | |
b364d6bc QT |
238 | struct _VikGpsLayer { |
239 | VikLayer vl; | |
240 | VikTrwLayer * trw_children[NUM_TRW]; | |
f253a6a6 QT |
241 | GList * children; /* used only for writing file */ |
242 | int cur_read_child; /* used only for reading file */ | |
001a86db | 243 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 | 244 | VglGpsd *vgpsd; |
ae198aa3 | 245 | gboolean realtime_tracking; /* set/reset only by the callback */ |
c5bc70c3 | 246 | gboolean first_realtime_trackpoint; |
b87d3952 QT |
247 | GpsFix realtime_fix; |
248 | GpsFix last_fix; | |
249 | ||
b87d3952 QT |
250 | VikTrack *realtime_track; |
251 | gchar *realtime_track_name; | |
252 | ||
253 | GIOChannel *realtime_io_channel; | |
254 | guint realtime_io_watch_id; | |
c5bc70c3 | 255 | guint realtime_retry_timer; |
b87d3952 QT |
256 | GdkGC *realtime_track_gc; |
257 | GdkGC *realtime_track_bg_gc; | |
258 | GdkGC *realtime_track_pt_gc; | |
259 | GdkGC *realtime_track_pt1_gc; | |
260 | GdkGC *realtime_track_pt2_gc; | |
261 | ||
b364d6bc | 262 | /* params */ |
b87d3952 QT |
263 | gchar *gpsd_host; |
264 | gchar *gpsd_port; | |
c5bc70c3 | 265 | gint gpsd_retry_interval; |
b87d3952 QT |
266 | gboolean realtime_record; |
267 | gboolean realtime_jump_to_start; | |
dc3a1898 | 268 | guint vehicle_position; |
001a86db QT |
269 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
270 | guint protocol_id; | |
ce37ab9b | 271 | gchar *serial_port; |
b364d6bc QT |
272 | }; |
273 | ||
274 | GType vik_gps_layer_get_type () | |
275 | { | |
276 | static GType val_type = 0; | |
277 | ||
278 | if (!val_type) | |
279 | { | |
280 | static const GTypeInfo val_info = | |
281 | { | |
282 | sizeof (VikGpsLayerClass), | |
283 | NULL, /* base_init */ | |
284 | NULL, /* base_finalize */ | |
285 | NULL, /* class init */ | |
286 | NULL, /* class_finalize */ | |
287 | NULL, /* class_data */ | |
288 | sizeof (VikGpsLayer), | |
289 | 0, | |
290 | NULL /* instance init */ | |
291 | }; | |
292 | val_type = g_type_register_static ( VIK_LAYER_TYPE, "VikGpsLayer", &val_info, 0 ); | |
293 | } | |
294 | ||
295 | return val_type; | |
296 | } | |
297 | ||
fdca5edb | 298 | static VikGpsLayer *vik_gps_layer_create (VikViewport *vp) |
b364d6bc | 299 | { |
c4e61875 QT |
300 | int i; |
301 | ||
b87d3952 | 302 | VikGpsLayer *rv = vik_gps_layer_new (vp); |
b364d6bc | 303 | vik_layer_rename ( VIK_LAYER(rv), vik_gps_layer_interface.name ); |
c4e61875 QT |
304 | |
305 | for (i = 0; i < NUM_TRW; i++) { | |
306 | rv->trw_children[i] = VIK_TRW_LAYER(vik_layer_create ( VIK_LAYER_TRW, vp, NULL, FALSE )); | |
307 | vik_layer_set_menu_items_selection(VIK_LAYER(rv->trw_children[i]), VIK_MENU_ITEM_ALL & ~(VIK_MENU_ITEM_CUT|VIK_MENU_ITEM_DELETE)); | |
308 | } | |
b364d6bc QT |
309 | return rv; |
310 | } | |
311 | ||
b364d6bc QT |
312 | /* "Copy" */ |
313 | static void gps_layer_marshall( VikGpsLayer *vgl, guint8 **data, gint *datalen ) | |
314 | { | |
315 | VikLayer *child_layer; | |
316 | guint8 *ld; | |
317 | gint ll; | |
318 | GByteArray* b = g_byte_array_new (); | |
319 | gint len; | |
320 | gint i; | |
321 | ||
322 | #define alm_append(obj, sz) \ | |
323 | len = (sz); \ | |
324 | g_byte_array_append ( b, (guint8 *)&len, sizeof(len) ); \ | |
325 | g_byte_array_append ( b, (guint8 *)(obj), len ); | |
326 | ||
327 | vik_layer_marshall_params(VIK_LAYER(vgl), &ld, &ll); | |
328 | alm_append(ld, ll); | |
329 | g_free(ld); | |
330 | ||
331 | for (i = 0; i < NUM_TRW; i++) { | |
332 | child_layer = VIK_LAYER(vgl->trw_children[i]); | |
333 | vik_layer_marshall(child_layer, &ld, &ll); | |
334 | if (ld) { | |
335 | alm_append(ld, ll); | |
336 | g_free(ld); | |
337 | } | |
338 | } | |
339 | *data = b->data; | |
340 | *datalen = b->len; | |
341 | g_byte_array_free(b, FALSE); | |
342 | #undef alm_append | |
343 | } | |
344 | ||
345 | /* "Paste" */ | |
346 | static VikGpsLayer *gps_layer_unmarshall( guint8 *data, gint len, VikViewport *vvp ) | |
347 | { | |
348 | #define alm_size (*(gint *)data) | |
349 | #define alm_next \ | |
350 | len -= sizeof(gint) + alm_size; \ | |
351 | data += sizeof(gint) + alm_size; | |
352 | ||
30a9c13f | 353 | VikGpsLayer *rv = vik_gps_layer_new(vvp); |
b364d6bc QT |
354 | VikLayer *child_layer; |
355 | gint i; | |
356 | ||
357 | vik_layer_unmarshall_params ( VIK_LAYER(rv), data+sizeof(gint), alm_size, vvp ); | |
358 | alm_next; | |
359 | ||
360 | i = 0; | |
361 | while (len>0 && i < NUM_TRW) { | |
362 | child_layer = vik_layer_unmarshall ( data + sizeof(gint), alm_size, vvp ); | |
363 | if (child_layer) { | |
fdca5edb | 364 | rv->trw_children[i++] = (VikTrwLayer *)child_layer; |
b87d3952 | 365 | g_signal_connect_swapped ( G_OBJECT(child_layer), "update", G_CALLBACK(vik_layer_emit_update_secondary), rv ); |
b364d6bc QT |
366 | } |
367 | alm_next; | |
368 | } | |
369 | // g_print("gps_layer_unmarshall ended with len=%d\n", len); | |
370 | g_assert(len == 0); | |
371 | return rv; | |
372 | #undef alm_size | |
373 | #undef alm_next | |
374 | } | |
375 | ||
158b3642 | 376 | static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerParamData data, VikViewport *vp, gboolean is_file_operation ) |
b364d6bc QT |
377 | { |
378 | switch ( id ) | |
379 | { | |
380 | case PARAM_PROTOCOL: | |
381 | if (data.u < NUM_PROTOCOLS) | |
382 | vgl->protocol_id = data.u; | |
383 | else | |
4c77d5e0 | 384 | g_warning(_("Unknown GPS Protocol")); |
b364d6bc QT |
385 | break; |
386 | case PARAM_PORT: | |
ce37ab9b GB |
387 | if (data.s) |
388 | { | |
389 | g_free(vgl->serial_port); | |
bb8aed99 GB |
390 | /* Compat: previous version stored serial_port as an array index */ |
391 | int index = data.s[0] - '0'; | |
392 | if (data.s[0] != '\0' && | |
393 | g_ascii_isdigit (data.s[0]) && | |
394 | data.s[1] == '\0' && | |
395 | index < OLD_NUM_PORTS) | |
396 | /* It is a single digit: activate compatibility */ | |
397 | vgl->serial_port = g_strdup(old_params_ports[index]); | |
398 | else | |
399 | vgl->serial_port = g_strdup(data.s); | |
400 | g_debug("%s: %s", __FUNCTION__, vgl->serial_port); | |
ce37ab9b | 401 | } |
b364d6bc | 402 | else |
4c77d5e0 | 403 | g_warning(_("Unknown serial port device")); |
b364d6bc | 404 | break; |
001a86db | 405 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 QT |
406 | case PARAM_GPSD_HOST: |
407 | if (vgl->gpsd_host) | |
408 | g_free(vgl->gpsd_host); | |
409 | vgl->gpsd_host = g_strdup(data.s); | |
410 | break; | |
411 | case PARAM_GPSD_PORT: | |
412 | if (vgl->gpsd_port) | |
413 | g_free(vgl->gpsd_port); | |
414 | vgl->gpsd_port = g_strdup(data.s); /* TODO: check for number */ | |
415 | break; | |
c5bc70c3 QT |
416 | case PARAM_GPSD_RETRY_INTERVAL: |
417 | vgl->gpsd_retry_interval = strtol(data.s, NULL, 10); | |
418 | break; | |
b87d3952 QT |
419 | case PARAM_REALTIME_REC: |
420 | vgl->realtime_record = data.b; | |
421 | break; | |
422 | case PARAM_REALTIME_CENTER_START: | |
423 | vgl->realtime_jump_to_start = data.b; | |
424 | break; | |
dc3a1898 QT |
425 | case PARAM_VEHICLE_POSITION: |
426 | vgl->vehicle_position = data.u; | |
b87d3952 | 427 | break; |
001a86db | 428 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
b87d3952 QT |
429 | default: |
430 | g_warning("gps_layer_set_param(): unknown parameter"); | |
b364d6bc QT |
431 | } |
432 | ||
433 | return TRUE; | |
434 | } | |
435 | ||
158b3642 | 436 | static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id, gboolean is_file_operation ) |
b364d6bc QT |
437 | { |
438 | VikLayerParamData rv; | |
439 | switch ( id ) | |
440 | { | |
441 | case PARAM_PROTOCOL: | |
442 | rv.u = vgl->protocol_id; | |
443 | break; | |
444 | case PARAM_PORT: | |
ce37ab9b GB |
445 | rv.s = vgl->serial_port; |
446 | g_debug("%s: %s", __FUNCTION__, rv.s); | |
b364d6bc | 447 | break; |
001a86db | 448 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 QT |
449 | case PARAM_GPSD_HOST: |
450 | rv.s = vgl->gpsd_host ? vgl->gpsd_host : ""; | |
451 | break; | |
452 | case PARAM_GPSD_PORT: | |
453 | rv.s = vgl->gpsd_port ? vgl->gpsd_port : g_strdup(DEFAULT_GPSD_PORT); | |
454 | break; | |
c5bc70c3 QT |
455 | case PARAM_GPSD_RETRY_INTERVAL: |
456 | rv.s = g_strdup_printf("%d", vgl->gpsd_retry_interval); | |
457 | break; | |
b87d3952 QT |
458 | case PARAM_REALTIME_REC: |
459 | rv.b = vgl->realtime_record; | |
460 | break; | |
461 | case PARAM_REALTIME_CENTER_START: | |
462 | rv.b = vgl->realtime_jump_to_start; | |
463 | break; | |
dc3a1898 QT |
464 | case PARAM_VEHICLE_POSITION: |
465 | rv.u = vgl->vehicle_position; | |
b87d3952 | 466 | break; |
001a86db | 467 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
b364d6bc | 468 | default: |
4c77d5e0 | 469 | g_warning(_("%s: unknown parameter"), __FUNCTION__); |
b364d6bc QT |
470 | } |
471 | ||
b364d6bc QT |
472 | return rv; |
473 | } | |
474 | ||
b87d3952 | 475 | VikGpsLayer *vik_gps_layer_new (VikViewport *vp) |
b364d6bc QT |
476 | { |
477 | gint i; | |
478 | VikGpsLayer *vgl = VIK_GPS_LAYER ( g_object_new ( VIK_GPS_LAYER_TYPE, NULL ) ); | |
479 | vik_layer_init ( VIK_LAYER(vgl), VIK_LAYER_GPS ); | |
480 | for (i = 0; i < NUM_TRW; i++) { | |
481 | vgl->trw_children[i] = NULL; | |
482 | } | |
7886de28 | 483 | vgl->children = NULL; |
f253a6a6 | 484 | vgl->cur_read_child = 0; |
b364d6bc | 485 | |
001a86db | 486 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 | 487 | vgl->realtime_tracking = FALSE; |
c5bc70c3 | 488 | vgl->first_realtime_trackpoint = FALSE; |
b87d3952 | 489 | vgl->vgpsd = NULL; |
c5bc70c3 QT |
490 | vgl->realtime_io_channel = NULL; |
491 | vgl->realtime_io_watch_id = 0; | |
492 | vgl->realtime_retry_timer = 0; | |
b87d3952 QT |
493 | vgl->realtime_track_gc = vik_viewport_new_gc ( vp, "#203070", 2 ); |
494 | vgl->realtime_track_bg_gc = vik_viewport_new_gc ( vp, "grey", 2 ); | |
495 | vgl->realtime_track_pt1_gc = vik_viewport_new_gc ( vp, "red", 2 ); | |
496 | vgl->realtime_track_pt2_gc = vik_viewport_new_gc ( vp, "green", 2 ); | |
497 | vgl->realtime_track_pt_gc = vgl->realtime_track_pt1_gc; | |
b87d3952 QT |
498 | vgl->realtime_track = NULL; |
499 | ||
b364d6bc | 500 | /* Setting params here */ |
b87d3952 QT |
501 | vgl->gpsd_host = g_strdup("localhost"); |
502 | vgl->gpsd_port = g_strdup(DEFAULT_GPSD_PORT); | |
503 | vgl->realtime_record = TRUE; | |
504 | vgl->realtime_jump_to_start = TRUE; | |
dc3a1898 | 505 | vgl->vehicle_position = VEHICLE_POSITION_ON_SCREEN; |
c5bc70c3 | 506 | vgl->gpsd_retry_interval = 10; |
001a86db QT |
507 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
508 | vgl->protocol_id = 0; | |
ce37ab9b | 509 | vgl->serial_port = NULL; |
b364d6bc | 510 | |
99163c34 RN |
511 | #ifndef WINDOWS |
512 | /* Attempt to auto set default USB serial port entry */ | |
513 | /* Ordered to make lowest device favourite if available */ | |
514 | if (g_access ("/dev/ttyUSB1", R_OK) == 0) { | |
515 | if (vgl->serial_port != NULL) | |
516 | g_free (vgl->serial_port); | |
517 | vgl->serial_port = g_strdup ("/dev/ttyUSB1"); | |
518 | } | |
519 | if (g_access ("/dev/ttyUSB0", R_OK) == 0) { | |
520 | if (vgl->serial_port != NULL) | |
521 | g_free (vgl->serial_port); | |
522 | vgl->serial_port = g_strdup ("/dev/ttyUSB0"); | |
523 | } | |
524 | #endif | |
525 | ||
b364d6bc QT |
526 | return vgl; |
527 | } | |
528 | ||
fdca5edb | 529 | static void vik_gps_layer_draw ( VikGpsLayer *vgl, gpointer data ) |
b364d6bc QT |
530 | { |
531 | gint i; | |
b87d3952 QT |
532 | VikLayer *vl; |
533 | VikLayer *trigger = VIK_LAYER(vik_viewport_get_trigger( VIK_VIEWPORT(data) )); | |
b364d6bc QT |
534 | |
535 | for (i = 0; i < NUM_TRW; i++) { | |
b87d3952 QT |
536 | vl = VIK_LAYER(vgl->trw_children[i]); |
537 | if (vl == trigger) { | |
538 | if ( vik_viewport_get_half_drawn ( VIK_VIEWPORT(data) ) ) { | |
539 | vik_viewport_set_half_drawn ( VIK_VIEWPORT(data), FALSE ); | |
540 | vik_viewport_snapshot_load( VIK_VIEWPORT(data) ); | |
541 | } else { | |
542 | vik_viewport_snapshot_save( VIK_VIEWPORT(data) ); | |
543 | } | |
544 | } | |
545 | if (!vik_viewport_get_half_drawn( VIK_VIEWPORT(data))) | |
546 | vik_layer_draw ( vl, data ); | |
547 | } | |
001a86db | 548 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 QT |
549 | if (vgl->realtime_tracking) { |
550 | if (VIK_LAYER(vgl) == trigger) { | |
551 | if ( vik_viewport_get_half_drawn ( VIK_VIEWPORT(data) ) ) { | |
552 | vik_viewport_set_half_drawn ( VIK_VIEWPORT(data), FALSE ); | |
553 | vik_viewport_snapshot_load( VIK_VIEWPORT(data) ); | |
554 | } else { | |
555 | vik_viewport_snapshot_save( VIK_VIEWPORT(data) ); | |
556 | } | |
557 | } | |
558 | if (!vik_viewport_get_half_drawn( VIK_VIEWPORT(data))) | |
559 | realtime_tracking_draw(vgl, VIK_VIEWPORT(data)); | |
b364d6bc | 560 | } |
001a86db | 561 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
b364d6bc QT |
562 | } |
563 | ||
564 | static void gps_layer_change_coord_mode ( VikGpsLayer *vgl, VikCoordMode mode ) | |
565 | { | |
566 | gint i; | |
567 | for (i = 0; i < NUM_TRW; i++) { | |
2cebc318 | 568 | vik_layer_change_coord_mode(VIK_LAYER(vgl->trw_children[i]), mode); |
b364d6bc QT |
569 | } |
570 | } | |
571 | ||
572 | static void gps_layer_add_menu_items( VikGpsLayer *vgl, GtkMenu *menu, gpointer vlp ) | |
573 | { | |
574 | static gpointer pass_along[2]; | |
575 | GtkWidget *item; | |
576 | pass_along[0] = vgl; | |
577 | pass_along[1] = vlp; | |
578 | ||
579 | item = gtk_menu_item_new(); | |
580 | gtk_menu_shell_append ( GTK_MENU_SHELL(menu), item ); | |
581 | gtk_widget_show ( item ); | |
582 | ||
fe161c08 | 583 | item = gtk_menu_item_new_with_mnemonic ( _("_Upload to GPS") ); |
b364d6bc QT |
584 | g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_upload_cb), pass_along ); |
585 | gtk_menu_shell_append (GTK_MENU_SHELL (menu), item); | |
586 | gtk_widget_show ( item ); | |
587 | ||
fe161c08 | 588 | item = gtk_menu_item_new_with_mnemonic ( _("Download from _GPS") ); |
b364d6bc QT |
589 | g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_download_cb), pass_along ); |
590 | gtk_menu_shell_append (GTK_MENU_SHELL (menu), item); | |
591 | gtk_widget_show ( item ); | |
592 | ||
001a86db | 593 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
fe161c08 RN |
594 | item = gtk_menu_item_new_with_mnemonic ( vgl->realtime_tracking ? |
595 | "_Stop Realtime Tracking" : | |
596 | "_Start Realtime Tracking" ); | |
b87d3952 QT |
597 | g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_start_stop_tracking_cb), pass_along ); |
598 | gtk_menu_shell_append (GTK_MENU_SHELL (menu), item); | |
599 | gtk_widget_show ( item ); | |
600 | ||
700b0908 QT |
601 | item = gtk_menu_item_new(); |
602 | gtk_menu_shell_append ( GTK_MENU_SHELL(menu), item ); | |
603 | gtk_widget_show ( item ); | |
22d1e285 RN |
604 | |
605 | item = gtk_menu_item_new_with_mnemonic ( _("Empty _Realtime") ); | |
606 | g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_empty_realtime_cb), pass_along ); | |
607 | gtk_menu_shell_append (GTK_MENU_SHELL (menu), item); | |
608 | gtk_widget_show ( item ); | |
001a86db | 609 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
700b0908 | 610 | |
fe161c08 | 611 | item = gtk_menu_item_new_with_mnemonic ( _("E_mpty Upload") ); |
700b0908 QT |
612 | g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_empty_upload_cb), pass_along ); |
613 | gtk_menu_shell_append (GTK_MENU_SHELL (menu), item); | |
614 | gtk_widget_show ( item ); | |
615 | ||
fe161c08 | 616 | item = gtk_menu_item_new_with_mnemonic ( _("_Empty Download") ); |
700b0908 QT |
617 | g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_empty_download_cb), pass_along ); |
618 | gtk_menu_shell_append (GTK_MENU_SHELL (menu), item); | |
619 | gtk_widget_show ( item ); | |
620 | ||
fe161c08 | 621 | item = gtk_menu_item_new_with_mnemonic ( _("Empty _All") ); |
700b0908 QT |
622 | g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_empty_all_cb), pass_along ); |
623 | gtk_menu_shell_append (GTK_MENU_SHELL (menu), item); | |
624 | gtk_widget_show ( item ); | |
625 | ||
b364d6bc QT |
626 | } |
627 | ||
628 | static void disconnect_layer_signal ( VikLayer *vl, VikGpsLayer *vgl ) | |
629 | { | |
30a9c13f RN |
630 | guint number_handlers = DISCONNECT_UPDATE_SIGNAL(vl,vgl); |
631 | if ( number_handlers != 1 ) { | |
632 | /* | |
633 | NB It's not fatal if this gives 2 for example! Hence removal of the g_assert | |
634 | This happens when copied GPS layer is deleted (not sure why the number_handlers would be 2) | |
635 | I don't think there's any side effects and certainly better than the program just aborting | |
636 | */ | |
637 | g_warning(_("Unexpected number of disconnected handlers: %d"), number_handlers); | |
638 | } | |
b364d6bc QT |
639 | } |
640 | ||
fdca5edb | 641 | static void vik_gps_layer_free ( VikGpsLayer *vgl ) |
b364d6bc | 642 | { |
b364d6bc QT |
643 | gint i; |
644 | for (i = 0; i < NUM_TRW; i++) { | |
e03074ba | 645 | if (vgl->vl.realized) |
fdca5edb | 646 | disconnect_layer_signal(VIK_LAYER(vgl->trw_children[i]), vgl); |
b364d6bc QT |
647 | g_object_unref(vgl->trw_children[i]); |
648 | } | |
001a86db | 649 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
b87d3952 QT |
650 | if (vgl->realtime_track_gc != NULL) |
651 | g_object_unref(vgl->realtime_track_gc); | |
652 | if (vgl->realtime_track_bg_gc != NULL) | |
653 | g_object_unref(vgl->realtime_track_bg_gc); | |
654 | if (vgl->realtime_track_pt1_gc != NULL) | |
655 | g_object_unref(vgl->realtime_track_pt1_gc); | |
656 | if (vgl->realtime_track_pt2_gc != NULL) | |
657 | g_object_unref(vgl->realtime_track_pt2_gc); | |
001a86db | 658 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
b364d6bc QT |
659 | } |
660 | ||
b364d6bc QT |
661 | gboolean vik_gps_layer_delete ( VikGpsLayer *vgl, GtkTreeIter *iter ) |
662 | { | |
663 | gint i; | |
664 | VikLayer *l = VIK_LAYER( vik_treeview_item_get_pointer ( VIK_LAYER(vgl)->vt, iter ) ); | |
665 | gboolean was_visible = l->visible; | |
666 | ||
667 | vik_treeview_item_delete ( VIK_LAYER(vgl)->vt, iter ); | |
668 | for (i = 0; i < NUM_TRW; i++) { | |
2cebc318 | 669 | if (VIK_LAYER(vgl->trw_children[i]) == l) |
b364d6bc QT |
670 | vgl->trw_children[i] = NULL; |
671 | } | |
672 | g_assert(DISCONNECT_UPDATE_SIGNAL(l,vgl)==1); | |
673 | g_object_unref ( l ); | |
674 | ||
675 | return was_visible; | |
676 | } | |
677 | ||
fdca5edb | 678 | static void vik_gps_layer_realize ( VikGpsLayer *vgl, VikTreeview *vt, GtkTreeIter *layer_iter ) |
b364d6bc QT |
679 | { |
680 | GtkTreeIter iter; | |
681 | int ix; | |
682 | ||
683 | for (ix = 0; ix < NUM_TRW; ix++) { | |
fdca5edb | 684 | VikLayer * trw = VIK_LAYER(vgl->trw_children[ix]); |
b364d6bc | 685 | vik_treeview_add_layer ( VIK_LAYER(vgl)->vt, layer_iter, &iter, |
4c77d5e0 | 686 | _(trw_names[ix]), vgl, |
b364d6bc QT |
687 | trw, trw->type, trw->type ); |
688 | if ( ! trw->visible ) | |
689 | vik_treeview_item_set_visible ( VIK_LAYER(vgl)->vt, &iter, FALSE ); | |
690 | vik_layer_realize ( trw, VIK_LAYER(vgl)->vt, &iter ); | |
b87d3952 | 691 | g_signal_connect_swapped ( G_OBJECT(trw), "update", G_CALLBACK(vik_layer_emit_update_secondary), vgl ); |
b364d6bc QT |
692 | } |
693 | } | |
694 | ||
7886de28 QT |
695 | const GList *vik_gps_layer_get_children ( VikGpsLayer *vgl ) |
696 | { | |
697 | int i; | |
698 | ||
699 | if (vgl->children == NULL) { | |
700 | for (i = NUM_TRW - 1; i >= 0; i--) | |
701 | vgl->children = g_list_prepend(vgl->children, vgl->trw_children[i]); | |
702 | } | |
703 | return vgl->children; | |
704 | } | |
705 | ||
f253a6a6 QT |
706 | VikTrwLayer * vik_gps_layer_get_a_child(VikGpsLayer *vgl) |
707 | { | |
708 | g_assert ((vgl->cur_read_child >= 0) && (vgl->cur_read_child < NUM_TRW)); | |
709 | ||
710 | VikTrwLayer * vtl = vgl->trw_children[vgl->cur_read_child]; | |
711 | if (++(vgl->cur_read_child) >= NUM_TRW) | |
712 | vgl->cur_read_child = 0; | |
713 | return(vtl); | |
714 | } | |
715 | ||
7886de28 QT |
716 | gboolean vik_gps_layer_is_empty ( VikGpsLayer *vgl ) |
717 | { | |
718 | if ( vgl->trw_children[0] ) | |
719 | return FALSE; | |
720 | return TRUE; | |
721 | } | |
722 | ||
b364d6bc QT |
723 | static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val_dest, GtkTreeIter *src_item_iter, GtkTreePath *dest_path ) |
724 | { | |
725 | VikTreeview *vt = VIK_LAYER(val_src)->vt; | |
726 | VikLayer *vl = vik_treeview_item_get_pointer(vt, src_item_iter); | |
727 | GtkTreeIter dest_iter; | |
728 | gchar *dp; | |
729 | gboolean target_exists; | |
730 | ||
b364d6bc QT |
731 | dp = gtk_tree_path_to_string(dest_path); |
732 | target_exists = vik_treeview_get_iter_from_path_str(vt, &dest_iter, dp); | |
733 | ||
734 | /* vik_gps_layer_delete unrefs, but we don't want that here. | |
735 | * we're still using the layer. */ | |
736 | g_object_ref ( vl ); | |
737 | vik_gps_layer_delete(val_src, src_item_iter); | |
738 | ||
b364d6bc QT |
739 | g_free(dp); |
740 | } | |
741 | ||
742 | static void gps_session_delete(GpsSession *sess) | |
743 | { | |
744 | /* TODO */ | |
745 | g_mutex_free(sess->mutex); | |
746 | g_free(sess->cmd_args); | |
747 | ||
748 | g_free(sess); | |
749 | ||
750 | } | |
751 | ||
752 | static void set_total_count(gint cnt, GpsSession *sess) | |
753 | { | |
754 | gchar s[128]; | |
755 | gdk_threads_enter(); | |
756 | g_mutex_lock(sess->mutex); | |
757 | if (sess->ok) { | |
97634600 GB |
758 | const gchar *tmp_str; |
759 | if (sess->direction == GPS_DOWN) | |
760 | { | |
761 | if (sess->progress_label == sess->wp_label) | |
2c3f09a6 | 762 | tmp_str = ngettext("Downloading %d waypoint...", "Downloading %d waypoints...", cnt); |
97634600 | 763 | else |
2c3f09a6 | 764 | tmp_str = ngettext("Downloading %d trackpoint...", "Downloading %d trackpoints...", cnt); |
97634600 GB |
765 | } |
766 | else | |
767 | { | |
768 | if (sess->progress_label == sess->wp_label) | |
2c3f09a6 | 769 | tmp_str = ngettext("Uploading %d waypoint...", "Uploading %d waypoints...", cnt); |
97634600 | 770 | else |
2c3f09a6 | 771 | tmp_str = ngettext("Uploading %d trackpoint...", "Uploading %d trackpoints...", cnt); |
97634600 GB |
772 | } |
773 | ||
774 | g_snprintf(s, 128, tmp_str, cnt); | |
b364d6bc QT |
775 | gtk_label_set_text ( GTK_LABEL(sess->progress_label), s ); |
776 | gtk_widget_show ( sess->progress_label ); | |
777 | sess->total_count = cnt; | |
778 | } | |
779 | g_mutex_unlock(sess->mutex); | |
780 | gdk_threads_leave(); | |
781 | } | |
782 | ||
783 | static void set_current_count(gint cnt, GpsSession *sess) | |
784 | { | |
785 | gchar s[128]; | |
97634600 | 786 | const gchar *tmp_str; |
b364d6bc QT |
787 | |
788 | gdk_threads_enter(); | |
789 | g_mutex_lock(sess->mutex); | |
790 | if (sess->ok) { | |
791 | if (cnt < sess->total_count) { | |
97634600 GB |
792 | if (sess->direction == GPS_DOWN) |
793 | { | |
794 | if (sess->progress_label == sess->wp_label) | |
56986697 | 795 | tmp_str = ngettext("Downloaded %d out of %d waypoint...", "Downloaded %d out of %d waypoints...", sess->total_count); |
97634600 | 796 | else |
56986697 | 797 | tmp_str = ngettext("Downloaded %d out of %d trackpoint...", "Downloaded %d out of %d trackpoints...", sess->total_count); |
97634600 GB |
798 | } |
799 | else { | |
800 | if (sess->progress_label == sess->wp_label) | |
56986697 | 801 | tmp_str = ngettext("Uploaded %d out of %d waypoint...", "Uploaded %d out of %d waypoints...", sess->total_count); |
97634600 | 802 | else |
56986697 | 803 | tmp_str = ngettext("Uploaded %d out of %d trackpoint...", "Uploaded %d out of %d trackpoints...", sess->total_count); |
97634600 GB |
804 | } |
805 | g_snprintf(s, 128, tmp_str, cnt, sess->total_count); | |
b364d6bc | 806 | } else { |
97634600 GB |
807 | if (sess->direction == GPS_DOWN) |
808 | { | |
809 | if (sess->progress_label == sess->wp_label) | |
56986697 | 810 | tmp_str = ngettext("Downloaded %d waypoint", "Downloaded %d waypoints", cnt); |
97634600 | 811 | else |
56986697 | 812 | tmp_str = ngettext("Downloaded %d trackpoint", "Downloaded %d trackpoints", cnt); |
97634600 GB |
813 | } |
814 | else { | |
815 | if (sess->progress_label == sess->wp_label) | |
56986697 | 816 | tmp_str = ngettext("Uploaded %d waypoint", "Uploaded %d waypoints", cnt); |
97634600 | 817 | else |
56986697 | 818 | tmp_str = ngettext("Uploaded %d trackpoint", "Uploaded %d trackpoints", cnt); |
97634600 GB |
819 | } |
820 | g_snprintf(s, 128, tmp_str, cnt); | |
b364d6bc QT |
821 | } |
822 | gtk_label_set_text ( GTK_LABEL(sess->progress_label), s ); | |
823 | } | |
824 | g_mutex_unlock(sess->mutex); | |
825 | gdk_threads_leave(); | |
826 | } | |
827 | ||
828 | static void set_gps_info(const gchar *info, GpsSession *sess) | |
829 | { | |
830 | gchar s[256]; | |
831 | gdk_threads_enter(); | |
832 | g_mutex_lock(sess->mutex); | |
833 | if (sess->ok) { | |
97634600 | 834 | g_snprintf(s, 256, _("GPS Device: %s"), info); |
b364d6bc QT |
835 | gtk_label_set_text ( GTK_LABEL(sess->gps_label), s ); |
836 | } | |
837 | g_mutex_unlock(sess->mutex); | |
838 | gdk_threads_leave(); | |
839 | } | |
840 | ||
841 | static void gps_download_progress_func(BabelProgressCode c, gpointer data, GpsSession * sess ) | |
842 | { | |
843 | gchar *line; | |
844 | ||
845 | gdk_threads_enter (); | |
846 | g_mutex_lock(sess->mutex); | |
847 | if (!sess->ok) { | |
848 | g_mutex_unlock(sess->mutex); | |
849 | gps_session_delete(sess); | |
850 | gdk_threads_leave(); | |
851 | g_thread_exit ( NULL ); | |
852 | } | |
853 | g_mutex_unlock(sess->mutex); | |
854 | gdk_threads_leave (); | |
855 | ||
856 | switch(c) { | |
857 | case BABEL_DIAG_OUTPUT: | |
858 | line = (gchar *)data; | |
859 | ||
860 | /* tells us how many items there will be */ | |
861 | if (strstr(line, "Xfer Wpt")) { | |
862 | sess->progress_label = sess->wp_label; | |
863 | } | |
864 | if (strstr(line, "Xfer Trk")) { | |
865 | sess->progress_label = sess->trk_label; | |
866 | } | |
867 | if (strstr(line, "PRDDAT")) { | |
868 | gchar **tokens = g_strsplit(line, " ", 0); | |
869 | gchar info[128]; | |
870 | int ilen = 0; | |
871 | int i; | |
c83b5ad9 QT |
872 | int n_tokens = 0; |
873 | ||
874 | while (tokens[n_tokens]) | |
875 | n_tokens++; | |
876 | ||
877 | if (n_tokens > 8) { | |
878 | for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) { | |
879 | guint ch; | |
880 | sscanf(tokens[i], "%x", &ch); | |
881 | info[ilen++] = ch; | |
882 | } | |
883 | info[ilen++] = 0; | |
884 | set_gps_info(info, sess); | |
b364d6bc | 885 | } |
c83b5ad9 | 886 | g_strfreev(tokens); |
b364d6bc | 887 | } |
0a3f9142 RN |
888 | /* eg: "Unit:\teTrex Legend HCx Software Version 2.90\n" */ |
889 | if (strstr(line, "Unit:")) { | |
890 | gchar **tokens = g_strsplit(line, "\t", 0); | |
891 | int n_tokens = 0; | |
892 | while (tokens[n_tokens]) | |
893 | n_tokens++; | |
894 | ||
895 | if (n_tokens > 1) { | |
896 | set_gps_info(tokens[1], sess); | |
897 | } | |
898 | g_strfreev(tokens); | |
899 | } | |
b364d6bc QT |
900 | if (strstr(line, "RECORD")) { |
901 | int lsb, msb, cnt; | |
902 | ||
c83b5ad9 QT |
903 | if (strlen(line) > 20) { |
904 | sscanf(line+17, "%x", &lsb); | |
905 | sscanf(line+20, "%x", &msb); | |
906 | cnt = lsb + msb * 256; | |
907 | set_total_count(cnt, sess); | |
908 | sess->count = 0; | |
909 | } | |
b364d6bc QT |
910 | } |
911 | if ( strstr(line, "WPTDAT") || strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) { | |
912 | sess->count++; | |
913 | set_current_count(sess->count, sess); | |
914 | } | |
915 | break; | |
916 | case BABEL_DONE: | |
917 | break; | |
918 | default: | |
919 | break; | |
920 | } | |
921 | ||
922 | } | |
923 | ||
924 | static void gps_upload_progress_func(BabelProgressCode c, gpointer data, GpsSession * sess ) | |
925 | { | |
926 | gchar *line; | |
927 | static int cnt = 0; | |
928 | ||
929 | gdk_threads_enter (); | |
930 | g_mutex_lock(sess->mutex); | |
931 | if (!sess->ok) { | |
932 | g_mutex_unlock(sess->mutex); | |
933 | gps_session_delete(sess); | |
934 | gdk_threads_leave(); | |
935 | g_thread_exit ( NULL ); | |
936 | } | |
937 | g_mutex_unlock(sess->mutex); | |
938 | gdk_threads_leave (); | |
939 | ||
940 | switch(c) { | |
941 | case BABEL_DIAG_OUTPUT: | |
942 | line = (gchar *)data; | |
943 | ||
944 | if (strstr(line, "PRDDAT")) { | |
945 | gchar **tokens = g_strsplit(line, " ", 0); | |
946 | gchar info[128]; | |
947 | int ilen = 0; | |
948 | int i; | |
c83b5ad9 QT |
949 | int n_tokens = 0; |
950 | ||
951 | while (tokens[n_tokens]) | |
952 | n_tokens++; | |
953 | ||
954 | if (n_tokens > 8) { | |
955 | for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) { | |
956 | guint ch; | |
957 | sscanf(tokens[i], "%x", &ch); | |
958 | info[ilen++] = ch; | |
959 | } | |
960 | info[ilen++] = 0; | |
961 | set_gps_info(info, sess); | |
b364d6bc | 962 | } |
c83b5ad9 | 963 | g_strfreev(tokens); |
b364d6bc QT |
964 | } |
965 | if (strstr(line, "RECORD")) { | |
966 | int lsb, msb; | |
967 | ||
c83b5ad9 QT |
968 | if (strlen(line) > 20) { |
969 | sscanf(line+17, "%x", &lsb); | |
970 | sscanf(line+20, "%x", &msb); | |
971 | cnt = lsb + msb * 256; | |
972 | /* set_total_count(cnt, sess); */ | |
973 | sess->count = 0; | |
974 | } | |
b364d6bc QT |
975 | } |
976 | if ( strstr(line, "WPTDAT")) { | |
977 | if (sess->count == 0) { | |
978 | sess->progress_label = sess->wp_label; | |
979 | set_total_count(cnt, sess); | |
980 | } | |
981 | sess->count++; | |
982 | set_current_count(sess->count, sess); | |
983 | ||
984 | } | |
985 | if ( strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) { | |
986 | if (sess->count == 0) { | |
987 | sess->progress_label = sess->trk_label; | |
988 | set_total_count(cnt, sess); | |
989 | } | |
990 | sess->count++; | |
991 | set_current_count(sess->count, sess); | |
992 | } | |
993 | break; | |
994 | case BABEL_DONE: | |
995 | break; | |
996 | default: | |
997 | break; | |
998 | } | |
999 | ||
1000 | } | |
1001 | ||
1002 | static void gps_comm_thread(GpsSession *sess) | |
1003 | { | |
1004 | gboolean result; | |
1005 | ||
1006 | if (sess->direction == GPS_DOWN) | |
1007 | result = a_babel_convert_from (sess->vtl, sess->cmd_args, | |
1008 | (BabelStatusFunc) gps_download_progress_func, sess->port, sess); | |
1009 | else | |
1010 | result = a_babel_convert_to (sess->vtl, sess->cmd_args, | |
1011 | (BabelStatusFunc) gps_upload_progress_func, sess->port, sess); | |
1012 | ||
1013 | gdk_threads_enter(); | |
1014 | if (!result) { | |
4c77d5e0 | 1015 | gtk_label_set_text ( GTK_LABEL(sess->status_label), _("Error: couldn't find gpsbabel.") ); |
b364d6bc QT |
1016 | } |
1017 | else { | |
1018 | g_mutex_lock(sess->mutex); | |
1019 | if (sess->ok) { | |
4c77d5e0 | 1020 | gtk_label_set_text ( GTK_LABEL(sess->status_label), _("Done.") ); |
b364d6bc QT |
1021 | gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_ACCEPT, TRUE ); |
1022 | gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_REJECT, FALSE ); | |
1023 | } else { | |
1024 | /* canceled */ | |
1025 | } | |
1026 | g_mutex_unlock(sess->mutex); | |
1027 | } | |
1028 | ||
1029 | g_mutex_lock(sess->mutex); | |
1030 | if (sess->ok) { | |
1031 | sess->ok = FALSE; | |
1032 | g_mutex_unlock(sess->mutex); | |
1033 | } | |
1034 | else { | |
1035 | g_mutex_unlock(sess->mutex); | |
1036 | gps_session_delete(sess); | |
1037 | } | |
1038 | gdk_threads_leave(); | |
1039 | g_thread_exit(NULL); | |
1040 | } | |
1041 | ||
1042 | static gint gps_comm(VikTrwLayer *vtl, gps_dir dir, vik_gps_proto proto, gchar *port) { | |
1043 | GpsSession *sess = g_malloc(sizeof(GpsSession)); | |
1044 | ||
1045 | sess->mutex = g_mutex_new(); | |
1046 | sess->direction = dir; | |
1047 | sess->vtl = vtl; | |
1048 | sess->port = g_strdup(port); | |
1049 | sess->ok = TRUE; | |
1050 | sess->cmd_args = g_strdup_printf("-D 9 -t -w -%c %s", | |
1051 | (dir == GPS_DOWN) ? 'i' : 'o', protocols_args[proto]); | |
4c77d5e0 | 1052 | sess->window_title = (dir == GPS_DOWN) ? _("GPS Download") : _("GPS Upload"); |
b364d6bc | 1053 | |
4a96999b | 1054 | sess->dialog = gtk_dialog_new_with_buttons ( "", VIK_GTK_WINDOW_FROM_LAYER(vtl), 0, GTK_STOCK_OK, GTK_RESPONSE_ACCEPT, GTK_STOCK_CANCEL, GTK_RESPONSE_REJECT, NULL ); |
b364d6bc QT |
1055 | gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), |
1056 | GTK_RESPONSE_ACCEPT, FALSE ); | |
1057 | gtk_window_set_title ( GTK_WINDOW(sess->dialog), sess->window_title ); | |
1058 | ||
4c77d5e0 | 1059 | sess->status_label = gtk_label_new (_("Status: detecting gpsbabel")); |
b364d6bc QT |
1060 | gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), |
1061 | sess->status_label, FALSE, FALSE, 5 ); | |
1062 | gtk_widget_show_all(sess->status_label); | |
1063 | ||
4c77d5e0 | 1064 | sess->gps_label = gtk_label_new (_("GPS device: N/A")); |
b364d6bc QT |
1065 | sess->ver_label = gtk_label_new (""); |
1066 | sess->id_label = gtk_label_new (""); | |
1067 | sess->wp_label = gtk_label_new (""); | |
1068 | sess->trk_label = gtk_label_new (""); | |
1069 | ||
1070 | gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->gps_label, FALSE, FALSE, 5 ); | |
1071 | gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->wp_label, FALSE, FALSE, 5 ); | |
1072 | gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->trk_label, FALSE, FALSE, 5 ); | |
1073 | ||
1074 | gtk_widget_show_all(sess->dialog); | |
1075 | ||
1076 | sess->progress_label = sess->wp_label; | |
1077 | sess->total_count = -1; | |
1078 | ||
1079 | /* TODO: starting gps read/write thread here */ | |
1080 | g_thread_create((GThreadFunc)gps_comm_thread, sess, FALSE, NULL ); | |
1081 | ||
f4732f9e | 1082 | gtk_dialog_set_default_response ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_ACCEPT ); |
b364d6bc QT |
1083 | gtk_dialog_run(GTK_DIALOG(sess->dialog)); |
1084 | ||
1085 | gtk_widget_destroy(sess->dialog); | |
1086 | ||
1087 | g_mutex_lock(sess->mutex); | |
1088 | if (sess->ok) { | |
1089 | sess->ok = FALSE; /* tell thread to stop */ | |
1090 | g_mutex_unlock(sess->mutex); | |
1091 | } | |
1092 | else { | |
1093 | g_mutex_unlock(sess->mutex); | |
1094 | gps_session_delete(sess); | |
1095 | } | |
1096 | ||
b364d6bc QT |
1097 | return 0; |
1098 | } | |
1099 | ||
1100 | static void gps_upload_cb( gpointer layer_and_vlp[2] ) | |
1101 | { | |
1102 | VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0]; | |
1103 | VikTrwLayer *vtl = vgl->trw_children[TRW_UPLOAD]; | |
ce37ab9b | 1104 | gps_comm(vtl, GPS_UP, vgl->protocol_id, vgl->serial_port); |
b364d6bc QT |
1105 | } |
1106 | ||
1107 | static void gps_download_cb( gpointer layer_and_vlp[2] ) | |
1108 | { | |
1109 | VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0]; | |
1110 | VikTrwLayer *vtl = vgl->trw_children[TRW_DOWNLOAD]; | |
ce37ab9b | 1111 | gps_comm(vtl, GPS_DOWN, vgl->protocol_id, vgl->serial_port); |
b364d6bc | 1112 | } |
700b0908 QT |
1113 | |
1114 | static void gps_empty_upload_cb( gpointer layer_and_vlp[2] ) | |
1115 | { | |
1116 | VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0]; | |
1117 | vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_UPLOAD]); | |
1118 | vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_UPLOAD]); | |
1119 | } | |
1120 | ||
1121 | static void gps_empty_download_cb( gpointer layer_and_vlp[2] ) | |
1122 | { | |
1123 | VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0]; | |
1124 | vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_DOWNLOAD]); | |
1125 | vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_DOWNLOAD]); | |
1126 | } | |
1127 | ||
22d1e285 RN |
1128 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
1129 | static void gps_empty_realtime_cb( gpointer layer_and_vlp[2] ) | |
1130 | { | |
1131 | VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0]; | |
1132 | vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_REALTIME]); | |
1133 | vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_REALTIME]); | |
1134 | } | |
1135 | #endif | |
1136 | ||
700b0908 QT |
1137 | static void gps_empty_all_cb( gpointer layer_and_vlp[2] ) |
1138 | { | |
1139 | VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0]; | |
1140 | vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_UPLOAD]); | |
1141 | vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_UPLOAD]); | |
1142 | vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_DOWNLOAD]); | |
1143 | vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_DOWNLOAD]); | |
dfef116b RN |
1144 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
1145 | vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_REALTIME]); | |
1146 | vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_REALTIME]); | |
1147 | #endif | |
700b0908 | 1148 | } |
b87d3952 | 1149 | |
001a86db | 1150 | #ifdef VIK_CONFIG_REALTIME_GPS_TRACKING |
c5bc70c3 QT |
1151 | static void rt_gpsd_disconnect(VikGpsLayer *vgl); |
1152 | static gboolean rt_gpsd_connect(VikGpsLayer *vgl, gboolean ask_if_failed); | |
1153 | ||
b87d3952 QT |
1154 | static void realtime_tracking_draw(VikGpsLayer *vgl, VikViewport *vp) |
1155 | { | |
c4e61875 | 1156 | struct LatLon ll; |
b87d3952 QT |
1157 | VikCoord nw, se; |
1158 | struct LatLon lnw, lse; | |
1159 | vik_viewport_screen_to_coord ( vp, -20, -20, &nw ); | |
1160 | vik_viewport_screen_to_coord ( vp, vik_viewport_get_width(vp)+20, vik_viewport_get_width(vp)+20, &se ); | |
1161 | vik_coord_to_latlon ( &nw, &lnw ); | |
1162 | vik_coord_to_latlon ( &se, &lse ); | |
c4e61875 QT |
1163 | if ( vgl->realtime_fix.fix.latitude > lse.lat && |
1164 | vgl->realtime_fix.fix.latitude < lnw.lat && | |
1165 | vgl->realtime_fix.fix.longitude > lnw.lon && | |
1166 | vgl->realtime_fix.fix.longitude < lse.lon ) { | |
b87d3952 QT |
1167 | VikCoord gps; |
1168 | gint x, y; | |
1169 | gint half_back_x, half_back_y; | |
1170 | gint half_back_bg_x, half_back_bg_y; | |
1171 | gint pt_x, pt_y; | |
1172 | gint ptbg_x, ptbg_y; | |
1173 | gint side1_x, side1_y, side2_x, side2_y; | |
1174 | gint side1bg_x, side1bg_y, side2bg_x, side2bg_y; | |
1175 | ||
c4e61875 QT |
1176 | ll.lat = vgl->realtime_fix.fix.latitude; |
1177 | ll.lon = vgl->realtime_fix.fix.longitude; | |
1178 | vik_coord_load_from_latlon ( &gps, vik_viewport_get_coord_mode(vp), &ll); | |
b87d3952 QT |
1179 | vik_viewport_coord_to_screen ( vp, &gps, &x, &y ); |
1180 | ||
c4e61875 QT |
1181 | gdouble heading_cos = cos(M_PI/180*vgl->realtime_fix.fix.track); |
1182 | gdouble heading_sin = sin(M_PI/180*vgl->realtime_fix.fix.track); | |
b87d3952 QT |
1183 | |
1184 | half_back_y = y+8*heading_cos; | |
1185 | half_back_x = x-8*heading_sin; | |
1186 | half_back_bg_y = y+10*heading_cos; | |
1187 | half_back_bg_x = x-10*heading_sin; | |
1188 | ||
1189 | pt_y = half_back_y-24*heading_cos; | |
1190 | pt_x = half_back_x+24*heading_sin; | |
1191 | ptbg_y = half_back_bg_y-28*heading_cos; | |
1192 | ptbg_x = half_back_bg_x+28*heading_sin; | |
1193 | ||
1194 | side1_y = half_back_y+9*heading_sin; | |
1195 | side1_x = half_back_x+9*heading_cos; | |
1196 | side1bg_y = half_back_bg_y+11*heading_sin; | |
1197 | side1bg_x = half_back_bg_x+11*heading_cos; | |
1198 | ||
1199 | side2_y = half_back_y-9*heading_sin; | |
1200 | side2_x = half_back_x-9*heading_cos; | |
1201 | side2bg_y = half_back_bg_y-11*heading_sin; | |
1202 | side2bg_x = half_back_bg_x-11*heading_cos; | |
1203 | ||
1204 | GdkPoint trian[3] = { { pt_x, pt_y }, {side1_x, side1_y}, {side2_x, side2_y} }; | |
1205 | GdkPoint trian_bg[3] = { { ptbg_x, pt_y }, {side1bg_x, side1bg_y}, {side2bg_x, side2bg_y} }; | |
1206 | ||
1207 | vik_viewport_draw_polygon ( vp, vgl->realtime_track_bg_gc, TRUE, trian_bg, 3 ); | |
1208 | vik_viewport_draw_polygon ( vp, vgl->realtime_track_gc, TRUE, trian, 3 ); | |
c4e61875 QT |
1209 | vik_viewport_draw_rectangle ( vp, |
1210 | (vgl->realtime_fix.fix.mode > MODE_2D) ? vgl->realtime_track_pt2_gc : vgl->realtime_track_pt1_gc, | |
1211 | TRUE, x-2, y-2, 4, 4 ); | |
1212 | //vgl->realtime_track_pt_gc = (vgl->realtime_track_pt_gc == vgl->realtime_track_pt1_gc) ? vgl->realtime_track_pt2_gc : vgl->realtime_track_pt1_gc; | |
b87d3952 QT |
1213 | } |
1214 | } | |
1215 | ||
b87d3952 QT |
1216 | static void create_realtime_trackpoint(VikGpsLayer *vgl, gboolean forced) |
1217 | { | |
c4e61875 QT |
1218 | struct LatLon ll; |
1219 | GList *last_tp; | |
97cab2d5 QT |
1220 | |
1221 | /* Note that fix.time is a double, but it should not affect the precision | |
1222 | for most GPS */ | |
1223 | time_t cur_timestamp = vgl->realtime_fix.fix.time; | |
1224 | time_t last_timestamp = vgl->last_fix.fix.time; | |
1225 | ||
1226 | if (cur_timestamp < last_timestamp) { | |
1227 | return; | |
1228 | } | |
1229 | ||
b87d3952 | 1230 | if (vgl->realtime_record && vgl->realtime_fix.dirty) { |
c4e61875 QT |
1231 | gboolean replace = FALSE; |
1232 | int heading = (int)floor(vgl->realtime_fix.fix.track); | |
1233 | int last_heading = (int)floor(vgl->last_fix.fix.track); | |
1234 | int alt = isnan(vgl->realtime_fix.fix.altitude) ? VIK_DEFAULT_ALTITUDE : floor(vgl->realtime_fix.fix.altitude); | |
1235 | int last_alt = isnan(vgl->last_fix.fix.altitude) ? VIK_DEFAULT_ALTITUDE : floor(vgl->last_fix.fix.altitude); | |
1236 | if (((last_tp = g_list_last(vgl->realtime_track->trackpoints)) != NULL) && | |
1237 | (vgl->realtime_fix.fix.mode > MODE_2D) && | |
1238 | (vgl->last_fix.fix.mode <= MODE_2D) && | |
97cab2d5 | 1239 | ((cur_timestamp - last_timestamp) < 2)) { |
c4e61875 QT |
1240 | g_free(last_tp->data); |
1241 | vgl->realtime_track->trackpoints = g_list_delete_link(vgl->realtime_track->trackpoints, last_tp); | |
1242 | replace = TRUE; | |
1243 | } | |
97cab2d5 QT |
1244 | if (replace || |
1245 | ((cur_timestamp != last_timestamp) && | |
1246 | ((forced || | |
1247 | ((heading < last_heading) && (heading < (last_heading - 3))) || | |
1248 | ((heading > last_heading) && (heading > (last_heading + 3))) || | |
1249 | ((alt != VIK_DEFAULT_ALTITUDE) && (alt != last_alt)))))) { | |
b87d3952 QT |
1250 | /* TODO: check for new segments */ |
1251 | VikTrackpoint *tp = vik_trackpoint_new(); | |
1252 | tp->newsegment = FALSE; | |
b87d3952 | 1253 | tp->has_timestamp = TRUE; |
c4e61875 | 1254 | tp->timestamp = vgl->realtime_fix.fix.time; |
a2817d3c QT |
1255 | tp->altitude = alt; |
1256 | /* speed only available for 3D fix. Check for NAN when use this speed */ | |
1257 | tp->speed = vgl->realtime_fix.fix.speed; | |
1258 | tp->course = vgl->realtime_fix.fix.track; | |
1259 | tp->nsats = vgl->realtime_fix.satellites_used; | |
1260 | tp->fix_mode = vgl->realtime_fix.fix.mode; | |
c4e61875 QT |
1261 | |
1262 | ll.lat = vgl->realtime_fix.fix.latitude; | |
1263 | ll.lon = vgl->realtime_fix.fix.longitude; | |
b87d3952 | 1264 | vik_coord_load_from_latlon(&tp->coord, |
c4e61875 | 1265 | vik_trw_layer_get_coord_mode(vgl->trw_children[TRW_REALTIME]), &ll); |
b87d3952 QT |
1266 | |
1267 | vgl->realtime_track->trackpoints = g_list_append(vgl->realtime_track->trackpoints, tp); | |
1268 | vgl->realtime_fix.dirty = FALSE; | |
a2817d3c | 1269 | vgl->realtime_fix.satellites_used = 0; |
b87d3952 QT |
1270 | vgl->last_fix = vgl->realtime_fix; |
1271 | } | |
1272 | } | |
1273 | ||
1274 | } | |
1275 | ||
c5bc70c3 | 1276 | static void gpsd_raw_hook(VglGpsd *vgpsd, gchar *data) |
b87d3952 | 1277 | { |
c4e61875 | 1278 | gboolean update_all = FALSE; |
b87d3952 QT |
1279 | VikGpsLayer *vgl = vgpsd->vgl; |
1280 | ||
c4e61875 QT |
1281 | if (!vgl->realtime_tracking) { |
1282 | g_warning("%s: receiving GPS data while not in realtime mode", __PRETTY_FUNCTION__); | |
b87d3952 | 1283 | return; |
b87d3952 QT |
1284 | } |
1285 | ||
b87d3952 QT |
1286 | if ((vgpsd->gpsd.fix.mode >= MODE_2D) && |
1287 | !isnan(vgpsd->gpsd.fix.latitude) && | |
1288 | !isnan(vgpsd->gpsd.fix.longitude) && | |
1289 | !isnan(vgpsd->gpsd.fix.track)) { | |
dc3a1898 QT |
1290 | |
1291 | VikWindow *vw = VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(vgl)); | |
1292 | VikViewport *vvp = vik_window_viewport(vw); | |
c4e61875 | 1293 | vgl->realtime_fix.fix = vgpsd->gpsd.fix; |
a2817d3c | 1294 | vgl->realtime_fix.satellites_used = vgpsd->gpsd.satellites_used; |
b87d3952 QT |
1295 | vgl->realtime_fix.dirty = TRUE; |
1296 | ||
dc3a1898 QT |
1297 | struct LatLon ll; |
1298 | VikCoord vehicle_coord; | |
c4e61875 | 1299 | |
dc3a1898 QT |
1300 | ll.lat = vgl->realtime_fix.fix.latitude; |
1301 | ll.lon = vgl->realtime_fix.fix.longitude; | |
1302 | vik_coord_load_from_latlon(&vehicle_coord, | |
1303 | vik_trw_layer_get_coord_mode(vgl->trw_children[TRW_REALTIME]), &ll); | |
1304 | ||
1305 | if ((vgl->vehicle_position == VEHICLE_POSITION_CENTERED) || | |
c5bc70c3 | 1306 | (vgl->realtime_jump_to_start && vgl->first_realtime_trackpoint)) { |
dc3a1898 QT |
1307 | vik_viewport_set_center_coord(vvp, &vehicle_coord); |
1308 | update_all = TRUE; | |
1309 | } | |
a00e1e36 | 1310 | else if (vgl->vehicle_position == VEHICLE_POSITION_ON_SCREEN) { |
dc3a1898 QT |
1311 | const int hdiv = 6; |
1312 | const int vdiv = 6; | |
1313 | const int px = 20; /* adjust ment in pixels to make sure vehicle is inside the box */ | |
1314 | gint width = vik_viewport_get_width(vvp); | |
1315 | gint height = vik_viewport_get_height(vvp); | |
1316 | gint vx, vy; | |
1317 | ||
1318 | vik_viewport_coord_to_screen(vvp, &vehicle_coord, &vx, &vy); | |
c4e61875 | 1319 | update_all = TRUE; |
dc3a1898 QT |
1320 | if (vx < (width/hdiv)) |
1321 | vik_viewport_set_center_screen(vvp, vx - width/2 + width/hdiv + px, vy); | |
1322 | else if (vx > (width - width/hdiv)) | |
1323 | vik_viewport_set_center_screen(vvp, vx + width/2 - width/hdiv - px, vy); | |
1324 | else if (vy < (height/vdiv)) | |
1325 | vik_viewport_set_center_screen(vvp, vx, vy - height/2 + height/vdiv + px); | |
1326 | else if (vy > (height - height/vdiv)) | |
1327 | vik_viewport_set_center_screen(vvp, vx, vy + height/2 - height/vdiv - px); | |
1328 | else | |
1329 | update_all = FALSE; | |
c4e61875 QT |
1330 | } |
1331 | ||
c5bc70c3 | 1332 | vgl->first_realtime_trackpoint = FALSE; |
b87d3952 | 1333 | create_realtime_trackpoint(vgl, FALSE); |
b87d3952 | 1334 | |
61d10ad4 | 1335 | gdk_threads_enter(); |
c4e61875 | 1336 | vik_layer_emit_update ( update_all ? VIK_LAYER(vgl) : VIK_LAYER(vgl->trw_children[TRW_REALTIME])); |
61d10ad4 | 1337 | gdk_threads_leave(); |
b87d3952 QT |
1338 | } |
1339 | } | |
1340 | ||
1341 | static gboolean gpsd_data_available(GIOChannel *source, GIOCondition condition, gpointer data) | |
1342 | { | |
b87d3952 | 1343 | VikGpsLayer *vgl = data; |
c5bc70c3 QT |
1344 | if (condition == G_IO_IN) { |
1345 | if (!gps_poll(&vgl->vgpsd->gpsd)) | |
1346 | return TRUE; | |
1347 | else { | |
24953b45 | 1348 | g_warning("Disconnected from gpsd. Trying to reconnect"); |
c5bc70c3 QT |
1349 | rt_gpsd_disconnect(vgl); |
1350 | rt_gpsd_connect(vgl, FALSE); | |
1351 | } | |
1352 | } | |
1353 | return FALSE; /* no further calling */ | |
b87d3952 QT |
1354 | } |
1355 | ||
1356 | static gchar *make_track_name(VikTrwLayer *vtl) | |
1357 | { | |
1358 | const gchar basename[] = "REALTIME"; | |
1359 | const gint bufsize = sizeof(basename) + 5; | |
1360 | gchar *name = g_malloc(bufsize); | |
1361 | strcpy(name, basename); | |
1362 | gint i = 2; | |
1363 | ||
1364 | while (vik_trw_layer_get_track(vtl, name) != NULL) { | |
1365 | g_snprintf(name, bufsize, "%s#%d", basename, i); | |
1366 | i++; | |
1367 | } | |
1368 | return(name); | |
1369 | ||
1370 | } | |
1371 | ||
c5bc70c3 QT |
1372 | static gboolean rt_gpsd_try_connect(gpointer *data) |
1373 | { | |
1374 | VikGpsLayer *vgl = (VikGpsLayer *)data; | |
a263d172 | 1375 | #ifndef HAVE_GPS_OPEN_R |
c5bc70c3 QT |
1376 | struct gps_data_t *gpsd = gps_open(vgl->gpsd_host, vgl->gpsd_port); |
1377 | ||
1378 | if (gpsd == NULL) { | |
a263d172 GB |
1379 | #else |
1380 | vgl->vgpsd = g_malloc(sizeof(VglGpsd)); | |
1381 | ||
1382 | if (gps_open_r(vgl->gpsd_host, vgl->gpsd_port, /*(struct gps_data_t *)*/vgl->vgpsd) != 0) { | |
1383 | #endif | |
24953b45 QT |
1384 | g_warning("Failed to connect to gpsd at %s (port %s). Will retry in %d seconds", |
1385 | vgl->gpsd_host, vgl->gpsd_port, vgl->gpsd_retry_interval); | |
c5bc70c3 QT |
1386 | return TRUE; /* keep timer running */ |
1387 | } | |
1388 | ||
a263d172 GB |
1389 | #ifndef HAVE_GPS_OPEN_R |
1390 | vgl->vgpsd = realloc(gpsd, sizeof(VglGpsd)); | |
1391 | #endif | |
c5bc70c3 QT |
1392 | vgl->vgpsd->vgl = vgl; |
1393 | ||
1394 | vgl->realtime_fix.dirty = vgl->last_fix.dirty = FALSE; | |
1395 | /* track alt/time graph uses VIK_DEFAULT_ALTITUDE (0.0) as invalid */ | |
1396 | vgl->realtime_fix.fix.altitude = vgl->last_fix.fix.altitude = VIK_DEFAULT_ALTITUDE; | |
1397 | vgl->realtime_fix.fix.speed = vgl->last_fix.fix.speed = NAN; | |
1398 | ||
1399 | if (vgl->realtime_record) { | |
1400 | VikTrwLayer *vtl = vgl->trw_children[TRW_REALTIME]; | |
1401 | vgl->realtime_track = vik_track_new(); | |
1402 | vgl->realtime_track->visible = TRUE; | |
1403 | vgl->realtime_track_name = make_track_name(vtl); | |
1404 | vik_trw_layer_add_track(vtl, vgl->realtime_track_name, vgl->realtime_track); | |
1405 | } | |
1406 | ||
1407 | gps_set_raw_hook(&vgl->vgpsd->gpsd, gpsd_raw_hook); | |
1408 | vgl->realtime_io_channel = g_io_channel_unix_new(vgl->vgpsd->gpsd.gps_fd); | |
1409 | vgl->realtime_io_watch_id = g_io_add_watch( vgl->realtime_io_channel, | |
1410 | G_IO_IN | G_IO_ERR | G_IO_HUP, gpsd_data_available, vgl); | |
bec818c4 | 1411 | #if HAVE_GPS_STREAM |
032c9651 | 1412 | gps_stream(&vgl->vgpsd->gpsd, WATCH_ENABLE, NULL); |
bec818c4 GB |
1413 | #else |
1414 | gps_query(&vgl->vgpsd->gpsd, "w+x"); | |
1415 | #endif | |
c5bc70c3 QT |
1416 | return FALSE; /* no longer called by timeout */ |
1417 | } | |
1418 | ||
1419 | static gboolean rt_ask_retry(VikGpsLayer *vgl) | |
1420 | { | |
1421 | GtkWidget *dialog = gtk_message_dialog_new (VIK_GTK_WINDOW_FROM_LAYER(vgl), | |
1422 | GTK_DIALOG_DESTROY_WITH_PARENT, | |
1423 | GTK_MESSAGE_QUESTION, | |
1424 | GTK_BUTTONS_YES_NO, | |
1425 | "Failed to connect to gpsd at %s (port %s)\n" | |
1426 | "Should Viking keep trying (every %d seconds)?", | |
1427 | vgl->gpsd_host, vgl->gpsd_port, | |
1428 | vgl->gpsd_retry_interval); | |
1429 | ||
1430 | gint res = gtk_dialog_run(GTK_DIALOG(dialog)); | |
1431 | gtk_widget_destroy(dialog); | |
1432 | return (res == GTK_RESPONSE_YES); | |
1433 | } | |
1434 | ||
1435 | static gboolean rt_gpsd_connect(VikGpsLayer *vgl, gboolean ask_if_failed) | |
1436 | { | |
1437 | vgl->realtime_retry_timer = 0; | |
1438 | if (rt_gpsd_try_connect((gpointer *)vgl)) { | |
1439 | if (vgl->gpsd_retry_interval <= 0) { | |
1440 | g_warning("Failed to connect to gpsd but will not retry because retry intervel was set to %d (which is 0 or negative)", vgl->gpsd_retry_interval); | |
1441 | return FALSE; | |
1442 | } | |
1443 | else if (ask_if_failed && !rt_ask_retry(vgl)) | |
1444 | return FALSE; | |
1445 | else | |
1446 | vgl->realtime_retry_timer = g_timeout_add_seconds(vgl->gpsd_retry_interval, | |
1447 | (GSourceFunc)rt_gpsd_try_connect, (gpointer *)vgl); | |
1448 | } | |
1449 | return TRUE; | |
1450 | } | |
1451 | ||
1452 | static void rt_gpsd_disconnect(VikGpsLayer *vgl) | |
1453 | { | |
1454 | if (vgl->realtime_io_watch_id) { | |
1455 | g_source_remove(vgl->realtime_io_watch_id); | |
1456 | vgl->realtime_io_watch_id = 0; | |
1457 | } | |
1458 | if (vgl->realtime_retry_timer) { | |
1459 | g_source_remove(vgl->realtime_retry_timer); | |
1460 | vgl->realtime_retry_timer = 0; | |
1461 | } | |
1462 | if (vgl->realtime_io_channel) { | |
1463 | GError *error = NULL; | |
1464 | g_io_channel_shutdown (vgl->realtime_io_channel, FALSE, &error); | |
1465 | vgl->realtime_io_channel = NULL; | |
1466 | } | |
1467 | if (vgl->vgpsd) { | |
1468 | gps_close(&vgl->vgpsd->gpsd); | |
a263d172 GB |
1469 | #ifdef HAVE_GPS_OPEN_R |
1470 | g_free(vgl->vgpsd); | |
1471 | #else | |
1472 | free(vgl->vgpsd); | |
1473 | #endif | |
c5bc70c3 QT |
1474 | vgl->vgpsd = NULL; |
1475 | } | |
1476 | ||
1477 | if (vgl->realtime_record && vgl->realtime_track) { | |
1478 | create_realtime_trackpoint(vgl, TRUE); | |
1479 | if ((vgl->realtime_track->trackpoints == NULL) || (vgl->realtime_track->trackpoints->next == NULL)) | |
1480 | vik_trw_layer_delete_track(vgl->trw_children[TRW_REALTIME], vgl->realtime_track_name); | |
1481 | vgl->realtime_track = NULL; | |
1482 | } | |
1483 | } | |
1484 | ||
b87d3952 QT |
1485 | static void gps_start_stop_tracking_cb( gpointer layer_and_vlp[2]) |
1486 | { | |
1487 | VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0]; | |
1488 | vgl->realtime_tracking = (vgl->realtime_tracking == FALSE); | |
1489 | ||
a2817d3c QT |
1490 | /* Make sure we are still in the boat with libgps */ |
1491 | g_assert((VIK_GPS_MODE_2D == MODE_2D) && (VIK_GPS_MODE_3D == MODE_3D)); | |
1492 | ||
b87d3952 | 1493 | if (vgl->realtime_tracking) { |
c5bc70c3 QT |
1494 | vgl->first_realtime_trackpoint = TRUE; |
1495 | if (!rt_gpsd_connect(vgl, TRUE)) { | |
1496 | vgl->first_realtime_trackpoint = FALSE; | |
b87d3952 | 1497 | vgl->realtime_tracking = FALSE; |
b87d3952 | 1498 | } |
b87d3952 QT |
1499 | } |
1500 | else { /* stop realtime tracking */ | |
c5bc70c3 QT |
1501 | vgl->first_realtime_trackpoint = FALSE; |
1502 | rt_gpsd_disconnect(vgl); | |
b87d3952 QT |
1503 | } |
1504 | } | |
001a86db | 1505 | #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */ |
b87d3952 | 1506 |