fixed proportional velocity control!