Minor changes to teleop_wf.c