RobotPickUp

Cleaned up code
MainRobot

testing made for RobotPickUp Class