Bugfix: enforce SPDness of cov matrices.
Refactor to hoist logp_id computation where possible.

(speeds up all but geodesic and my distances.)