diff --git a/librfm69.c b/librfm69.c index f01b21e..b8f1be2 100644 --- a/librfm69.c +++ b/librfm69.c @@ -259,14 +259,16 @@ // wait until "PayloadReady" or (forced) "Timeout" do {} while (!payloadReady && !timeout); - timeoutEnable(false); - setMode(RFM_MODE_STDBY); if (timeout) { + timeoutEnable(false); + return 0; } + timeoutEnable(false); + return rfmReadPayload(payload, size); }