increase p for breaking. Decrease velocity. Send stop message
Merge pull request #23 from mlosch/master

increase p for breaking. Decrease velocity. Send stop message