2 * viking -- GPS Data and Topo Analyzer, Explorer, and Manager
4 * Copyright (C) 2003-2005, Evan Battaglia <gtoevan@gmx.net>
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.
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.
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
25 #include "vikgpslayer_pixmap.h"
30 #include <glib/gprintf.h>
33 #define DISCONNECT_UPDATE_SIGNAL(vl, val) g_signal_handlers_disconnect_matched(vl, G_SIGNAL_MATCH_DATA, 0, 0, 0, 0, val)
34 static VikGpsLayer *vik_gps_layer_create (VikViewport *vp);
35 static void vik_gps_layer_realize ( VikGpsLayer *val, VikTreeview *vt, GtkTreeIter *layer_iter );
36 static void vik_gps_layer_free ( VikGpsLayer *val );
37 static void vik_gps_layer_draw ( VikGpsLayer *val, gpointer data );
38 VikGpsLayer *vik_gps_layer_new ();
40 static void gps_layer_marshall( VikGpsLayer *val, guint8 **data, gint *len );
41 static VikGpsLayer *gps_layer_unmarshall( guint8 *data, gint len, VikViewport *vvp );
42 static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerParamData data, VikViewport *vp );
43 static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id );
45 static void gps_layer_change_coord_mode ( VikGpsLayer *val, VikCoordMode mode );
46 static void gps_layer_add_menu_items( VikGpsLayer *vtl, GtkMenu *menu, gpointer vlp );
47 static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val_dest, GtkTreeIter *src_item_iter, GtkTreePath *dest_path );
49 static void realtime_tracking_draw(VikGpsLayer *vgl, VikViewport *vp);
51 static void gps_upload_cb( gpointer layer_and_vlp[2] );
52 static void gps_download_cb( gpointer layer_and_vlp[2] );
53 static void gps_empty_upload_cb( gpointer layer_and_vlp[2] );
54 static void gps_empty_download_cb( gpointer layer_and_vlp[2] );
55 static void gps_empty_all_cb( gpointer layer_and_vlp[2] );
56 static void gps_start_stop_tracking_cb( gpointer layer_and_vlp[2] );
58 typedef enum {GARMIN_P = 0, MAGELLAN_P, NUM_PROTOCOLS} vik_gps_proto;
59 static gchar * params_protocols[] = {"Garmin", "Magellan", NULL};
60 static gchar * protocols_args[] = {"garmin", "magellan"};
61 /*#define NUM_PROTOCOLS (sizeof(params_protocols)/sizeof(params_protocols[0]) - 1) */
62 static gchar * params_ports[] = {"/dev/ttyS0", "/dev/ttyS1", "/dev/ttyUSB0", "/dev/ttyUSB1", "usb:", NULL};
63 #define NUM_PORTS (sizeof(params_ports)/sizeof(params_ports[0]) - 1)
64 typedef enum {GPS_DOWN=0, GPS_UP} gps_dir;
77 GtkWidget *status_label;
82 GtkWidget *progress_label;
85 static void gps_session_delete(GpsSession *sess);
87 static gchar *params_groups[] = {"Data Mode", "Realtime Tracking Mode"};
88 enum {GROUP_DATA_MODE, GROUP_REALTIME_MODE};
90 static VikLayerParam gps_layer_params[] = {
91 { "gps_protocol", VIK_LAYER_PARAM_UINT, GROUP_DATA_MODE, "GPS Protocol:", VIK_LAYER_WIDGET_COMBOBOX, params_protocols, NULL},
92 { "gps_port", VIK_LAYER_PARAM_UINT, GROUP_DATA_MODE, "Serial Port:", VIK_LAYER_WIDGET_COMBOBOX, params_ports, NULL},
94 { "record_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, "Recording tracks", VIK_LAYER_WIDGET_CHECKBUTTON},
95 { "center_start_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, "Jump to current position on start", VIK_LAYER_WIDGET_CHECKBUTTON},
96 { "centered_tracking", VIK_LAYER_PARAM_BOOLEAN, GROUP_REALTIME_MODE, "Keep current position at center", VIK_LAYER_WIDGET_CHECKBUTTON},
97 { "gpsd_host", VIK_LAYER_PARAM_STRING, GROUP_REALTIME_MODE, "Gpsd Host:", VIK_LAYER_WIDGET_ENTRY},
98 { "gpsd_port", VIK_LAYER_PARAM_STRING, GROUP_REALTIME_MODE, "Gpsd Port:", VIK_LAYER_WIDGET_ENTRY},
100 enum {PARAM_PROTOCOL=0, PARAM_PORT, PARAM_REALTIME_REC, PARAM_REALTIME_CENTER_START, PARAM_REALTIME_CENTERED, PARAM_GPSD_HOST, PARAM_GPSD_PORT, NUM_PARAMS};
102 VikLayerInterface vik_gps_layer_interface = {
112 sizeof(params_groups)/sizeof(params_groups[0]),
114 VIK_MENU_ITEM_ALL & ~(VIK_MENU_ITEM_CUT|VIK_MENU_ITEM_COPY),
116 (VikLayerFuncCreate) vik_gps_layer_create,
117 (VikLayerFuncRealize) vik_gps_layer_realize,
118 (VikLayerFuncPostRead) NULL,
119 (VikLayerFuncFree) vik_gps_layer_free,
121 (VikLayerFuncProperties) NULL,
122 (VikLayerFuncDraw) vik_gps_layer_draw,
123 (VikLayerFuncChangeCoordMode) gps_layer_change_coord_mode,
125 (VikLayerFuncSetMenuItemsSelection) NULL,
126 (VikLayerFuncGetMenuItemsSelection) NULL,
128 (VikLayerFuncAddMenuItems) gps_layer_add_menu_items,
129 (VikLayerFuncSublayerAddMenuItems) NULL,
131 (VikLayerFuncSublayerRenameRequest) NULL,
132 (VikLayerFuncSublayerToggleVisible) NULL,
134 (VikLayerFuncMarshall) gps_layer_marshall,
135 (VikLayerFuncUnmarshall) gps_layer_unmarshall,
137 (VikLayerFuncSetParam) gps_layer_set_param,
138 (VikLayerFuncGetParam) gps_layer_get_param,
140 (VikLayerFuncReadFileData) NULL,
141 (VikLayerFuncWriteFileData) NULL,
143 (VikLayerFuncDeleteItem) NULL,
144 (VikLayerFuncCopyItem) NULL,
145 (VikLayerFuncPasteItem) NULL,
146 (VikLayerFuncFreeCopiedItem) NULL,
147 (VikLayerFuncDragDropRequest) gps_layer_drag_drop_request,
150 enum {TRW_DOWNLOAD, TRW_UPLOAD, NUM_TRW};
151 static gchar * trw_names[] = {"GPS Download", "GPS Upload"};
154 struct gps_data_t gpsd;
161 gdouble alt; /* meters */
162 gdouble speed; /* m/s */
164 gboolean dirty; /* needs to be saved */
167 struct _VikGpsLayer {
169 VikTrwLayer * trw_children[NUM_TRW];
170 GList * children; /* used only for writing file */
171 int cur_read_child; /* used only for reading file */
173 gboolean realtime_tracking;
174 GMutex *realtime_tracking_mutex;
178 enum unit realtime_gpsd_unit;
180 VikTrack *realtime_track;
181 gchar *realtime_track_name;
183 GIOChannel *realtime_io_channel;
184 guint realtime_io_watch_id;
185 GdkGC *realtime_track_gc;
186 GdkGC *realtime_track_bg_gc;
187 GdkGC *realtime_track_pt_gc;
188 GdkGC *realtime_track_pt1_gc;
189 GdkGC *realtime_track_pt2_gc;
193 guint serial_port_id;
194 /* TODO: show on diaglog */
197 gboolean realtime_record;
198 gboolean realtime_jump_to_start;
199 gboolean realtime_keep_at_center;
202 GType vik_gps_layer_get_type ()
204 static GType val_type = 0;
208 static const GTypeInfo val_info =
210 sizeof (VikGpsLayerClass),
211 NULL, /* base_init */
212 NULL, /* base_finalize */
213 NULL, /* class init */
214 NULL, /* class_finalize */
215 NULL, /* class_data */
216 sizeof (VikGpsLayer),
218 NULL /* instance init */
220 val_type = g_type_register_static ( VIK_LAYER_TYPE, "VikGpsLayer", &val_info, 0 );
226 static VikGpsLayer *vik_gps_layer_create (VikViewport *vp)
228 VikGpsLayer *rv = vik_gps_layer_new (vp);
229 vik_layer_rename ( VIK_LAYER(rv), vik_gps_layer_interface.name );
230 rv->trw_children[TRW_UPLOAD] = VIK_TRW_LAYER(vik_layer_create ( VIK_LAYER_TRW, vp, NULL, FALSE ));
231 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));
232 rv->trw_children[TRW_DOWNLOAD] = VIK_TRW_LAYER(vik_layer_create ( VIK_LAYER_TRW, vp, NULL, FALSE ));
233 vik_layer_set_menu_items_selection(VIK_LAYER(rv->trw_children[TRW_DOWNLOAD]), VIK_MENU_ITEM_ALL & ~(VIK_MENU_ITEM_CUT|VIK_MENU_ITEM_DELETE));
238 static void gps_layer_marshall( VikGpsLayer *vgl, guint8 **data, gint *datalen )
240 VikLayer *child_layer;
243 GByteArray* b = g_byte_array_new ();
247 #define alm_append(obj, sz) \
249 g_byte_array_append ( b, (guint8 *)&len, sizeof(len) ); \
250 g_byte_array_append ( b, (guint8 *)(obj), len );
252 vik_layer_marshall_params(VIK_LAYER(vgl), &ld, &ll);
256 for (i = 0; i < NUM_TRW; i++) {
257 child_layer = VIK_LAYER(vgl->trw_children[i]);
258 vik_layer_marshall(child_layer, &ld, &ll);
266 g_byte_array_free(b, FALSE);
271 static VikGpsLayer *gps_layer_unmarshall( guint8 *data, gint len, VikViewport *vvp )
273 #define alm_size (*(gint *)data)
275 len -= sizeof(gint) + alm_size; \
276 data += sizeof(gint) + alm_size;
278 VikGpsLayer *rv = vik_gps_layer_new();
279 VikLayer *child_layer;
282 vik_layer_unmarshall_params ( VIK_LAYER(rv), data+sizeof(gint), alm_size, vvp );
286 while (len>0 && i < NUM_TRW) {
287 child_layer = vik_layer_unmarshall ( data + sizeof(gint), alm_size, vvp );
289 rv->trw_children[i++] = (VikTrwLayer *)child_layer;
290 g_signal_connect_swapped ( G_OBJECT(child_layer), "update", G_CALLBACK(vik_layer_emit_update_secondary), rv );
294 // g_print("gps_layer_unmarshall ended with len=%d\n", len);
301 static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerParamData data, VikViewport *vp )
305 /* TODO: gpsd_host, gpsd_port */
307 if (data.u < NUM_PROTOCOLS)
308 vgl->protocol_id = data.u;
310 g_warning("Unknown GPS Protocol");
313 if (data.u < NUM_PORTS)
314 vgl->serial_port_id = data.u;
316 g_warning("Unknown serial port device");
318 case PARAM_GPSD_HOST:
320 g_free(vgl->gpsd_host);
321 vgl->gpsd_host = g_strdup(data.s);
323 case PARAM_GPSD_PORT:
325 g_free(vgl->gpsd_port);
326 vgl->gpsd_port = g_strdup(data.s); /* TODO: check for number */
328 case PARAM_REALTIME_REC:
329 vgl->realtime_record = data.b;
331 case PARAM_REALTIME_CENTER_START:
332 vgl->realtime_jump_to_start = data.b;
334 case PARAM_REALTIME_CENTERED:
335 vgl->realtime_keep_at_center = data.b;
338 g_warning("gps_layer_set_param(): unknown parameter");
344 static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id )
346 VikLayerParamData rv;
349 /* TODO: gpsd_host, gpsd_port */
351 rv.u = vgl->protocol_id;
354 rv.u = vgl->serial_port_id;
356 case PARAM_GPSD_HOST:
357 rv.s = vgl->gpsd_host ? vgl->gpsd_host : "";
359 case PARAM_GPSD_PORT:
360 rv.s = vgl->gpsd_port ? vgl->gpsd_port : g_strdup(DEFAULT_GPSD_PORT);
362 case PARAM_REALTIME_REC:
363 rv.b = vgl->realtime_record;
365 case PARAM_REALTIME_CENTER_START:
366 rv.b = vgl->realtime_jump_to_start;
368 case PARAM_REALTIME_CENTERED:
369 rv.b = vgl->realtime_keep_at_center;
372 g_warning("gps_layer_get_param(): unknown parameter");
378 VikGpsLayer *vik_gps_layer_new (VikViewport *vp)
381 VikGpsLayer *vgl = VIK_GPS_LAYER ( g_object_new ( VIK_GPS_LAYER_TYPE, NULL ) );
382 vik_layer_init ( VIK_LAYER(vgl), VIK_LAYER_GPS );
383 for (i = 0; i < NUM_TRW; i++) {
384 vgl->trw_children[i] = NULL;
386 vgl->children = NULL;
387 vgl->cur_read_child = 0;
389 vgl->realtime_tracking_mutex = g_mutex_new();
390 vgl->realtime_tracking = FALSE;
392 vgl->realtime_track_gc = vik_viewport_new_gc ( vp, "#203070", 2 );
393 vgl->realtime_track_bg_gc = vik_viewport_new_gc ( vp, "grey", 2 );
394 vgl->realtime_track_pt1_gc = vik_viewport_new_gc ( vp, "red", 2 );
395 vgl->realtime_track_pt2_gc = vik_viewport_new_gc ( vp, "green", 2 );
396 vgl->realtime_track_pt_gc = vgl->realtime_track_pt1_gc;
397 vgl->realtime_gpsd_unit = gpsd_units();
398 // fprintf(stderr, "DEBUG: gpsd_unit = %d\n", vgl->realtime_gpsd_unit);
399 vgl->realtime_track = NULL;
401 /* Setting params here */
402 vgl->protocol_id = 0;
403 vgl->serial_port_id = 0;
404 vgl->gpsd_host = g_strdup("localhost");
405 vgl->gpsd_port = g_strdup(DEFAULT_GPSD_PORT);
406 vgl->realtime_record = TRUE;
407 vgl->realtime_jump_to_start = TRUE;
408 vgl->realtime_keep_at_center = FALSE;
413 static void vik_gps_layer_draw ( VikGpsLayer *vgl, gpointer data )
417 VikLayer *trigger = VIK_LAYER(vik_viewport_get_trigger( VIK_VIEWPORT(data) ));
419 for (i = 0; i < NUM_TRW; i++) {
420 vl = VIK_LAYER(vgl->trw_children[i]);
422 if ( vik_viewport_get_half_drawn ( VIK_VIEWPORT(data) ) ) {
423 vik_viewport_set_half_drawn ( VIK_VIEWPORT(data), FALSE );
424 vik_viewport_snapshot_load( VIK_VIEWPORT(data) );
426 vik_viewport_snapshot_save( VIK_VIEWPORT(data) );
429 if (!vik_viewport_get_half_drawn( VIK_VIEWPORT(data)))
430 vik_layer_draw ( vl, data );
432 if (vgl->realtime_tracking) {
433 if (VIK_LAYER(vgl) == trigger) {
434 if ( vik_viewport_get_half_drawn ( VIK_VIEWPORT(data) ) ) {
435 vik_viewport_set_half_drawn ( VIK_VIEWPORT(data), FALSE );
436 vik_viewport_snapshot_load( VIK_VIEWPORT(data) );
438 vik_viewport_snapshot_save( VIK_VIEWPORT(data) );
441 if (!vik_viewport_get_half_drawn( VIK_VIEWPORT(data)))
442 realtime_tracking_draw(vgl, VIK_VIEWPORT(data));
446 static void gps_layer_change_coord_mode ( VikGpsLayer *vgl, VikCoordMode mode )
449 for (i = 0; i < NUM_TRW; i++) {
450 vik_layer_change_coord_mode(VIK_LAYER(vgl->trw_children[i]), mode);
454 static void gps_layer_add_menu_items( VikGpsLayer *vgl, GtkMenu *menu, gpointer vlp )
456 static gpointer pass_along[2];
461 item = gtk_menu_item_new();
462 gtk_menu_shell_append ( GTK_MENU_SHELL(menu), item );
463 gtk_widget_show ( item );
465 item = gtk_menu_item_new_with_label ( "Upload to GPS" );
466 g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_upload_cb), pass_along );
467 gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
468 gtk_widget_show ( item );
470 item = gtk_menu_item_new_with_label ( "Download from GPS" );
471 g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_download_cb), pass_along );
472 gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
473 gtk_widget_show ( item );
475 item = gtk_menu_item_new_with_label ( vgl->realtime_tracking ?
476 "Stop realtime tracking" :
477 "Start realtime tracking" );
478 g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_start_stop_tracking_cb), pass_along );
479 gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
480 gtk_widget_show ( item );
482 item = gtk_menu_item_new();
483 gtk_menu_shell_append ( GTK_MENU_SHELL(menu), item );
484 gtk_widget_show ( item );
486 item = gtk_menu_item_new_with_label ( "Empty Upload" );
487 g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_empty_upload_cb), pass_along );
488 gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
489 gtk_widget_show ( item );
491 item = gtk_menu_item_new_with_label ( "Empty Download" );
492 g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_empty_download_cb), pass_along );
493 gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
494 gtk_widget_show ( item );
496 item = gtk_menu_item_new_with_label ( "Empty All" );
497 g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_empty_all_cb), pass_along );
498 gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
499 gtk_widget_show ( item );
503 static void disconnect_layer_signal ( VikLayer *vl, VikGpsLayer *vgl )
505 g_assert(DISCONNECT_UPDATE_SIGNAL(vl,vgl)==1);
508 static void vik_gps_layer_free ( VikGpsLayer *vgl )
511 for (i = 0; i < NUM_TRW; i++) {
512 if (vgl->vl.realized)
513 disconnect_layer_signal(VIK_LAYER(vgl->trw_children[i]), vgl);
514 g_object_unref(vgl->trw_children[i]);
516 if (vgl->realtime_track_gc != NULL)
517 g_object_unref(vgl->realtime_track_gc);
518 if (vgl->realtime_track_bg_gc != NULL)
519 g_object_unref(vgl->realtime_track_bg_gc);
520 if (vgl->realtime_track_pt1_gc != NULL)
521 g_object_unref(vgl->realtime_track_pt1_gc);
522 if (vgl->realtime_track_pt2_gc != NULL)
523 g_object_unref(vgl->realtime_track_pt2_gc);
524 if (vgl->realtime_tracking_mutex != NULL)
525 g_mutex_free(vgl->realtime_tracking_mutex);
528 gboolean vik_gps_layer_delete ( VikGpsLayer *vgl, GtkTreeIter *iter )
531 VikLayer *l = VIK_LAYER( vik_treeview_item_get_pointer ( VIK_LAYER(vgl)->vt, iter ) );
532 gboolean was_visible = l->visible;
534 vik_treeview_item_delete ( VIK_LAYER(vgl)->vt, iter );
535 for (i = 0; i < NUM_TRW; i++) {
536 if (VIK_LAYER(vgl->trw_children[i]) == l)
537 vgl->trw_children[i] = NULL;
539 g_assert(DISCONNECT_UPDATE_SIGNAL(l,vgl)==1);
540 g_object_unref ( l );
545 static void vik_gps_layer_realize ( VikGpsLayer *vgl, VikTreeview *vt, GtkTreeIter *layer_iter )
550 for (ix = 0; ix < NUM_TRW; ix++) {
551 VikLayer * trw = VIK_LAYER(vgl->trw_children[ix]);
552 vik_treeview_add_layer ( VIK_LAYER(vgl)->vt, layer_iter, &iter,
554 trw, trw->type, trw->type );
555 if ( ! trw->visible )
556 vik_treeview_item_set_visible ( VIK_LAYER(vgl)->vt, &iter, FALSE );
557 vik_layer_realize ( trw, VIK_LAYER(vgl)->vt, &iter );
558 g_signal_connect_swapped ( G_OBJECT(trw), "update", G_CALLBACK(vik_layer_emit_update_secondary), vgl );
562 const GList *vik_gps_layer_get_children ( VikGpsLayer *vgl )
566 if (vgl->children == NULL) {
567 for (i = NUM_TRW - 1; i >= 0; i--)
568 vgl->children = g_list_prepend(vgl->children, vgl->trw_children[i]);
570 return vgl->children;
573 VikTrwLayer * vik_gps_layer_get_a_child(VikGpsLayer *vgl)
575 g_assert ((vgl->cur_read_child >= 0) && (vgl->cur_read_child < NUM_TRW));
577 VikTrwLayer * vtl = vgl->trw_children[vgl->cur_read_child];
578 if (++(vgl->cur_read_child) >= NUM_TRW)
579 vgl->cur_read_child = 0;
583 gboolean vik_gps_layer_is_empty ( VikGpsLayer *vgl )
585 if ( vgl->trw_children[0] )
590 static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val_dest, GtkTreeIter *src_item_iter, GtkTreePath *dest_path )
592 VikTreeview *vt = VIK_LAYER(val_src)->vt;
593 VikLayer *vl = vik_treeview_item_get_pointer(vt, src_item_iter);
594 GtkTreeIter dest_iter;
596 gboolean target_exists;
598 dp = gtk_tree_path_to_string(dest_path);
599 target_exists = vik_treeview_get_iter_from_path_str(vt, &dest_iter, dp);
601 /* vik_gps_layer_delete unrefs, but we don't want that here.
602 * we're still using the layer. */
604 vik_gps_layer_delete(val_src, src_item_iter);
609 static void gps_session_delete(GpsSession *sess)
612 g_mutex_free(sess->mutex);
613 g_free(sess->cmd_args);
619 static void set_total_count(gint cnt, GpsSession *sess)
623 g_mutex_lock(sess->mutex);
625 g_sprintf(s, "%s %d %s...",
626 (sess->direction == GPS_DOWN) ? "Downloading" : "Uploading", cnt,
627 (sess->progress_label == sess->wp_label) ? "waypoints" : "trackpoints");
628 gtk_label_set_text ( GTK_LABEL(sess->progress_label), s );
629 gtk_widget_show ( sess->progress_label );
630 sess->total_count = cnt;
632 g_mutex_unlock(sess->mutex);
636 static void set_current_count(gint cnt, GpsSession *sess)
639 gchar *dir_str = (sess->direction == GPS_DOWN) ? "Downloaded" : "Uploaded";
642 g_mutex_lock(sess->mutex);
644 if (cnt < sess->total_count) {
645 g_sprintf(s, "%s %d out of %d %s...", dir_str, cnt, sess->total_count, (sess->progress_label == sess->wp_label) ? "waypoints" : "trackpoints");
647 g_sprintf(s, "%s %d %s.", dir_str, cnt, (sess->progress_label == sess->wp_label) ? "waypoints" : "trackpoints");
649 gtk_label_set_text ( GTK_LABEL(sess->progress_label), s );
651 g_mutex_unlock(sess->mutex);
655 static void set_gps_info(const gchar *info, GpsSession *sess)
659 g_mutex_lock(sess->mutex);
661 g_sprintf(s, "GPS Device: %s", info);
662 gtk_label_set_text ( GTK_LABEL(sess->gps_label), s );
664 g_mutex_unlock(sess->mutex);
668 static void gps_download_progress_func(BabelProgressCode c, gpointer data, GpsSession * sess )
672 gdk_threads_enter ();
673 g_mutex_lock(sess->mutex);
675 g_mutex_unlock(sess->mutex);
676 gps_session_delete(sess);
678 g_thread_exit ( NULL );
680 g_mutex_unlock(sess->mutex);
681 gdk_threads_leave ();
684 case BABEL_DIAG_OUTPUT:
685 line = (gchar *)data;
687 /* tells us how many items there will be */
688 if (strstr(line, "Xfer Wpt")) {
689 sess->progress_label = sess->wp_label;
691 if (strstr(line, "Xfer Trk")) {
692 sess->progress_label = sess->trk_label;
694 if (strstr(line, "PRDDAT")) {
695 gchar **tokens = g_strsplit(line, " ", 0);
701 while (tokens[n_tokens])
705 for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) {
707 sscanf(tokens[i], "%x", &ch);
711 set_gps_info(info, sess);
715 if (strstr(line, "RECORD")) {
718 if (strlen(line) > 20) {
719 sscanf(line+17, "%x", &lsb);
720 sscanf(line+20, "%x", &msb);
721 cnt = lsb + msb * 256;
722 set_total_count(cnt, sess);
726 if ( strstr(line, "WPTDAT") || strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) {
728 set_current_count(sess->count, sess);
739 static void gps_upload_progress_func(BabelProgressCode c, gpointer data, GpsSession * sess )
744 gdk_threads_enter ();
745 g_mutex_lock(sess->mutex);
747 g_mutex_unlock(sess->mutex);
748 gps_session_delete(sess);
750 g_thread_exit ( NULL );
752 g_mutex_unlock(sess->mutex);
753 gdk_threads_leave ();
756 case BABEL_DIAG_OUTPUT:
757 line = (gchar *)data;
759 if (strstr(line, "PRDDAT")) {
760 gchar **tokens = g_strsplit(line, " ", 0);
766 while (tokens[n_tokens])
770 for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) {
772 sscanf(tokens[i], "%x", &ch);
776 set_gps_info(info, sess);
780 if (strstr(line, "RECORD")) {
783 if (strlen(line) > 20) {
784 sscanf(line+17, "%x", &lsb);
785 sscanf(line+20, "%x", &msb);
786 cnt = lsb + msb * 256;
787 /* set_total_count(cnt, sess); */
791 if ( strstr(line, "WPTDAT")) {
792 if (sess->count == 0) {
793 sess->progress_label = sess->wp_label;
794 set_total_count(cnt, sess);
797 set_current_count(sess->count, sess);
800 if ( strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) {
801 if (sess->count == 0) {
802 sess->progress_label = sess->trk_label;
803 set_total_count(cnt, sess);
806 set_current_count(sess->count, sess);
817 static void gps_comm_thread(GpsSession *sess)
821 if (sess->direction == GPS_DOWN)
822 result = a_babel_convert_from (sess->vtl, sess->cmd_args,
823 (BabelStatusFunc) gps_download_progress_func, sess->port, sess);
825 result = a_babel_convert_to (sess->vtl, sess->cmd_args,
826 (BabelStatusFunc) gps_upload_progress_func, sess->port, sess);
830 gtk_label_set_text ( GTK_LABEL(sess->status_label), "Error: couldn't find gpsbabel." );
833 g_mutex_lock(sess->mutex);
835 gtk_label_set_text ( GTK_LABEL(sess->status_label), "Done." );
836 gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_ACCEPT, TRUE );
837 gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_REJECT, FALSE );
841 g_mutex_unlock(sess->mutex);
844 g_mutex_lock(sess->mutex);
847 g_mutex_unlock(sess->mutex);
850 g_mutex_unlock(sess->mutex);
851 gps_session_delete(sess);
857 static gint gps_comm(VikTrwLayer *vtl, gps_dir dir, vik_gps_proto proto, gchar *port) {
858 GpsSession *sess = g_malloc(sizeof(GpsSession));
860 sess->mutex = g_mutex_new();
861 sess->direction = dir;
863 sess->port = g_strdup(port);
865 sess->cmd_args = g_strdup_printf("-D 9 -t -w -%c %s",
866 (dir == GPS_DOWN) ? 'i' : 'o', protocols_args[proto]);
867 sess->window_title = (dir == GPS_DOWN) ? "GPS Download" : "GPS Upload";
869 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 );
870 gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog),
871 GTK_RESPONSE_ACCEPT, FALSE );
872 gtk_window_set_title ( GTK_WINDOW(sess->dialog), sess->window_title );
874 sess->status_label = gtk_label_new ("Status: detecting gpsbabel");
875 gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox),
876 sess->status_label, FALSE, FALSE, 5 );
877 gtk_widget_show_all(sess->status_label);
879 sess->gps_label = gtk_label_new ("GPS device: N/A");
880 sess->ver_label = gtk_label_new ("");
881 sess->id_label = gtk_label_new ("");
882 sess->wp_label = gtk_label_new ("");
883 sess->trk_label = gtk_label_new ("");
885 gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->gps_label, FALSE, FALSE, 5 );
886 gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->wp_label, FALSE, FALSE, 5 );
887 gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->trk_label, FALSE, FALSE, 5 );
889 gtk_widget_show_all(sess->dialog);
891 sess->progress_label = sess->wp_label;
892 sess->total_count = -1;
894 /* TODO: starting gps read/write thread here */
895 g_thread_create((GThreadFunc)gps_comm_thread, sess, FALSE, NULL );
897 gtk_dialog_run(GTK_DIALOG(sess->dialog));
899 gtk_widget_destroy(sess->dialog);
901 g_mutex_lock(sess->mutex);
903 sess->ok = FALSE; /* tell thread to stop */
904 g_mutex_unlock(sess->mutex);
907 g_mutex_unlock(sess->mutex);
908 gps_session_delete(sess);
914 static void gps_upload_cb( gpointer layer_and_vlp[2] )
916 VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
917 VikTrwLayer *vtl = vgl->trw_children[TRW_UPLOAD];
918 gps_comm(vtl, GPS_UP, vgl->protocol_id, params_ports[vgl->serial_port_id]);
921 static void gps_download_cb( gpointer layer_and_vlp[2] )
923 VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
924 VikTrwLayer *vtl = vgl->trw_children[TRW_DOWNLOAD];
925 gps_comm(vtl, GPS_DOWN, vgl->protocol_id, params_ports[vgl->serial_port_id]);
928 static void gps_empty_upload_cb( gpointer layer_and_vlp[2] )
930 VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
931 vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_UPLOAD]);
932 vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_UPLOAD]);
935 static void gps_empty_download_cb( gpointer layer_and_vlp[2] )
937 VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
938 vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_DOWNLOAD]);
939 vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_DOWNLOAD]);
942 static void gps_empty_all_cb( gpointer layer_and_vlp[2] )
944 VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
945 vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_UPLOAD]);
946 vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_UPLOAD]);
947 vik_trw_layer_delete_all_waypoints ( vgl-> trw_children[TRW_DOWNLOAD]);
948 vik_trw_layer_delete_all_tracks ( vgl-> trw_children[TRW_DOWNLOAD]);
951 static void realtime_tracking_draw(VikGpsLayer *vgl, VikViewport *vp)
954 struct LatLon lnw, lse;
955 vik_viewport_screen_to_coord ( vp, -20, -20, &nw );
956 vik_viewport_screen_to_coord ( vp, vik_viewport_get_width(vp)+20, vik_viewport_get_width(vp)+20, &se );
957 vik_coord_to_latlon ( &nw, &lnw );
958 vik_coord_to_latlon ( &se, &lse );
959 if ( vgl->realtime_fix.ll.lat > lse.lat &&
960 vgl->realtime_fix.ll.lat < lnw.lat &&
961 vgl->realtime_fix.ll.lon > lnw.lon &&
962 vgl->realtime_fix.ll.lon < lse.lon ) {
965 gint half_back_x, half_back_y;
966 gint half_back_bg_x, half_back_bg_y;
969 gint side1_x, side1_y, side2_x, side2_y;
970 gint side1bg_x, side1bg_y, side2bg_x, side2bg_y;
972 vik_coord_load_from_latlon ( &gps, vik_viewport_get_coord_mode(vp), &(vgl->realtime_fix.ll) );
973 vik_viewport_coord_to_screen ( vp, &gps, &x, &y );
975 gdouble heading_cos = cos(M_PI/180*vgl->realtime_fix.heading);
976 gdouble heading_sin = sin(M_PI/180*vgl->realtime_fix.heading);
978 half_back_y = y+8*heading_cos;
979 half_back_x = x-8*heading_sin;
980 half_back_bg_y = y+10*heading_cos;
981 half_back_bg_x = x-10*heading_sin;
983 pt_y = half_back_y-24*heading_cos;
984 pt_x = half_back_x+24*heading_sin;
985 ptbg_y = half_back_bg_y-28*heading_cos;
986 ptbg_x = half_back_bg_x+28*heading_sin;
988 side1_y = half_back_y+9*heading_sin;
989 side1_x = half_back_x+9*heading_cos;
990 side1bg_y = half_back_bg_y+11*heading_sin;
991 side1bg_x = half_back_bg_x+11*heading_cos;
993 side2_y = half_back_y-9*heading_sin;
994 side2_x = half_back_x-9*heading_cos;
995 side2bg_y = half_back_bg_y-11*heading_sin;
996 side2bg_x = half_back_bg_x-11*heading_cos;
998 GdkPoint trian[3] = { { pt_x, pt_y }, {side1_x, side1_y}, {side2_x, side2_y} };
999 GdkPoint trian_bg[3] = { { ptbg_x, pt_y }, {side1bg_x, side1bg_y}, {side2bg_x, side2bg_y} };
1001 vik_viewport_draw_polygon ( vp, vgl->realtime_track_bg_gc, TRUE, trian_bg, 3 );
1002 vik_viewport_draw_polygon ( vp, vgl->realtime_track_gc, TRUE, trian, 3 );
1003 vik_viewport_draw_rectangle ( vp, vgl->realtime_track_pt_gc, TRUE, x-2, y-2, 4, 4 );
1004 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;
1008 /* lock/unlock realtime_tracking_mutex when call this */
1009 static void create_realtime_trackpoint(VikGpsLayer *vgl, gboolean forced)
1011 if (vgl->realtime_record && vgl->realtime_fix.dirty) {
1012 int heading = (int)floor(vgl->realtime_fix.heading);
1013 int last_heading = (int)floor(vgl->last_fix.heading);
1015 ((heading < last_heading) && (heading < (last_heading - 3))) ||
1016 ((heading > last_heading) && (heading > (last_heading + 3))) ||
1017 ((int)vgl->realtime_fix.alt != (int)vgl->last_fix.alt)) {
1018 /* TODO: check for new segments */
1019 VikTrackpoint *tp = vik_trackpoint_new();
1020 tp->newsegment = FALSE;
1021 tp->altitude = vgl->realtime_fix.alt;
1022 tp->has_timestamp = TRUE;
1023 tp->timestamp = vgl->realtime_fix.timestamp;
1024 vik_coord_load_from_latlon(&tp->coord,
1025 vik_trw_layer_get_coord_mode(vgl->trw_children[TRW_DOWNLOAD]),
1026 &vgl->realtime_fix.ll);
1027 if (vgl->realtime_keep_at_center ||
1028 (vgl->realtime_jump_to_start && !vgl->realtime_track->trackpoints)) {
1029 VikWindow *vw = VIK_WINDOW(VIK_GTK_WINDOW_FROM_LAYER(vgl));
1030 VikViewport *vvp = vik_window_viewport(vw);
1031 vik_viewport_set_center_coord(vvp, &tp->coord);
1034 vgl->realtime_track->trackpoints = g_list_append(vgl->realtime_track->trackpoints, tp);
1035 vgl->realtime_fix.dirty = FALSE;
1036 vgl->last_fix = vgl->realtime_fix;
1042 void gpsd_raw_hook(VglGpsd *vgpsd, gchar *data)
1044 VikGpsLayer *vgl = vgpsd->vgl;
1046 // fprintf(stderr, "raw_hook called\n");
1047 if (!vgl->realtime_tracking)
1050 if (vgpsd->gpsd.fix.mode >= MODE_2D) {
1051 if (!isnan(vgpsd->gpsd.fix.altitude))
1052 vgl->realtime_fix.alt = vgpsd->gpsd.fix.altitude; /* in meters */
1053 if (!isnan(vgpsd->gpsd.fix.speed))
1054 vgl->realtime_fix.speed = vgpsd->gpsd.fix.speed; /* m/s */
1057 if (vgl->realtime_fix.timestamp == (time_t)vgpsd->gpsd.fix.time)
1060 if ((vgpsd->gpsd.fix.mode >= MODE_2D) &&
1061 !isnan(vgpsd->gpsd.fix.latitude) &&
1062 !isnan(vgpsd->gpsd.fix.longitude) &&
1063 !isnan(vgpsd->gpsd.fix.track)) {
1064 g_mutex_lock(vgl->realtime_tracking_mutex);
1065 vgl->realtime_fix.timestamp = vgpsd->gpsd.fix.time;
1066 vgl->realtime_fix.ll.lat = vgpsd->gpsd.fix.latitude;
1067 vgl->realtime_fix.ll.lon = vgpsd->gpsd.fix.longitude;
1068 vgl->realtime_fix.heading = vgpsd->gpsd.fix.track;
1069 vgl->realtime_fix.dirty = TRUE;
1071 create_realtime_trackpoint(vgl, FALSE);
1072 g_mutex_unlock(vgl->realtime_tracking_mutex);
1074 vik_layer_emit_update ( VIK_LAYER(vgl) ); /* passing vgl to make sure layers underneath are updated */
1078 static gboolean gpsd_data_available(GIOChannel *source, GIOCondition condition, gpointer data)
1080 VikGpsLayer *vgl = data;
1081 gps_poll(&vgl->vgpsd->gpsd);
1085 static gchar *make_track_name(VikTrwLayer *vtl)
1087 const gchar basename[] = "REALTIME";
1088 const gint bufsize = sizeof(basename) + 5;
1089 gchar *name = g_malloc(bufsize);
1090 strcpy(name, basename);
1093 while (vik_trw_layer_get_track(vtl, name) != NULL) {
1094 g_snprintf(name, bufsize, "%s#%d", basename, i);
1101 static void gps_start_stop_tracking_cb( gpointer layer_and_vlp[2])
1103 VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
1104 vgl->realtime_tracking = (vgl->realtime_tracking == FALSE);
1106 if (vgl->realtime_tracking) {
1107 struct gps_data_t *gpsd = gps_open(vgl->gpsd_host, vgl->gpsd_port);
1109 fprintf(stderr, "DEBUG: %s(): gps_open failed\n", __PRETTY_FUNCTION__);
1110 vgl->realtime_tracking = FALSE;
1113 vgl->vgpsd = g_realloc(gpsd, sizeof(VglGpsd));
1114 vgl->vgpsd->vgl = vgl;
1115 vgl->realtime_fix.ll.lat = vgl->realtime_fix.ll.lon = vgl->realtime_fix.heading = 0;
1116 vgl->last_fix.ll.lat = vgl->last_fix.ll.lon = vgl->last_fix.heading = 0;
1118 gps_set_raw_hook(&vgl->vgpsd->gpsd, gpsd_raw_hook);
1119 vgl->realtime_io_channel = g_io_channel_unix_new(vgl->vgpsd->gpsd.gps_fd);
1120 vgl->realtime_io_watch_id = g_io_add_watch( vgl->realtime_io_channel,
1121 G_IO_IN, gpsd_data_available, vgl);
1123 // vgl->realtime_timeout = gtk_timeout_add ( 1000, (GtkFunction)gpsd_timeout, vgl);
1124 if (vgl->realtime_record) {
1125 VikTrwLayer *vtl = vgl->trw_children[TRW_DOWNLOAD];
1126 vgl->realtime_track = vik_track_new();
1127 vgl->realtime_track->visible = TRUE;
1128 vgl->realtime_track_name = make_track_name(vtl);
1129 vik_trw_layer_add_track(vtl, vgl->realtime_track_name, vgl->realtime_track);
1132 vgl->realtime_fix.ll.lat = vgl->realtime_fix.ll.lon = 0.0;
1133 vgl->realtime_fix.heading = vgl->realtime_fix.speed = 0.0;
1134 vgl->realtime_fix.alt = VIK_DEFAULT_ALTITUDE;
1135 vgl->realtime_fix.timestamp = 0;
1136 vgl->realtime_fix.dirty = FALSE;
1137 vgl->last_fix = vgl->realtime_fix;
1139 gps_query(&vgl->vgpsd->gpsd, "w+x");
1142 else { /* stop realtime tracking */
1143 /* TODO: handle race condition here , make sure vgpsd is NULL */
1144 g_mutex_lock(vgl->realtime_tracking_mutex);
1145 gps_close(&vgl->vgpsd->gpsd);
1147 // g_source_remove(vgl->realtime_timeout);
1148 g_source_remove(vgl->realtime_io_watch_id);
1149 g_io_channel_unref (vgl->realtime_io_channel);
1151 if (vgl->realtime_record) {
1152 create_realtime_trackpoint(vgl, TRUE);
1153 if ((vgl->realtime_track->trackpoints == NULL) || (vgl->realtime_track->trackpoints->next == NULL))
1154 vik_trw_layer_delete_track(vgl->trw_children[TRW_DOWNLOAD], vgl->realtime_track_name);
1156 g_mutex_unlock(vgl->realtime_tracking_mutex);