Vision test code.

Added vision test command and auton routine for calibrating vision on
the field.