Adding back my vision code. Removed sleeps.
Merge pull request #5 from kcarcia/vision

Adding back my vision code. Removed sleeps.