Vision update

Now tracks 2 targets. A lot of noise in the image due to classroom
setting. Still working on the angles.