Started implementing Fast Marching Method for computing geodesic distances.  Needs debuggin