AC_WPNav:  bug fix to dt calculation
Copter: replace set_next_WP with direct call to wp_nav