pub fn so2_log(rotation: &Matrix2<f64>) -> f64
Logarithm map from SO(2) to so(2), returning an angle in [-pi, pi].
[-pi, pi]