AGV constant speed fix

\^0^/