]> git.street.me.uk Git - andy/viking.git/blame_incremental - src/gpx.c
GeoRef Layer only works in UTM Projection Mode.
[andy/viking.git] / src / gpx.c
... / ...
CommitLineData
1/*
2 * viking -- GPS Data and Topo Analyzer, Explorer, and Manager
3 *
4 * Copyright (C) 2003-2007, Evan Battaglia <gtoevan@gmx.net>
5 * Copyright (C) 2007, Quy Tonthat <qtonthat@gmail.com>
6 * Copyright (C) 2008, Hein Ragas <viking@ragas.nl>
7 * Copyright (C) 2009, Tal B <tal.bav@gmail.com>
8 * Copyright (c) 2012, Rob Norris <rw_norris@hotmail.com>
9 *
10 * Some of the code adapted from GPSBabel 1.2.7
11 * http://gpsbabel.sf.net/
12 * Copyright (C) 2002, 2003, 2004, 2005 Robert Lipe, robertlipe@usa.net
13 *
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License as published by
16 * the Free Software Foundation; either version 2 of the License, or
17 * (at your option) any later version.
18 *
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
23 *
24 * You should have received a copy of the GNU General Public License
25 * along with this program; if not, write to the Free Software
26 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 *
28 */
29#ifdef HAVE_CONFIG_H
30#include "config.h"
31#endif
32
33#define _XOPEN_SOURCE /* glibc2 needs this */
34
35#include "gpx.h"
36#include "viking.h"
37#include <expat.h>
38#ifdef HAVE_STRING_H
39#include <string.h>
40#endif
41#include <glib.h>
42#ifdef HAVE_MATH_H
43#include <math.h>
44#endif
45#include <time.h>
46
47typedef enum {
48 tt_unknown = 0,
49
50 tt_gpx,
51
52 tt_wpt,
53 tt_wpt_cmt,
54 tt_wpt_desc,
55 tt_wpt_name,
56 tt_wpt_ele,
57 tt_wpt_sym,
58 tt_wpt_link, /* New in GPX 1.1 */
59
60 tt_trk,
61 tt_trk_cmt,
62 tt_trk_desc,
63 tt_trk_name,
64
65 tt_rte,
66
67 tt_trk_trkseg,
68 tt_trk_trkseg_trkpt,
69 tt_trk_trkseg_trkpt_ele,
70 tt_trk_trkseg_trkpt_time,
71 /* extended */
72 tt_trk_trkseg_trkpt_course,
73 tt_trk_trkseg_trkpt_speed,
74 tt_trk_trkseg_trkpt_fix,
75 tt_trk_trkseg_trkpt_sat,
76
77 tt_trk_trkseg_trkpt_hdop,
78 tt_trk_trkseg_trkpt_vdop,
79 tt_trk_trkseg_trkpt_pdop,
80
81 tt_waypoint,
82 tt_waypoint_coord,
83 tt_waypoint_name,
84} tag_type;
85
86typedef struct tag_mapping {
87 tag_type tag_type; /* enum from above for this tag */
88 const char *tag_name; /* xpath-ish tag name */
89} tag_mapping;
90
91typedef struct {
92 GpxWritingOptions *options;
93 FILE *file;
94} GpxWritingContext;
95
96/*
97 * xpath(ish) mappings between full tag paths and internal identifers.
98 * These appear in the order they appear in the GPX specification.
99 * If it's not a tag we explictly handle, it doesn't go here.
100 */
101
102tag_mapping tag_path_map[] = {
103
104 { tt_wpt, "/gpx/wpt" },
105
106 { tt_waypoint, "/loc/waypoint" },
107 { tt_waypoint_coord, "/loc/waypoint/coord" },
108 { tt_waypoint_name, "/loc/waypoint/name" },
109
110 { tt_wpt_ele, "/gpx/wpt/ele" },
111 { tt_wpt_name, "/gpx/wpt/name" },
112 { tt_wpt_cmt, "/gpx/wpt/cmt" },
113 { tt_wpt_desc, "/gpx/wpt/desc" },
114 { tt_wpt_sym, "/gpx/wpt/sym" },
115 { tt_wpt_sym, "/loc/waypoint/type" },
116 { tt_wpt_link, "/gpx/wpt/link" }, /* GPX 1.1 */
117
118 { tt_trk, "/gpx/trk" },
119 { tt_trk_name, "/gpx/trk/name" },
120 { tt_trk_cmt, "/gpx/trk/cmt" },
121 { tt_trk_desc, "/gpx/trk/desc" },
122 { tt_trk_trkseg, "/gpx/trk/trkseg" },
123 { tt_trk_trkseg_trkpt, "/gpx/trk/trkseg/trkpt" },
124 { tt_trk_trkseg_trkpt_ele, "/gpx/trk/trkseg/trkpt/ele" },
125 { tt_trk_trkseg_trkpt_time, "/gpx/trk/trkseg/trkpt/time" },
126 /* extended */
127 { tt_trk_trkseg_trkpt_course, "/gpx/trk/trkseg/trkpt/course" },
128 { tt_trk_trkseg_trkpt_speed, "/gpx/trk/trkseg/trkpt/speed" },
129 { tt_trk_trkseg_trkpt_fix, "/gpx/trk/trkseg/trkpt/fix" },
130 { tt_trk_trkseg_trkpt_sat, "/gpx/trk/trkseg/trkpt/sat" },
131
132 { tt_trk_trkseg_trkpt_hdop, "/gpx/trk/trkseg/trkpt/hdop" },
133 { tt_trk_trkseg_trkpt_vdop, "/gpx/trk/trkseg/trkpt/vdop" },
134 { tt_trk_trkseg_trkpt_pdop, "/gpx/trk/trkseg/trkpt/pdop" },
135
136 { tt_rte, "/gpx/rte" },
137 // NB Route reuses track point feature tags
138 { tt_trk_name, "/gpx/rte/name" },
139 { tt_trk_cmt, "/gpx/rte/cmt" },
140 { tt_trk_desc, "/gpx/rte/desc" },
141 { tt_trk_trkseg_trkpt, "/gpx/rte/rtept" },
142 { tt_trk_trkseg_trkpt_ele, "/gpx/rte/rtept/ele" },
143
144 {0}
145};
146
147static tag_type get_tag(const char *t)
148{
149 tag_mapping *tm;
150 for (tm = tag_path_map; tm->tag_type != 0; tm++)
151 if (0 == strcmp(tm->tag_name, t))
152 return tm->tag_type;
153 return tt_unknown;
154}
155
156/******************************************/
157
158tag_type current_tag = tt_unknown;
159GString *xpath = NULL;
160GString *c_cdata = NULL;
161
162/* current ("c_") objects */
163VikTrackpoint *c_tp = NULL;
164VikWaypoint *c_wp = NULL;
165VikTrack *c_tr = NULL;
166
167gchar *c_wp_name = NULL;
168gchar *c_tr_name = NULL;
169
170/* temporary things so we don't have to create them lots of times */
171const gchar *c_slat, *c_slon;
172struct LatLon c_ll;
173
174/* specialty flags / etc */
175gboolean f_tr_newseg;
176guint unnamed_waypoints = 0;
177guint unnamed_tracks = 0;
178
179
180static const char *get_attr ( const char **attr, const char *key )
181{
182 while ( *attr ) {
183 if ( strcmp(*attr,key) == 0 )
184 return *(attr + 1);
185 attr += 2;
186 }
187 return NULL;
188}
189
190static gboolean set_c_ll ( const char **attr )
191{
192 if ( (c_slat = get_attr ( attr, "lat" )) && (c_slon = get_attr ( attr, "lon" )) ) {
193 c_ll.lat = g_ascii_strtod(c_slat, NULL);
194 c_ll.lon = g_ascii_strtod(c_slon, NULL);
195 return TRUE;
196 }
197 return FALSE;
198}
199
200static void gpx_start(VikTrwLayer *vtl, const char *el, const char **attr)
201{
202 static const gchar *tmp;
203
204 g_string_append_c ( xpath, '/' );
205 g_string_append ( xpath, el );
206 current_tag = get_tag ( xpath->str );
207
208 switch ( current_tag ) {
209
210 case tt_wpt:
211 if ( set_c_ll( attr ) ) {
212 c_wp = vik_waypoint_new ();
213 c_wp->visible = TRUE;
214 if ( get_attr ( attr, "hidden" ) )
215 c_wp->visible = FALSE;
216
217 vik_coord_load_from_latlon ( &(c_wp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
218 }
219 break;
220
221 case tt_trk:
222 case tt_rte:
223 c_tr = vik_track_new ();
224 c_tr->is_route = (current_tag == tt_rte) ? TRUE : FALSE;
225 c_tr->visible = TRUE;
226 if ( get_attr ( attr, "hidden" ) )
227 c_tr->visible = FALSE;
228 break;
229
230 case tt_trk_trkseg:
231 f_tr_newseg = TRUE;
232 break;
233
234 case tt_trk_trkseg_trkpt:
235 if ( set_c_ll( attr ) ) {
236 c_tp = vik_trackpoint_new ();
237 vik_coord_load_from_latlon ( &(c_tp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
238 if ( f_tr_newseg ) {
239 c_tp->newsegment = TRUE;
240 f_tr_newseg = FALSE;
241 }
242 c_tr->trackpoints = g_list_append ( c_tr->trackpoints, c_tp );
243 }
244 break;
245
246 case tt_trk_trkseg_trkpt_ele:
247 case tt_trk_trkseg_trkpt_time:
248 case tt_wpt_cmt:
249 case tt_wpt_desc:
250 case tt_wpt_name:
251 case tt_wpt_ele:
252 case tt_wpt_link:
253 case tt_trk_cmt:
254 case tt_trk_desc:
255 case tt_trk_name:
256 g_string_erase ( c_cdata, 0, -1 ); /* clear the cdata buffer */
257 break;
258
259 case tt_waypoint:
260 c_wp = vik_waypoint_new ();
261 c_wp->visible = TRUE;
262 break;
263
264 case tt_waypoint_coord:
265 if ( set_c_ll( attr ) )
266 vik_coord_load_from_latlon ( &(c_wp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
267 break;
268
269 case tt_waypoint_name:
270 if ( ( tmp = get_attr(attr, "id") ) ) {
271 if ( c_wp_name )
272 g_free ( c_wp_name );
273 c_wp_name = g_strdup ( tmp );
274 }
275 g_string_erase ( c_cdata, 0, -1 ); /* clear the cdata buffer for description */
276 break;
277
278 default: break;
279 }
280}
281
282static void gpx_end(VikTrwLayer *vtl, const char *el)
283{
284 static GTimeVal tp_time;
285
286 g_string_truncate ( xpath, xpath->len - strlen(el) - 1 );
287
288 switch ( current_tag ) {
289
290 case tt_waypoint:
291 case tt_wpt:
292 if ( ! c_wp_name )
293 c_wp_name = g_strdup_printf("VIKING_WP%d", unnamed_waypoints++);
294 vik_trw_layer_filein_add_waypoint ( vtl, c_wp_name, c_wp );
295 g_free ( c_wp_name );
296 c_wp = NULL;
297 c_wp_name = NULL;
298 break;
299
300 case tt_trk:
301 case tt_rte:
302 if ( ! c_tr_name )
303 c_tr_name = g_strdup_printf("VIKING_TR%d", unnamed_tracks++);
304 vik_trw_layer_filein_add_track ( vtl, c_tr_name, c_tr );
305 g_free ( c_tr_name );
306 c_tr = NULL;
307 c_tr_name = NULL;
308 break;
309
310 case tt_wpt_name:
311 if ( c_wp_name )
312 g_free ( c_wp_name );
313 c_wp_name = g_strdup ( c_cdata->str );
314 g_string_erase ( c_cdata, 0, -1 );
315 break;
316
317 case tt_trk_name:
318 if ( c_tr_name )
319 g_free ( c_tr_name );
320 c_tr_name = g_strdup ( c_cdata->str );
321 g_string_erase ( c_cdata, 0, -1 );
322 break;
323
324 case tt_wpt_ele:
325 c_wp->altitude = g_ascii_strtod ( c_cdata->str, NULL );
326 g_string_erase ( c_cdata, 0, -1 );
327 break;
328
329 case tt_trk_trkseg_trkpt_ele:
330 c_tp->altitude = g_ascii_strtod ( c_cdata->str, NULL );
331 g_string_erase ( c_cdata, 0, -1 );
332 break;
333
334 case tt_waypoint_name: /* .loc name is really description. */
335 case tt_wpt_desc:
336 vik_waypoint_set_description ( c_wp, c_cdata->str );
337 g_string_erase ( c_cdata, 0, -1 );
338 break;
339
340 case tt_wpt_cmt:
341 vik_waypoint_set_comment ( c_wp, c_cdata->str );
342 g_string_erase ( c_cdata, 0, -1 );
343 break;
344
345 case tt_wpt_link:
346 vik_waypoint_set_image ( c_wp, c_cdata->str );
347 g_string_erase ( c_cdata, 0, -1 );
348 break;
349
350 case tt_wpt_sym: {
351 gchar *tmp_lower = g_utf8_strdown(c_cdata->str, -1); /* for things like <type>Geocache</type> */
352 vik_waypoint_set_symbol ( c_wp, tmp_lower );
353 g_free ( tmp_lower );
354 g_string_erase ( c_cdata, 0, -1 );
355 break;
356 }
357
358 case tt_trk_desc:
359 vik_track_set_description ( c_tr, c_cdata->str );
360 g_string_erase ( c_cdata, 0, -1 );
361 break;
362
363 case tt_trk_cmt:
364 vik_track_set_comment ( c_tr, c_cdata->str );
365 g_string_erase ( c_cdata, 0, -1 );
366 break;
367
368 case tt_trk_trkseg_trkpt_time:
369 if ( g_time_val_from_iso8601(c_cdata->str, &tp_time) ) {
370 c_tp->timestamp = tp_time.tv_sec;
371 c_tp->has_timestamp = TRUE;
372 }
373 g_string_erase ( c_cdata, 0, -1 );
374 break;
375
376 case tt_trk_trkseg_trkpt_course:
377 c_tp->course = g_ascii_strtod ( c_cdata->str, NULL );
378 g_string_erase ( c_cdata, 0, -1 );
379 break;
380
381 case tt_trk_trkseg_trkpt_speed:
382 c_tp->speed = g_ascii_strtod ( c_cdata->str, NULL );
383 g_string_erase ( c_cdata, 0, -1 );
384 break;
385
386 case tt_trk_trkseg_trkpt_fix:
387 if (!strcmp("2d", c_cdata->str))
388 c_tp->fix_mode = VIK_GPS_MODE_2D;
389 else if (!strcmp("3d", c_cdata->str))
390 c_tp->fix_mode = VIK_GPS_MODE_3D;
391 else /* TODO: more fix modes here */
392 c_tp->fix_mode = VIK_GPS_MODE_NOT_SEEN;
393 g_string_erase ( c_cdata, 0, -1 );
394 break;
395
396 case tt_trk_trkseg_trkpt_sat:
397 c_tp->nsats = atoi ( c_cdata->str );
398 g_string_erase ( c_cdata, 0, -1 );
399 break;
400
401 case tt_trk_trkseg_trkpt_hdop:
402 c_tp->hdop = g_strtod ( c_cdata->str, NULL );
403 g_string_erase ( c_cdata, 0, -1 );
404 break;
405
406 case tt_trk_trkseg_trkpt_vdop:
407 c_tp->vdop = g_strtod ( c_cdata->str, NULL );
408 g_string_erase ( c_cdata, 0, -1 );
409 break;
410
411 case tt_trk_trkseg_trkpt_pdop:
412 c_tp->pdop = g_strtod ( c_cdata->str, NULL );
413 g_string_erase ( c_cdata, 0, -1 );
414 break;
415
416 default: break;
417 }
418
419 current_tag = get_tag ( xpath->str );
420}
421
422static void gpx_cdata(void *dta, const XML_Char *s, int len)
423{
424 switch ( current_tag ) {
425 case tt_wpt_name:
426 case tt_trk_name:
427 case tt_wpt_ele:
428 case tt_trk_trkseg_trkpt_ele:
429 case tt_wpt_cmt:
430 case tt_wpt_desc:
431 case tt_wpt_sym:
432 case tt_wpt_link:
433 case tt_trk_cmt:
434 case tt_trk_desc:
435 case tt_trk_trkseg_trkpt_time:
436 case tt_trk_trkseg_trkpt_course:
437 case tt_trk_trkseg_trkpt_speed:
438 case tt_trk_trkseg_trkpt_fix:
439 case tt_trk_trkseg_trkpt_sat:
440 case tt_trk_trkseg_trkpt_hdop:
441 case tt_trk_trkseg_trkpt_vdop:
442 case tt_trk_trkseg_trkpt_pdop:
443 case tt_waypoint_name: /* .loc name is really description. */
444 g_string_append_len ( c_cdata, s, len );
445 break;
446
447 default: break; /* ignore cdata from other things */
448 }
449}
450
451// make like a "stack" of tag names
452// like gpspoint's separated like /gpx/wpt/whatever
453
454gboolean a_gpx_read_file( VikTrwLayer *vtl, FILE *f ) {
455 XML_Parser parser = XML_ParserCreate(NULL);
456 int done=0, len;
457 enum XML_Status status = XML_STATUS_ERROR;
458
459 XML_SetElementHandler(parser, (XML_StartElementHandler) gpx_start, (XML_EndElementHandler) gpx_end);
460 XML_SetUserData(parser, vtl); /* in the future we could remove all global variables */
461 XML_SetCharacterDataHandler(parser, (XML_CharacterDataHandler) gpx_cdata);
462
463 gchar buf[4096];
464
465 g_assert ( f != NULL && vtl != NULL );
466
467 xpath = g_string_new ( "" );
468 c_cdata = g_string_new ( "" );
469
470 unnamed_waypoints = 0;
471 unnamed_tracks = 0;
472
473 while (!done) {
474 len = fread(buf, 1, sizeof(buf)-7, f);
475 done = feof(f) || !len;
476 status = XML_Parse(parser, buf, len, done);
477 }
478
479 XML_ParserFree (parser);
480 g_string_free ( xpath, TRUE );
481 g_string_free ( c_cdata, TRUE );
482
483 return status != XML_STATUS_ERROR;
484}
485
486/**** entitize from GPSBabel ****/
487typedef struct {
488 const char * text;
489 const char * entity;
490 int not_html;
491} entity_types;
492
493static
494entity_types stdentities[] = {
495 { "&", "&amp;", 0 },
496 { "'", "&apos;", 1 },
497 { "<", "&lt;", 0 },
498 { ">", "&gt;", 0 },
499 { "\"", "&quot;", 0 },
500 { NULL, NULL, 0 }
501};
502
503void utf8_to_int( const char *cp, int *bytes, int *value )
504{
505 if ( (*cp & 0xe0) == 0xc0 ) {
506 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
507 *bytes = 2;
508 *value = ((*cp & 0x1f) << 6) |
509 (*(cp+1) & 0x3f);
510 }
511 else if ( (*cp & 0xf0) == 0xe0 ) {
512 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
513 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
514 *bytes = 3;
515 *value = ((*cp & 0x0f) << 12) |
516 ((*(cp+1) & 0x3f) << 6) |
517 (*(cp+2) & 0x3f);
518 }
519 else if ( (*cp & 0xf8) == 0xf0 ) {
520 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
521 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
522 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
523 *bytes = 4;
524 *value = ((*cp & 0x07) << 18) |
525 ((*(cp+1) & 0x3f) << 12) |
526 ((*(cp+2) & 0x3f) << 6) |
527 (*(cp+3) & 0x3f);
528 }
529 else if ( (*cp & 0xfc) == 0xf8 ) {
530 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
531 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
532 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
533 if ( (*(cp+4) & 0xc0) != 0x80 ) goto dodefault;
534 *bytes = 5;
535 *value = ((*cp & 0x03) << 24) |
536 ((*(cp+1) & 0x3f) << 18) |
537 ((*(cp+2) & 0x3f) << 12) |
538 ((*(cp+3) & 0x3f) << 6) |
539 (*(cp+4) & 0x3f);
540 }
541 else if ( (*cp & 0xfe) == 0xfc ) {
542 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
543 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
544 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
545 if ( (*(cp+4) & 0xc0) != 0x80 ) goto dodefault;
546 if ( (*(cp+5) & 0xc0) != 0x80 ) goto dodefault;
547 *bytes = 6;
548 *value = ((*cp & 0x01) << 30) |
549 ((*(cp+1) & 0x3f) << 24) |
550 ((*(cp+2) & 0x3f) << 18) |
551 ((*(cp+3) & 0x3f) << 12) |
552 ((*(cp+4) & 0x3f) << 6) |
553 (*(cp+5) & 0x3f);
554 }
555 else {
556dodefault:
557 *bytes = 1;
558 *value = (unsigned char)*cp;
559 }
560}
561
562static
563char *
564entitize(const char * str)
565{
566 int elen, ecount, nsecount;
567 entity_types *ep;
568 const char * cp;
569 char * p, * tmp, * xstr;
570
571 char tmpsub[20];
572 int bytes = 0;
573 int value = 0;
574 ep = stdentities;
575 elen = ecount = nsecount = 0;
576
577 /* figure # of entity replacements and additional size. */
578 while (ep->text) {
579 cp = str;
580 while ((cp = strstr(cp, ep->text)) != NULL) {
581 elen += strlen(ep->entity) - strlen(ep->text);
582 ecount++;
583 cp += strlen(ep->text);
584 }
585 ep++;
586 }
587
588 /* figure the same for other than standard entities (i.e. anything
589 * that isn't in the range U+0000 to U+007F */
590 for ( cp = str; *cp; cp++ ) {
591 if ( *cp & 0x80 ) {
592
593 utf8_to_int( cp, &bytes, &value );
594 cp += bytes-1;
595 elen += sprintf( tmpsub, "&#x%x;", value ) - bytes;
596 nsecount++;
597 }
598 }
599
600 /* enough space for the whole string plus entity replacements, if any */
601 tmp = g_malloc((strlen(str) + elen + 1));
602 strcpy(tmp, str);
603
604 /* no entity replacements */
605 if (ecount == 0 && nsecount == 0)
606 return (tmp);
607
608 if ( ecount != 0 ) {
609 for (ep = stdentities; ep->text; ep++) {
610 p = tmp;
611 while ((p = strstr(p, ep->text)) != NULL) {
612 elen = strlen(ep->entity);
613
614 xstr = g_strdup(p + strlen(ep->text));
615
616 strcpy(p, ep->entity);
617 strcpy(p + elen, xstr);
618
619 g_free(xstr);
620
621 p += elen;
622 }
623 }
624 }
625
626 if ( nsecount != 0 ) {
627 p = tmp;
628 while (*p) {
629 if ( *p & 0x80 ) {
630 utf8_to_int( p, &bytes, &value );
631 if ( p[bytes] ) {
632 xstr = g_strdup( p + bytes );
633 }
634 else {
635 xstr = NULL;
636 }
637 sprintf( p, "&#x%x;", value );
638 p = p+strlen(p);
639 if ( xstr ) {
640 strcpy( p, xstr );
641 g_free(xstr);
642 }
643 }
644 else {
645 p++;
646 }
647 }
648 }
649 return (tmp);
650}
651/**** end GPSBabel code ****/
652
653/* export GPX */
654
655static void gpx_write_waypoint ( VikWaypoint *wp, GpxWritingContext *context )
656{
657 // Don't write invisible waypoints when specified
658 if (context->options && !context->options->hidden && !wp->visible)
659 return;
660
661 FILE *f = context->file;
662 static struct LatLon ll;
663 gchar *s_lat,*s_lon;
664 gchar *tmp;
665 vik_coord_to_latlon ( &(wp->coord), &ll );
666 s_lat = a_coords_dtostr( ll.lat );
667 s_lon = a_coords_dtostr( ll.lon );
668 // NB 'hidden' is not part of any GPX standard - this appears to be a made up Viking 'extension'
669 // luckily most other GPX processing software ignores things they don't understand
670 fprintf ( f, "<wpt lat=\"%s\" lon=\"%s\"%s>\n",
671 s_lat, s_lon, wp->visible ? "" : " hidden=\"hidden\"" );
672 g_free ( s_lat );
673 g_free ( s_lon );
674
675 // Sanity clause
676 if ( wp->name )
677 tmp = entitize ( wp->name );
678 else
679 tmp = g_strdup ("waypoint");
680
681 fprintf ( f, " <name>%s</name>\n", tmp );
682 g_free ( tmp);
683
684 if ( wp->altitude != VIK_DEFAULT_ALTITUDE )
685 {
686 tmp = a_coords_dtostr ( wp->altitude );
687 fprintf ( f, " <ele>%s</ele>\n", tmp );
688 g_free ( tmp );
689 }
690 if ( wp->comment )
691 {
692 tmp = entitize(wp->comment);
693 fprintf ( f, " <cmt>%s</cmt>\n", tmp );
694 g_free ( tmp );
695 }
696 if ( wp->description )
697 {
698 tmp = entitize(wp->description);
699 fprintf ( f, " <desc>%s</desc>\n", tmp );
700 g_free ( tmp );
701 }
702 if ( wp->image )
703 {
704 tmp = entitize(wp->image);
705 fprintf ( f, " <link>%s</link>\n", tmp );
706 g_free ( tmp );
707 }
708 if ( wp->symbol )
709 {
710 tmp = entitize(wp->symbol);
711 fprintf ( f, " <sym>%s</sym>\n", tmp);
712 g_free ( tmp );
713 }
714
715 fprintf ( f, "</wpt>\n" );
716}
717
718static void gpx_write_trackpoint ( VikTrackpoint *tp, GpxWritingContext *context )
719{
720 FILE *f = context->file;
721 static struct LatLon ll;
722 gchar *s_lat,*s_lon, *s_alt, *s_dop;
723 gchar *time_iso8601;
724 vik_coord_to_latlon ( &(tp->coord), &ll );
725
726 // No such thing as a rteseg! So make sure we don't put them in
727 if ( context->options && !context->options->is_route && tp->newsegment )
728 fprintf ( f, " </trkseg>\n <trkseg>\n" );
729
730 s_lat = a_coords_dtostr( ll.lat );
731 s_lon = a_coords_dtostr( ll.lon );
732 fprintf ( f, " <%spt lat=\"%s\" lon=\"%s\">\n", (context->options && context->options->is_route) ? "rte" : "trk", s_lat, s_lon );
733 g_free ( s_lat ); s_lat = NULL;
734 g_free ( s_lon ); s_lon = NULL;
735
736 s_alt = NULL;
737 if ( tp->altitude != VIK_DEFAULT_ALTITUDE )
738 {
739 s_alt = a_coords_dtostr ( tp->altitude );
740 }
741 else if ( context->options != NULL && context->options->force_ele )
742 {
743 s_alt = a_coords_dtostr ( 0 );
744 }
745 if (s_alt != NULL)
746 fprintf ( f, " <ele>%s</ele>\n", s_alt );
747 g_free ( s_alt ); s_alt = NULL;
748
749 time_iso8601 = NULL;
750 if ( tp->has_timestamp ) {
751 GTimeVal timestamp;
752 timestamp.tv_sec = tp->timestamp;
753 timestamp.tv_usec = 0;
754
755 time_iso8601 = g_time_val_to_iso8601 ( &timestamp );
756 }
757 else if ( context->options != NULL && context->options->force_time )
758 {
759 GTimeVal current;
760 g_get_current_time ( &current );
761
762 time_iso8601 = g_time_val_to_iso8601 ( &current );
763 }
764 if ( time_iso8601 != NULL )
765 fprintf ( f, " <time>%s</time>\n", time_iso8601 );
766 g_free(time_iso8601);
767 time_iso8601 = NULL;
768
769 if (!isnan(tp->course)) {
770 gchar *s_course = a_coords_dtostr(tp->course);
771 fprintf ( f, " <course>%s</course>\n", s_course );
772 g_free(s_course);
773 }
774 if (!isnan(tp->speed)) {
775 gchar *s_speed = a_coords_dtostr(tp->speed);
776 fprintf ( f, " <speed>%s</speed>\n", s_speed );
777 g_free(s_speed);
778 }
779 if (tp->fix_mode == VIK_GPS_MODE_2D)
780 fprintf ( f, " <fix>2d</fix>\n");
781 if (tp->fix_mode == VIK_GPS_MODE_3D)
782 fprintf ( f, " <fix>3d</fix>\n");
783 if (tp->nsats > 0)
784 fprintf ( f, " <sat>%d</sat>\n", tp->nsats );
785
786 s_dop = NULL;
787 if ( tp->hdop != VIK_DEFAULT_DOP )
788 {
789 s_dop = a_coords_dtostr ( tp->hdop );
790 }
791 if (s_dop != NULL)
792 fprintf ( f, " <hdop>%s</hdop>\n", s_dop );
793 g_free ( s_dop ); s_dop = NULL;
794
795 if ( tp->vdop != VIK_DEFAULT_DOP )
796 {
797 s_dop = a_coords_dtostr ( tp->vdop );
798 }
799 if (s_dop != NULL)
800 fprintf ( f, " <vdop>%s</vdop>\n", s_dop );
801 g_free ( s_dop ); s_dop = NULL;
802
803 if ( tp->pdop != VIK_DEFAULT_DOP )
804 {
805 s_dop = a_coords_dtostr ( tp->pdop );
806 }
807 if (s_dop != NULL)
808 fprintf ( f, " <pdop>%s</pdop>\n", s_dop );
809 g_free ( s_dop ); s_dop = NULL;
810
811 fprintf ( f, " </%spt>\n", (context->options && context->options->is_route) ? "rte" : "trk" );
812}
813
814
815static void gpx_write_track ( VikTrack *t, GpxWritingContext *context )
816{
817 // Don't write invisible tracks when specified
818 if (context->options && !context->options->hidden && !t->visible)
819 return;
820
821 FILE *f = context->file;
822 gchar *tmp;
823 gboolean first_tp_is_newsegment = FALSE; /* must temporarily make it not so, but we want to restore state. not that it matters. */
824
825 // Sanity clause
826 if ( t->name )
827 tmp = entitize ( t->name );
828 else
829 tmp = g_strdup ("track");
830
831 // NB 'hidden' is not part of any GPX standard - this appears to be a made up Viking 'extension'
832 // luckily most other GPX processing software ignores things they don't understand
833 fprintf ( f, "<%s%s>\n <name>%s</name>\n",
834 t->is_route ? "rte" : "trk",
835 t->visible ? "" : " hidden=\"hidden\"",
836 tmp );
837 g_free ( tmp );
838
839 if ( t->comment )
840 {
841 tmp = entitize ( t->comment );
842 fprintf ( f, " <cmt>%s</cmt>\n", tmp );
843 g_free ( tmp );
844 }
845
846 if ( t->description )
847 {
848 tmp = entitize ( t->description );
849 fprintf ( f, " <desc>%s</desc>\n", tmp );
850 g_free ( tmp );
851 }
852
853 /* No such thing as a rteseg! */
854 if ( !t->is_route )
855 fprintf ( f, " <trkseg>\n" );
856
857 if ( t->trackpoints && t->trackpoints->data ) {
858 first_tp_is_newsegment = VIK_TRACKPOINT(t->trackpoints->data)->newsegment;
859 VIK_TRACKPOINT(t->trackpoints->data)->newsegment = FALSE; /* so we won't write </trkseg><trkseg> already */
860 g_list_foreach ( t->trackpoints, (GFunc) gpx_write_trackpoint, context );
861 VIK_TRACKPOINT(t->trackpoints->data)->newsegment = first_tp_is_newsegment; /* restore state */
862 }
863
864 /* NB apparently no such thing as a rteseg! */
865 if (!t->is_route)
866 fprintf ( f, " </trkseg>\n");
867
868 fprintf ( f, "</%s>\n", t->is_route ? "rte" : "trk" );
869}
870
871static void gpx_write_header( FILE *f )
872{
873 fprintf(f, "<?xml version=\"1.0\"?>\n"
874 "<gpx version=\"1.0\" creator=\"Viking -- http://viking.sf.net/\"\n"
875 "xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\"\n"
876 "xmlns=\"http://www.topografix.com/GPX/1/0\"\n"
877 "xsi:schemaLocation=\"http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd\">\n");
878}
879
880static void gpx_write_footer( FILE *f )
881{
882 fprintf(f, "</gpx>\n");
883}
884
885static int gpx_waypoint_compare(const void *x, const void *y)
886{
887 VikWaypoint *a = (VikWaypoint *)x;
888 VikWaypoint *b = (VikWaypoint *)y;
889 return strcmp(a->name,b->name);
890}
891
892static int gpx_track_compare_name(const void *x, const void *y)
893{
894 VikTrack *a = (VikTrack *)x;
895 VikTrack *b = (VikTrack *)y;
896 return strcmp(a->name,b->name);
897}
898
899/* Function to compare two tracks by their first timestamp */
900static int gpx_track_compare_timestamp (const void *x, const void *y)
901{
902 VikTrack *a = (VikTrack *)x;
903 VikTrack *b = (VikTrack *)y;
904
905 VikTrackpoint *tpa = NULL;
906 VikTrackpoint *tpb = NULL;
907
908 if ( a->trackpoints )
909 tpa = VIK_TRACKPOINT(g_list_first(a->trackpoints)->data);
910
911 if ( b->trackpoints )
912 tpb = VIK_TRACKPOINT(g_list_first(b->trackpoints)->data);
913
914 if ( tpa && tpb ) {
915 if ( tpa->timestamp < tpb->timestamp )
916 return -1;
917 if ( tpa->timestamp > tpb->timestamp )
918 return 1;
919 }
920
921 if ( tpa && !tpb )
922 return 1;
923
924 if ( !tpa && tpb )
925 return -1;
926
927 return 0;
928}
929
930void a_gpx_write_file ( VikTrwLayer *vtl, FILE *f, GpxWritingOptions *options )
931{
932 GpxWritingContext context = { options, f };
933
934 gpx_write_header ( f );
935
936 // gather waypoints in a list, then sort
937 // g_hash_table_get_values: glib 2.14+
938 GList *gl = g_hash_table_get_values ( vik_trw_layer_get_waypoints ( vtl ) );
939 gl = g_list_sort ( gl, gpx_waypoint_compare );
940
941 GList *iter;
942 for (iter = g_list_first (gl); iter != NULL; iter = g_list_next (iter)) {
943 gpx_write_waypoint ( (VikWaypoint*)iter->data, &context );
944 }
945
946 g_list_free ( gl );
947
948 gl = g_hash_table_get_values ( vik_trw_layer_get_tracks ( vtl ) );
949 // Sort method determined by preference
950 if ( a_vik_get_gpx_export_trk_sort() == VIK_GPX_EXPORT_TRK_SORT_TIME )
951 gl = g_list_sort ( gl, gpx_track_compare_timestamp );
952 else
953 gl = g_list_sort ( gl, gpx_track_compare_name );
954
955 // Routes sorted by name
956 GList *glrte = g_hash_table_get_values ( vik_trw_layer_get_routes ( vtl ) );
957 glrte = g_list_sort ( glrte, gpx_track_compare_name );
958
959 // g_list_concat doesn't copy memory properly
960 // so process each list separately
961
962 GpxWritingContext context_tmp = context;
963 GpxWritingOptions opt_tmp = { FALSE, FALSE, FALSE };
964 // Force trackpoints on tracks
965 if ( !context.options )
966 context_tmp.options = &opt_tmp;
967 context_tmp.options->is_route = FALSE;
968
969 // Loop around each list and write each one
970 for (iter = g_list_first (gl); iter != NULL; iter = g_list_next (iter)) {
971 gpx_write_track ( (VikTrack*)iter->data, &context_tmp );
972 }
973
974 // Routes (to get routepoints)
975 context_tmp.options->is_route = TRUE;
976 for (iter = g_list_first (glrte); iter != NULL; iter = g_list_next (iter)) {
977 gpx_write_track ( (VikTrack*)iter->data, &context_tmp );
978 }
979
980 g_list_free ( gl );
981 g_list_free ( glrte );
982
983 gpx_write_footer ( f );
984}
985
986void a_gpx_write_track_file ( VikTrack *trk, FILE *f, GpxWritingOptions *options )
987{
988 GpxWritingContext context = {options, f};
989 gpx_write_header ( f );
990 gpx_write_track ( trk, &context );
991 gpx_write_footer ( f );
992}