2 * viking -- GPS Data and Topo Analyzer, Explorer, and Manager
4 * Copyright (C) 2003-2005, Evan Battaglia <gtoevan@gmx.net>
6 * Some of the code adapted from GPSBabel 1.2.7
7 * http://gpsbabel.sf.net/
8 * Copyright (C) 2002, 2003, 2004, 2005 Robert Lipe, robertlipe@usa.net
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 #define _XOPEN_SOURCE /* glibc2 needs this */
33 #define GPX_TIME_FORMAT "%Y-%m-%dT%H:%M:%SZ"
45 tt_wpt_link, /* New in GPX 1.1 */
53 tt_trk_trkseg_trkpt_ele,
54 tt_trk_trkseg_trkpt_time,
61 typedef struct tag_mapping {
62 tag_type tag_type; /* enum from above for this tag */
63 const char *tag_name; /* xpath-ish tag name */
67 * xpath(ish) mappings between full tag paths and internal identifers.
68 * These appear in the order they appear in the GPX specification.
69 * If it's not a tag we explictly handle, it doesn't go here.
72 tag_mapping tag_path_map[] = {
74 { tt_wpt, "/gpx/wpt" },
76 { tt_waypoint, "/loc/waypoint" },
77 { tt_waypoint_coord, "/loc/waypoint/coord" },
78 { tt_waypoint_name, "/loc/waypoint/name" },
80 { tt_wpt_ele, "/gpx/wpt/ele" },
81 { tt_wpt_name, "/gpx/wpt/name" },
82 { tt_wpt_desc, "/gpx/wpt/desc" },
83 { tt_wpt_sym, "/gpx/wpt/sym" },
84 { tt_wpt_link, "/gpx/wpt/link" }, /* GPX 1.1 */
86 { tt_trk, "/gpx/trk" },
87 { tt_trk, "/gpx/rte" },
88 { tt_trk_name, "/gpx/trk/name" },
89 { tt_trk_desc, "/gpx/trk/desc" },
90 { tt_trk_trkseg, "/gpx/trk/trkseg" },
91 { tt_trk_trkseg_trkpt, "/gpx/trk/trkseg/trkpt" },
92 { tt_trk_trkseg_trkpt, "/gpx/rte/rtept" },
93 { tt_trk_trkseg_trkpt_ele, "/gpx/trk/trkseg/trkpt/ele" },
94 { tt_trk_trkseg_trkpt_time, "/gpx/trk/trkseg/trkpt/time" },
99 static tag_type get_tag(const char *t)
102 for (tm = tag_path_map; tm->tag_type != 0; tm++)
103 if (0 == strcmp(tm->tag_name, t))
108 /******************************************/
110 tag_type current_tag = tt_unknown;
111 GString *xpath = NULL;
112 GString *c_cdata = NULL;
114 /* current ("c_") objects */
115 VikTrackpoint *c_tp = NULL;
116 VikWaypoint *c_wp = NULL;
117 VikTrack *c_tr = NULL;
119 gchar *c_wp_name = NULL;
120 gchar *c_tr_name = NULL;
122 /* temporary things so we don't have to create them lots of times */
123 const gchar *c_slat, *c_slon;
126 /* specialty flags / etc */
127 gboolean f_tr_newseg;
128 guint unnamed_waypoints = 0;
129 guint unnamed_tracks = 0;
132 static const char *get_attr ( const char **attr, const char *key )
135 if ( strcmp(*attr,key) == 0 )
142 static gboolean set_c_ll ( const char **attr )
144 if ( (c_slat = get_attr ( attr, "lat" )) && (c_slon = get_attr ( attr, "lon" )) ) {
145 c_ll.lat = g_strtod(c_slat, NULL);
146 c_ll.lon = g_strtod(c_slon, NULL);
152 static void gpx_start(VikTrwLayer *vtl, const char *el, const char **attr)
154 static const gchar *tmp;
156 g_string_append_c ( xpath, '/' );
157 g_string_append ( xpath, el );
158 current_tag = get_tag ( xpath->str );
160 switch ( current_tag ) {
163 if ( set_c_ll( attr ) ) {
164 c_wp = vik_waypoint_new ();
165 c_wp->altitude = VIK_DEFAULT_ALTITUDE;
166 if ( ! get_attr ( attr, "hidden" ) )
167 c_wp->visible = TRUE;
169 vik_coord_load_from_latlon ( &(c_wp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
174 c_tr = vik_track_new ();
175 if ( ! get_attr ( attr, "hidden" ) )
176 c_tr->visible = TRUE;
183 case tt_trk_trkseg_trkpt:
184 if ( set_c_ll( attr ) ) {
185 c_tp = vik_trackpoint_new ();
186 c_tp->altitude = VIK_DEFAULT_ALTITUDE;
187 vik_coord_load_from_latlon ( &(c_tp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
189 c_tp->newsegment = TRUE;
192 c_tr->trackpoints = g_list_append ( c_tr->trackpoints, c_tp );
196 case tt_trk_trkseg_trkpt_ele:
197 case tt_trk_trkseg_trkpt_time:
204 g_string_erase ( c_cdata, 0, -1 ); /* clear the cdata buffer */
208 c_wp = vik_waypoint_new ();
209 c_wp->altitude = VIK_DEFAULT_ALTITUDE;
210 c_wp->visible = TRUE;
213 case tt_waypoint_coord:
214 if ( set_c_ll( attr ) )
215 vik_coord_load_from_latlon ( &(c_wp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
218 case tt_waypoint_name:
219 if ( ( tmp = get_attr(attr, "id") ) ) {
221 g_free ( c_wp_name );
222 c_wp_name = g_strdup ( tmp );
224 g_string_erase ( c_cdata, 0, -1 ); /* clear the cdata buffer for description */
231 static void gpx_end(VikTrwLayer *vtl, const char *el)
234 g_string_truncate ( xpath, xpath->len - strlen(el) - 1 );
236 switch ( current_tag ) {
241 c_wp_name = g_strdup_printf("VIKING_WP%d", unnamed_waypoints++);
242 g_hash_table_insert ( vik_trw_layer_get_waypoints ( vtl ), c_wp_name, c_wp );
249 c_tr_name = g_strdup_printf("VIKING_TR%d", unnamed_waypoints++);
250 g_hash_table_insert ( vik_trw_layer_get_tracks ( vtl ), c_tr_name, c_tr );
257 g_free ( c_wp_name );
258 c_wp_name = g_strdup ( c_cdata->str );
259 g_string_erase ( c_cdata, 0, -1 );
264 g_free ( c_tr_name );
265 c_tr_name = g_strdup ( c_cdata->str );
266 g_string_erase ( c_cdata, 0, -1 );
270 c_wp->altitude = g_strtod ( c_cdata->str, NULL );
271 g_string_erase ( c_cdata, 0, -1 );
274 case tt_trk_trkseg_trkpt_ele:
275 c_tp->altitude = g_strtod ( c_cdata->str, NULL );
276 g_string_erase ( c_cdata, 0, -1 );
279 case tt_waypoint_name: /* .loc name is really description. */
281 vik_waypoint_set_comment ( c_wp, c_cdata->str );
282 g_string_erase ( c_cdata, 0, -1 );
286 vik_waypoint_set_image ( c_wp, c_cdata->str );
287 g_string_erase ( c_cdata, 0, -1 );
291 vik_waypoint_set_symbol ( c_wp, c_cdata->str );
292 g_string_erase ( c_cdata, 0, -1 );
296 vik_track_set_comment ( c_tr, c_cdata->str );
297 g_string_erase ( c_cdata, 0, -1 );
300 case tt_trk_trkseg_trkpt_time:
301 if ( strptime(c_cdata->str, GPX_TIME_FORMAT, &tm) != c_cdata->str ) { /* it read at least one char */
302 c_tp->timestamp = mktime(&tm);
303 c_tp->has_timestamp = TRUE;
305 g_string_erase ( c_cdata, 0, -1 );
311 current_tag = get_tag ( xpath->str );
314 static void gpx_cdata(void *dta, const XML_Char *s, int len)
316 switch ( current_tag ) {
320 case tt_trk_trkseg_trkpt_ele:
325 case tt_trk_trkseg_trkpt_time:
326 case tt_waypoint_name: /* .loc name is really description. */
327 g_string_append_len ( c_cdata, s, len );
330 default: break; /* ignore cdata from other things */
334 // make like a "stack" of tag names
335 // like gpspoint's separated like /gpx/wpt/whatever
337 void a_gpx_read_file( VikTrwLayer *vtl, FILE *f ) {
338 XML_Parser parser = XML_ParserCreate(NULL);
341 XML_SetElementHandler(parser, (XML_StartElementHandler) gpx_start, (XML_EndElementHandler) gpx_end);
342 XML_SetUserData(parser, vtl); /* in the future we could remove all global variables */
343 XML_SetCharacterDataHandler(parser, (XML_CharacterDataHandler) gpx_cdata);
347 g_assert ( f != NULL && vtl != NULL );
349 xpath = g_string_new ( "" );
350 c_cdata = g_string_new ( "" );
352 unnamed_waypoints = 0;
356 len = fread(buf, 1, sizeof(buf)-7, f);
357 done = feof(f) || !len;
358 XML_Parse(parser, buf, len, done);
361 g_string_free ( xpath, TRUE );
362 g_string_free ( c_cdata, TRUE );
365 /**** entitize from GPSBabel ****/
373 entity_types stdentities[] = {
375 { "'", "'", 1 },
378 { "\"", """, 0 },
382 void utf8_to_int( const char *cp, int *bytes, int *value )
384 if ( (*cp & 0xe0) == 0xc0 ) {
385 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
387 *value = ((*cp & 0x1f) << 6) |
390 else if ( (*cp & 0xf0) == 0xe0 ) {
391 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
392 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
394 *value = ((*cp & 0x0f) << 12) |
395 ((*(cp+1) & 0x3f) << 6) |
398 else if ( (*cp & 0xf8) == 0xf0 ) {
399 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
400 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
401 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
403 *value = ((*cp & 0x07) << 18) |
404 ((*(cp+1) & 0x3f) << 12) |
405 ((*(cp+2) & 0x3f) << 6) |
408 else if ( (*cp & 0xfc) == 0xf8 ) {
409 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
410 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
411 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
412 if ( (*(cp+4) & 0xc0) != 0x80 ) goto dodefault;
414 *value = ((*cp & 0x03) << 24) |
415 ((*(cp+1) & 0x3f) << 18) |
416 ((*(cp+2) & 0x3f) << 12) |
417 ((*(cp+3) & 0x3f) << 6) |
420 else if ( (*cp & 0xfe) == 0xfc ) {
421 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
422 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
423 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
424 if ( (*(cp+4) & 0xc0) != 0x80 ) goto dodefault;
425 if ( (*(cp+5) & 0xc0) != 0x80 ) goto dodefault;
427 *value = ((*cp & 0x01) << 30) |
428 ((*(cp+1) & 0x3f) << 24) |
429 ((*(cp+2) & 0x3f) << 18) |
430 ((*(cp+3) & 0x3f) << 12) |
431 ((*(cp+4) & 0x3f) << 6) |
437 *value = (unsigned char)*cp;
443 entitize(const char * str)
445 int elen, ecount, nsecount;
448 char * p, * tmp, * xstr;
454 elen = ecount = nsecount = 0;
456 /* figure # of entity replacements and additional size. */
459 while ((cp = strstr(cp, ep->text)) != NULL) {
460 elen += strlen(ep->entity) - strlen(ep->text);
462 cp += strlen(ep->text);
467 /* figure the same for other than standard entities (i.e. anything
468 * that isn't in the range U+0000 to U+007F */
469 for ( cp = str; *cp; cp++ ) {
472 utf8_to_int( cp, &bytes, &value );
474 elen += sprintf( tmpsub, "&#x%x;", value ) - bytes;
479 /* enough space for the whole string plus entity replacements, if any */
480 tmp = g_malloc((strlen(str) + elen + 1));
483 /* no entity replacements */
484 if (ecount == 0 && nsecount == 0)
488 for (ep = stdentities; ep->text; ep++) {
490 while ((p = strstr(p, ep->text)) != NULL) {
491 elen = strlen(ep->entity);
493 xstr = g_strdup(p + strlen(ep->text));
495 strcpy(p, ep->entity);
496 strcpy(p + elen, xstr);
505 if ( nsecount != 0 ) {
509 utf8_to_int( p, &bytes, &value );
511 xstr = g_strdup( p + bytes );
516 sprintf( p, "&#x%x;", value );
530 /**** end GPSBabel code ****/
533 static void gpx_write_waypoint ( const gchar *name, VikWaypoint *wp, FILE *f )
535 static struct LatLon ll;
537 vik_coord_to_latlon ( &(wp->coord), &ll );
538 fprintf ( f, "<wpt lat=\"%f\" lon=\"%f\"%s>\n",
539 ll.lat, ll.lon, wp->visible ? "" : " hidden=\"hidden\"" );
541 tmp = entitize ( name );
542 fprintf ( f, " <name>%s</name>\n", tmp );
545 if ( wp->altitude != VIK_DEFAULT_ALTITUDE )
546 fprintf ( f, " <ele>%f</ele>\n", wp->altitude );
549 tmp = entitize(wp->comment);
550 fprintf ( f, " <desc>%s</desc>\n", tmp );
555 tmp = entitize(wp->image);
556 fprintf ( f, " <link>%s</link>\n", tmp );
561 tmp = entitize(wp->symbol);
562 fprintf ( f, " <sym>%s</sym>\n", tmp);
566 fprintf ( f, "</wpt>\n" );
569 static void gpx_write_trackpoint ( VikTrackpoint *tp, FILE *f )
571 static struct LatLon ll;
572 static gchar time_buf[30];
573 vik_coord_to_latlon ( &(tp->coord), &ll );
575 if ( tp->newsegment )
576 fprintf ( f, " </trkseg>\n <trkseg>\n" );
578 fprintf ( f, " <trkpt lat=\"%f\" lon=\"%f\">\n", ll.lat, ll.lon );
580 if ( tp->altitude != VIK_DEFAULT_ALTITUDE )
581 fprintf ( f, " <ele>%f</ele>\n", tp->altitude );
582 if ( tp->has_timestamp ) {
583 time_buf [ strftime ( time_buf, sizeof(time_buf)-1, GPX_TIME_FORMAT, localtime(&(tp->timestamp)) ) ] = '\0';
584 fprintf ( f, " <time>%s</time>\n", time_buf );
586 fprintf ( f, " </trkpt>\n" );
590 static void gpx_write_track ( const gchar *name, VikTrack *t, FILE *f )
593 gboolean first_tp_is_newsegment; /* must temporarily make it not so, but we want to restore state. not that it matters. */
595 tmp = entitize ( name );
596 fprintf ( f, "<trk%s>\n <name>%s</name>\n", t->visible ? "" : " hidden=\"hidden\"", tmp );
601 tmp = entitize ( t->comment );
602 fprintf ( f, " <desc>%s</desc>\n", tmp );
606 fprintf ( f, " <trkseg>\n" );
608 if ( t->trackpoints && t->trackpoints->data ) {
609 first_tp_is_newsegment = VIK_TRACKPOINT(t->trackpoints->data)->newsegment;
610 VIK_TRACKPOINT(t->trackpoints->data)->newsegment = FALSE; /* so we won't write </trkseg><trkseg> already */
612 g_list_foreach ( t->trackpoints, (GFunc) gpx_write_trackpoint, f );
613 if ( t->trackpoints && t->trackpoints->data )
614 VIK_TRACKPOINT(t->trackpoints->data)->newsegment = first_tp_is_newsegment; /* restore state */
616 fprintf ( f, "</trkseg>\n</trk>\n" );
619 void a_gpx_write_file( VikTrwLayer *vtl, FILE *f )
621 fprintf(f, "<?xml version=\"1.0\"?>\n"
622 "<gpx version=\"1.0\" creator=\"Viking -- http://viking.sf.net/\"\n"
623 "xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\"\n"
624 "xmlns=\"http://www.topografix.com/GPX/1/0\"\n"
625 "xsi:schemaLocation=\"http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd\">\n");
626 g_hash_table_foreach ( vik_trw_layer_get_waypoints ( vtl ), (GHFunc) gpx_write_waypoint, f );
627 g_hash_table_foreach ( vik_trw_layer_get_tracks ( vtl ), (GHFunc) gpx_write_track, f );
628 fprintf(f, "</gpx>\n");