src/vikgpslayer.c

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