Create teleop_mode_2.c