teleoperation function modification

compiles
untested