Added moveDone function for single_chain interface and RobotUtils for POSITION control type
Added getRobotName function