fiq_fsm: fix queueing bug for fsm_mask=0x3