Copter: leonard's inav2

Moved loiter controller to navigation.pde