[DEV] Third rewrite of linear velocity control