Week 2 Update - Testing the vision algorithm

The vision algorithm searches for the next ripe spear using a combination of colour and contour matching. This vision program runs in real time on a Raspberry Pi. The outputs of this program are the distance along the row to the next spear and the depth into the row to the next spear. The distance is used in a proportional control loop to control the drive speed and the depth is used as a reference position for extending the arm.