Fix SO3 initialisation and update more non_const access to unit_quaternion.