[control station] fixes some bugs and add stopRobot