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