Rover: use EKF velocity for high rate ground_speed updates

this may give smoother throttle response when the EKF is enabled
AC_WPNav: bug fix for loiter and waypoint update rate

Thanks to EmileC for spotting this