Dumbed down test code and fixed it up.
Moved sensor tests into a dedicated function.
Added more prints to the Driver station LCD for the Test function.

Added some comments
Added another TODO.

Increased size of PI constant in RobotVision just in case we needed it to 40 decimal places.

Canonicalized cross-class object names.  Makes it easier to code if all of the "talonKickerLeft"'s are all the same name in all classes.