Getting vision worked in.

preliminary vision commit. copied in vision stuff from last year.
getting ready to modify it for the 1114/987 method.
Will use vision to adjust arm angle when operator requests a lock.