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