Avoiding unnecassy declarations.
Temlating the cost functors.
Adding custom cache for torsion
Unifying point struct.
Making all functors compatible.
Geodesic length local optimization.
Adding unit tests
Adding a shortest path on a surface example.