Update SFMR code for RTZ mode