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 */
46 tt_wpt_link, /* New in GPX 1.1 */
54 tt_trk_trkseg_trkpt_ele,
55 tt_trk_trkseg_trkpt_time,
57 tt_trk_trkseg_trkpt_course,
58 tt_trk_trkseg_trkpt_speed,
59 tt_trk_trkseg_trkpt_fix,
60 tt_trk_trkseg_trkpt_sat,
67 typedef struct tag_mapping {
68 tag_type tag_type; /* enum from above for this tag */
69 const char *tag_name; /* xpath-ish tag name */
73 GpxWritingOptions *options;
78 * xpath(ish) mappings between full tag paths and internal identifers.
79 * These appear in the order they appear in the GPX specification.
80 * If it's not a tag we explictly handle, it doesn't go here.
83 tag_mapping tag_path_map[] = {
85 { tt_wpt, "/gpx/wpt" },
87 { tt_waypoint, "/loc/waypoint" },
88 { tt_waypoint_coord, "/loc/waypoint/coord" },
89 { tt_waypoint_name, "/loc/waypoint/name" },
91 { tt_wpt_ele, "/gpx/wpt/ele" },
92 { tt_wpt_name, "/gpx/wpt/name" },
93 { tt_wpt_desc, "/gpx/wpt/desc" },
94 { tt_wpt_sym, "/gpx/wpt/sym" },
95 { tt_wpt_sym, "/loc/waypoint/type" },
96 { tt_wpt_link, "/gpx/wpt/link" }, /* GPX 1.1 */
98 { tt_trk, "/gpx/trk" },
99 { tt_trk, "/gpx/rte" },
100 { tt_trk_name, "/gpx/trk/name" },
101 { tt_trk_desc, "/gpx/trk/desc" },
102 { tt_trk_trkseg, "/gpx/trk/trkseg" },
103 { tt_trk_trkseg_trkpt, "/gpx/trk/trkseg/trkpt" },
104 { tt_trk_trkseg_trkpt, "/gpx/rte/rtept" },
105 { tt_trk_trkseg_trkpt_ele, "/gpx/trk/trkseg/trkpt/ele" },
106 { tt_trk_trkseg_trkpt_time, "/gpx/trk/trkseg/trkpt/time" },
108 { tt_trk_trkseg_trkpt_course, "/gpx/trk/trkseg/trkpt/course" },
109 { tt_trk_trkseg_trkpt_speed, "/gpx/trk/trkseg/trkpt/speed" },
110 { tt_trk_trkseg_trkpt_fix, "/gpx/trk/trkseg/trkpt/fix" },
111 { tt_trk_trkseg_trkpt_sat, "/gpx/trk/trkseg/trkpt/sat" },
116 static tag_type get_tag(const char *t)
119 for (tm = tag_path_map; tm->tag_type != 0; tm++)
120 if (0 == strcmp(tm->tag_name, t))
125 /******************************************/
127 tag_type current_tag = tt_unknown;
128 GString *xpath = NULL;
129 GString *c_cdata = NULL;
131 /* current ("c_") objects */
132 VikTrackpoint *c_tp = NULL;
133 VikWaypoint *c_wp = NULL;
134 VikTrack *c_tr = NULL;
136 gchar *c_wp_name = NULL;
137 gchar *c_tr_name = NULL;
139 /* temporary things so we don't have to create them lots of times */
140 const gchar *c_slat, *c_slon;
143 /* specialty flags / etc */
144 gboolean f_tr_newseg;
145 guint unnamed_waypoints = 0;
146 guint unnamed_tracks = 0;
149 static const char *get_attr ( const char **attr, const char *key )
152 if ( strcmp(*attr,key) == 0 )
159 static gboolean set_c_ll ( const char **attr )
161 if ( (c_slat = get_attr ( attr, "lat" )) && (c_slon = get_attr ( attr, "lon" )) ) {
162 c_ll.lat = g_strtod(c_slat, NULL);
163 c_ll.lon = g_strtod(c_slon, NULL);
169 static void gpx_start(VikTrwLayer *vtl, const char *el, const char **attr)
171 static const gchar *tmp;
173 g_string_append_c ( xpath, '/' );
174 g_string_append ( xpath, el );
175 current_tag = get_tag ( xpath->str );
177 switch ( current_tag ) {
180 if ( set_c_ll( attr ) ) {
181 c_wp = vik_waypoint_new ();
182 c_wp->altitude = VIK_DEFAULT_ALTITUDE;
183 if ( ! get_attr ( attr, "hidden" ) )
184 c_wp->visible = TRUE;
186 vik_coord_load_from_latlon ( &(c_wp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
191 c_tr = vik_track_new ();
192 if ( ! get_attr ( attr, "hidden" ) )
193 c_tr->visible = TRUE;
200 case tt_trk_trkseg_trkpt:
201 if ( set_c_ll( attr ) ) {
202 c_tp = vik_trackpoint_new ();
203 c_tp->altitude = VIK_DEFAULT_ALTITUDE;
204 vik_coord_load_from_latlon ( &(c_tp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
206 c_tp->newsegment = TRUE;
209 c_tr->trackpoints = g_list_append ( c_tr->trackpoints, c_tp );
213 case tt_trk_trkseg_trkpt_ele:
214 case tt_trk_trkseg_trkpt_time:
221 g_string_erase ( c_cdata, 0, -1 ); /* clear the cdata buffer */
225 c_wp = vik_waypoint_new ();
226 c_wp->altitude = VIK_DEFAULT_ALTITUDE;
227 c_wp->visible = TRUE;
230 case tt_waypoint_coord:
231 if ( set_c_ll( attr ) )
232 vik_coord_load_from_latlon ( &(c_wp->coord), vik_trw_layer_get_coord_mode ( vtl ), &c_ll );
235 case tt_waypoint_name:
236 if ( ( tmp = get_attr(attr, "id") ) ) {
238 g_free ( c_wp_name );
239 c_wp_name = g_strdup ( tmp );
241 g_string_erase ( c_cdata, 0, -1 ); /* clear the cdata buffer for description */
248 static void gpx_end(VikTrwLayer *vtl, const char *el)
250 static GTimeVal tp_time;
252 g_string_truncate ( xpath, xpath->len - strlen(el) - 1 );
254 switch ( current_tag ) {
259 c_wp_name = g_strdup_printf("VIKING_WP%d", unnamed_waypoints++);
260 vik_trw_layer_filein_add_waypoint ( vtl, c_wp_name, c_wp );
261 g_free ( c_wp_name );
268 c_tr_name = g_strdup_printf("VIKING_TR%d", unnamed_waypoints++);
269 vik_trw_layer_filein_add_track ( vtl, c_tr_name, c_tr );
270 g_free ( c_tr_name );
277 g_free ( c_wp_name );
278 c_wp_name = g_strdup ( c_cdata->str );
279 g_string_erase ( c_cdata, 0, -1 );
284 g_free ( c_tr_name );
285 c_tr_name = g_strdup ( c_cdata->str );
286 g_string_erase ( c_cdata, 0, -1 );
290 c_wp->altitude = g_strtod ( c_cdata->str, NULL );
291 g_string_erase ( c_cdata, 0, -1 );
294 case tt_trk_trkseg_trkpt_ele:
295 c_tp->altitude = g_strtod ( c_cdata->str, NULL );
296 g_string_erase ( c_cdata, 0, -1 );
299 case tt_waypoint_name: /* .loc name is really description. */
301 vik_waypoint_set_comment ( c_wp, c_cdata->str );
302 g_string_erase ( c_cdata, 0, -1 );
306 vik_waypoint_set_image ( c_wp, c_cdata->str );
307 g_string_erase ( c_cdata, 0, -1 );
311 gchar *tmp_lower = g_utf8_strdown(c_cdata->str, -1); /* for things like <type>Geocache</type> */
312 vik_waypoint_set_symbol ( c_wp, tmp_lower );
313 g_free ( tmp_lower );
314 g_string_erase ( c_cdata, 0, -1 );
319 vik_track_set_comment ( c_tr, c_cdata->str );
320 g_string_erase ( c_cdata, 0, -1 );
323 case tt_trk_trkseg_trkpt_time:
324 if ( g_time_val_from_iso8601(c_cdata->str, &tp_time) ) {
325 c_tp->timestamp = tp_time.tv_sec;
326 c_tp->has_timestamp = TRUE;
328 g_string_erase ( c_cdata, 0, -1 );
331 case tt_trk_trkseg_trkpt_course:
332 c_tp->extended = TRUE;
333 c_tp->course = g_strtod ( c_cdata->str, NULL );
334 g_string_erase ( c_cdata, 0, -1 );
337 case tt_trk_trkseg_trkpt_speed:
338 c_tp->extended = TRUE;
339 c_tp->speed = g_strtod ( c_cdata->str, NULL );
340 g_string_erase ( c_cdata, 0, -1 );
343 case tt_trk_trkseg_trkpt_fix:
344 c_tp->extended = TRUE;
345 if (!strcmp("2d", c_cdata->str))
346 c_tp->fix_mode = VIK_GPS_MODE_2D;
347 else if (!strcmp("3d", c_cdata->str))
348 c_tp->fix_mode = VIK_GPS_MODE_3D;
349 else /* TODO: more fix modes here */
350 c_tp->fix_mode = VIK_GPS_MODE_NOT_SEEN;
351 g_string_erase ( c_cdata, 0, -1 );
354 case tt_trk_trkseg_trkpt_sat:
355 c_tp->extended = TRUE;
356 c_tp->nsats = atoi ( c_cdata->str );
357 g_string_erase ( c_cdata, 0, -1 );
363 current_tag = get_tag ( xpath->str );
366 static void gpx_cdata(void *dta, const XML_Char *s, int len)
368 switch ( current_tag ) {
372 case tt_trk_trkseg_trkpt_ele:
377 case tt_trk_trkseg_trkpt_time:
378 case tt_trk_trkseg_trkpt_course:
379 case tt_trk_trkseg_trkpt_speed:
380 case tt_trk_trkseg_trkpt_fix:
381 case tt_trk_trkseg_trkpt_sat:
382 case tt_waypoint_name: /* .loc name is really description. */
383 g_string_append_len ( c_cdata, s, len );
386 default: break; /* ignore cdata from other things */
390 // make like a "stack" of tag names
391 // like gpspoint's separated like /gpx/wpt/whatever
393 void a_gpx_read_file( VikTrwLayer *vtl, FILE *f ) {
394 XML_Parser parser = XML_ParserCreate(NULL);
397 XML_SetElementHandler(parser, (XML_StartElementHandler) gpx_start, (XML_EndElementHandler) gpx_end);
398 XML_SetUserData(parser, vtl); /* in the future we could remove all global variables */
399 XML_SetCharacterDataHandler(parser, (XML_CharacterDataHandler) gpx_cdata);
403 g_assert ( f != NULL && vtl != NULL );
405 xpath = g_string_new ( "" );
406 c_cdata = g_string_new ( "" );
408 unnamed_waypoints = 0;
412 len = fread(buf, 1, sizeof(buf)-7, f);
413 done = feof(f) || !len;
414 XML_Parse(parser, buf, len, done);
417 g_string_free ( xpath, TRUE );
418 g_string_free ( c_cdata, TRUE );
421 /**** entitize from GPSBabel ****/
429 entity_types stdentities[] = {
431 { "'", "'", 1 },
434 { "\"", """, 0 },
438 void utf8_to_int( const char *cp, int *bytes, int *value )
440 if ( (*cp & 0xe0) == 0xc0 ) {
441 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
443 *value = ((*cp & 0x1f) << 6) |
446 else if ( (*cp & 0xf0) == 0xe0 ) {
447 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
448 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
450 *value = ((*cp & 0x0f) << 12) |
451 ((*(cp+1) & 0x3f) << 6) |
454 else if ( (*cp & 0xf8) == 0xf0 ) {
455 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
456 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
457 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
459 *value = ((*cp & 0x07) << 18) |
460 ((*(cp+1) & 0x3f) << 12) |
461 ((*(cp+2) & 0x3f) << 6) |
464 else if ( (*cp & 0xfc) == 0xf8 ) {
465 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
466 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
467 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
468 if ( (*(cp+4) & 0xc0) != 0x80 ) goto dodefault;
470 *value = ((*cp & 0x03) << 24) |
471 ((*(cp+1) & 0x3f) << 18) |
472 ((*(cp+2) & 0x3f) << 12) |
473 ((*(cp+3) & 0x3f) << 6) |
476 else if ( (*cp & 0xfe) == 0xfc ) {
477 if ( (*(cp+1) & 0xc0) != 0x80 ) goto dodefault;
478 if ( (*(cp+2) & 0xc0) != 0x80 ) goto dodefault;
479 if ( (*(cp+3) & 0xc0) != 0x80 ) goto dodefault;
480 if ( (*(cp+4) & 0xc0) != 0x80 ) goto dodefault;
481 if ( (*(cp+5) & 0xc0) != 0x80 ) goto dodefault;
483 *value = ((*cp & 0x01) << 30) |
484 ((*(cp+1) & 0x3f) << 24) |
485 ((*(cp+2) & 0x3f) << 18) |
486 ((*(cp+3) & 0x3f) << 12) |
487 ((*(cp+4) & 0x3f) << 6) |
493 *value = (unsigned char)*cp;
499 entitize(const char * str)
501 int elen, ecount, nsecount;
504 char * p, * tmp, * xstr;
510 elen = ecount = nsecount = 0;
512 /* figure # of entity replacements and additional size. */
515 while ((cp = strstr(cp, ep->text)) != NULL) {
516 elen += strlen(ep->entity) - strlen(ep->text);
518 cp += strlen(ep->text);
523 /* figure the same for other than standard entities (i.e. anything
524 * that isn't in the range U+0000 to U+007F */
525 for ( cp = str; *cp; cp++ ) {
528 utf8_to_int( cp, &bytes, &value );
530 elen += sprintf( tmpsub, "&#x%x;", value ) - bytes;
535 /* enough space for the whole string plus entity replacements, if any */
536 tmp = g_malloc((strlen(str) + elen + 1));
539 /* no entity replacements */
540 if (ecount == 0 && nsecount == 0)
544 for (ep = stdentities; ep->text; ep++) {
546 while ((p = strstr(p, ep->text)) != NULL) {
547 elen = strlen(ep->entity);
549 xstr = g_strdup(p + strlen(ep->text));
551 strcpy(p, ep->entity);
552 strcpy(p + elen, xstr);
561 if ( nsecount != 0 ) {
565 utf8_to_int( p, &bytes, &value );
567 xstr = g_strdup( p + bytes );
572 sprintf( p, "&#x%x;", value );
586 /**** end GPSBabel code ****/
590 static void gpx_write_waypoint ( const gchar *name, VikWaypoint *wp, GpxWritingContext *context )
592 FILE *f = context->file;
593 static struct LatLon ll;
596 vik_coord_to_latlon ( &(wp->coord), &ll );
597 s_lat = a_coords_dtostr( ll.lat );
598 s_lon = a_coords_dtostr( ll.lon );
599 fprintf ( f, "<wpt lat=\"%s\" lon=\"%s\"%s>\n",
600 s_lat, s_lon, wp->visible ? "" : " hidden=\"hidden\"" );
604 tmp = entitize ( name );
605 fprintf ( f, " <name>%s</name>\n", tmp );
608 if ( wp->altitude != VIK_DEFAULT_ALTITUDE )
610 tmp = a_coords_dtostr ( wp->altitude );
611 fprintf ( f, " <ele>%s</ele>\n", tmp );
616 tmp = entitize(wp->comment);
617 fprintf ( f, " <desc>%s</desc>\n", tmp );
622 tmp = entitize(wp->image);
623 fprintf ( f, " <link>%s</link>\n", tmp );
628 tmp = entitize(wp->symbol);
629 fprintf ( f, " <sym>%s</sym>\n", tmp);
633 fprintf ( f, "</wpt>\n" );
636 static void gpx_write_trackpoint ( VikTrackpoint *tp, GpxWritingContext *context )
638 FILE *f = context->file;
639 static struct LatLon ll;
640 gchar *s_lat,*s_lon, *s_alt;
642 vik_coord_to_latlon ( &(tp->coord), &ll );
644 if ( tp->newsegment )
645 fprintf ( f, " </trkseg>\n <trkseg>\n" );
647 s_lat = a_coords_dtostr( ll.lat );
648 s_lon = a_coords_dtostr( ll.lon );
649 fprintf ( f, " <trkpt lat=\"%s\" lon=\"%s\">\n", s_lat, s_lon );
650 g_free ( s_lat ); s_lat = NULL;
651 g_free ( s_lon ); s_lon = NULL;
654 if ( tp->altitude != VIK_DEFAULT_ALTITUDE )
656 s_alt = a_coords_dtostr ( tp->altitude );
658 else if ( context->options != NULL && context->options->force_ele )
660 s_alt = a_coords_dtostr ( 0 );
663 fprintf ( f, " <ele>%s</ele>\n", s_alt );
664 g_free ( s_alt ); s_alt = NULL;
667 if ( tp->has_timestamp ) {
669 timestamp.tv_sec = tp->timestamp;
670 timestamp.tv_usec = 0;
672 time_iso8601 = g_time_val_to_iso8601 ( ×tamp );
674 else if ( context->options != NULL && context->options->force_time )
677 g_get_current_time ( ¤t );
679 time_iso8601 = g_time_val_to_iso8601 ( ¤t );
681 if ( time_iso8601 != NULL )
682 fprintf ( f, " <time>%s</time>\n", time_iso8601 );
683 g_free(time_iso8601);
686 if (tp->extended && (tp->fix_mode >= VIK_GPS_MODE_2D)) {
687 if (!isnan(tp->course)) {
688 gchar *s_course = a_coords_dtostr(tp->course);
689 fprintf ( f, " <course>%s</course>\n", s_course );
692 if (!isnan(tp->speed)) {
693 gchar *s_speed = a_coords_dtostr(tp->speed);
694 fprintf ( f, " <speed>%s</speed>\n", s_speed );
697 if (tp->fix_mode == VIK_GPS_MODE_2D)
698 fprintf ( f, " <fix>2d</fix>\n");
699 if (tp->fix_mode == VIK_GPS_MODE_3D)
700 fprintf ( f, " <fix>3d</fix>\n");
702 fprintf ( f, " <sat>%d</sat>\n", tp->nsats );
705 fprintf ( f, " </trkpt>\n" );
709 static void gpx_write_track ( const gchar *name, VikTrack *t, GpxWritingContext *context )
711 FILE *f = context->file;
713 gboolean first_tp_is_newsegment = FALSE; /* must temporarily make it not so, but we want to restore state. not that it matters. */
715 tmp = entitize ( name );
716 fprintf ( f, "<trk%s>\n <name>%s</name>\n", t->visible ? "" : " hidden=\"hidden\"", tmp );
721 tmp = entitize ( t->comment );
722 fprintf ( f, " <desc>%s</desc>\n", tmp );
726 fprintf ( f, " <trkseg>\n" );
728 if ( t->trackpoints && t->trackpoints->data ) {
729 first_tp_is_newsegment = VIK_TRACKPOINT(t->trackpoints->data)->newsegment;
730 VIK_TRACKPOINT(t->trackpoints->data)->newsegment = FALSE; /* so we won't write </trkseg><trkseg> already */
731 g_list_foreach ( t->trackpoints, (GFunc) gpx_write_trackpoint, context );
732 VIK_TRACKPOINT(t->trackpoints->data)->newsegment = first_tp_is_newsegment; /* restore state */
735 fprintf ( f, "</trkseg>\n</trk>\n" );
738 static void gpx_write_header( FILE *f )
740 fprintf(f, "<?xml version=\"1.0\"?>\n"
741 "<gpx version=\"1.0\" creator=\"Viking -- http://viking.sf.net/\"\n"
742 "xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\"\n"
743 "xmlns=\"http://www.topografix.com/GPX/1/0\"\n"
744 "xsi:schemaLocation=\"http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd\">\n");
747 static void gpx_write_footer( FILE *f )
749 fprintf(f, "</gpx>\n");
757 } gpx_waypoint_and_name;
760 gpx_waypoint_and_name *wps;
763 } gpx_gather_waypoints_passalong_t;
765 static void gpx_collect_waypoint ( const gchar *name, VikWaypoint *wp, gpx_gather_waypoints_passalong_t *passalong )
767 if ( passalong->i < passalong->n_wps ) {
768 passalong->wps[passalong->i].name = name;
769 passalong->wps[passalong->i].wp = wp;
774 static int gpx_waypoint_and_name_compar(const void *x, const void *y)
776 gpx_waypoint_and_name *a = (gpx_waypoint_and_name *)x;
777 gpx_waypoint_and_name *b = (gpx_waypoint_and_name *)y;
778 return strcmp(a->name,b->name);
781 void a_gpx_write_file( VikTrwLayer *vtl, FILE *f )
783 a_gpx_write_file_options(NULL, vtl, f);
786 void a_gpx_write_file_options ( GpxWritingOptions *options, VikTrwLayer *vtl, FILE *f )
788 GpxWritingContext context = { options, f };
791 gpx_write_header ( f );
794 gpx_gather_waypoints_passalong_t passalong;
795 passalong.n_wps = g_hash_table_size ( vik_trw_layer_get_waypoints ( vtl ) );
797 passalong.wps = g_new(gpx_waypoint_and_name,passalong.n_wps);
798 g_hash_table_foreach ( vik_trw_layer_get_waypoints ( vtl ), (GHFunc) gpx_collect_waypoint, &passalong );
799 /* gather waypoints in a list, then sort */
800 qsort(passalong.wps, passalong.n_wps, sizeof(gpx_waypoint_and_name), gpx_waypoint_and_name_compar);
801 for ( i = 0; i < passalong.n_wps; i++ )
802 gpx_write_waypoint ( passalong.wps[i].name, passalong.wps[i].wp, &context);
803 g_free ( passalong.wps );
805 g_hash_table_foreach ( vik_trw_layer_get_tracks ( vtl ), (GHFunc) gpx_write_track, &context );
807 gpx_write_footer ( f );
810 void a_gpx_write_track_file ( const gchar *name, VikTrack *t, FILE *f )
812 a_gpx_write_track_file_options ( NULL, name, t, f );
815 void a_gpx_write_track_file_options ( GpxWritingOptions *options, const gchar *name, VikTrack *t, FILE *f )
817 GpxWritingContext context = {options, f};
818 gpx_write_header ( f );
819 gpx_write_track ( name, t, &context );
820 gpx_write_footer ( f );