AC_WPNav: Use target yaw instead of current yaw for close waypoints
Copter: supply wp_nav with attitude_control