Test controller working, preparing for robot testing.