Update RobotMap.cpp