Cleaned up code and changed constants to #define fields
not yet tested on robot/compliation
	modified:   Teleop.c