Modifications with the vision code
Small changes to the vision, should work now

NOTE: There is a crap-ton of things commented out. That was just for testing, be sure to uncomment it in future