spd_isometry_from_identity function

Reverse isometry from tangent space at identity to tangent space at P