adding robomap class and adding some pid code to robot class