Merge pull request #22 from mlosch/master

Turn and forward controller working and tested
increase p for breaking. Decrease velocity. Send stop message