Mostly completed a teleop drive command