Added Vision Tracking Code

Also, figured out function usage