arm: Fix APSR writes via M profile MSR