Ready to test teleop mode