192fca209SWei Huang /* 292fca209SWei Huang * Ripped off from arch/arm64/include/asm/sysreg.h 392fca209SWei Huang * 492fca209SWei Huang * Copyright (C) 2016, Red Hat Inc, Andrew Jones <drjones@redhat.com> 592fca209SWei Huang * 692fca209SWei Huang * This work is licensed under the terms of the GNU LGPL, version 2. 792fca209SWei Huang */ 892fca209SWei Huang #ifndef _ASMARM64_SYSREG_H_ 992fca209SWei Huang #define _ASMARM64_SYSREG_H_ 1092fca209SWei Huang 11*91a6c3ceSAndrew Jones #define sys_reg(op0, op1, crn, crm, op2) \ 12*91a6c3ceSAndrew Jones ((((op0)&3)<<19)|((op1)<<16)|((crn)<<12)|((crm)<<8)|((op2)<<5)) 13*91a6c3ceSAndrew Jones 14*91a6c3ceSAndrew Jones #ifdef __ASSEMBLY__ 15*91a6c3ceSAndrew Jones .irp num,0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30 16*91a6c3ceSAndrew Jones .equ .L__reg_num_x\num, \num 17*91a6c3ceSAndrew Jones .endr 18*91a6c3ceSAndrew Jones .equ .L__reg_num_xzr, 31 19*91a6c3ceSAndrew Jones 20*91a6c3ceSAndrew Jones .macro mrs_s, rt, sreg 21*91a6c3ceSAndrew Jones .inst 0xd5200000|(\sreg)|(.L__reg_num_\rt) 22*91a6c3ceSAndrew Jones .endm 23*91a6c3ceSAndrew Jones 24*91a6c3ceSAndrew Jones .macro msr_s, sreg, rt 25*91a6c3ceSAndrew Jones .inst 0xd5000000|(\sreg)|(.L__reg_num_\rt) 26*91a6c3ceSAndrew Jones .endm 27*91a6c3ceSAndrew Jones #else 2892fca209SWei Huang #include <libcflat.h> 2992fca209SWei Huang 3092fca209SWei Huang #define read_sysreg(r) ({ \ 3192fca209SWei Huang u64 __val; \ 3292fca209SWei Huang asm volatile("mrs %0, " xstr(r) : "=r" (__val)); \ 3392fca209SWei Huang __val; \ 3492fca209SWei Huang }) 3592fca209SWei Huang 3692fca209SWei Huang #define write_sysreg(v, r) do { \ 3792fca209SWei Huang u64 __val = (u64)v; \ 3892fca209SWei Huang asm volatile("msr " xstr(r) ", %x0" : : "rZ" (__val)); \ 3992fca209SWei Huang } while (0) 4092fca209SWei Huang 41*91a6c3ceSAndrew Jones asm( 42*91a6c3ceSAndrew Jones " .irp num,0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30\n" 43*91a6c3ceSAndrew Jones " .equ .L__reg_num_x\\num, \\num\n" 44*91a6c3ceSAndrew Jones " .endr\n" 45*91a6c3ceSAndrew Jones " .equ .L__reg_num_xzr, 31\n" 46*91a6c3ceSAndrew Jones "\n" 47*91a6c3ceSAndrew Jones " .macro mrs_s, rt, sreg\n" 48*91a6c3ceSAndrew Jones " .inst 0xd5200000|(\\sreg)|(.L__reg_num_\\rt)\n" 49*91a6c3ceSAndrew Jones " .endm\n" 50*91a6c3ceSAndrew Jones "\n" 51*91a6c3ceSAndrew Jones " .macro msr_s, sreg, rt\n" 52*91a6c3ceSAndrew Jones " .inst 0xd5000000|(\\sreg)|(.L__reg_num_\\rt)\n" 53*91a6c3ceSAndrew Jones " .endm\n" 54*91a6c3ceSAndrew Jones ); 55*91a6c3ceSAndrew Jones #endif /* __ASSEMBLY__ */ 5692fca209SWei Huang #endif /* _ASMARM64_SYSREG_H_ */ 57