diff --git a/armsrc/lfops.c b/armsrc/lfops.c index 9919df0f2..16e555739 100644 --- a/armsrc/lfops.c +++ b/armsrc/lfops.c @@ -1106,7 +1106,7 @@ void CmdIOdemodFSK(int findone, int *high, int *low, int ledcontrol) if (ledcontrol) LED_A_OFF(); *high=code; *low=code2; - return; + goto out; } code=code2=0; version=facilitycode=0; @@ -1115,6 +1115,8 @@ void CmdIOdemodFSK(int findone, int *high, int *low, int ledcontrol) WDT_HIT(); } +OUT: + FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF); DbpString("Stopped"); if (ledcontrol) LED_A_OFF(); }