pub const ORTHONORMAL_TOLERANCE: f64 = 1e-3;
How far from orthonormal (the largest entry of |R^T R - I|, or |det R - 1|) the rotation block of a target pose may be: within this it is re-orthonormalised, beyond it refused.
|R^T R - I|
|det R - 1|