Velocity control working much better now