Minor cleanup

-AndyB
Added Limit Switch
CLeaned up code

-AndyB
Added code to turn on LED for vision
-KA RP
assorted cleanup