src/viktrack.c

   1 /*
   2  * viking -- GPS Data and Topo Analyzer, Explorer, and Manager
   3  *
   4  * Copyright (C) 2003-2005, Evan Battaglia <gtoevan@gmx.net>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  *
  20  */
  21
  22 #include <glib.h>
  23 #include <time.h>
  24 #include <stdio.h>
  25 #include <stdlib.h>
  26 #include <string.h>
  27 #include <math.h>
  28 #include "coords.h"
  29 #include "vikcoord.h"
  30 #include "viktrack.h"
  31 #include "globals.h"
  32 #include "dems.h"
  33
  34 VikTrack *vik_track_new()
  35 {
  36   VikTrack *tr = g_malloc0 ( sizeof ( VikTrack ) );
  37   tr->ref_count = 1;
  38   return tr;
  39 }
  40
  41 void vik_track_set_comment_no_copy(VikTrack *tr, gchar *comment)
  42 {
  43   if ( tr->comment )
  44     g_free ( tr->comment );
  45   tr->comment = comment;
  46 }
  47
  48
  49 void vik_track_set_comment(VikTrack *tr, const gchar *comment)
  50 {
  51   if ( tr->comment )
  52     g_free ( tr->comment );
  53
  54   if ( comment && comment[0] != '\0' )
  55     tr->comment = g_strdup(comment);
  56   else
  57     tr->comment = NULL;
  58 }
  59
  60 void vik_track_ref(VikTrack *tr)
  61 {
  62   tr->ref_count++;
  63 }
  64
  65 void vik_track_free(VikTrack *tr)
  66 {
  67   if ( tr->ref_count-- > 1 )
  68     return;
  69
  70   if ( tr->comment )
  71     g_free ( tr->comment );
  72   g_list_foreach ( tr->trackpoints, (GFunc) g_free, NULL );
  73   g_list_free( tr->trackpoints );
  74   g_free ( tr );
  75 }
  76
  77 VikTrack *vik_track_copy ( const VikTrack *tr )
  78 {
  79   VikTrack *new_tr = vik_track_new();
  80   VikTrackpoint *new_tp;
  81   GList *tp_iter = tr->trackpoints;
  82   new_tr->visible = tr->visible;
  83   new_tr->trackpoints = NULL;
  84   while ( tp_iter )
  85   {
  86     new_tp = g_malloc ( sizeof ( VikTrackpoint ) );
  87     *new_tp = *((VikTrackpoint *)(tp_iter->data));
  88     new_tr->trackpoints = g_list_append ( new_tr->trackpoints, new_tp );
  89     tp_iter = tp_iter->next;
  90   }
  91   vik_track_set_comment(new_tr,tr->comment);
  92   return new_tr;
  93 }
  94
  95 VikTrackpoint *vik_trackpoint_new()
  96 {
  97   VikTrackpoint *tp = g_malloc0(sizeof(VikTrackpoint));
  98   tp->extended = FALSE;
  99   tp->speed = NAN;
 100   tp->course = NAN;
 101   return tp;
 102 }
 103
 104 void vik_trackpoint_free(VikTrackpoint *tp)
 105 {
 106   g_free(tp);
 107 }
 108
 109 VikTrackpoint *vik_trackpoint_copy(VikTrackpoint *tp)
 110 {
 111   VikTrackpoint *rv = vik_trackpoint_new();
 112   *rv = *tp;
 113   return rv;
 114 }
 115
 116 gdouble vik_track_get_length(const VikTrack *tr)
 117 {
 118   gdouble len = 0.0;
 119   if ( tr->trackpoints )
 120   {
 121     GList *iter = tr->trackpoints->next;
 122     while (iter)
 123     {
 124       if ( ! VIK_TRACKPOINT(iter->data)->newsegment )
 125         len += vik_coord_diff ( &(VIK_TRACKPOINT(iter->data)->coord),
 126                                 &(VIK_TRACKPOINT(iter->prev->data)->coord) );
 127       iter = iter->next;
 128     }
 129   }
 130   return len;
 131 }
 132
 133 gdouble vik_track_get_length_including_gaps(const VikTrack *tr)
 134 {
 135   gdouble len = 0.0;
 136   if ( tr->trackpoints )
 137   {
 138     GList *iter = tr->trackpoints->next;
 139     while (iter)
 140     {
 141       len += vik_coord_diff ( &(VIK_TRACKPOINT(iter->data)->coord),
 142                               &(VIK_TRACKPOINT(iter->prev->data)->coord) );
 143       iter = iter->next;
 144     }
 145   }
 146   return len;
 147 }
 148
 149 gulong vik_track_get_tp_count(const VikTrack *tr)
 150 {
 151   gulong num = 0;
 152   GList *iter = tr->trackpoints;
 153   while ( iter )
 154   {
 155     num++;
 156     iter = iter->next;
 157   }
 158   return num;
 159 }
 160
 161 gulong vik_track_get_dup_point_count ( const VikTrack *tr )
 162 {
 163   gulong num = 0;
 164   GList *iter = tr->trackpoints;
 165   while ( iter )
 166   {
 167     if ( iter->next && vik_coord_equals ( &(VIK_TRACKPOINT(iter->data)->coord),
 168                        &(VIK_TRACKPOINT(iter->next->data)->coord) ) )
 169       num++;
 170     iter = iter->next;
 171   }
 172   return num;
 173 }
 174
 175 void vik_track_remove_dup_points ( VikTrack *tr )
 176 {
 177   GList *iter = tr->trackpoints;
 178   while ( iter )
 179   {
 180     if ( iter->next && vik_coord_equals ( &(VIK_TRACKPOINT(iter->data)->coord),
 181                        &(VIK_TRACKPOINT(iter->next->data)->coord) ) )
 182     {
 183       g_free ( iter->next->data );
 184       tr->trackpoints = g_list_delete_link ( tr->trackpoints, iter->next );
 185     }
 186     else
 187       iter = iter->next;
 188   }
 189 }
 190
 191 guint vik_track_get_segment_count(const VikTrack *tr)
 192 {
 193   guint num = 1;
 194   GList *iter = tr->trackpoints;
 195   if ( !iter )
 196     return 0;
 197   while ( (iter = iter->next) )
 198   {
 199     if ( VIK_TRACKPOINT(iter->data)->newsegment )
 200       num++;
 201   }
 202   return num;
 203 }
 204
 205 VikTrack **vik_track_split_into_segments(VikTrack *t, guint *ret_len)
 206 {
 207   VikTrack **rv;
 208   VikTrack *tr;
 209   guint i;
 210   guint segs = vik_track_get_segment_count(t);
 211   GList *iter;
 212
 213   if ( segs < 2 )
 214   {
 215     *ret_len = 0;
 216     return NULL;
 217   }
 218
 219   rv = g_malloc ( segs * sizeof(VikTrack *) );
 220   tr = vik_track_copy ( t );
 221   rv[0] = tr;
 222   iter = tr->trackpoints;
 223
 224   i = 1;
 225   while ( (iter = iter->next) )
 226   {
 227     if ( VIK_TRACKPOINT(iter->data)->newsegment )
 228     {
 229       iter->prev->next = NULL;
 230       iter->prev = NULL;
 231       rv[i] = vik_track_new();
 232       if ( tr->comment )
 233         vik_track_set_comment ( rv[i], tr->comment );
 234       rv[i]->visible = tr->visible;
 235       rv[i]->trackpoints = iter;
 236       i++;
 237     }
 238   }
 239   *ret_len = segs;
 240   return rv;
 241 }
 242
 243 void vik_track_reverse ( VikTrack *tr )
 244 {
 245   GList *iter;
 246   tr->trackpoints = g_list_reverse(tr->trackpoints);
 247
 248   /* fix 'newsegment' */
 249   iter = g_list_last ( tr->trackpoints );
 250   while ( iter )
 251   {
 252     if ( ! iter->next ) /* last segment, was first, cancel newsegment. */
 253       VIK_TRACKPOINT(iter->data)->newsegment = FALSE;
 254     if ( ! iter->prev ) /* first segment by convention has newsegment flag. */
 255       VIK_TRACKPOINT(iter->data)->newsegment = TRUE;
 256     else if ( VIK_TRACKPOINT(iter->data)->newsegment && iter->next )
 257     {
 258       VIK_TRACKPOINT(iter->next->data)->newsegment = TRUE;
 259       VIK_TRACKPOINT(iter->data)->newsegment = FALSE;
 260     }
 261     iter = iter->prev;
 262   }
 263 }
 264
 265 gdouble vik_track_get_average_speed(const VikTrack *tr)
 266 {
 267   gdouble len = 0.0;
 268   guint32 time = 0;
 269   if ( tr->trackpoints )
 270   {
 271     GList *iter = tr->trackpoints->next;
 272     while (iter)
 273     {
 274       if ( VIK_TRACKPOINT(iter->data)->has_timestamp &&
 275           VIK_TRACKPOINT(iter->prev->data)->has_timestamp &&
 276           (! VIK_TRACKPOINT(iter->data)->newsegment) )
 277       {
 278         len += vik_coord_diff ( &(VIK_TRACKPOINT(iter->data)->coord),
 279                                 &(VIK_TRACKPOINT(iter->prev->data)->coord) );
 280         time += ABS(VIK_TRACKPOINT(iter->data)->timestamp - VIK_TRACKPOINT(iter->prev->data)->timestamp);
 281       }
 282       iter = iter->next;
 283     }
 284   }
 285   return (time == 0) ? 0 : ABS(len/time);
 286 }
 287
 288 gdouble vik_track_get_max_speed(const VikTrack *tr)
 289 {
 290   gdouble maxspeed = 0.0, speed = 0.0;
 291   if ( tr->trackpoints )
 292   {
 293     GList *iter = tr->trackpoints->next;
 294     while (iter)
 295     {
 296       if ( VIK_TRACKPOINT(iter->data)->has_timestamp &&
 297           VIK_TRACKPOINT(iter->prev->data)->has_timestamp &&
 298           (! VIK_TRACKPOINT(iter->data)->newsegment) )
 299       {
 300         speed =  vik_coord_diff ( &(VIK_TRACKPOINT(iter->data)->coord), &(VIK_TRACKPOINT(iter->prev->data)->coord) )
 301                  / ABS(VIK_TRACKPOINT(iter->data)->timestamp - VIK_TRACKPOINT(iter->prev->data)->timestamp);
 302         if ( speed > maxspeed )
 303           maxspeed = speed;
 304       }
 305       iter = iter->next;
 306     }
 307   }
 308   return maxspeed;
 309 }
 310
 311 void vik_track_convert ( VikTrack *tr, VikCoordMode dest_mode )
 312 {
 313   GList *iter = tr->trackpoints;
 314   while (iter)
 315   {
 316     vik_coord_convert ( &(VIK_TRACKPOINT(iter->data)->coord), dest_mode );
 317     iter = iter->next;
 318   }
 319 }
 320
 321 /* I understood this when I wrote it ... maybe ... Basically it eats up the
 322  * proper amounts of length on the track and averages elevation over that. */
 323 gdouble *vik_track_make_elevation_map ( const VikTrack *tr, guint16 num_chunks )
 324 {
 325   gdouble *pts;
 326   gdouble total_length, chunk_length, current_dist, current_area_under_curve, current_seg_length, dist_along_seg = 0.0;
 327   gdouble altitude1, altitude2;
 328   guint16 current_chunk;
 329   gboolean ignore_it = FALSE;
 330
 331   GList *iter = tr->trackpoints;
 332
 333   if (!iter || !iter->next) /* zero- or one-point track */
 334           return NULL;
 335
 336   { /* test if there's anything worth calculating */
 337     gboolean okay = FALSE;
 338     while ( iter )
 339     {
 340       if ( VIK_TRACKPOINT(iter->data)->altitude != VIK_DEFAULT_ALTITUDE ) {
 341         okay = TRUE; break;
 342       }
 343       iter = iter->next;
 344     }
 345     if ( ! okay )
 346       return NULL;
 347   }
 348
 349   iter = tr->trackpoints;
 350
 351   g_assert ( num_chunks < 16000 );
 352
 353   pts = g_malloc ( sizeof(gdouble) * num_chunks );
 354
 355   total_length = vik_track_get_length_including_gaps ( tr );
 356   chunk_length = total_length / num_chunks;
 357
 358   current_dist = 0.0;
 359   current_area_under_curve = 0;
 360   current_chunk = 0;
 361   current_seg_length = 0;
 362
 363   current_seg_length = vik_coord_diff ( &(VIK_TRACKPOINT(iter->data)->coord),
 364       &(VIK_TRACKPOINT(iter->next->data)->coord) );
 365   altitude1 = VIK_TRACKPOINT(iter->data)->altitude;
 366   altitude2 = VIK_TRACKPOINT(iter->next->data)->altitude;
 367   dist_along_seg = 0;
 368
 369   while ( current_chunk < num_chunks ) {
 370
 371     /* go along current seg */
 372     if ( current_seg_length && (current_seg_length - dist_along_seg) > chunk_length ) {
 373       dist_along_seg += chunk_length;
 374
 375       /*        /
 376        *   pt2 *
 377        *      /x       altitude = alt_at_pt_1 + alt_at_pt_2 / 2 = altitude1 + slope * dist_value_of_pt_inbetween_pt1_and_pt2
 378        *     /xx   avg altitude = area under curve / chunk len
 379        *pt1 *xxx   avg altitude = altitude1 + (altitude2-altitude1)/(current_seg_length)*(dist_along_seg + (chunk_len/2))
 380        *   / xxx
 381        *  /  xxx
 382        **/
 383
 384       if ( ignore_it )
 385         pts[current_chunk] = VIK_DEFAULT_ALTITUDE;
 386       else
 387         pts[current_chunk] = altitude1 + (altitude2-altitude1)*((dist_along_seg - (chunk_length/2))/current_seg_length);
 388
 389       current_chunk++;
 390     } else {
 391       /* finish current seg */
 392       if ( current_seg_length ) {
 393         gdouble altitude_at_dist_along_seg = altitude1 + (altitude2-altitude1)/(current_seg_length)*dist_along_seg;
 394         current_dist = current_seg_length - dist_along_seg;
 395         current_area_under_curve = current_dist*(altitude_at_dist_along_seg + altitude2)*0.5;
 396       } else { current_dist = current_area_under_curve = 0; } /* should only happen if first current_seg_length == 0 */
 397
 398       /* get intervening segs */
 399       iter = iter->next;
 400       while ( iter && iter->next ) {
 401         current_seg_length = vik_coord_diff ( &(VIK_TRACKPOINT(iter->data)->coord),
 402             &(VIK_TRACKPOINT(iter->next->data)->coord) );
 403         altitude1 = VIK_TRACKPOINT(iter->data)->altitude;
 404         altitude2 = VIK_TRACKPOINT(iter->next->data)->altitude;
 405         ignore_it = VIK_TRACKPOINT(iter->next->data)->newsegment;
 406
 407         if ( chunk_length - current_dist >= current_seg_length ) {
 408           current_dist += current_seg_length;
 409           current_area_under_curve += current_seg_length * (altitude1+altitude2) * 0.5;
 410           iter = iter->next;
 411         } else {
 412           break;
 413         }
 414       }
 415
 416       /* final seg */
 417       dist_along_seg = chunk_length - current_dist;
 418       if ( ignore_it || !iter->next ) {
 419         pts[current_chunk] = current_area_under_curve / current_dist;
 420       }
 421       else {
 422         current_area_under_curve += dist_along_seg * (altitude1 + (altitude2 - altitude1)*dist_along_seg/current_seg_length);
 423         pts[current_chunk] = current_area_under_curve / chunk_length;
 424       }
 425
 426       current_dist = 0;
 427       current_chunk++;
 428     }
 429   }
 430
 431   return pts;
 432 }
 433
 434
 435 void vik_track_get_total_elevation_gain(const VikTrack *tr, gdouble *up, gdouble *down)
 436 {
 437   gdouble diff;
 438   *up = *down = 0;
 439   if ( tr->trackpoints && VIK_TRACKPOINT(tr->trackpoints->data)->altitude != VIK_DEFAULT_ALTITUDE )
 440   {
 441     GList *iter = tr->trackpoints->next;
 442     while (iter)
 443     {
 444       diff = VIK_TRACKPOINT(iter->data)->altitude - VIK_TRACKPOINT(iter->prev->data)->altitude;
 445       if ( diff > 0 )
 446         *up += diff;
 447       else
 448         *down -= diff;
 449       iter = iter->next;
 450     }
 451   } else
 452     *up = *down = VIK_DEFAULT_ALTITUDE;
 453 }
 454
 455 typedef struct {
 456   double a, b, c, d;
 457 } spline_coeff_t;
 458
 459 void compute_spline(int n, double *x, double *f, spline_coeff_t *p)
 460 {
 461   double *h, *alpha, *B, *m;
 462   int i;
 463   int orig_n = n;
 464   double new_x[3], new_f[3];
 465
 466   if (n==0) return;
 467   if (n==1) {
 468     new_x[0] = x[0];
 469     new_f[0] = f[0];
 470     new_x[1] = x[0]+0.00001;
 471     new_f[1] = f[0];
 472     x = new_x;
 473     f = new_f;
 474     n = 3;
 475   }
 476   if (n==2) {
 477     new_x[0] = x[0];
 478     new_f[0] = f[0];
 479     new_x[1] = x[1];
 480     new_f[1] = f[1];
 481     new_x[2] = x[1] + x[1]-x[0];
 482     new_f[2] = f[1] + f[1]-f[0];
 483     x = new_x;
 484     f = new_f;
 485     n = 3;
 486   }
 487
 488   /* we're solving a linear system of equations of the form Ax = B.
 489    * The matrix a is tridiagonal and consists of coefficients in
 490    * the h[] and alpha[] arrays.
 491    */
 492
 493   h = (double *)malloc(sizeof(double) * (n-1));
 494   for (i=0; i<n-1; i++) {
 495     h[i] = x[i+1]-x[i];
 496   }
 497
 498   alpha = (double *)malloc(sizeof(double) * (n-2));
 499   for (i=0; i<n-2; i++) {
 500     alpha[i] = 2 * (h[i] + h[i+1]);
 501   }
 502
 503   /* B[] is the vector on the right hand side of the equation */
 504   B = (double *)malloc(sizeof(double) * (n-2));
 505   for (i=0; i<n-2; i++) {
 506     B[i] = 6 * ((f[i+2] - f[i+1])/h[i+1] - (f[i+1] - f[i])/h[i]);
 507   }
 508
 509   /* Now solve the n-2 by n-2 system */
 510   m = (double *)malloc(sizeof(double) * (n-2));
 511   for (i=1; i<=n-3; i++) {
 512     /*
 513     d0 = alpha 0
 514     a0 = h1
 515     c0 = h1
 516
 517       di = di - (ai-1 / di-1) * ci-1
 518       bi = bi - (ai-1 / di-1) * bi-1
 519       ;
 520     */
 521     alpha[i] = alpha[i] - (h[i]/alpha[i-1]) * h[i];
 522     B[i] = B[i] - (h[i]/alpha[i-1]) * B[i-1];
 523   }
 524   /*  xn-3 = bn-3 / dn-3; */
 525   m[n-3] = B[n-3]/alpha[n-3];
 526   for (i=n-4; i>=0; i--) {
 527     m[i] = (B[i]-h[i+1]*m[i+1])/alpha[i];
 528   }
 529
 530   for (i=0; i<orig_n-1; i++) {
 531     double mi, mi1;
 532     mi = (i==(n-2)) ? 0 : m[i];
 533     mi1 = (i==0) ? 0 : m[i-1];
 534
 535     p[i].a = f[i+1];
 536     p[i].b = (f[i+1] - f[i]) / h[i]  +  h[i] * (2*mi + mi1) / 6;
 537     p[i].c = mi/2;
 538     p[i].d = (mi-mi1)/(6*h[i]);
 539   }
 540
 541   free(alpha);
 542   free(B);
 543   free(h);
 544   free(m);
 545 }
 546
 547 /* by Alex Foobarian */
 548 gdouble *vik_track_make_speed_map ( const VikTrack *tr, guint16 num_chunks )
 549 {
 550   gdouble *v, *s, *t;
 551   gdouble duration, chunk_dur, T, s_prev, s_now;
 552   time_t t1, t2;
 553   int i, pt_count, numpts, spline;
 554   GList *iter;
 555   spline_coeff_t *p;
 556
 557   if ( ! tr->trackpoints )
 558     return NULL;
 559
 560   g_assert ( num_chunks < 16000 );
 561
 562 #ifdef XXXXXXXXXXXXXXXXXX
 563   iter = tr->trackpoints;
 564   while (iter) {
 565
 566   }
 567 #endif /*XXXXXXXXXXXXXXXXXX*/
 568
 569   t1 = VIK_TRACKPOINT(tr->trackpoints->data)->timestamp;
 570   t2 = VIK_TRACKPOINT(g_list_last(tr->trackpoints)->data)->timestamp;
 571   duration = t2 - t1;
 572
 573   if ( !t1 || !t2 || !duration )
 574     return NULL;
 575
 576   if (duration < 0) {
 577     g_warning("negative duration: unsorted trackpoint timestamps?\n");
 578     return NULL;
 579   }
 580   pt_count = vik_track_get_tp_count(tr);
 581
 582   v = g_malloc ( sizeof(gdouble) * num_chunks );
 583   chunk_dur = duration / num_chunks;
 584
 585   s = g_malloc(sizeof(double) * pt_count);
 586   t = g_malloc(sizeof(double) * pt_count);
 587   p = g_malloc(sizeof(spline_coeff_t) * (pt_count-1));
 588
 589   iter = tr->trackpoints->next;
 590   numpts = 0;
 591   s[0] = 0;
 592   t[0] = VIK_TRACKPOINT(iter->prev->data)->timestamp;
 593   numpts++;
 594   while (iter) {
 595     s[numpts] = s[numpts-1] + vik_coord_diff ( &(VIK_TRACKPOINT(iter->prev->data)->coord), &(VIK_TRACKPOINT(iter->data)->coord) );
 596     t[numpts] = VIK_TRACKPOINT(iter->data)->timestamp;
 597     numpts++;
 598     iter = iter->next;
 599   }
 600
 601   compute_spline(numpts, t, s, p);
 602
 603   /* the spline gives us distances at chunk_dur intervals. from these,
 604    * we obtain average speed in each interval.
 605    */
 606   spline = 0;
 607   T = t[spline];
 608   s_prev =
 609       p[spline].d * pow(T - t[spline+1], 3) +
 610       p[spline].c * pow(T - t[spline+1], 2) +
 611       p[spline].b * (T - t[spline+1]) +
 612       p[spline].a;
 613   for (i = 0; i < num_chunks; i++, T+=chunk_dur) {
 614     while (T > t[spline+1]) {
 615       spline++;
 616     }
 617     s_now =
 618       p[spline].d * pow(T - t[spline+1], 3) +
 619       p[spline].c * pow(T - t[spline+1], 2) +
 620       p[spline].b * (T - t[spline+1]) +
 621       p[spline].a;
 622     v[i] = (s_now - s_prev) / chunk_dur;
 623     s_prev = s_now;
 624     /*
 625      * old method of averages
 626     v[i] = (s[spline+1]-s[spline])/(t[spline+1]-t[spline]);
 627     */
 628   }
 629   g_free(s);
 630   g_free(t);
 631   g_free(p);
 632   return v;
 633 }
 634
 635 /* by Alex Foobarian */
 636 VikTrackpoint *vik_track_get_closest_tp_by_percentage_dist ( VikTrack *tr, gdouble reldist, gdouble *meters_from_start )
 637 {
 638   gdouble dist = vik_track_get_length_including_gaps(tr) * reldist;
 639   gdouble current_dist = 0.0;
 640   gdouble current_inc = 0.0;
 641   if ( tr->trackpoints )
 642   {
 643     GList *iter = tr->trackpoints->next;
 644     GList *last_iter = NULL;
 645     gdouble last_dist = 0.0;
 646     while (iter)
 647     {
 648       current_inc = vik_coord_diff ( &(VIK_TRACKPOINT(iter->data)->coord),
 649                                      &(VIK_TRACKPOINT(iter->prev->data)->coord) );
 650       last_dist = current_dist;
 651       current_dist += current_inc;
 652       if ( current_dist >= dist )
 653         break;
 654       last_iter = iter;
 655       iter = iter->next;
 656     }
 657     if (!iter) { /* passing the end the track */
 658       if (last_iter) {
 659         if (meters_from_start)
 660           *meters_from_start = last_dist;
 661         return(VIK_TRACKPOINT(last_iter->data));
 662       }
 663       else
 664         return NULL;
 665     }
 666     /* we've gone past the dist already, was prev trackpoint closer? */
 667     /* should do a vik_coord_average_weighted() thingy. */
 668     if ( iter->prev && abs(current_dist-current_inc-dist) < abs(current_dist-dist) ) {
 669       if (meters_from_start)
 670         *meters_from_start = last_dist;
 671       iter = iter->prev;
 672     }
 673     else
 674       if (meters_from_start)
 675         *meters_from_start = current_dist;
 676
 677     return VIK_TRACKPOINT(iter->data);
 678
 679   }
 680   return NULL;
 681 }
 682
 683 VikTrackpoint *vik_track_get_closest_tp_by_percentage_time ( VikTrack *tr, gdouble reltime, time_t *seconds_from_start )
 684 {
 685   time_t t_pos, t_start, t_end, t_total;
 686   t_start = VIK_TRACKPOINT(tr->trackpoints->data)->timestamp;
 687   t_end = VIK_TRACKPOINT(g_list_last(tr->trackpoints)->data)->timestamp;
 688   t_total = t_end - t_start;
 689
 690   t_pos = t_start + t_total * reltime;
 691
 692   if ( !tr->trackpoints )
 693     return NULL;
 694
 695   GList *iter = tr->trackpoints;
 696
 697   while (iter) {
 698     if (VIK_TRACKPOINT(iter->data)->timestamp == t_pos)
 699       break;
 700     if (VIK_TRACKPOINT(iter->data)->timestamp > t_pos) {
 701       if (iter->prev == NULL)  /* first trackpoint */
 702         break;
 703       time_t t_before = t_pos - VIK_TRACKPOINT(iter->prev)->timestamp;
 704       time_t t_after = VIK_TRACKPOINT(iter->data)->timestamp - t_pos;
 705       if (t_before <= t_after)
 706         iter = iter->prev;
 707       break;
 708     }
 709     else if ((iter->next == NULL) && (t_pos < (VIK_TRACKPOINT(iter->data)->timestamp + 3))) /* last trackpoint: accommodate for round-off */
 710       break;
 711     iter = iter->next;
 712   }
 713
 714   if (!iter)
 715     return NULL;
 716   if (seconds_from_start)
 717     *seconds_from_start = VIK_TRACKPOINT(iter->data)->timestamp - VIK_TRACKPOINT(tr->trackpoints->data)->timestamp;
 718   return VIK_TRACKPOINT(iter->data);
 719 }
 720
 721 gboolean vik_track_get_minmax_alt ( const VikTrack *tr, gdouble *min_alt, gdouble *max_alt )
 722 {
 723   *min_alt = 25000;
 724   *max_alt = -5000;
 725   if ( tr && tr->trackpoints && tr->trackpoints->data && (VIK_TRACKPOINT(tr->trackpoints->data)->altitude != VIK_DEFAULT_ALTITUDE) ) {
 726     GList *iter = tr->trackpoints->next;
 727     gdouble tmp_alt;
 728     while (iter)
 729     {
 730       tmp_alt = VIK_TRACKPOINT(iter->data)->altitude;
 731       if ( tmp_alt > *max_alt )
 732         *max_alt = tmp_alt;
 733       if ( tmp_alt < *min_alt )
 734         *min_alt = tmp_alt;
 735       iter = iter->next;
 736     }
 737     return TRUE;
 738   }
 739   return FALSE;
 740 }
 741
 742 void vik_track_marshall ( VikTrack *tr, guint8 **data, guint *datalen)
 743 {
 744   GList *tps;
 745   GByteArray *b = g_byte_array_new();
 746   guint len;
 747   guint intp, ntp;
 748
 749   g_byte_array_append(b, (guint8 *)tr, sizeof(*tr));
 750
 751   /* we'll fill out number of trackpoints later */
 752   intp = b->len;
 753   g_byte_array_append(b, (guint8 *)&len, sizeof(len));
 754
 755   tps = tr->trackpoints;
 756   ntp = 0;
 757   while (tps) {
 758     g_byte_array_append(b, (guint8 *)tps->data, sizeof(VikTrackpoint));
 759     tps = tps->next;
 760     ntp++;
 761   }
 762   *(guint *)(b->data + intp) = ntp;
 763
 764   len = (tr->comment) ? strlen(tr->comment)+1 : 0;
 765   g_byte_array_append(b, (guint8 *)&len, sizeof(len));
 766   if (tr->comment) g_byte_array_append(b, (guint8 *)tr->comment, len);
 767
 768   *data = b->data;
 769   *datalen = b->len;
 770   g_byte_array_free(b, FALSE);
 771 }
 772
 773 VikTrack *vik_track_unmarshall (guint8 *data, guint datalen)
 774 {
 775   guint len;
 776   VikTrack *new_tr = vik_track_new();
 777   VikTrackpoint *new_tp;
 778   guint ntp;
 779   gint i;
 780
 781   /* only the visibility is needed */
 782   new_tr->visible = ((VikTrack *)data)->visible;
 783   data += sizeof(*new_tr);
 784
 785   ntp = *(guint *)data;
 786   data += sizeof(ntp);
 787
 788   for (i=0; i<ntp; i++) {
 789     new_tp = vik_trackpoint_new();
 790     memcpy(new_tp, data, sizeof(*new_tp));
 791     data += sizeof(*new_tp);
 792     new_tr->trackpoints = g_list_append(new_tr->trackpoints, new_tp);
 793   }
 794
 795   len = *(guint *)data;
 796   data += sizeof(len);
 797   if (len) {
 798     new_tr->comment = g_strdup((gchar *)data);
 799   }
 800   return new_tr;
 801 }
 802
 803 void vik_track_apply_dem_data ( VikTrack *tr )
 804 {
 805   GList *tp_iter;
 806   gint16 elev;
 807   tp_iter = tr->trackpoints;
 808   while ( tp_iter ) {
 809     /* TODO: of the 4 possible choices we have for choosing an elevation
 810      * (trackpoint in between samples), choose the one with the least elevation change
 811      * as the last */
 812     elev = a_dems_get_elev_by_coord ( &(VIK_TRACKPOINT(tp_iter->data)->coord) );
 813     if ( elev != VIK_DEM_INVALID_ELEVATION )
 814       VIK_TRACKPOINT(tp_iter->data)->altitude = elev;
 815     tp_iter = tp_iter->next;
 816   }
 817 }
 818
 819 /* appends t2 to t1, leaving t2 with no trackpoints */
 820 void vik_track_steal_and_append_trackpoints ( VikTrack *t1, VikTrack *t2 )
 821 {
 822   if ( t1->trackpoints ) {
 823     GList *tpiter = t1->trackpoints;
 824     while ( tpiter->next )
 825       tpiter = tpiter->next;
 826     tpiter->next = t2->trackpoints;
 827     t2->trackpoints->prev = tpiter;
 828   } else
 829     t1->trackpoints = t2->trackpoints;
 830   t2->trackpoints = NULL;
 831 }
 832
 833 /* starting at the end, looks backwards for the last "double point", a duplicate trackpoint.
 834  * this is indicative of magic scissors continued use. If there is no double point,
 835  * deletes all the trackpoints. Returns the new end of the track (or the start if
 836  * there are no double points
 837  */
 838 VikCoord *vik_track_cut_back_to_double_point ( VikTrack *tr )
 839 {
 840   GList *iter = tr->trackpoints;
 841   VikCoord *rv;
 842
 843   if ( !iter )
 844     return NULL;
 845   while ( iter->next )
 846     iter = iter->next;
 847
 848
 849   while ( iter->prev ) {
 850     if ( vik_coord_equals((VikCoord *)iter->data, (VikCoord *)iter->prev->data) ) {
 851       GList *prev = iter->prev;
 852
 853       rv = g_malloc(sizeof(VikCoord));
 854       *rv = *((VikCoord *) iter->data);
 855
 856       /* truncate trackpoint list */
 857       iter->prev = NULL; /* pretend it's the end */
 858       g_list_foreach ( iter, (GFunc) g_free, NULL );
 859       g_list_free( iter );
 860
 861       prev->next = NULL;
 862
 863       return rv;
 864     }
 865     iter = iter->prev;
 866   }
 867
 868   /* no double point found! */
 869   rv = g_malloc(sizeof(VikCoord));
 870   *rv = *((VikCoord *) tr->trackpoints->data);
 871   g_list_foreach ( tr->trackpoints, (GFunc) g_free, NULL );
 872   g_list_free( tr->trackpoints );
 873   tr->trackpoints = NULL;
 874   return rv;
 875 }
 876