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 typedef enum {GPS_DOWN=0, GPS_UP} gps_dir;
 104
 105 typedef struct {
 106   GMutex *mutex;
 107   gps_dir direction;
 108   gchar *port;
 109   gboolean ok;
 110   gint total_count;
 111   gint count;
 112   VikTrwLayer *vtl;
 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     /* tells us how many items there will be */
 967     if (strstr(line, "Xfer Wpt")) {
 968       sess->progress_label = sess->wp_label;
 969     }
 970     if (strstr(line, "Xfer Trk")) {
 971       sess->progress_label = sess->trk_label;
 972     }
 973     if (strstr(line, "PRDDAT")) {
 974       gchar **tokens = g_strsplit(line, " ", 0);
 975       gchar info[128];
 976       int ilen = 0;
 977       int i;
 978       int n_tokens = 0;
 979
 980       while (tokens[n_tokens])
 981         n_tokens++;
 982
 983       if (n_tokens > 8) {
 984         for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) {
 985           guint ch;
 986           sscanf(tokens[i], "%x", &ch);
 987           info[ilen++] = ch;
 988         }
 989         info[ilen++] = 0;
 990         set_gps_info(info, sess);
 991       }
 992       g_strfreev(tokens);
 993     }
 994     /* eg: "Unit:\teTrex Legend HCx Software Version 2.90\n" */
 995     if (strstr(line, "Unit:")) {
 996       gchar **tokens = g_strsplit(line, "\t", 0);
 997       int n_tokens = 0;
 998       while (tokens[n_tokens])
 999         n_tokens++;
1000
1001       if (n_tokens > 1) {
1002         set_gps_info(tokens[1], sess);
1003       }
1004       g_strfreev(tokens);
1005     }
1006     if (strstr(line, "RECORD")) {
1007       int lsb, msb, cnt;
1008
1009       if (strlen(line) > 20) {
1010         sscanf(line+17, "%x", &lsb);
1011         sscanf(line+20, "%x", &msb);
1012         cnt = lsb + msb * 256;
1013         set_total_count(cnt, sess);
1014         sess->count = 0;
1015       }
1016     }
1017     if ( strstr(line, "WPTDAT") || strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) {
1018       sess->count++;
1019       set_current_count(sess->count, sess);
1020     }
1021     break;
1022   case BABEL_DONE:
1023     break;
1024   default:
1025     break;
1026   }
1027
1028 }
1029
1030 static void gps_upload_progress_func(BabelProgressCode c, gpointer data, GpsSession * sess )
1031 {
1032   gchar *line;
1033   static int cnt = 0;
1034
1035   gdk_threads_enter ();
1036   g_mutex_lock(sess->mutex);
1037   if (!sess->ok) {
1038     g_mutex_unlock(sess->mutex);
1039     gps_session_delete(sess);
1040     gdk_threads_leave();
1041     g_thread_exit ( NULL );
1042   }
1043   g_mutex_unlock(sess->mutex);
1044   gdk_threads_leave ();
1045
1046   switch(c) {
1047   case BABEL_DIAG_OUTPUT:
1048     line = (gchar *)data;
1049
1050     if (strstr(line, "PRDDAT")) {
1051       gchar **tokens = g_strsplit(line, " ", 0);
1052       gchar info[128];
1053       int ilen = 0;
1054       int i;
1055       int n_tokens = 0;
1056
1057       while (tokens[n_tokens])
1058         n_tokens++;
1059
1060       if (n_tokens > 8) {
1061         for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) {
1062           guint ch;
1063           sscanf(tokens[i], "%x", &ch);
1064           info[ilen++] = ch;
1065         }
1066         info[ilen++] = 0;
1067         set_gps_info(info, sess);
1068       }
1069       g_strfreev(tokens);
1070     }
1071     if (strstr(line, "RECORD")) {
1072       int lsb, msb;
1073
1074       if (strlen(line) > 20) {
1075         sscanf(line+17, "%x", &lsb);
1076         sscanf(line+20, "%x", &msb);
1077         cnt = lsb + msb * 256;
1078         /* set_total_count(cnt, sess); */
1079         sess->count = 0;
1080       }
1081     }
1082     if ( strstr(line, "WPTDAT")) {
1083       if (sess->count == 0) {
1084         sess->progress_label = sess->wp_label;
1085         set_total_count(cnt, sess);
1086       }
1087       sess->count++;
1088       set_current_count(sess->count, sess);
1089
1090     }
1091     if ( strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) {
1092       if (sess->count == 0) {
1093         sess->progress_label = sess->trk_label;
1094         set_total_count(cnt, sess);
1095       }
1096       sess->count++;
1097       set_current_count(sess->count, sess);
1098     }
1099     break;
1100   case BABEL_DONE:
1101     break;
1102   default:
1103     break;
1104   }
1105
1106 }
1107
1108 static void gps_comm_thread(GpsSession *sess)
1109 {
1110   gboolean result;
1111
1112   if (sess->direction == GPS_DOWN)
1113     result = a_babel_convert_from (sess->vtl, sess->cmd_args, sess->port,
1114         (BabelStatusFunc) gps_download_progress_func, sess);
1115   else {
1116     result = a_babel_convert_to (sess->vtl, NULL, sess->cmd_args, sess->port,
1117         (BabelStatusFunc) gps_upload_progress_func, sess);
1118   }
1119
1120   if (!result) {
1121     gtk_label_set_text ( GTK_LABEL(sess->status_label), _("Error: couldn't find gpsbabel.") );
1122   }
1123   else {
1124     g_mutex_lock(sess->mutex);
1125     if (sess->ok) {
1126       gtk_label_set_text ( GTK_LABEL(sess->status_label), _("Done.") );
1127       gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_ACCEPT, TRUE );
1128       gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_REJECT, FALSE );
1129
1130       /* Do not change the view if we are following the current GPS position */
1131 #if defined (VIK_CONFIG_REALTIME_GPS_TRACKING) && defined (GPSD_API_MAJOR_VERSION)
1132       if (!sess->realtime_tracking)
1133 #endif
1134       {
1135         if ( sess->vvp && sess->direction == GPS_DOWN ) {
1136           /* View the data available */
1137           vik_trw_layer_auto_set_view ( sess->vtl, sess->vvp) ;
1138           vik_layer_emit_update ( VIK_LAYER(sess->vtl), TRUE ); // Yes update from background thread
1139         }
1140       }
1141     } else {
1142       /* canceled */
1143     }
1144     g_mutex_unlock(sess->mutex);
1145   }
1146
1147   g_mutex_lock(sess->mutex);
1148   if (sess->ok) {
1149     sess->ok = FALSE;
1150     g_mutex_unlock(sess->mutex);
1151   }
1152   else {
1153     g_mutex_unlock(sess->mutex);
1154     gps_session_delete(sess);
1155   }
1156   g_thread_exit(NULL);
1157 }
1158
1159 static gint gps_comm(VikTrwLayer *vtl, gps_dir dir, vik_gps_proto proto, gchar *port, gboolean tracking, VikViewport *vvp, VikLayersPanel *vlp, gboolean do_tracks, gboolean do_waypoints) {
1160   GpsSession *sess = g_malloc(sizeof(GpsSession));
1161   char *tracks = NULL;
1162   char *waypoints = NULL;
1163
1164   sess->mutex = g_mutex_new();
1165   sess->direction = dir;
1166   sess->vtl = vtl;
1167   sess->port = g_strdup(port);
1168   sess->ok = TRUE;
1169   sess->window_title = (dir == GPS_DOWN) ? _("GPS Download") : _("GPS Upload");
1170   sess->vvp = vvp;
1171
1172   // This must be done inside the main thread as the uniquify causes screen updates
1173   //  (originally performed this nearer the point of upload in the thread)
1174   if ( dir == GPS_UP ) {
1175     // Enforce unique names in the layer upload to the GPS device
1176     // NB this may only be a Garmin device restriction (and may be not every Garmin device either...)
1177     // Thus this maintains the older code in built restriction
1178     if ( ! vik_trw_layer_uniquify ( sess->vtl, vlp ) )
1179       vik_statusbar_set_message ( vik_window_get_statusbar (VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(sess->vtl))), VIK_STATUSBAR_INFO,
1180                                   _("Warning - GPS Upload items may overwrite each other") );
1181   }
1182
1183 #if defined (VIK_CONFIG_REALTIME_GPS_TRACKING) && defined (GPSD_API_MAJOR_VERSION)
1184   sess->realtime_tracking = tracking;
1185 #endif
1186
1187   if (do_tracks)
1188     tracks = "-t";
1189   else
1190     tracks = "";
1191   if (do_waypoints)
1192     waypoints = "-w";
1193   else
1194     waypoints = "";
1195
1196   sess->cmd_args = g_strdup_printf("-D 9 %s %s -%c %s",
1197                                    tracks, waypoints, (dir == GPS_DOWN) ? 'i' : 'o', protocol);
1198   tracks = NULL;
1199   waypoints = NULL;
1200
1201   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 );
1202   gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog),
1203       GTK_RESPONSE_ACCEPT, FALSE );
1204   gtk_window_set_title ( GTK_WINDOW(sess->dialog), sess->window_title );
1205
1206   sess->status_label = gtk_label_new (_("Status: detecting gpsbabel"));
1207   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox),
1208       sess->status_label, FALSE, FALSE, 5 );
1209   gtk_widget_show_all(sess->status_label);
1210
1211   sess->gps_label = gtk_label_new (_("GPS device: N/A"));
1212   sess->ver_label = gtk_label_new ("");
1213   sess->id_label = gtk_label_new ("");
1214   sess->wp_label = gtk_label_new ("");
1215   sess->trk_label = gtk_label_new ("");
1216
1217   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->gps_label, FALSE, FALSE, 5 );
1218   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->wp_label, FALSE, FALSE, 5 );
1219   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->trk_label, FALSE, FALSE, 5 );
1220
1221   gtk_widget_show_all(sess->dialog);
1222
1223   sess->progress_label = sess->wp_label;
1224   sess->total_count = -1;
1225
1226   /* TODO: starting gps read/write thread here */
1227   g_thread_create((GThreadFunc)gps_comm_thread, sess, FALSE, NULL );
1228
1229   gtk_dialog_set_default_response ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_ACCEPT );
1230   gtk_dialog_run(GTK_DIALOG(sess->dialog));
1231
1232   gtk_widget_destroy(sess->dialog);
1233
1234   g_mutex_lock(sess->mutex);
1235   if (sess->ok) {
1236     sess->ok = FALSE;   /* tell thread to stop */
1237     g_mutex_unlock(sess->mutex);
1238   }
1239   else {
1240     g_mutex_unlock(sess->mutex);
1241     gps_session_delete(sess);
1242   }
1243
1244   return 0;
1245 }
1246
1247 static void gps_upload_cb( gpointer layer_and_vlp[2] )
1248 {
1249   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1250   VikLayersPanel *vlp = VIK_LAYERS_PANEL(layer_and_vlp[1]);
1251   VikTrwLayer *vtl = vgl->trw_children[TRW_UPLOAD];
1252   VikWindow *vw = VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(vgl));
1253   VikViewport *vvp = vik_window_viewport(vw);
1254   gps_comm(vtl, GPS_UP, vgl->protocol_id, vgl->serial_port, FALSE, vvp, vlp, vgl->upload_tracks, vgl->upload_waypoints);
1255 }
1256
1257 static void gps_download_cb( gpointer layer_and_vlp[2] )
1258 {
1259   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1260   VikTrwLayer *vtl = vgl->trw_children[TRW_DOWNLOAD];
1261   VikWindow *vw = VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(vgl));
1262   VikViewport *vvp = vik_window_viewport(vw);
1263 #if defined (VIK_CONFIG_REALTIME_GPS_TRACKING) && defined (GPSD_API_MAJOR_VERSION)
1264   gps_comm(vtl, GPS_DOWN, vgl->protocol_id, vgl->serial_port, vgl->realtime_tracking, vvp, NULL, vgl->download_tracks, vgl->download_waypoints);
1265 #else
1266   gps_comm(vtl, GPS_DOWN, vgl->protocol_id, vgl->serial_port, FALSE, vvp, NULL, vgl->download_tracks, vgl->download_waypoints);
1267 #endif
1268 }
1269
1270 static void gps_empty_upload_cb( gpointer layer_and_vlp[2] )
1271 {
1272   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1273   // Get confirmation from the user
1274   if ( ! a_dialog_yes_or_no ( VIK_GTK_WINDOW_FROM_WIDGET(layer_and_vlp[1]),
1275                               _("Are you sure you want to delete GPS Upload data?"),
1276                               NULL ) )
1277     return;
1278   vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_UPLOAD]);
1279   vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_UPLOAD]);
1280 }
1281
1282 static void gps_empty_download_cb( gpointer layer_and_vlp[2] )
1283 {
1284   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1285   // Get confirmation from the user
1286   if ( ! a_dialog_yes_or_no ( VIK_GTK_WINDOW_FROM_WIDGET(layer_and_vlp[1]),
1287                               _("Are you sure you want to delete GPS Download data?"),
1288                               NULL ) )
1289     return;
1290   vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_DOWNLOAD]);
1291   vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_DOWNLOAD]);
1292 }
1293
1294 #if defined (VIK_CONFIG_REALTIME_GPS_TRACKING) && defined (GPSD_API_MAJOR_VERSION)
1295 static void gps_empty_realtime_cb( gpointer layer_and_vlp[2] )
1296 {
1297   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1298   // Get confirmation from the user
1299   if ( ! a_dialog_yes_or_no ( VIK_GTK_WINDOW_FROM_WIDGET(layer_and_vlp[1]),
1300                               _("Are you sure you want to delete GPS Realtime data?"),
1301                               NULL ) )
1302     return;
1303   vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_REALTIME]);
1304   vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_REALTIME]);
1305 }
1306 #endif
1307
1308 static void gps_empty_all_cb( gpointer layer_and_vlp[2] )
1309 {
1310   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1311   // Get confirmation from the user
1312   if ( ! a_dialog_yes_or_no ( VIK_GTK_WINDOW_FROM_WIDGET(layer_and_vlp[1]),
1313                               _("Are you sure you want to delete All GPS data?"),
1314                               NULL ) )
1315     return;
1316   vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_UPLOAD]);
1317   vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_UPLOAD]);
1318   vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_DOWNLOAD]);
1319   vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_DOWNLOAD]);
1320 #if defined (VIK_CONFIG_REALTIME_GPS_TRACKING) && defined (GPSD_API_MAJOR_VERSION)
1321   vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_REALTIME]);
1322   vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_REALTIME]);
1323 #endif
1324 }
1325
1326 #if defined (VIK_CONFIG_REALTIME_GPS_TRACKING) && defined (GPSD_API_MAJOR_VERSION)
1327 static void realtime_tracking_draw(VikGpsLayer *vgl, VikViewport *vp)
1328 {
1329   struct LatLon ll;
1330   VikCoord nw, se;
1331   struct LatLon lnw, lse;
1332   vik_viewport_screen_to_coord ( vp, -20, -20, &nw );
1333   vik_viewport_screen_to_coord ( vp, vik_viewport_get_width(vp)+20, vik_viewport_get_width(vp)+20, &se );
1334   vik_coord_to_latlon ( &nw, &lnw );
1335   vik_coord_to_latlon ( &se, &lse );
1336   if ( vgl->realtime_fix.fix.latitude > lse.lat &&
1337        vgl->realtime_fix.fix.latitude < lnw.lat &&
1338        vgl->realtime_fix.fix.longitude > lnw.lon &&
1339        vgl->realtime_fix.fix.longitude < lse.lon ) {
1340     VikCoord gps;
1341     gint x, y;
1342     gint half_back_x, half_back_y;
1343     gint half_back_bg_x, half_back_bg_y;
1344     gint pt_x, pt_y;
1345     gint ptbg_x;
1346     gint side1_x, side1_y, side2_x, side2_y;
1347     gint side1bg_x, side1bg_y, side2bg_x, side2bg_y;
1348
1349     ll.lat = vgl->realtime_fix.fix.latitude;
1350     ll.lon = vgl->realtime_fix.fix.longitude;
1351     vik_coord_load_from_latlon ( &gps, vik_viewport_get_coord_mode(vp), &ll);
1352     vik_viewport_coord_to_screen ( vp, &gps, &x, &y );
1353
1354     gdouble heading_cos = cos(M_PI/180*vgl->realtime_fix.fix.track);
1355     gdouble heading_sin = sin(M_PI/180*vgl->realtime_fix.fix.track);
1356
1357     half_back_y = y+8*heading_cos;
1358     half_back_x = x-8*heading_sin;
1359     half_back_bg_y = y+10*heading_cos;
1360     half_back_bg_x = x-10*heading_sin;
1361
1362     pt_y = half_back_y-24*heading_cos;
1363     pt_x = half_back_x+24*heading_sin;
1364     //ptbg_y = half_back_bg_y-28*heading_cos;
1365     ptbg_x = half_back_bg_x+28*heading_sin;
1366
1367     side1_y = half_back_y+9*heading_sin;
1368     side1_x = half_back_x+9*heading_cos;
1369     side1bg_y = half_back_bg_y+11*heading_sin;
1370     side1bg_x = half_back_bg_x+11*heading_cos;
1371
1372     side2_y = half_back_y-9*heading_sin;
1373     side2_x = half_back_x-9*heading_cos;
1374     side2bg_y = half_back_bg_y-11*heading_sin;
1375     side2bg_x = half_back_bg_x-11*heading_cos;
1376
1377      GdkPoint trian[3] = { { pt_x, pt_y }, {side1_x, side1_y}, {side2_x, side2_y} };
1378      GdkPoint trian_bg[3] = { { ptbg_x, pt_y }, {side1bg_x, side1bg_y}, {side2bg_x, side2bg_y} };
1379
1380      vik_viewport_draw_polygon ( vp, vgl->realtime_track_bg_gc, TRUE, trian_bg, 3 );
1381      vik_viewport_draw_polygon ( vp, vgl->realtime_track_gc, TRUE, trian, 3 );
1382      vik_viewport_draw_rectangle ( vp,
1383          (vgl->realtime_fix.fix.mode > MODE_2D) ? vgl->realtime_track_pt2_gc : vgl->realtime_track_pt1_gc,
1384          TRUE, x-2, y-2, 4, 4 );
1385      //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;
1386   }
1387 }
1388
1389 static void create_realtime_trackpoint(VikGpsLayer *vgl, gboolean forced)
1390 {
1391     struct LatLon ll;
1392     GList *last_tp;
1393
1394     /* Note that fix.time is a double, but it should not affect the precision
1395        for most GPS */
1396     time_t cur_timestamp = vgl->realtime_fix.fix.time;
1397     time_t last_timestamp = vgl->last_fix.fix.time;
1398
1399     if (cur_timestamp < last_timestamp) {
1400       return;
1401     }
1402
1403     if (vgl->realtime_record && vgl->realtime_fix.dirty) {
1404       gboolean replace = FALSE;
1405       int heading = (int)floor(vgl->realtime_fix.fix.track);
1406       int last_heading = (int)floor(vgl->last_fix.fix.track);
1407       int alt = isnan(vgl->realtime_fix.fix.altitude) ? VIK_DEFAULT_ALTITUDE : floor(vgl->realtime_fix.fix.altitude);
1408       int last_alt = isnan(vgl->last_fix.fix.altitude) ? VIK_DEFAULT_ALTITUDE : floor(vgl->last_fix.fix.altitude);
1409       if (((last_tp = g_list_last(vgl->realtime_track->trackpoints)) != NULL) &&
1410           (vgl->realtime_fix.fix.mode > MODE_2D) &&
1411           (vgl->last_fix.fix.mode <= MODE_2D) &&
1412           ((cur_timestamp - last_timestamp) < 2)) {
1413         g_free(last_tp->data);
1414         vgl->realtime_track->trackpoints = g_list_delete_link(vgl->realtime_track->trackpoints, last_tp);
1415         replace = TRUE;
1416       }
1417       if (replace ||
1418           ((cur_timestamp != last_timestamp) &&
1419           ((forced ||
1420             ((heading < last_heading) && (heading < (last_heading - 3))) ||
1421             ((heading > last_heading) && (heading > (last_heading + 3))) ||
1422             ((alt != VIK_DEFAULT_ALTITUDE) && (alt != last_alt)))))) {
1423         /* TODO: check for new segments */
1424         VikTrackpoint *tp = vik_trackpoint_new();
1425         tp->newsegment = FALSE;
1426         tp->has_timestamp = TRUE;
1427         tp->timestamp = vgl->realtime_fix.fix.time;
1428         tp->altitude = alt;
1429         /* speed only available for 3D fix. Check for NAN when use this speed */
1430         tp->speed = vgl->realtime_fix.fix.speed;
1431         tp->course = vgl->realtime_fix.fix.track;
1432         tp->nsats = vgl->realtime_fix.satellites_used;
1433         tp->fix_mode = vgl->realtime_fix.fix.mode;
1434
1435         ll.lat = vgl->realtime_fix.fix.latitude;
1436         ll.lon = vgl->realtime_fix.fix.longitude;
1437         vik_coord_load_from_latlon(&tp->coord,
1438              vik_trw_layer_get_coord_mode(vgl->trw_children[TRW_REALTIME]), &ll);
1439
1440         vgl->realtime_track->trackpoints = g_list_append(vgl->realtime_track->trackpoints, tp);
1441         vgl->realtime_fix.dirty = FALSE;
1442         vgl->realtime_fix.satellites_used = 0;
1443         vgl->last_fix = vgl->realtime_fix;
1444       }
1445     }
1446
1447 }
1448
1449 static void gpsd_raw_hook(VglGpsd *vgpsd, gchar *data)
1450 {
1451   gboolean update_all = FALSE;
1452   VikGpsLayer *vgl = vgpsd->vgl;
1453
1454   if (!vgl->realtime_tracking) {
1455     g_warning("%s: receiving GPS data while not in realtime mode", __PRETTY_FUNCTION__);
1456     return;
1457   }
1458
1459   if ((vgpsd->gpsd.fix.mode >= MODE_2D) &&
1460       !isnan(vgpsd->gpsd.fix.latitude) &&
1461       !isnan(vgpsd->gpsd.fix.longitude) &&
1462       !isnan(vgpsd->gpsd.fix.track)) {
1463
1464     VikWindow *vw = VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(vgl));
1465     VikViewport *vvp = vik_window_viewport(vw);
1466     vgl->realtime_fix.fix = vgpsd->gpsd.fix;
1467     vgl->realtime_fix.satellites_used = vgpsd->gpsd.satellites_used;
1468     vgl->realtime_fix.dirty = TRUE;
1469
1470     struct LatLon ll;
1471     VikCoord vehicle_coord;
1472
1473     ll.lat = vgl->realtime_fix.fix.latitude;
1474     ll.lon = vgl->realtime_fix.fix.longitude;
1475     vik_coord_load_from_latlon(&vehicle_coord,
1476            vik_trw_layer_get_coord_mode(vgl->trw_children[TRW_REALTIME]), &ll);
1477
1478     if ((vgl->vehicle_position == VEHICLE_POSITION_CENTERED) ||
1479         (vgl->realtime_jump_to_start && vgl->first_realtime_trackpoint)) {
1480       vik_viewport_set_center_coord(vvp, &vehicle_coord);
1481       update_all = TRUE;
1482     }
1483     else if (vgl->vehicle_position == VEHICLE_POSITION_ON_SCREEN) {
1484       const int hdiv = 6;
1485       const int vdiv = 6;
1486       const int px = 20; /* adjust ment in pixels to make sure vehicle is inside the box */
1487       gint width = vik_viewport_get_width(vvp);
1488       gint height = vik_viewport_get_height(vvp);
1489       gint vx, vy;
1490
1491       vik_viewport_coord_to_screen(vvp, &vehicle_coord, &vx, &vy);
1492       update_all = TRUE;
1493       if (vx < (width/hdiv))
1494         vik_viewport_set_center_screen(vvp, vx - width/2 + width/hdiv + px, vy);
1495       else if (vx > (width - width/hdiv))
1496         vik_viewport_set_center_screen(vvp, vx + width/2 - width/hdiv - px, vy);
1497       else if (vy < (height/vdiv))
1498         vik_viewport_set_center_screen(vvp, vx, vy - height/2 + height/vdiv + px);
1499       else if (vy > (height - height/vdiv))
1500         vik_viewport_set_center_screen(vvp, vx, vy + height/2 - height/vdiv - px);
1501       else
1502         update_all = FALSE;
1503     }
1504
1505     vgl->first_realtime_trackpoint = FALSE;
1506     create_realtime_trackpoint(vgl, FALSE);
1507
1508     vik_layer_emit_update ( update_all ? VIK_LAYER(vgl) : VIK_LAYER(vgl->trw_children[TRW_REALTIME]), TRUE); // Yes update from background thread
1509   }
1510 }
1511
1512 static gboolean gpsd_data_available(GIOChannel *source, GIOCondition condition, gpointer data)
1513 {
1514   VikGpsLayer *vgl = data;
1515   if (condition == G_IO_IN) {
1516 #if GPSD_API_MAJOR_VERSION == 3 || GPSD_API_MAJOR_VERSION == 4
1517     if (!gps_poll(&vgl->vgpsd->gpsd)) {
1518 #elif GPSD_API_MAJOR_VERSION == 5
1519     if (gps_read(&vgl->vgpsd->gpsd) > -1) {
1520       // Reuse old function to perform operations on the new GPS data
1521       gpsd_raw_hook(vgl->vgpsd, NULL);
1522 #else
1523       // Broken compile
1524 #endif
1525       return TRUE;
1526     }
1527     else {
1528       g_warning("Disconnected from gpsd. Trying to reconnect");
1529       rt_gpsd_disconnect(vgl);
1530       rt_gpsd_connect(vgl, FALSE);
1531     }
1532   }
1533   return FALSE; /* no further calling */
1534 }
1535
1536 static gchar *make_track_name(VikTrwLayer *vtl)
1537 {
1538   const gchar basename[] = "REALTIME";
1539   const gint bufsize = sizeof(basename) + 5;
1540   gchar *name = g_malloc(bufsize);
1541   strcpy(name, basename);
1542   gint i = 2;
1543
1544   while (vik_trw_layer_get_track(vtl, name) != NULL) {
1545     g_snprintf(name, bufsize, "%s#%d", basename, i);
1546     i++;
1547   }
1548   return(name);
1549
1550 }
1551
1552 static gboolean rt_gpsd_try_connect(gpointer *data)
1553 {
1554   VikGpsLayer *vgl = (VikGpsLayer *)data;
1555 #if GPSD_API_MAJOR_VERSION == 3
1556   struct gps_data_t *gpsd = gps_open(vgl->gpsd_host, vgl->gpsd_port);
1557
1558   if (gpsd == NULL) {
1559 #elif GPSD_API_MAJOR_VERSION == 4
1560   vgl->vgpsd = g_malloc(sizeof(VglGpsd));
1561
1562   if (gps_open_r(vgl->gpsd_host, vgl->gpsd_port, /*(struct gps_data_t *)*/vgl->vgpsd) != 0) {
1563 #elif GPSD_API_MAJOR_VERSION == 5
1564   vgl->vgpsd = g_malloc(sizeof(VglGpsd));
1565   if (gps_open(vgl->gpsd_host, vgl->gpsd_port, &vgl->vgpsd->gpsd) != 0) {
1566 #else
1567 // Delibrately break compilation...
1568 #endif
1569     g_warning("Failed to connect to gpsd at %s (port %s). Will retry in %d seconds",
1570                      vgl->gpsd_host, vgl->gpsd_port, vgl->gpsd_retry_interval);
1571     return TRUE;   /* keep timer running */
1572   }
1573
1574 #if GPSD_API_MAJOR_VERSION == 3
1575   vgl->vgpsd = realloc(gpsd, sizeof(VglGpsd));
1576 #endif
1577   vgl->vgpsd->vgl = vgl;
1578
1579   vgl->realtime_fix.dirty = vgl->last_fix.dirty = FALSE;
1580   /* track alt/time graph uses VIK_DEFAULT_ALTITUDE (0.0) as invalid */
1581   vgl->realtime_fix.fix.altitude = vgl->last_fix.fix.altitude = VIK_DEFAULT_ALTITUDE;
1582   vgl->realtime_fix.fix.speed = vgl->last_fix.fix.speed = NAN;
1583
1584   if (vgl->realtime_record) {
1585     VikTrwLayer *vtl = vgl->trw_children[TRW_REALTIME];
1586     vgl->realtime_track = vik_track_new();
1587     vgl->realtime_track->visible = TRUE;
1588     vik_trw_layer_add_track(vtl, make_track_name(vtl), vgl->realtime_track);
1589   }
1590
1591 #if GPSD_API_MAJOR_VERSION == 3 || GPSD_API_MAJOR_VERSION == 4
1592   gps_set_raw_hook(&vgl->vgpsd->gpsd, gpsd_raw_hook);
1593 #endif
1594
1595   vgl->realtime_io_channel = g_io_channel_unix_new(vgl->vgpsd->gpsd.gps_fd);
1596   vgl->realtime_io_watch_id = g_io_add_watch( vgl->realtime_io_channel,
1597                     G_IO_IN | G_IO_ERR | G_IO_HUP, gpsd_data_available, vgl);
1598
1599 #if GPSD_API_MAJOR_VERSION == 3
1600   gps_query(&vgl->vgpsd->gpsd, "w+x");
1601 #endif
1602 #if GPSD_API_MAJOR_VERSION == 4 || GPSD_API_MAJOR_VERSION == 5
1603   gps_stream(&vgl->vgpsd->gpsd, WATCH_ENABLE, NULL);
1604 #endif
1605
1606   return FALSE;  /* no longer called by timeout */
1607 }
1608
1609 static gboolean rt_ask_retry(VikGpsLayer *vgl)
1610 {
1611   GtkWidget *dialog = gtk_message_dialog_new (VIK_GTK_WINDOW_FROM_LAYER(vgl),
1612                           GTK_DIALOG_DESTROY_WITH_PARENT,
1613                           GTK_MESSAGE_QUESTION,
1614                           GTK_BUTTONS_YES_NO,
1615                           "Failed to connect to gpsd at %s (port %s)\n"
1616                           "Should Viking keep trying (every %d seconds)?",
1617                           vgl->gpsd_host, vgl->gpsd_port,
1618                           vgl->gpsd_retry_interval);
1619
1620   gint res = gtk_dialog_run(GTK_DIALOG(dialog));
1621   gtk_widget_destroy(dialog);
1622   return (res == GTK_RESPONSE_YES);
1623 }
1624
1625 static gboolean rt_gpsd_connect(VikGpsLayer *vgl, gboolean ask_if_failed)
1626 {
1627   vgl->realtime_retry_timer = 0;
1628   if (rt_gpsd_try_connect((gpointer *)vgl)) {
1629     if (vgl->gpsd_retry_interval <= 0) {
1630       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);
1631       return FALSE;
1632     }
1633     else if (ask_if_failed && !rt_ask_retry(vgl))
1634       return FALSE;
1635     else
1636       vgl->realtime_retry_timer = g_timeout_add_seconds(vgl->gpsd_retry_interval,
1637         (GSourceFunc)rt_gpsd_try_connect, (gpointer *)vgl);
1638   }
1639   return TRUE;
1640 }
1641
1642 static void rt_gpsd_disconnect(VikGpsLayer *vgl)
1643 {
1644   if (vgl->realtime_retry_timer) {
1645     g_source_remove(vgl->realtime_retry_timer);
1646     vgl->realtime_retry_timer = 0;
1647   }
1648   if (vgl->realtime_io_watch_id) {
1649     g_source_remove(vgl->realtime_io_watch_id);
1650     vgl->realtime_io_watch_id = 0;
1651   }
1652   if (vgl->realtime_io_channel) {
1653     GError *error = NULL;
1654     g_io_channel_shutdown (vgl->realtime_io_channel, FALSE, &error);
1655     vgl->realtime_io_channel = NULL;
1656   }
1657   if (vgl->vgpsd) {
1658 #if GPSD_API_MAJOR_VERSION == 4 || GPSD_API_MAJOR_VERSION == 5
1659     gps_stream(&vgl->vgpsd->gpsd, WATCH_DISABLE, NULL);
1660 #endif
1661     gps_close(&vgl->vgpsd->gpsd);
1662 #if GPSD_API_MAJOR_VERSION == 3
1663     free(vgl->vgpsd);
1664 #elif GPSD_API_MAJOR_VERSION == 4 || GPSD_API_MAJOR_VERSION == 5
1665     g_free(vgl->vgpsd);
1666 #endif
1667     vgl->vgpsd = NULL;
1668   }
1669
1670   if (vgl->realtime_record && vgl->realtime_track) {
1671     if ((vgl->realtime_track->trackpoints == NULL) || (vgl->realtime_track->trackpoints->next == NULL))
1672       vik_trw_layer_delete_track(vgl->trw_children[TRW_REALTIME], vgl->realtime_track);
1673     vgl->realtime_track = NULL;
1674   }
1675 }
1676
1677 static void gps_start_stop_tracking_cb( gpointer layer_and_vlp[2])
1678 {
1679   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1680   vgl->realtime_tracking = (vgl->realtime_tracking == FALSE);
1681
1682   /* Make sure we are still in the boat with libgps */
1683   g_assert((VIK_GPS_MODE_2D == MODE_2D) && (VIK_GPS_MODE_3D == MODE_3D));
1684
1685   if (vgl->realtime_tracking) {
1686     vgl->first_realtime_trackpoint = TRUE;
1687     if (!rt_gpsd_connect(vgl, TRUE)) {
1688       vgl->first_realtime_trackpoint = FALSE;
1689       vgl->realtime_tracking = FALSE;
1690     }
1691   }
1692   else {  /* stop realtime tracking */
1693     vgl->first_realtime_trackpoint = FALSE;
1694     rt_gpsd_disconnect(vgl);
1695   }
1696 }
1697 #endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */
1698