Added TeleOp.c with new motor configuration