fix errors found by roslaunch unit test (#10)