fiq_fsm: Add remainder of periodic FSM FIQ-side