void
gtc_trk_pnt_e(const char *args, const char **unused)
{
if(wpt_tmp->longitude != 0. && wpt_tmp->latitude != 0.) track_add_wpt(trk_head, wpt_tmp);
else waypt_free(wpt_tmp);
wpt_tmp = NULL;
}
static const char *
match_b_record(const char *p, struct tm *tm, route_head **track)
{
waypoint *w = waypt_new();
p = match_char(p, 'B');
struct tm _tm = *tm;
p = match_n_digits(p, 2, &_tm.tm_hour);
p = match_n_digits(p, 2, &_tm.tm_min);
p = match_n_digits(p, 2, &_tm.tm_sec);
w->creation_time = mktime(&_tm);
int lat = 0, lat_min = 0, lat_mmin = 0;
p = match_n_digits(p, 2, &lat);
p = match_n_digits(p, 2, &lat_min);
p = match_n_digits(p, 3, &lat_mmin);
w->latitude = lat + lat_min / 60.0 + lat_mmin / 60000.0;
char lat_hemi = 0;
p = match_one_of(p, "NS", &lat_hemi);
if (lat_hemi == 'S')
w->latitude = -w->latitude;
int lon = 0, lon_min = 0, lon_mmin = 0;
p = match_n_digits(p, 3, &lon);
p = match_n_digits(p, 2, &lon_min);
p = match_n_digits(p, 3, &lon_mmin);
w->longitude = lon + lon_min / 60.0 + lon_mmin / 60000.0;
char lon_hemi = 0;
p = match_one_of(p, "EW", &lon_hemi);
if (lon_hemi == 'W')
w->longitude = -w->longitude;
char av = 0;
p = match_one_of(p, "AV", &av);
switch (av) {
case 'A':
w->fix = fix_3d;
break;
case 'V':
w->fix = fix_2d;
break;
}
int alt = 0, ele = 0;
p = match_n_digits(p, 5, &alt);
w->altitude = alt;
p = match_n_digits(p, 5, &ele);
p = match_until_eol(p);
if (!p)
goto error;
if (!*track) {
*track = route_head_alloc();
track_add_head(*track);
}
track_add_wpt(*track, w);
return p;
error:
waypt_del(w);
return 0;
}
static void
xol_shape_end(const char *args, const char **unused)
{
if (wpt) {
if (trk) track_add_wpt(trk, wpt);
else waypt_add(wpt);
wpt = NULL;
}
else if (trk) {
if (trk->rte_waypt_ct == 0) track_del_head(trk);
trk = NULL;
}
}
void
vpl_parse_75_sentence(const char *ibuf)
{
gbuint32 ymd, hms;
gbint32 lat_raw, lon_raw;
gbint16 alt, speed_raw;
gbuint16 hdg_raw;
gbuint8 sats, hdop_raw, vdop_raw;
waypoint *waypt;
struct tm tm;
// The files have DOS line endings (CR/LF) but we don't care, because we
// don't read to the end.
sscanf(ibuf, "75%*2c%8X%8X%4hX%4hX%4hX%*2c%2hhX%2hhX%2hhX%6u%6u",
&lat_raw, &lon_raw, &alt, &speed_raw, &hdg_raw, &sats, &hdop_raw, &vdop_raw,
&ymd, &hms);
tm.tm_sec = hms % 100;
hms /= 100;
tm.tm_min = hms % 100;
hms /= 100;
tm.tm_hour = hms % 100;
tm.tm_mday = ymd % 100;
ymd /= 100;
tm.tm_mon = ymd % 100;
ymd /= 100;
tm.tm_year = ymd % 100 + 100;
waypt = waypt_new();
// Lat/Lon are both stored *0xE1000 which we have to divide out
// for decimal degrees
waypt->latitude = lat_raw / (double) 0xE1000;
waypt->longitude = lon_raw / (double) 0xE1000;
waypt->altitude = alt;
waypt->sat = sats;
// Speed comes in (MPH x 0x10) which we have to convert to m/s
WAYPT_SET(waypt, speed, (speed_raw / (double) 0x10) * 0.44704);
waypt->course = hdg_raw * (double) (360/65535);
waypt->hdop = hdop_raw / (double) 8;
waypt->vdop = vdop_raw / (double) 8;
waypt->creation_time = mkgmtime(&tm);
track_add_wpt(track_head, waypt);
}
static void
sbp_read(void)
{
if (global_opts.masked_objective & TRKDATAMASK) {
waypoint *logpoint;
route_head *track;
track = route_head_alloc();
track_add_head(track);
read_sbp_header(track);
while ((logpoint = read_logpoint())) {
track_add_wpt(track, logpoint);
}
}
}
static void
parse_track_waypoint(void)
{
char *str;
int column = -1;
waypoint *wpt;
bind_fields(trkpt_header);
wpt = waypt_new();
while ((str = csv_lineparse(NULL, "\t", "", column++))) {
int field_no;
double x;
if (! *str) continue;
field_no = header_fields[trkpt_header][column];
switch(field_no) {
case 1:
parse_coordinates(str, datum_index, grid_index,
&wpt->latitude, &wpt->longitude, MYNAME);
break;
case 2:
parse_date_and_time(str, &wpt->creation_time);
break;
case 3:
if (parse_distance(str, &x, 1, MYNAME))
wpt->altitude = x;
break;
case 4:
if (parse_distance(str, &x, 1, MYNAME)) WAYPT_SET(wpt, depth, x);
break;
case 5:
if (parse_temperature(str, &x)) WAYPT_SET(wpt, temperature, x);
break;
case 8:
if (parse_speed(str, &x, 1, MYNAME)) WAYPT_SET(wpt, speed, x);
break;
case 9:
WAYPT_SET(wpt, course, atoi(str));
break;
}
}
track_add_wpt(current_trk, wpt);
}
void trk_coord(const char *args, const char **attrv)
{
int consumed = 0;
double lat, lon, alt;
waypoint *trkpt;
route_head *trk_head = route_head_alloc();
if (wpt_tmp->shortname) {
trk_head->rte_name = xstrdup(wpt_tmp->shortname);
}
track_add_head(trk_head);
while (3 == sscanf(args, "%lf,%lf,%lf %n", &lon, &lat, &alt, &consumed)){
trkpt = waypt_new();
trkpt->latitude = lat;
trkpt->longitude = lon;
trkpt->altitude = alt;
track_add_wpt(trk_head, trkpt);
args += consumed;
}
}
/*
* Main Function to process Saved tracks file
*/
static void
format_garmin_xt_proc_strk(void)
{
int Count = 0; // Used to obtain number of read bytes
int NumberOfTracks = 0, TracksCompleted = 0; // Number of tracks in the file and number of processed tracks
gbuint16 trackbytes = 0; // Bytes in track
gbuint8 TrackBlock[STRK_BLOCK_SIZE]; // File Block
gbuint8 ii; // temp variable
double Lat = 0, Lon = 0; // wpt data
double PrevLat = 0, PrevLon = 0, PrevEle = 0; // wpt data
gbuint32 Time = 0, PrevTime =0; // wpt data
int FirstCoo;
gbuint8 trk_color = 0xff;
// Skip 12 bytes from the BOF
gbfseek(fin, 12, SEEK_SET);
// read # of tracks
NumberOfTracks = gbfgetuint16(fin);
// Skip 2 bytes
gbfseek(fin, 2, SEEK_CUR);
// Process all tracks one by one
while ((TracksCompleted < NumberOfTracks) && (!gbfeof( fin ) ) )
{
route_head *tmp_track;
waypoint *wpt;
char *trk_name;
trk_name = xmalloc(30);
// Generate Track Header
trackbytes = format_garmin_xt_rd_st_attrs(trk_name, &trk_color) - 50;
tmp_track = route_head_alloc();
// update track color
tmp_track->line_color.bbggrr = colors[trk_color];
tmp_track->line_color.opacity = 255;
// update track name
tmp_track->rte_name = trk_name;
track_add_head(tmp_track);
// This is the 1st coordinate of the track
FirstCoo = TRUE;
while (trackbytes>0)
{
if (trackbytes>=STRK_BLOCK_SIZE)
{
Count = gbfread(&TrackBlock, DATABLOCKSIZE, STRK_BLOCK_SIZE, fin);
trackbytes -= STRK_BLOCK_SIZE;
}
else
{
Count = gbfread(&TrackBlock, DATABLOCKSIZE, trackbytes, fin);
trackbytes = 0;
}
// decrypt loaded track block (Count - size of loaded TrackBlock)
format_garmin_xt_decrypt_trk_blk(Count, TrackBlock);
// process each track point in the loaded TrackBlock
for (ii=1; ii <= ((Count-1) / 12); ii++)
{
// decompose loaded track block part (track point)
format_garmin_xt_decomp_trk_blk(ii, TrackBlock, &PrevEle, &Lat, &Lon, &Time);
// Add point to the track if not the first point
if (!FirstCoo)
{
//create new waypoint
wpt = waypt_new();
//populate wpt;
wpt->latitude = PrevLat; /* Degrees */
wpt->longitude = PrevLon; /* Degrees */
wpt->altitude = PrevEle; /* Meters. */
wpt->creation_time = Time; /* Unix Time adjusted to Garmin time */
// add way point to the track
track_add_wpt(tmp_track, wpt);
}
else
{
FirstCoo = FALSE;
}
PrevLat = Lat;
PrevLon = Lon;
PrevTime = Time;
}
}
// decompose elevation for the last point
if (Count > 12)
{
Count--;
}
format_garmin_xt_decomp_last_ele(Count, &PrevEle, TrackBlock);
//create new waypoint
wpt = waypt_new();
//populate wpt;
wpt->latitude = PrevLat; /* Degrees */
wpt->longitude = PrevLon; /* Degrees */
wpt->altitude = PrevEle; /* Meters. */
wpt->creation_time = Time; /* Unix Time adjusted to Garmin time */
// add way point to the track
track_add_wpt(tmp_track, wpt);
// update completed tracks counter
TracksCompleted++;
}
}
static void
compegps_data_read(void)
{
char *buff;
int line = 0;
int input_datum;
waypoint *wpt = NULL;
route_head *route = NULL;
route_head *track = NULL;
while ((buff = gbfgetstr(fin)))
{
char *cin = buff;
char *ctail;
if ((line++ == 0) && fin->unicode) cet_convert_init(CET_CHARSET_UTF8, 1);
cin = lrtrim(buff);
if (strlen(cin) == 0) continue;
ctail = strchr(cin, ' ');
if (ctail == NULL) continue;
ctail = lrtrim(ctail);
switch(*cin)
{
case 'G':
input_datum = GPS_Lookup_Datum_Index(ctail);
if (input_datum < 0) {
fatal( MYNAME ": Unsupported datum \"%s\"!", ctail);
}
break;
case 'U':
switch(*ctail)
{
case '1': /* lat/lon, that's we want to see */
break;
case '0': /* UTM not supported yet */
fatal(MYNAME "Sorry, UTM is not supported yet!\n");
default:
fatal(MYNAME "Invalid system of coordinates (%s)!\n", cin);
}
break;
case 'R':
route = route_head_alloc();
route_add_head(route);
parse_rte_info(ctail, route);
break;
case 'M':
break;
case 'W':
wpt = parse_wpt(ctail);
if (wpt != NULL)
{
if (route != NULL)
route_add_wpt(route, wpt);
else
waypt_add(wpt);
}
break;
case 'w':
is_fatal((wpt == NULL), MYNAME ": No waypoint data before \"%s\"!", cin);
parse_wpt_info(ctail, wpt);
break;
case 'T':
wpt = parse_trkpt(ctail);
if (wpt != NULL)
{
if (track == NULL)
{
track = route_head_alloc();
track_add_head(track);
}
track_add_wpt(track, wpt);
}
break;
case 't':
if (track != NULL)
parse_track_info(ctail, track);
break;
}
}
}
static void
humminbird_read_track_old(gbfile* fin) {
humminbird_trk_header_old_t th;
humminbird_trk_point_old_t* points;
route_head* trk;
waypoint* first_wpt;
int i;
int max_points = 0;
gbint32 accum_east;
gbint32 accum_north;
double g_lat;
const int file_len = 8048;
char namebuf[TRK_NAME_LEN];
if (! gbfread(&th, 1, sizeof(th), fin))
fatal(MYNAME ": Unexpected end of file reading header!\n");
th.trk_num = be_read16(&th.trk_num);
th.num_points = be_read16(&th.num_points);
th.time = be_read32(&th.time);
th.start_east = be_read32(&th.start_east);
th.start_north = be_read32(&th.start_north);
th.end_east = be_read32(&th.end_east);
th.end_north = be_read32(&th.end_north);
// These files are always 8048 bytes long. Note that that's the value
// of the second 16-bit word in the signature.
max_points = (file_len - (sizeof(th) + sizeof (gbuint32) + TRK_NAME_LEN)) / sizeof(humminbird_trk_point_old_t);
if (th.num_points > max_points)
fatal(MYNAME ": Too many track points! (%d)\n", th.num_points);
/* num_points is actually one too big, because it includes the value in
the header. But we want the extra point at the end because the
freak-value filter below looks at points[i+1] */
points = xcalloc(th.num_points, sizeof(humminbird_trk_point_old_t));
if (! gbfread(points, sizeof(humminbird_trk_point_old_t), th.num_points-1, fin))
fatal(MYNAME ": Unexpected end of file reading points!\n");
accum_east = th.start_east;
accum_north = th.start_north;
trk = route_head_alloc();
track_add_head(trk);
/* The name is not in the header, but at the end of the file.
(The last 20 bytes.) */
gbfseek(fin, file_len-TRK_NAME_LEN, SEEK_SET);
gbfread(&namebuf, 1, TRK_NAME_LEN, fin);
trk->rte_name = xstrndup(namebuf, sizeof(namebuf));
trk->rte_num = th.trk_num;
/* We create one wpt for the info in the header */
first_wpt = waypt_new();
g_lat = gudermannian_i1924(accum_north);
first_wpt->latitude = geocentric_to_geodetic_hwr(g_lat);
first_wpt->longitude = accum_east/EAST_SCALE * 180.0;
first_wpt->altitude = 0.0;
track_add_wpt(trk, first_wpt);
for(i=0 ; i<th.num_points-1 ; i++) {
waypoint *wpt = waypt_new();
// gbint16 next_deltaeast, next_deltanorth;
double guder;
points[i].deltaeast = be_read16(&points[i].deltaeast);
points[i].deltanorth = be_read16(&points[i].deltanorth);
// I've commented this out, don't know if it happens in this
// format. It happens in the newer version though.
// /* Every once in a while the delta values are
// 32767 followed by -32768. Filter that. */
//
// next_deltaeast = be_read16(&points[i+1].deltaeast);
// if (points[ i ].deltaeast == 32767 &&
// next_deltaeast == -32768) {
// points[ i ].deltaeast = -1;
// points[i+1].deltaeast = 0; /* BE 0 == LE 0 */
// }
// next_deltanorth = be_read16(&points[i+1].deltanorth);
// if (points[ i ].deltanorth == 32767 &&
// next_deltanorth == -32768) {
// points[ i ].deltanorth = -1;
// points[i+1].deltanorth = 0;
// }
//
accum_east += points[i].deltaeast;
accum_north += points[i].deltanorth;
guder = gudermannian_i1924(accum_north);
wpt->latitude = geocentric_to_geodetic_hwr(guder);
wpt->longitude = accum_east/EAST_SCALE * 180.0;
wpt->altitude = 0.0;
if (i == th.num_points-2 && th.time != 0) {
/* Last point. Add the date from the header. */
/* Unless it's zero. Sometimes happens, possibly if
the gps didn't have a lock when the track was
saved. */
wpt->creation_time = th.time;
}
track_add_wpt(trk, wpt);
}
xfree(points);
}
static void
humminbird_read_track(gbfile* fin) {
humminbird_trk_header_t th;
humminbird_trk_point_t* points;
route_head* trk;
waypoint* first_wpt;
int i;
int max_points = 0;
gbint32 accum_east;
gbint32 accum_north;
double g_lat;
if (! gbfread(&th, 1, sizeof(th), fin))
fatal(MYNAME ": Unexpected end of file reading header!\n");
th.trk_num = be_read16(&th.trk_num);
th.num_points = be_read16(&th.num_points);
th.time = be_read32(&th.time);
th.start_east = be_read32(&th.start_east);
th.start_north = be_read32(&th.start_north);
th.end_east = be_read32(&th.end_east);
th.end_north = be_read32(&th.end_north);
th.sw_east = be_read32(&th.sw_east);
th.sw_north = be_read32(&th.sw_north);
th.ne_east = be_read32(&th.ne_east);
th.ne_north = be_read32(&th.ne_north);
max_points = (131080 - sizeof(gbuint32) - sizeof(th)) / sizeof(humminbird_trk_point_t);
if (th.num_points > max_points)
fatal(MYNAME ": Too many track points! (%d)\n", th.num_points);
/* num_points is actually one too big, because it includes the value in
the header. But we want the extra point at the end because the
freak-value filter below looks at points[i+1] */
points = xcalloc(th.num_points, sizeof(humminbird_trk_point_t));
if (! gbfread(points, sizeof(humminbird_trk_point_t), th.num_points-1, fin))
fatal(MYNAME ": Unexpected end of file reading points!\n");
accum_east = th.start_east;
accum_north = th.start_north;
trk = route_head_alloc();
track_add_head(trk);
trk->rte_name = xstrndup(th.name, sizeof(th.name));
trk->rte_num = th.trk_num;
/* We create one wpt for the info in the header */
first_wpt = waypt_new();
g_lat = gudermannian_i1924(accum_north);
first_wpt->latitude = geocentric_to_geodetic_hwr(g_lat);
first_wpt->longitude = accum_east/EAST_SCALE * 180.0;
first_wpt->altitude = 0.0;
/* No depth info in the header. */
track_add_wpt(trk, first_wpt);
for(i=0 ; i<th.num_points-1 ; i++) {
waypoint *wpt = waypt_new();
gbint16 next_deltaeast, next_deltanorth;
double guder;
points[i].depth = be_read16(&points[i].depth);
points[i].deltaeast = be_read16(&points[i].deltaeast);
points[i].deltanorth = be_read16(&points[i].deltanorth);
/* Every once in a while the delta values are
32767 followed by -32768. Filter that. */
next_deltaeast = be_read16(&points[i+1].deltaeast);
if (points[ i ].deltaeast == 32767 &&
next_deltaeast == -32768) {
points[ i ].deltaeast = -1;
points[i+1].deltaeast = 0; /* BE 0 == LE 0 */
}
next_deltanorth = be_read16(&points[i+1].deltanorth);
if (points[ i ].deltanorth == 32767 &&
next_deltanorth == -32768) {
points[ i ].deltanorth = -1;
points[i+1].deltanorth = 0;
}
accum_east += points[i].deltaeast;
accum_north += points[i].deltanorth;
guder = gudermannian_i1924(accum_north);
wpt->latitude = geocentric_to_geodetic_hwr(guder);
wpt->longitude = accum_east/EAST_SCALE * 180.0;
wpt->altitude = 0.0;
if (points[i].depth != 0)
WAYPT_SET(wpt,depth,(double)points[i].depth / 100.0);
if (i == th.num_points-2 && th.time != 0) {
/* Last point. Add the date from the header. */
/* Unless it's zero. Sometimes happens, possibly if
the gps didn't have a lock when the track was
saved. */
wpt->creation_time = th.time;
}
track_add_wpt(trk, wpt);
}
xfree(points);
}
static
int ppdb_read_wpt(route_head *head, int isRoute)
{
char *data, *str;
double altfeet;
struct tm tm;
while (pdb_read_rec(file_in, NULL, NULL, NULL, (void *)&data) >= 0) {
waypoint *wpt_tmp = waypt_new();
int line = 0;
char *tmp = data;
/* Print the whole input record. All input records are printed before processing. */
if (global_opts.debug_level >= 5)
{
DBG(("\n\
--- BEGIN Input data record -----------------------------------------------\n\
%s\n\
--- END Input data record -------------------------------------------------\n",data));
}
while ((str = csv_lineparse(tmp, ",", "\"", line++))) {
tmp = NULL;
switch(line)
{
case 1: /* latitude */
wpt_tmp->latitude = ppdb_decode_coord(str);
break;
case 2: /* longitude */
wpt_tmp->longitude = ppdb_decode_coord(str);
break;
case 3: /* altitude */
if (*str != '\0')
{
CHECK_INP(1, sscanf(str, "%lf", &altfeet), "altitude", str);
if (altfeet != -9999)
wpt_tmp->altitude = FEET_TO_METERS(altfeet);
}
break;
case 4: /* time and date (optional) */
memset(&tm, 0, sizeof(tm));
if (ppdb_decode_tm(str, &tm))
{
tm.tm_year -= 1900;
tm.tm_mon--;
wpt_tmp->creation_time = mkgmtime(&tm);
}
break;
case 5: /* name */
if (*str != '\0')
wpt_tmp->shortname = xstrdup(str);
break;
case 6: /* icon */
if (*str != '\0')
wpt_tmp->icon_descr = xstrdup(str);
wpt_tmp->wpt_flags.icon_descr_is_dynamic = 1;
break;
case 7: /* notes */
if (*str != '\0')
wpt_tmp->notes = xstrdup(str);
break;
}
}
/* Print the whole input record, should a warning be triggered.
* Use warning() here instead of DBG() to print the data record
* right after the warning is issued.
*/
if (warn_ && (global_opts.debug_level > 1) && (global_opts.debug_level < 5))
{
warning("Faulty input data record : %s\n",data);
warn_ = 0;
}
if (head && isRoute )
route_add_wpt(head, wpt_tmp);
else if (head)
track_add_wpt(head, wpt_tmp);
else
waypt_add(wpt_tmp);
}
static void
mmo_read_CObjTrack(mmo_data_t *data)
{
#ifdef MMO_DBG
const char *sobj = "CObjTrack";
#endif
int tp, ctp;
route_head *trk;
DBG((sobj, ":-----------------------------------------------------\n"));
DBG((sobj, "name = \"%s\" [ visible=%s, id=0x%04X ]\n",
data->name, data->visible ? "yes" : "NO", data->objid));
trk = route_head_alloc();
trk->rte_name = xstrdup(data->name);
track_add_head(trk);
tp = gbfgetint16(fin);
DBG((sobj, "track has %d point(s)\n", tp));
for (ctp = 0; ctp < tp; ctp++) {
waypoint *wpt;
char unk;
wpt = waypt_new();
wpt->latitude = gbfgetdbl(fin);
wpt->longitude = gbfgetdbl(fin);
unk = gbfgetc(fin);
wpt->creation_time = gbfgetint32(fin);
wpt->altitude = gbfgetflt(fin);
if (unk != 0) {
gbuint16 ux;
ux = gbfgetuint16(fin);
DBG((sobj, "u16 = %04X (%d)\n", ux, ux));
if (unk > 1) {
gbuint16 ux;
ux = gbfgetuint16(fin);
DBG((sobj, "u16 = %04X (%d)\n", ux, ux));
}
}
track_add_wpt(trk, wpt);
}
if (mmo_version > 0) {
gbuint32 u32;
u32 = gbfgetuint32(fin); /* Min. update interval */
DBG((sobj, "min. update interval = %d\n", u32));
u32 = gbfgetuint32(fin); /* unknown */
// DBG((sobj, "unknown value = 0x%8X (%d)\n", u32, u32));
u32 = gbfgetuint32(fin); /* unknown */
// DBG((sobj, "unknown value = 0x%8X (%d)\n", u32, u32));
u32 = gbfgetuint32(fin); /* unknown */
DBG((sobj, "min. update distance = %d\n", u32));
u32 = gbfgetuint32(fin); /* unknown */
DBG((sobj, "track partition interval = %d\n", u32 / 60));
u32 = gbfgetuint32(fin); /* unknown */
// DBG((sobj, "unknown value = 0x%8X (%d)\n", u32, u32));
u32 = gbfgetuint32(fin); /* unknown */
DBG((sobj, "tick interval = %d\n", u32 / 60));
trk->line_color.bbggrr = gbfgetuint32(fin); /* rgb color */
trk->line_color.opacity = 255;
DBG((sobj, "color = 0x%06X\n", trk->line_color.bbggrr));
}
if (mmo_version >= 0x12) {
char u8;
u8 = gbfgetc(fin);
DBG((sobj, "line width = %d - (since 0x12)\n", u8));
u8 = gbfgetc(fin);
DBG((sobj, "line style = %d - (since 0x12)\n", u8));
u8 = gbfgetc(fin);
DBG((sobj, "transparency = %d - (since 0x12)\n", u8));
trk->line_color.opacity = 255 - (u8 * 51);
if (mmo_version >= 0x16) {
char u8;
gbuint16 u16;
u8 = gbfgetc(fin);
// DBG((sobj, "u8 = 0x%X (since 0x16)\n", u8));
u16 = gbfgetuint16(fin);
// DBG((sobj, "u16 = 0x%X (since 0x16)\n", u16));
u16 = gbfgetuint16(fin);
// DBG((sobj, "u16 = 0x%X (since 0x16)\n", u16));
}
}
if (trk->rte_waypt_ct == 0) {
track_del_head(trk);
data->data = NULL;
}
}
static void
gtm_read(void)
{
route_head *first_trk_head = NULL;
route_head *trk_head = NULL;
route_head *rte_head = NULL;
waypoint *wpt;
int real_tr_count = 0;
char *route_name;
unsigned int icon;
int i;
/* Image information */
for (i = 0; i != im_count; i++) {
fread_string_discard(file_in);
fread_string_discard(file_in);
fread_discard(file_in, 30);
}
/* Waypoints */
for (i = 0; i != wp_count; i++) {
wpt = waypt_new();
wpt->latitude = fread_double(file_in);
wpt->longitude = fread_double(file_in);
convert_datum(&wpt->latitude, &wpt->longitude);
wpt->shortname = fread_fixedstring(file_in, 10);
wpt->description = fread_string(file_in);
icon = fread_integer(file_in);
if (icon < sizeof(icon_descr)/sizeof(char*))
wpt->icon_descr = icon_descr[icon];
fread_discard(file_in, 1);
wpt->creation_time = fread_long(file_in);
if (wpt->creation_time)
wpt->creation_time += EPOCH89DIFF;
fread_discard(file_in, 2);
wpt->altitude = fread_single(file_in);
if (wpt->altitude == unknown_alt_gtm)
wpt->altitude = unknown_alt;
fread_discard(file_in, 2);
waypt_add(wpt);
}
/* Waypoint Styles */
if (wp_count) {
for (i = 0; i != ws_count; i++) {
fread_discard(file_in, 4);
fread_string_discard(file_in);
fread_discard(file_in, 24);
}
}
/* Tracklogs */
for (i = 0; i != tr_count; i++) {
wpt = waypt_new();
wpt->latitude = fread_double(file_in);
wpt->longitude = fread_double(file_in);
convert_datum(&wpt->latitude, &wpt->longitude);
wpt->creation_time = fread_long(file_in);
if (wpt->creation_time)
wpt->creation_time += EPOCH89DIFF;
start_new = fread_byte(file_in);
wpt->altitude = fread_single(file_in);
if (wpt->altitude == unknown_alt_gtm)
wpt->altitude = unknown_alt;
if (start_new || !trk_head) {
trk_head = route_head_alloc();
track_add_head(trk_head);
real_tr_count++;
if (!first_trk_head)
first_trk_head = trk_head;
}
track_add_wpt(trk_head, wpt);
}
/* Tracklog styles */
trk_head = first_trk_head;
for (i = 0; i != ts_count && i != real_tr_count; i++) {
trk_head->rte_name = fread_string(file_in);
fread_discard(file_in, 12);
trk_head = (route_head *)QUEUE_NEXT(&trk_head->Q);
}
/* Routes */
for (i = 0; i != rt_count; i++) {
wpt = waypt_new();
wpt->latitude = fread_double(file_in);
wpt->longitude = fread_double(file_in);
convert_datum(&wpt->latitude, &wpt->longitude);
wpt->shortname = fread_fixedstring(file_in, 10);
wpt->description = fread_string(file_in);
route_name = fread_string(file_in);
icon = fread_integer(file_in);
if (icon < sizeof(icon_descr)/sizeof(char*))
wpt->icon_descr = icon_descr[icon];
fread_discard(file_in, 1);
start_new = fread_byte(file_in);
fread_discard(file_in, 6);
wpt->altitude = fread_single(file_in);
if (wpt->altitude == unknown_alt_gtm)
wpt->altitude = unknown_alt;
fread_discard(file_in, 2);
if (start_new || !rte_head) {
rte_head = route_head_alloc();
rte_head->rte_name = route_name;
route_add_head(rte_head);
}
else {
xfree(route_name);
}
route_add_wpt(rte_head, wpt);
}
}
static void
format_garmin_xt_proc_atrk(void)
{
gbuint16 block=0, uu=0;
gbuint32 Lat=0, Lon=0;
gbuint32 Tim=0;
double LatF = 0, LonF = 0, AltF = 0;
waypoint *wpt;
int method = 0;
unsigned char buf[3];
gbint32 num_trackpoints;
// get the option for the processing the track name
if ( opt_trk_header )
{
method = atoi(opt_trk_header);
}
if (! track) {
track = route_head_alloc();
// header option was not set to ignore
if ( method !=1 )
{
track->rte_name = xstrdup("ATRK XT");
}
track_add_head(track);
}
// We think the word at offset 0xc is the trackpoint count.
gbfseek(fin, 12, SEEK_SET);
num_trackpoints = gbfgetuint32(fin);
while (num_trackpoints--) {
block = gbfgetuint16(fin);
if (block != 0x0c)
break;
gbfread(&buf, 3, DATABLOCKSIZE, fin); //1. Lat
Lat = buf[0] | (buf[1] << 8) | (buf[2] << 16);
gbfread(&buf, 3, DATABLOCKSIZE, fin); //2. Lon
Lon = buf[0] | (buf[1] << 8) | (buf[2] << 16);
uu = gbfgetuint16(fin);
Tim = gbfgetuint32(fin);
Tim += 631065600; // adjustment to UnixTime
LatF = Lat;
if (LatF>8388608) {LatF -= 16777216;};
LonF = Lon;
if (LonF>8388608) {LonF -= 16777216;};
AltF = (double)uu * GARMIN_XT_ELE - 1500;
//create new waypoint
wpt = waypt_new();
//populate wpt;
wpt->latitude = LatF*180/16777216; /* Degrees */
wpt->longitude = LonF*360/16777216; /* Degrees */
wpt->altitude = AltF; /* Meters. */
wpt->creation_time = Tim; /* Unix Time adjusted to Garmin time */
track_add_wpt(track, wpt);
}
}
static void
lowranceusr_parse_trails(void)
{
char buff[MAXUSRSTRINGSIZE + 1];
short int num_trails, num_trail_points, num_section_points;
int i,j, trk_num, itmp;
int text_len;
waypoint *wpt_tmp;
route_head *trk_tmp;
/* num trails */
num_trails = gbfgetint16(file_in);
if (global_opts.debug_level >= 1)
printf(MYNAME " parse_trails: num trails = %d\n", num_trails);
for (i=trk_num=0; i < num_trails; i++)
{
trk_head = route_head_alloc();
trk_head->rte_num = ++trk_num;
track_add_head(trk_head);
/* trail name */
text_len = lowranceusr_readstr(&buff[0], MAXUSRSTRINGSIZE, file_in);
if (global_opts.debug_level >= 1)
printf(MYNAME " parse_trails: name text len = %d\n", text_len);
if (text_len) {
buff[text_len] = '\0';
trk_head->rte_name = xstrdup(buff);
}
trk_head->rte_desc = '\0';
if (global_opts.debug_level >= 1)
printf(MYNAME " parse_trails: trail name = %s\n", trk_head->rte_name);
/* visible */
(void) gbfread(&buff[0], 1, 1, file_in);
/* num trail points */
num_trail_points = gbfgetint16(file_in);
if (global_opts.debug_level >= 1)
printf(MYNAME " parse_trails: num trail points = %d\n", num_trail_points);
/* max trail size */
itmp = gbfgetint16(file_in);
if (global_opts.debug_level >= 1)
printf(MYNAME " parse_trails: max trail size = %d\n", itmp);
if (num_trail_points)
{
while (num_trail_points)
{
/* num section points */
num_section_points = gbfgetint16(file_in);
if (global_opts.debug_level >= 1)
printf(MYNAME " parse_trails: num section points = %d\n", num_section_points);
for (j=0; j < num_section_points; j++, num_trail_points--)
{
wpt_tmp = waypt_new();
wpt_tmp->latitude = lat_mm_to_deg(gbfgetint32(file_in));
wpt_tmp->longitude = lon_mm_to_deg(gbfgetint32(file_in));
/* continuous */
(void) gbfread(&buff[0], 1, 1, file_in);
if (!buff[0] && seg_break && j)
{
trk_tmp = route_head_alloc();
trk_tmp->rte_num = ++trk_num;
trk_tmp->rte_name = xstrdup(trk_head->rte_name);
trk_tmp->rte_desc = '\0';
track_add_head(trk_tmp);
trk_head = trk_tmp;
}
track_add_wpt(trk_head, wpt_tmp);
if (global_opts.debug_level >= 1)
printf(MYNAME " parse_trails: Trail pt lat %f lon %f\n", wpt_tmp->latitude, wpt_tmp->longitude);
}
}
}
/* remove the trail since it's empty */
else track_del_head(trk_head);
}
}
static void
unicsv_parse_one_line(char *ibuf)
{
char *s;
waypoint *wpt = NULL;
int column;
int utm_zone = -9999;
double utm_easting = 0;
double utm_northing = 0;
char utm_zc = 'N';
char bng_zone[3] = "";
double bng_easting = 0;
double bng_northing = 0;
double swiss_easting = unicsv_unknown;
double swiss_northing = unicsv_unknown;
int checked = 0;
time_t date = -1, time = -1;
int msec = -1;
char is_localtime = 0;
garmin_fs_t *gmsd;
double d;
struct tm ymd;
int src_datum = unicsv_datum_idx;
int ns = 1;
int ew = 1;
#ifdef UNICSV_GC_READY
geocache_data *gc_data = NULL;
#endif
wpt = waypt_new();
wpt->latitude = unicsv_unknown;
wpt->longitude = unicsv_unknown;
memset(&ymd, 0, sizeof(ymd));
column = -1;
while ((s = csv_lineparse(ibuf, unicsv_fieldsep, "\"", 0))) {
if (column > unicsv_fields_tab_ct) break; /* ignore extra fields on line */
ibuf = NULL;
column++;
checked++;
s = lrtrim(s);
if (! *s) continue; /* skip empty columns */
switch(unicsv_fields_tab[column]) {
case fld_time:
case fld_date:
case fld_datetime:
/* switch column type if it looks like an iso time string */
if (strchr(s, 'T'))
unicsv_fields_tab[column] = fld_iso_time;
break;
default: ;
}
switch(unicsv_fields_tab[column]) {
case fld_latitude:
human_to_dec( s, &wpt->latitude, &wpt->longitude, 1 );
wpt->latitude = wpt->latitude * ns;
break;
case fld_longitude:
human_to_dec( s, &wpt->latitude, &wpt->longitude, 2 );
wpt->longitude = wpt->longitude * ew;
break;
case fld_shortname:
wpt->shortname = xstrdup(s);
break;
case fld_description:
wpt->description = xstrdup(s);
break;
case fld_notes:
wpt->notes = xstrdup(s);
break;
case fld_url:
wpt->url = xstrdup(s);
break;
case fld_altitude:
if (parse_distance(s, &d, unicsv_altscale, MYNAME)) {
if (fabs(d) < fabs(unknown_alt))
wpt->altitude = d;
}
break;
case fld_utm_zone:
utm_zone = atoi(s);
break;
case fld_utm_easting:
utm_easting = atof(s);
break;
case fld_utm_northing:
utm_northing = atof(s);
break;
case fld_utm_zone_char:
utm_zc = toupper(s[0]);
break;
case fld_utm:
parse_coordinates(s, unicsv_datum_idx, grid_utm,
&wpt->latitude, &wpt->longitude, MYNAME);
/* coordinates from parse_coordinates are in WGS84
don't convert a second time */
src_datum = DATUM_WGS84;
break;
case fld_bng:
parse_coordinates(s, DATUM_OSGB36, grid_bng,
&wpt->latitude, &wpt->longitude, MYNAME);
/* coordinates from parse_coordinates are in WGS84
don't convert a second time */
src_datum = DATUM_WGS84;
break;
case fld_bng_zone:
strncpy(bng_zone, s, sizeof(bng_zone));
strupper(bng_zone);
break;
case fld_bng_northing:
bng_northing = atof(s);
break;
case fld_bng_easting:
bng_easting = atof(s);
break;
case fld_swiss:
parse_coordinates(s, DATUM_WGS84, grid_swiss,
&wpt->latitude, &wpt->longitude, MYNAME);
/* coordinates from parse_coordinates are in WGS84
don't convert a second time */
src_datum = DATUM_WGS84;
break;
case fld_swiss_easting:
swiss_easting = atof(s);
break;
case fld_swiss_northing:
swiss_northing = atof(s);
break;
case fld_hdop:
wpt->hdop = atof(s);
if (unicsv_detect) unicsv_data_type = trkdata;
break;
case fld_pdop:
wpt->pdop = atof(s);
if (unicsv_detect) unicsv_data_type = trkdata;
break;
case fld_vdop:
wpt->vdop = atof(s);
if (unicsv_detect) unicsv_data_type = trkdata;
break;
case fld_sat:
wpt->sat = atoi(s);
if (unicsv_detect) unicsv_data_type = trkdata;
break;
case fld_fix:
if (unicsv_detect) unicsv_data_type = trkdata;
if (case_ignore_strcmp(s, "none") == 0)
wpt->fix = fix_none;
else if (case_ignore_strcmp(s, "2d") == 0)
wpt->fix = fix_2d;
else if (case_ignore_strcmp(s, "3d") == 0)
wpt->fix = fix_3d;
else if (case_ignore_strcmp(s, "dgps") == 0)
wpt->fix = fix_dgps;
else if (case_ignore_strcmp(s, "pps") == 0)
wpt->fix = fix_pps;
else wpt->fix = fix_unknown;
break;
case fld_utc_date:
if ((is_localtime < 2) && (date < 0)) {
date = unicsv_parse_date(s, NULL);
is_localtime = 0;
}
break;
case fld_utc_time:
if ((is_localtime < 2) && (time < 0)) {
time = unicsv_parse_time(s, &msec, &date);
is_localtime = 0;
}
break;
case fld_speed:
if (parse_speed(s, &d, 1.0, MYNAME)) {
WAYPT_SET(wpt, speed, d);
if (unicsv_detect)
unicsv_data_type = trkdata;
}
break;
case fld_course:
WAYPT_SET(wpt, course, atof(s));
if (unicsv_detect) unicsv_data_type = trkdata;
break;
case fld_temperature:
d = atof(s);
if (fabs(d) < 999999) WAYPT_SET(wpt, temperature, d);
break;
case fld_temperature_f:
d = atof(s);
if (fabs(d) < 999999) WAYPT_SET(wpt, temperature, FAHRENHEIT_TO_CELSIUS(d));
break;
case fld_heartrate:
wpt->heartrate = atoi(s);
if (unicsv_detect) unicsv_data_type = trkdata;
break;
case fld_cadence:
wpt->cadence = atoi(s);
if (unicsv_detect) unicsv_data_type = trkdata;
break;
case fld_proximity:
if (parse_distance(s, &d, unicsv_proximityscale, MYNAME))
WAYPT_SET(wpt, proximity, d);
break;
case fld_depth:
if (parse_distance(s, &d, unicsv_depthscale, MYNAME))
WAYPT_SET(wpt, depth, d);
break;
case fld_symbol:
wpt->icon_descr = xstrdup(s);
wpt->wpt_flags.icon_descr_is_dynamic = 1;
break;
case fld_iso_time:
is_localtime = 2; /* fix result */
wpt->creation_time = xml_parse_time(s, &wpt->microseconds);
break;
case fld_time:
if ((is_localtime < 2) && (time < 0)) {
time = unicsv_parse_time(s, &msec, &date);
is_localtime = 1;
}
break;
case fld_date:
if ((is_localtime < 2) && (date < 0)) {
date = unicsv_parse_date(s, NULL);
is_localtime = 1;
}
break;
case fld_year:
ymd.tm_year = atoi(s);
break;
case fld_month:
ymd.tm_mon = atoi(s);
break;
case fld_day:
ymd.tm_mday = atoi(s);
break;
case fld_hour:
ymd.tm_hour = atoi(s);
break;
case fld_min:
ymd.tm_min = atoi(s);
break;
case fld_sec:
ymd.tm_sec = atoi(s);
break;
case fld_datetime:
if ((is_localtime < 2) && (date < 0) && (time < 0)) {
time = unicsv_parse_time(s, &msec, &date);
is_localtime = 1;
}
break;
case fld_ns:
ns = tolower(s[0]) == 'n' ? 1 : -1;
wpt->latitude *= ns;
break;
case fld_ew:
ew = tolower(s[0]) == 'e' ? 1 : -1;
wpt->longitude *= ew;
break;
case fld_garmin_city:
case fld_garmin_postal_code:
case fld_garmin_state:
case fld_garmin_country:
case fld_garmin_addr:
case fld_garmin_phone_nr:
case fld_garmin_phone_nr2:
case fld_garmin_fax_nr:
case fld_garmin_email:
case fld_garmin_facility:
gmsd = GMSD_FIND(wpt);
if (! gmsd) {
gmsd = garmin_fs_alloc(-1);
fs_chain_add(&wpt->fs, (format_specific_data *) gmsd);
}
switch(unicsv_fields_tab[column]) {
case fld_garmin_city: GMSD_SETSTR(city, s); break;
case fld_garmin_postal_code: GMSD_SETSTR(postal_code, s); break;
case fld_garmin_state: GMSD_SETSTR(state, s); break;
case fld_garmin_country: GMSD_SETSTR(country, s); break;
case fld_garmin_addr: GMSD_SETSTR(addr, s); break;
case fld_garmin_phone_nr: GMSD_SETSTR(phone_nr, s); break;
case fld_garmin_phone_nr2: GMSD_SETSTR(phone_nr2, s); break;
case fld_garmin_fax_nr: GMSD_SETSTR(fax_nr, s); break;
case fld_garmin_email: GMSD_SETSTR(email, s); break;
case fld_garmin_facility: GMSD_SETSTR(facility, s); break;
default: break;
}
break;
#ifdef UNICSV_GC_READY
case fld_gc_id:
case fld_gc_type:
case fld_gc_container:
case fld_gc_terr:
case fld_gc_diff:
case fld_gc_is_archived:
case fld_gc_is_available:
case fld_gc_exported:
case fld_gc_last_found:
case fld_gc_placer:
case fld_gc_placer_id:
case fld_gc_hint:
gc_data = waypt_alloc_gc_data(wpt);
switch(unicsv_fields_tab[column]) {
case fld_gc_id:
gc_data->id = atoi(s);
if (gc_data->id == 0) gc_data->id = unicsv_parse_gc_id(s);
break;
case fld_gc_type: gc_data->type = gs_mktype(s); break;
case fld_gc_container: gc_data->container = gs_mkcont(s); break;
case fld_gc_terr: gc_data->terr = atof(s) * 10; break;
case fld_gc_diff: gc_data->diff = atof(s) * 10; break;
case fld_gc_is_archived: gc_data->is_archived = unicsv_parse_status(s); break;
case fld_gc_is_available: gc_data->is_available = unicsv_parse_status(s); break;
case fld_gc_exported: {
time_t time, date; int msec;
time = unicsv_parse_time(s, &msec, &date);
if (date || time) gc_data->exported = unicsv_adjust_time(time, &date);
}
break;
case fld_gc_last_found: {
time_t time, date;
int msec;
time = unicsv_parse_time(s, &msec, &date);
if (date || time) gc_data->last_found = unicsv_adjust_time(time, &date);
}
break;
case fld_gc_placer: gc_data->placer = xstrdup(s); break;
case fld_gc_placer_id: gc_data->placer_id = atoi(s); break;
case fld_gc_hint: gc_data->hint = xstrdup(s); break;
default: break;
}
break;
#endif
case fld_terminator: /* dummy */
checked--;
break;
}
}
if (checked == 0) {
waypt_free(wpt);
return;
}
if (is_localtime < 2) { /* not fixed */
if ((time >= 0) && (date >= 0)) {
time_t t = date + time;
if (is_localtime) {
struct tm tm;
tm = *gmtime(&t);
if (opt_utc)
wpt->creation_time = mkgmtime(&tm);
else
wpt->creation_time = mklocaltime(&tm);
}
else
wpt->creation_time = t;
}
else if (time >= 0)
wpt->creation_time = time;
else if (date >= 0)
wpt->creation_time = date;
else if (ymd.tm_year || ymd.tm_mon || ymd.tm_mday) {
if (ymd.tm_year < 100) {
if (ymd.tm_year <= 70) ymd.tm_year += 2000;
else ymd.tm_year += 1900;
}
ymd.tm_year -= 1900;
if (ymd.tm_mon == 0) ymd.tm_mon = 1;
if (ymd.tm_mday == 0) ymd.tm_mday = 1;
ymd.tm_mon--;
if (opt_utc)
wpt->creation_time = mkgmtime(&ymd);
else
wpt->creation_time = mklocaltime(&ymd);
}
else if (ymd.tm_hour || ymd.tm_min || ymd.tm_sec) {
if (opt_utc)
wpt->creation_time = mkgmtime(&ymd);
else
wpt->creation_time = mklocaltime(&ymd);
}
if (msec >= 0)
wpt->microseconds = msec;
if (opt_utc)
wpt->creation_time += atoi(opt_utc) * SECONDS_PER_HOUR;
}
/* utm/bng/swiss can be optional */
if ((wpt->latitude == unicsv_unknown) && (wpt->longitude == unicsv_unknown)) {
if (utm_zone != -9999) {
GPS_Math_UTM_EN_To_Known_Datum(&wpt->latitude, &wpt->longitude,
utm_easting, utm_northing, utm_zone, utm_zc, unicsv_datum_idx);
}
else if (bng_zone[0]) {
if (! GPS_Math_UKOSMap_To_WGS84_M(
bng_zone, bng_easting, bng_northing,
&wpt->latitude, &wpt->longitude))
fatal(MYNAME ": Unable to convert BNG coordinates (%s %.f %.f)!\n",
bng_zone, bng_easting, bng_northing);
src_datum = DATUM_WGS84; /* don't convert afterwards */
}
else if ((swiss_easting != unicsv_unknown) && (swiss_northing != unicsv_unknown)) {
GPS_Math_Swiss_EN_To_WGS84(swiss_easting, swiss_northing,
&wpt->latitude, &wpt->longitude);
src_datum = DATUM_WGS84; /* don't convert afterwards */
}
}
if ((src_datum != DATUM_WGS84) &&
(wpt->latitude != unicsv_unknown) && (wpt->longitude != unicsv_unknown)) {
double alt;
GPS_Math_Known_Datum_To_WGS84_M(wpt->latitude, wpt->longitude, (double) 0.0,
&wpt->latitude, &wpt->longitude, &alt, src_datum);
}
switch(unicsv_data_type) {
case rtedata:
if (! unicsv_route) {
unicsv_route = route_head_alloc();
route_add_head(unicsv_route);
}
route_add_wpt(unicsv_route, wpt);
break;
case trkdata:
if (! unicsv_track) {
unicsv_track = route_head_alloc();
track_add_head(unicsv_track);
}
track_add_wpt(unicsv_track, wpt);
break;
default:
waypt_add(wpt);
}
}