fix: gimbal lock handling

Fix of current implementation of FromRotationMatrix which does not take into account gimbal lock cases which end up in wrong euler angles result.