Vision Tracking Added

timer, some manipulator functions, and vision tracking commented out.
TODO: debug vision tracking, timer, and manipulators