Turn and forward controller working and tested