?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Fix #2766609: Don't use gpsd_units()
[viking/guyou.git] / src / vikgpslayer.c
blobd06f5a322e498a995f5492e809c3092a7790e44e
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
Works of Guyou on Viking