velocity controller working, need some more testing