Added new autonomous vision code and reorganized old vision code (not sure if still needed)
Added new autonomous vision code and reorganized old vision code (not sure if still needed)