publish debug message even if auto dock is not running
refactoring
leaning comments
Merge pull request #310 from yujinrobot/auto_dock_test

remove comments. Use more descriptive state definitions.