Update teleop.c

more debugging stuff