telemetry_switch: fixed condition when using softserial