]> git.street.me.uk Git - andy/viking.git/commitdiff
Add realtime tracking to GPS layer.
authorQuy Tonthat <qtonthat@gmail.com>
Tue, 2 Oct 2007 07:12:14 +0000 (07:12 +0000)
committerQuy Tonthat <qtonthat@gmail.com>
Tue, 2 Oct 2007 07:12:14 +0000 (07:12 +0000)
New features included:

- Show real time position from GPS.
- New layer menu item to start/stop realtime tracking.
- Using gpsd. Host and port can be set in the layer properties dialog.
- Enable/disable track recording (in peroperties dialog). Tracks are
  recorded in "GPS Download" folder.
- Jump to the first position on start (enable/disable in properties dialog).
- Moving maps to keep current tracking position at the center (enable/disable
  in properties dialog)

Signed-off-by: Quy Tonthat <qtonthat@gmail.com>
ChangeLog
src/Makefile.am
src/vikgpslayer.c

index a80e05fa3836519d36e19d673e5c2261194194e8..ccaffd8d2a7e7a5e9e37b40c1263a4b59cf1d217 100644 (file)
--- a/ChangeLog
+++ b/ChangeLog
@@ -1,6 +1,7 @@
 2007-10-02
 Quy Tonthat <qtonthat@gmail.com>:
        * Fix crashes caused by emitting update too early at layer creation.
+       * Add realtime tracking to GPS layer.
 
 2007-10-01
 Quy Tonthat <qtonthat@gmail.com>:
index df435745f6f6c3a83f576b3e30bcc85292615006..12cff9e28789795bfd10ef8518dd80b059d688e7 100644 (file)
@@ -92,5 +92,6 @@ endif
 
 INCLUDES        = @GTK_CFLAGS@ @EXPAT_CFLAGS@ @LIBCURL_CPPFLAGS@
 LDADD           = @GTK_LIBS@ @EXPAT_LIBS@ @LIBCURL@
+LDADD           += -lgps
 #LDADD           = -lz @GTK_LIBS@ @EXPAT_LIBS@ @LIBCURL@
 AM_CFLAGS              = -Wall -g
index 4ea320a04a53b9d93372d74812767fad361ef76f..a1f34d6a1da0a791dfa1e63760a6fa67aefb64f5 100644 (file)
@@ -19,6 +19,8 @@
  *
  */
 
+#include <stdlib.h>
+#include <math.h>
 #include "viking.h"
 #include "vikgpslayer_pixmap.h"
 #include "babel.h"
@@ -26,6 +28,7 @@
 #include <string.h>
 #include <glib.h>
 #include <glib/gprintf.h>
+#include <gps.h>
 
 #define DISCONNECT_UPDATE_SIGNAL(vl, val) g_signal_handlers_disconnect_matched(vl, G_SIGNAL_MATCH_DATA, 0, 0, 0, 0, val)
 static VikGpsLayer *vik_gps_layer_create (VikViewport *vp);
@@ -43,12 +46,14 @@ static void gps_layer_change_coord_mode ( VikGpsLayer *val, VikCoordMode mode );
 static void gps_layer_add_menu_items( VikGpsLayer *vtl, GtkMenu *menu, gpointer vlp );
 static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val_dest, GtkTreeIter *src_item_iter, GtkTreePath *dest_path );
 
+static void realtime_tracking_draw(VikGpsLayer *vgl, VikViewport *vp);
 
 static void gps_upload_cb( gpointer layer_and_vlp[2] );
 static void gps_download_cb( gpointer layer_and_vlp[2] );
 static void gps_empty_upload_cb( gpointer layer_and_vlp[2] );
 static void gps_empty_download_cb( gpointer layer_and_vlp[2] );
 static void gps_empty_all_cb( gpointer layer_and_vlp[2] );
+static void gps_start_stop_tracking_cb( gpointer layer_and_vlp[2] );
 
 typedef enum {GARMIN_P = 0, MAGELLAN_P, NUM_PROTOCOLS} vik_gps_proto;
 static gchar * params_protocols[] = {"Garmin", "Magellan", NULL};
@@ -79,11 +84,20 @@ typedef struct {
 } GpsSession;
 static void gps_session_delete(GpsSession *sess);
 
+static gchar *params_groups[] = {"Data Mode", "Realtime Tracking Mode"};
+enum {GROUP_DATA_MODE, GROUP_REALTIME_MODE};
+
 static VikLayerParam gps_layer_params[] = {
-  { "gps_protocol", VIK_LAYER_PARAM_UINT, VIK_LAYER_GROUP_NONE, "GPS Protocol:", VIK_LAYER_WIDGET_COMBOBOX, params_protocols, NULL},
-  { "gps_port", VIK_LAYER_PARAM_UINT, VIK_LAYER_GROUP_NONE, "Serial Port:", VIK_LAYER_WIDGET_COMBOBOX, params_ports, NULL},
+  { "gps_protocol", VIK_LAYER_PARAM_UINT, GROUP_DATA_MODE, "GPS Protocol:", VIK_LAYER_WIDGET_COMBOBOX, params_protocols, NULL},
+  { "gps_port", VIK_LAYER_PARAM_UINT, GROUP_DATA_MODE, "Serial Port:", VIK_LAYER_WIDGET_COMBOBOX, params_ports, NULL},
+
+  { "record_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, "Recording tracks", VIK_LAYER_WIDGET_CHECKBUTTON},
+  { "center_start_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, "Jump to current position on start", VIK_LAYER_WIDGET_CHECKBUTTON},
+  { "centered_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, "Keep current position at center", VIK_LAYER_WIDGET_CHECKBUTTON},
+  { "gpsd_host", VIK_LAYER_PARAM_STRING, GROUP_REALTIME_MODE, "Gpsd Host:", VIK_LAYER_WIDGET_ENTRY},
+  { "gpsd_port", VIK_LAYER_PARAM_STRING, GROUP_REALTIME_MODE, "Gpsd Port:", VIK_LAYER_WIDGET_ENTRY},
 };
-enum {PARAM_PROTOCOL=0, PARAM_PORT, NUM_PARAMS};
+enum {PARAM_PROTOCOL=0, PARAM_PORT, PARAM_REALTIME_REC, PARAM_REALTIME_CENTER_START, PARAM_REALTIME_CENTERED, PARAM_GPSD_HOST, PARAM_GPSD_PORT, NUM_PARAMS};
 
 VikLayerInterface vik_gps_layer_interface = {
   "GPS",
@@ -94,8 +108,8 @@ VikLayerInterface vik_gps_layer_interface = {
 
   gps_layer_params,
   NUM_PARAMS,
-  NULL,
-  0,
+  params_groups,
+  sizeof(params_groups)/sizeof(params_groups[0]),
 
   VIK_MENU_ITEM_ALL & ~(VIK_MENU_ITEM_CUT|VIK_MENU_ITEM_COPY),
 
@@ -135,14 +149,54 @@ VikLayerInterface vik_gps_layer_interface = {
 
 enum {TRW_DOWNLOAD, TRW_UPLOAD, NUM_TRW};
 static gchar * trw_names[] = {"GPS Download", "GPS Upload"};
+
+typedef struct {
+  struct gps_data_t gpsd;
+  VikGpsLayer *vgl;
+} VglGpsd;
+
+typedef struct {
+  struct LatLon ll;
+  gdouble heading;
+  gdouble alt;   /* meters */
+  gdouble speed; /* m/s */
+  time_t timestamp;
+  gboolean dirty;   /* needs to be saved */
+} GpsFix;
+
 struct _VikGpsLayer {
   VikLayer vl;
   VikTrwLayer * trw_children[NUM_TRW];
   GList * children;    /* used only for writing file */
   int cur_read_child;   /* used only for reading file */
+  VglGpsd *vgpsd;
+  gboolean realtime_tracking;
+  GMutex *realtime_tracking_mutex;
+  GpsFix realtime_fix;
+  GpsFix last_fix;
+
+  enum unit realtime_gpsd_unit;
+
+  VikTrack *realtime_track;
+  gchar *realtime_track_name;
+
+  GIOChannel *realtime_io_channel;
+  guint realtime_io_watch_id;
+  GdkGC *realtime_track_gc;
+  GdkGC *realtime_track_bg_gc;
+  GdkGC *realtime_track_pt_gc;
+  GdkGC *realtime_track_pt1_gc;
+  GdkGC *realtime_track_pt2_gc;
+
   /* params */
   guint protocol_id;
   guint serial_port_id;
+  /* TODO: show on diaglog */
+  gchar *gpsd_host;
+  gchar *gpsd_port;
+  gboolean realtime_record;
+  gboolean realtime_jump_to_start;
+  gboolean realtime_keep_at_center;
 };
 
 GType vik_gps_layer_get_type ()
@@ -171,7 +225,7 @@ GType vik_gps_layer_get_type ()
 
 static VikGpsLayer *vik_gps_layer_create (VikViewport *vp)
 {
-  VikGpsLayer *rv = vik_gps_layer_new ();
+  VikGpsLayer *rv = vik_gps_layer_new (vp);
   vik_layer_rename ( VIK_LAYER(rv), vik_gps_layer_interface.name );
   rv->trw_children[TRW_UPLOAD] = VIK_TRW_LAYER(vik_layer_create ( VIK_LAYER_TRW, vp, NULL, FALSE ));
   vik_layer_set_menu_items_selection(VIK_LAYER(rv->trw_children[TRW_UPLOAD]), VIK_MENU_ITEM_ALL & ~(VIK_MENU_ITEM_CUT|VIK_MENU_ITEM_DELETE));
@@ -233,7 +287,7 @@ static VikGpsLayer *gps_layer_unmarshall( guint8 *data, gint len, VikViewport *v
     child_layer = vik_layer_unmarshall ( data + sizeof(gint), alm_size, vvp );
     if (child_layer) {
       rv->trw_children[i++] = (VikTrwLayer *)child_layer;
-      g_signal_connect_swapped ( G_OBJECT(child_layer), "update", G_CALLBACK(vik_layer_emit_update), rv );
+      g_signal_connect_swapped ( G_OBJECT(child_layer), "update", G_CALLBACK(vik_layer_emit_update_secondary), rv );
     }
     alm_next;
   }
@@ -248,6 +302,7 @@ static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerPara
 {
   switch ( id )
   {
+    /* TODO: gpsd_host, gpsd_port */
     case PARAM_PROTOCOL:
       if (data.u < NUM_PROTOCOLS)
         vgl->protocol_id = data.u;
@@ -260,6 +315,27 @@ static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerPara
       else
         g_warning("Unknown serial port device");
       break;
+    case PARAM_GPSD_HOST:
+      if (vgl->gpsd_host)
+        g_free(vgl->gpsd_host);
+      vgl->gpsd_host = g_strdup(data.s);
+      break;
+    case PARAM_GPSD_PORT:
+      if (vgl->gpsd_port)
+        g_free(vgl->gpsd_port);
+      vgl->gpsd_port = g_strdup(data.s); /* TODO: check for number */
+      break;
+    case PARAM_REALTIME_REC:
+      vgl->realtime_record = data.b;
+      break;
+    case PARAM_REALTIME_CENTER_START:
+      vgl->realtime_jump_to_start = data.b;
+      break;
+    case PARAM_REALTIME_CENTERED:
+      vgl->realtime_keep_at_center = data.b;
+      break;
+    default:
+      g_warning("gps_layer_set_param(): unknown parameter");
   }
 
   return TRUE;
@@ -270,12 +346,28 @@ static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id )
   VikLayerParamData rv;
   switch ( id )
   {
+    /* TODO: gpsd_host, gpsd_port */
     case PARAM_PROTOCOL:
       rv.u = vgl->protocol_id;
       break;
     case PARAM_PORT:
       rv.u = vgl->serial_port_id;
       break;
+    case PARAM_GPSD_HOST:
+      rv.s = vgl->gpsd_host ? vgl->gpsd_host : "";
+      break;
+    case PARAM_GPSD_PORT:
+      rv.s = vgl->gpsd_port ? vgl->gpsd_port : g_strdup(DEFAULT_GPSD_PORT);
+      break;
+    case PARAM_REALTIME_REC:
+      rv.b = vgl->realtime_record;
+      break;
+    case PARAM_REALTIME_CENTER_START:
+      rv.b = vgl->realtime_jump_to_start;
+      break;
+    case PARAM_REALTIME_CENTERED:
+      rv.b = vgl->realtime_keep_at_center;
+      break;
     default:
       g_warning("gps_layer_get_param(): unknown parameter");
   }
@@ -283,7 +375,7 @@ static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id )
   return rv;
 }
 
-VikGpsLayer *vik_gps_layer_new ()
+VikGpsLayer *vik_gps_layer_new (VikViewport *vp)
 {
   gint i;
   VikGpsLayer *vgl = VIK_GPS_LAYER ( g_object_new ( VIK_GPS_LAYER_TYPE, NULL ) );
@@ -294,9 +386,26 @@ VikGpsLayer *vik_gps_layer_new ()
   vgl->children = NULL;
   vgl->cur_read_child = 0;
 
+  vgl->realtime_tracking_mutex = g_mutex_new();
+  vgl->realtime_tracking = FALSE;
+  vgl->vgpsd = NULL;
+  vgl->realtime_track_gc = vik_viewport_new_gc ( vp, "#203070", 2 );
+  vgl->realtime_track_bg_gc = vik_viewport_new_gc ( vp, "grey", 2 );
+  vgl->realtime_track_pt1_gc = vik_viewport_new_gc ( vp, "red", 2 );
+  vgl->realtime_track_pt2_gc = vik_viewport_new_gc ( vp, "green", 2 );
+  vgl->realtime_track_pt_gc = vgl->realtime_track_pt1_gc;
+  vgl->realtime_gpsd_unit = gpsd_units();
+  // fprintf(stderr, "DEBUG: gpsd_unit = %d\n", vgl->realtime_gpsd_unit);
+  vgl->realtime_track = NULL;
+
   /* Setting params here */
   vgl->protocol_id = 0;
   vgl->serial_port_id = 0;
+  vgl->gpsd_host = g_strdup("localhost");
+  vgl->gpsd_port = g_strdup(DEFAULT_GPSD_PORT);
+  vgl->realtime_record = TRUE;
+  vgl->realtime_jump_to_start = TRUE;
+  vgl->realtime_keep_at_center = FALSE;
 
   return vgl;
 }
@@ -304,10 +413,33 @@ VikGpsLayer *vik_gps_layer_new ()
 static void vik_gps_layer_draw ( VikGpsLayer *vgl, gpointer data )
 {
   gint i;
+  VikLayer *vl;
+  VikLayer *trigger = VIK_LAYER(vik_viewport_get_trigger( VIK_VIEWPORT(data) ));
 
-  /* TODO: half-drawn hack -- see vik_aggregate_layer_draw */
   for (i = 0; i < NUM_TRW; i++) {
-    vik_layer_draw((VikLayer*)(vgl->trw_children[i]), data);
+    vl = VIK_LAYER(vgl->trw_children[i]);
+    if (vl == trigger) {
+      if ( vik_viewport_get_half_drawn ( VIK_VIEWPORT(data) ) ) {
+        vik_viewport_set_half_drawn ( VIK_VIEWPORT(data), FALSE );
+        vik_viewport_snapshot_load( VIK_VIEWPORT(data) );
+      } else {
+        vik_viewport_snapshot_save( VIK_VIEWPORT(data) );
+      }
+    }
+    if (!vik_viewport_get_half_drawn( VIK_VIEWPORT(data)))
+      vik_layer_draw ( vl, data );
+  }
+  if (vgl->realtime_tracking) {
+    if (VIK_LAYER(vgl) == trigger) {
+      if ( vik_viewport_get_half_drawn ( VIK_VIEWPORT(data) ) ) {
+        vik_viewport_set_half_drawn ( VIK_VIEWPORT(data), FALSE );
+        vik_viewport_snapshot_load( VIK_VIEWPORT(data) );
+      } else {
+        vik_viewport_snapshot_save( VIK_VIEWPORT(data) );
+      }
+    }
+    if (!vik_viewport_get_half_drawn( VIK_VIEWPORT(data)))
+      realtime_tracking_draw(vgl, VIK_VIEWPORT(data));
   }
 }
 
@@ -340,6 +472,13 @@ static void gps_layer_add_menu_items( VikGpsLayer *vgl, GtkMenu *menu, gpointer
   gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
   gtk_widget_show ( item );
 
+  item = gtk_menu_item_new_with_label ( vgl->realtime_tracking  ?
+                                       "Stop realtime tracking" :
+                                       "Start realtime tracking" );
+  g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_start_stop_tracking_cb), pass_along );
+  gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
+  gtk_widget_show ( item );
+
   item = gtk_menu_item_new();
   gtk_menu_shell_append ( GTK_MENU_SHELL(menu), item );
   gtk_widget_show ( item );
@@ -374,6 +513,16 @@ static void vik_gps_layer_free ( VikGpsLayer *vgl )
       disconnect_layer_signal(VIK_LAYER(vgl->trw_children[i]), vgl);
     g_object_unref(vgl->trw_children[i]);
   }
+  if (vgl->realtime_track_gc != NULL)
+    g_object_unref(vgl->realtime_track_gc);
+  if (vgl->realtime_track_bg_gc != NULL)
+    g_object_unref(vgl->realtime_track_bg_gc);
+  if (vgl->realtime_track_pt1_gc != NULL)
+    g_object_unref(vgl->realtime_track_pt1_gc);
+  if (vgl->realtime_track_pt2_gc != NULL)
+    g_object_unref(vgl->realtime_track_pt2_gc);
+  if (vgl->realtime_tracking_mutex != NULL)
+   g_mutex_free(vgl->realtime_tracking_mutex);
 }
 
 gboolean vik_gps_layer_delete ( VikGpsLayer *vgl, GtkTreeIter *iter )
@@ -406,7 +555,7 @@ static void vik_gps_layer_realize ( VikGpsLayer *vgl, VikTreeview *vt, GtkTreeIt
     if ( ! trw->visible )
       vik_treeview_item_set_visible ( VIK_LAYER(vgl)->vt, &iter, FALSE );
     vik_layer_realize ( trw, VIK_LAYER(vgl)->vt, &iter );
-    g_signal_connect_swapped ( G_OBJECT(trw), "update", G_CALLBACK(vik_layer_emit_update), vgl );
+    g_signal_connect_swapped ( G_OBJECT(trw), "update", G_CALLBACK(vik_layer_emit_update_secondary), vgl );
   }
 }
 
@@ -454,14 +603,6 @@ static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val
   g_object_ref ( vl );
   vik_gps_layer_delete(val_src, src_item_iter);
 
-#ifdef XXXXXXXXXXXXXXXXXXXXXXXXX
-  TODO:
-  if (target_exists) {
-    vik_gps_layer_insert_layer(val_dest, vl, &dest_iter);
-  } else {
-    vik_gps_layer_insert_layer(val_dest, vl, NULL); /* append */
-  }
-#endif /* XXXXXXXXXXXXXXXXXXXXXXXXX */
   g_free(dp);
 }
 
@@ -806,3 +947,217 @@ static void gps_empty_all_cb( gpointer layer_and_vlp[2] )
   vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_DOWNLOAD]);
   vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_DOWNLOAD]);
 }
+
+static void realtime_tracking_draw(VikGpsLayer *vgl, VikViewport *vp)
+{
+  VikCoord nw, se;
+  struct LatLon lnw, lse;
+  vik_viewport_screen_to_coord ( vp, -20, -20, &nw );
+  vik_viewport_screen_to_coord ( vp, vik_viewport_get_width(vp)+20, vik_viewport_get_width(vp)+20, &se );
+  vik_coord_to_latlon ( &nw, &lnw );
+  vik_coord_to_latlon ( &se, &lse );
+  if ( vgl->realtime_fix.ll.lat > lse.lat &&
+       vgl->realtime_fix.ll.lat < lnw.lat &&
+       vgl->realtime_fix.ll.lon > lnw.lon &&
+       vgl->realtime_fix.ll.lon < lse.lon ) {
+    VikCoord gps;
+    gint x, y;
+    gint half_back_x, half_back_y;
+    gint half_back_bg_x, half_back_bg_y;
+    gint pt_x, pt_y;
+    gint ptbg_x, ptbg_y;
+    gint side1_x, side1_y, side2_x, side2_y;
+    gint side1bg_x, side1bg_y, side2bg_x, side2bg_y;
+
+    vik_coord_load_from_latlon ( &gps, vik_viewport_get_coord_mode(vp), &(vgl->realtime_fix.ll) );
+    vik_viewport_coord_to_screen ( vp, &gps, &x, &y );
+
+    gdouble heading_cos = cos(M_PI/180*vgl->realtime_fix.heading);
+    gdouble heading_sin = sin(M_PI/180*vgl->realtime_fix.heading);
+
+    half_back_y = y+8*heading_cos;
+    half_back_x = x-8*heading_sin;
+    half_back_bg_y = y+10*heading_cos;
+    half_back_bg_x = x-10*heading_sin;
+
+    pt_y = half_back_y-24*heading_cos;
+    pt_x = half_back_x+24*heading_sin;
+    ptbg_y = half_back_bg_y-28*heading_cos;
+    ptbg_x = half_back_bg_x+28*heading_sin;
+
+    side1_y = half_back_y+9*heading_sin;
+    side1_x = half_back_x+9*heading_cos;
+    side1bg_y = half_back_bg_y+11*heading_sin;
+    side1bg_x = half_back_bg_x+11*heading_cos;
+
+    side2_y = half_back_y-9*heading_sin;
+    side2_x = half_back_x-9*heading_cos;
+    side2bg_y = half_back_bg_y-11*heading_sin;
+    side2bg_x = half_back_bg_x-11*heading_cos;
+
+     GdkPoint trian[3] = { { pt_x, pt_y }, {side1_x, side1_y}, {side2_x, side2_y} };
+     GdkPoint trian_bg[3] = { { ptbg_x, pt_y }, {side1bg_x, side1bg_y}, {side2bg_x, side2bg_y} };
+
+     vik_viewport_draw_polygon ( vp, vgl->realtime_track_bg_gc, TRUE, trian_bg, 3 );
+     vik_viewport_draw_polygon ( vp, vgl->realtime_track_gc, TRUE, trian, 3 );
+     vik_viewport_draw_rectangle ( vp, vgl->realtime_track_pt_gc, TRUE, x-2, y-2, 4, 4 );
+     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;
+  }
+}
+
+/* lock/unlock realtime_tracking_mutex when call this */
+static void create_realtime_trackpoint(VikGpsLayer *vgl, gboolean forced)
+{
+    if (vgl->realtime_record && vgl->realtime_fix.dirty) {
+      int heading = (int)floor(vgl->realtime_fix.heading);
+      int last_heading = (int)floor(vgl->last_fix.heading);
+      if (forced ||
+          ((heading < last_heading) && (heading < (last_heading - 3))) || 
+          ((heading > last_heading) && (heading > (last_heading + 3))) ||
+          ((int)vgl->realtime_fix.alt != (int)vgl->last_fix.alt)) {
+        /* TODO: check for new segments */
+        VikTrackpoint *tp = vik_trackpoint_new();
+        tp->newsegment = FALSE;
+        tp->altitude = vgl->realtime_fix.alt;
+        tp->has_timestamp = TRUE;
+        tp->timestamp = vgl->realtime_fix.timestamp;
+        vik_coord_load_from_latlon(&tp->coord,
+               vik_trw_layer_get_coord_mode(vgl->trw_children[TRW_DOWNLOAD]),
+               &vgl->realtime_fix.ll);
+        if (vgl->realtime_keep_at_center ||
+            (vgl->realtime_jump_to_start && !vgl->realtime_track->trackpoints)) {
+          VikWindow *vw = VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(vgl));
+          VikViewport *vvp = vik_window_viewport(vw);
+          vik_viewport_set_center_coord(vvp, &tp->coord);
+        }
+
+        vgl->realtime_track->trackpoints = g_list_append(vgl->realtime_track->trackpoints, tp);
+        vgl->realtime_fix.dirty = FALSE;
+        vgl->last_fix = vgl->realtime_fix;
+      }
+    }
+
+}
+
+void gpsd_raw_hook(VglGpsd *vgpsd, gchar *data)
+{
+  VikGpsLayer *vgl = vgpsd->vgl;
+
+  // fprintf(stderr, "raw_hook called\n");
+  if (!vgl->realtime_tracking)
+    return;
+
+  if (vgpsd->gpsd.fix.mode >= MODE_2D) {
+    if (!isnan(vgpsd->gpsd.fix.altitude))
+      vgl->realtime_fix.alt = vgpsd->gpsd.fix.altitude; /* in meters */
+    if (!isnan(vgpsd->gpsd.fix.speed))
+      vgl->realtime_fix.speed = vgpsd->gpsd.fix.speed; /* m/s */
+  }
+
+  if (vgl->realtime_fix.timestamp == (time_t)vgpsd->gpsd.fix.time)
+    return;
+
+  if ((vgpsd->gpsd.fix.mode >= MODE_2D) &&
+      !isnan(vgpsd->gpsd.fix.latitude) &&
+      !isnan(vgpsd->gpsd.fix.longitude) &&
+      !isnan(vgpsd->gpsd.fix.track)) {
+    g_mutex_lock(vgl->realtime_tracking_mutex);
+    vgl->realtime_fix.timestamp = vgpsd->gpsd.fix.time;
+    vgl->realtime_fix.ll.lat = vgpsd->gpsd.fix.latitude;
+    vgl->realtime_fix.ll.lon = vgpsd->gpsd.fix.longitude;
+    vgl->realtime_fix.heading = vgpsd->gpsd.fix.track;
+    vgl->realtime_fix.dirty = TRUE;
+
+    // fprintf(stderr, "%f %f\n", vgl->realtime_fix.alt, vgl->realtime_fix.speed * MPS_TO_KPH);
+
+    create_realtime_trackpoint(vgl, FALSE);
+    g_mutex_unlock(vgl->realtime_tracking_mutex);
+
+    vik_layer_emit_update ( VIK_LAYER(vgl) );
+  }
+}
+
+static gboolean gpsd_data_available(GIOChannel *source, GIOCondition condition, gpointer data)
+{
+  // fprintf(stderr, "gpsd_data_available called\n");
+
+  VikGpsLayer *vgl = data;
+  gps_poll(&vgl->vgpsd->gpsd);
+  return TRUE;
+}
+
+static gchar *make_track_name(VikTrwLayer *vtl)
+{
+  const gchar basename[] = "REALTIME";
+  const gint bufsize = sizeof(basename) + 5;
+  gchar *name = g_malloc(bufsize);
+  strcpy(name, basename);
+  gint i = 2;
+
+  while (vik_trw_layer_get_track(vtl, name) != NULL) {
+    g_snprintf(name, bufsize, "%s#%d", basename, i);
+    i++;
+  }
+  return(name);
+
+}
+
+static void gps_start_stop_tracking_cb( gpointer layer_and_vlp[2])
+{
+  VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
+  vgl->realtime_tracking = (vgl->realtime_tracking == FALSE);
+
+  if (vgl->realtime_tracking) {
+    struct gps_data_t *gpsd = gps_open(vgl->gpsd_host, vgl->gpsd_port);
+    if (gpsd == NULL) {
+      fprintf(stderr, "DEBUG: %s(): gps_open failed\n", __PRETTY_FUNCTION__);
+      vgl->realtime_tracking = FALSE;
+      return;
+    }
+    vgl->vgpsd = g_realloc(gpsd, sizeof(VglGpsd));
+    vgl->vgpsd->vgl = vgl;
+    vgl->realtime_fix.ll.lat = vgl->realtime_fix.ll.lon = vgl->realtime_fix.heading = 0;
+    vgl->last_fix.ll.lat = vgl->last_fix.ll.lon = vgl->last_fix.heading = 0;
+
+    gps_set_raw_hook(&vgl->vgpsd->gpsd, gpsd_raw_hook);
+    vgl->realtime_io_channel = g_io_channel_unix_new(vgl->vgpsd->gpsd.gps_fd);
+    vgl->realtime_io_watch_id = g_io_add_watch( vgl->realtime_io_channel,
+                                           G_IO_IN, gpsd_data_available, vgl);
+
+    // vgl->realtime_timeout = gtk_timeout_add ( 1000, (GtkFunction)gpsd_timeout, vgl);
+    if (vgl->realtime_record) {
+      VikTrwLayer *vtl = vgl->trw_children[TRW_DOWNLOAD];
+      vgl->realtime_track = vik_track_new();
+      vgl->realtime_track->visible = TRUE;
+      vgl->realtime_track_name = make_track_name(vtl);
+      vik_trw_layer_add_track(vtl, vgl->realtime_track_name, vgl->realtime_track);
+    }
+
+    vgl->realtime_fix.ll.lat = vgl->realtime_fix.ll.lon = 0.0;
+    vgl->realtime_fix.heading = vgl->realtime_fix.speed = 0.0;
+    vgl->realtime_fix.alt = VIK_DEFAULT_ALTITUDE;
+    vgl->realtime_fix.timestamp = 0;
+    vgl->realtime_fix.dirty = FALSE;
+    vgl->last_fix = vgl->realtime_fix;
+      
+    gps_query(&vgl->vgpsd->gpsd, "w+x");
+
+  }
+  else {  /* stop realtime tracking */
+    /* TODO: handle race condition here , make sure vgpsd is NULL */
+    g_mutex_lock(vgl->realtime_tracking_mutex);
+    gps_close(&vgl->vgpsd->gpsd);
+    vgl->vgpsd = NULL;
+    // g_source_remove(vgl->realtime_timeout);
+    g_source_remove(vgl->realtime_io_watch_id);
+    g_io_channel_unref (vgl->realtime_io_channel);
+
+    if (vgl->realtime_record) {
+      create_realtime_trackpoint(vgl, TRUE);
+      if ((vgl->realtime_track->trackpoints == NULL) || (vgl->realtime_track->trackpoints->next == NULL))
+        vik_trw_layer_delete_track(vgl->trw_children[TRW_DOWNLOAD], vgl->realtime_track_name);
+    }
+    g_mutex_unlock(vgl->realtime_tracking_mutex);
+  }
+}
+