Rewrote tracking code to account for focal length and other random stuff.
Merge branch 'master' of https://github.com/HighlandersFRC/2013-java.git