Fixed Roller function in teleopFunctions.h, added kenTest1.c for testing motors/servos