coordinatorRobotID and inGoalPose were set accordingly in readConfigFile fnction