Use MMP to compute gradient of distance function and log map

[MarkGillespie]

This code adds helper functions to compute exact geodesic distance gradients & log maps with MMP, as well as adding const all over the place