Update TeleOp.c

Backed out recent changes