bugfixes in turn controller and some debug output for testing
expose two parameters to parameter server
calibration on kobuki, add d term, refine stop conditions