Fixed #17. Added RobotMap class