Manual flight possible

Worked on IMU axis orientations. servo reversing.