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