fiq_fsm: Implement sof FIQ handler