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