Finished Vision Code

Still requires minor fixes, but the bulk of the code is complete.