Added to and organized vision

organized the methods in vision and added ballcentered methods. Also
made encoder methods in drivetrain more accurate, because they were
sending encoder COUNTS instead of DISTANCE, so I changed the method
names.