Fixed more bugs, preliminary vision code complete
Tested vision; image acquisition and filtering works. Sorted out thresholding constants.