Adjusted for new disabled mode and teleop mode