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