AC_PosControl: add init take-off
Copter: integrate init take-off