WPNav: make get_stopping_point method public
Copter: bug fix for RTL bearing

Also smooth RTL's initial climb stage by projecting stopping point