adding robomap class and adding some pid code to robot class
adding pid work
merge