Copter: split up loiter into 4 steps

Reduces disruption to the main loop but also introduces a delay of 30ms
to navigation output