+
+static void gpsd_raw_hook(VglGpsd *vgpsd, gchar *data)
+{
+ gboolean update_all = FALSE;
+ VikGpsLayer *vgl = vgpsd->vgl;
+
+ if (!vgl->realtime_tracking) {
+ g_warning("%s: receiving GPS data while not in realtime mode", __PRETTY_FUNCTION__);
+ return;
+ }
+
+ if ((vgpsd->gpsd.fix.mode >= MODE_2D) &&
+ !isnan(vgpsd->gpsd.fix.latitude) &&
+ !isnan(vgpsd->gpsd.fix.longitude) &&
+ !isnan(vgpsd->gpsd.fix.track)) {
+
+ VikWindow *vw = VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(vgl));
+ VikViewport *vvp = vik_window_viewport(vw);
+ vgl->realtime_fix.fix = vgpsd->gpsd.fix;
+ vgl->realtime_fix.satellites_used = vgpsd->gpsd.satellites_used;
+ vgl->realtime_fix.dirty = TRUE;
+
+ struct LatLon ll;
+ VikCoord vehicle_coord;
+
+ ll.lat = vgl->realtime_fix.fix.latitude;
+ ll.lon = vgl->realtime_fix.fix.longitude;
+ vik_coord_load_from_latlon(&vehicle_coord,
+ vik_trw_layer_get_coord_mode(vgl->trw_children[TRW_REALTIME]), &ll);
+
+ if ((vgl->vehicle_position == VEHICLE_POSITION_CENTERED) ||
+ (vgl->realtime_jump_to_start && vgl->first_realtime_trackpoint)) {
+ vik_viewport_set_center_coord(vvp, &vehicle_coord);
+ update_all = TRUE;
+ }
+ else if (vgl->vehicle_position == VEHICLE_POSITION_ON_SCREEN) {
+ const int hdiv = 6;
+ const int vdiv = 6;
+ const int px = 20; /* adjust ment in pixels to make sure vehicle is inside the box */
+ gint width = vik_viewport_get_width(vvp);
+ gint height = vik_viewport_get_height(vvp);
+ gint vx, vy;
+
+ vik_viewport_coord_to_screen(vvp, &vehicle_coord, &vx, &vy);
+ update_all = TRUE;
+ if (vx < (width/hdiv))
+ vik_viewport_set_center_screen(vvp, vx - width/2 + width/hdiv + px, vy);
+ else if (vx > (width - width/hdiv))
+ vik_viewport_set_center_screen(vvp, vx + width/2 - width/hdiv - px, vy);
+ else if (vy < (height/vdiv))
+ vik_viewport_set_center_screen(vvp, vx, vy - height/2 + height/vdiv + px);
+ else if (vy > (height - height/vdiv))
+ vik_viewport_set_center_screen(vvp, vx, vy + height/2 - height/vdiv - px);
+ else
+ update_all = FALSE;
+ }
+
+ vgl->first_realtime_trackpoint = FALSE;
+ create_realtime_trackpoint(vgl, FALSE);
+
+ gdk_threads_enter();
+ vik_layer_emit_update ( update_all ? VIK_LAYER(vgl) : VIK_LAYER(vgl->trw_children[TRW_REALTIME]));
+ gdk_threads_leave();
+ }
+}
+
+static gboolean gpsd_data_available(GIOChannel *source, GIOCondition condition, gpointer data)
+{
+ VikGpsLayer *vgl = data;
+ if (condition == G_IO_IN) {
+ if (!gps_poll(&vgl->vgpsd->gpsd))
+ return TRUE;
+ else {
+ g_warning("Disconnected from gpsd. Trying to reconnect");
+ rt_gpsd_disconnect(vgl);
+ rt_gpsd_connect(vgl, FALSE);
+ }
+ }
+ return FALSE; /* no further calling */
+}
+
+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 gboolean rt_gpsd_try_connect(gpointer *data)
+{
+ VikGpsLayer *vgl = (VikGpsLayer *)data;
+#ifndef HAVE_GPS_OPEN_R
+ struct gps_data_t *gpsd = gps_open(vgl->gpsd_host, vgl->gpsd_port);
+
+ if (gpsd == NULL) {
+#else
+ vgl->vgpsd = g_malloc(sizeof(VglGpsd));
+
+ if (gps_open_r(vgl->gpsd_host, vgl->gpsd_port, /*(struct gps_data_t *)*/vgl->vgpsd) != 0) {
+#endif
+ g_warning("Failed to connect to gpsd at %s (port %s). Will retry in %d seconds",
+ vgl->gpsd_host, vgl->gpsd_port, vgl->gpsd_retry_interval);
+ return TRUE; /* keep timer running */
+ }
+
+#ifndef HAVE_GPS_OPEN_R
+ vgl->vgpsd = realloc(gpsd, sizeof(VglGpsd));
+#endif
+ vgl->vgpsd->vgl = vgl;
+
+ vgl->realtime_fix.dirty = vgl->last_fix.dirty = FALSE;
+ /* track alt/time graph uses VIK_DEFAULT_ALTITUDE (0.0) as invalid */
+ vgl->realtime_fix.fix.altitude = vgl->last_fix.fix.altitude = VIK_DEFAULT_ALTITUDE;
+ vgl->realtime_fix.fix.speed = vgl->last_fix.fix.speed = NAN;
+
+ if (vgl->realtime_record) {
+ VikTrwLayer *vtl = vgl->trw_children[TRW_REALTIME];
+ 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);
+ }
+
+ 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 | G_IO_ERR | G_IO_HUP, gpsd_data_available, vgl);
+#if HAVE_GPS_STREAM
+ gps_stream(&vgl->vgpsd->gpsd, WATCH_ENABLE, NULL);
+#else
+ gps_query(&vgl->vgpsd->gpsd, "w+x");
+#endif
+ return FALSE; /* no longer called by timeout */
+}
+
+static gboolean rt_ask_retry(VikGpsLayer *vgl)
+{
+ GtkWidget *dialog = gtk_message_dialog_new (VIK_GTK_WINDOW_FROM_LAYER(vgl),
+ GTK_DIALOG_DESTROY_WITH_PARENT,
+ GTK_MESSAGE_QUESTION,
+ GTK_BUTTONS_YES_NO,
+ "Failed to connect to gpsd at %s (port %s)\n"
+ "Should Viking keep trying (every %d seconds)?",
+ vgl->gpsd_host, vgl->gpsd_port,
+ vgl->gpsd_retry_interval);
+
+ gint res = gtk_dialog_run(GTK_DIALOG(dialog));
+ gtk_widget_destroy(dialog);
+ return (res == GTK_RESPONSE_YES);
+}
+
+static gboolean rt_gpsd_connect(VikGpsLayer *vgl, gboolean ask_if_failed)
+{
+ vgl->realtime_retry_timer = 0;
+ if (rt_gpsd_try_connect((gpointer *)vgl)) {
+ if (vgl->gpsd_retry_interval <= 0) {
+ 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);
+ return FALSE;
+ }
+ else if (ask_if_failed && !rt_ask_retry(vgl))
+ return FALSE;
+ else
+ vgl->realtime_retry_timer = g_timeout_add_seconds(vgl->gpsd_retry_interval,
+ (GSourceFunc)rt_gpsd_try_connect, (gpointer *)vgl);
+ }
+ return TRUE;
+}
+
+static void rt_gpsd_disconnect(VikGpsLayer *vgl)
+{
+ if (vgl->realtime_io_watch_id) {
+ g_source_remove(vgl->realtime_io_watch_id);
+ vgl->realtime_io_watch_id = 0;
+ }
+ if (vgl->realtime_retry_timer) {
+ g_source_remove(vgl->realtime_retry_timer);
+ vgl->realtime_retry_timer = 0;
+ }
+ if (vgl->realtime_io_channel) {
+ GError *error = NULL;
+ g_io_channel_shutdown (vgl->realtime_io_channel, FALSE, &error);
+ vgl->realtime_io_channel = NULL;
+ }
+ if (vgl->vgpsd) {
+ gps_close(&vgl->vgpsd->gpsd);
+#ifdef HAVE_GPS_OPEN_R
+ g_free(vgl->vgpsd);
+#else
+ free(vgl->vgpsd);
+#endif
+ vgl->vgpsd = NULL;
+ }
+
+ if (vgl->realtime_record && vgl->realtime_track) {
+ 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_REALTIME], vgl->realtime_track_name);
+ vgl->realtime_track = NULL;
+ }
+}
+
+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);
+
+ /* Make sure we are still in the boat with libgps */
+ g_assert((VIK_GPS_MODE_2D == MODE_2D) && (VIK_GPS_MODE_3D == MODE_3D));
+
+ if (vgl->realtime_tracking) {
+ vgl->first_realtime_trackpoint = TRUE;
+ if (!rt_gpsd_connect(vgl, TRUE)) {
+ vgl->first_realtime_trackpoint = FALSE;
+ vgl->realtime_tracking = FALSE;
+ }
+ }
+ else { /* stop realtime tracking */
+ vgl->first_realtime_trackpoint = FALSE;
+ rt_gpsd_disconnect(vgl);
+ }
+}
+#endif /* VIK_CONFIG_REALTIME_GPS_TRACKING */
+