Fix logic for S.Bus failsafe detection