LSS05 detection code and some logic

Simulate moving the robot and picking up a ball