spd_isometry_to_identity function

Isometry from tangent space at P to tangent space at identity