Added more todos and sample RobotMap code.