Added pick up code and solenoid methods. Also updated RobotMain code.