Sorry, I guess I am not observant enough, I see you posted your code.
Question: Why are you using
Watchdog? It is disabled by default and its function has basically been replaced by the motor safety stuff put in in 2011 (I think that was the year).
I believe that I found the problem as well. It appears that your teleoperated code only runs once, instead of in a loop.
Try doing it like this:
Code:
while(isOperatorControl()) {
... Business code ...
}
Your motors need to be updated constantly to actually use the robot. If you want the functionality provided up there ^^^, look into
IterativeRobot instead of
SimpleRobot. It automatically loops
teleopPeriodic().
Hopefully that helps.