Fixed deadlock when waiting for SFD to go low