Updated Teleop to current state