ARM: Fix FIQ code on VIVT CPUs