AC_WPNav: bug fix for loiter and waypoint update rate

Thanks to EmileC for spotting this