Cleaned up Teleop.c and Autonomous.c, added AutoFunctions.h, and testMotorEncoders.c