AC_WPNav: bug fix sanity check of set_speed_xy

This corrects a bug that allowed the waypoint speed to be set to zero