Use MRS/MSR instructions in assembler code v2

v2 patch for #53