AC_WPNav: set wp origin to horiz and vert stopping point

Also bug fix to set pos_control's down speed as a negative number
AC_AttControl: alternative get_stopping_point_z
Copter: control_rtl
Copter: integrate control_rtl
Copter: resolve conflict between control_auto, control_rtl states