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