microblaze: Remove nop after MSRCLR/SET, MTS, MFS instructions
We need to save instruction and the latest Microblaze shouldn't have any problem with it. Signed-off-by: Michal Simek <monstr@monstr.eu>
This commit is contained in:
Michal Simek
Родитель
0e41c90908
Коммит
958063e67b
|
|
@ -49,138 +49,106 @@
|
|||
#if CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR
|
||||
.macro clear_bip
|
||||
msrclr r0, MSR_BIP
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_bip
|
||||
msrset r0, MSR_BIP
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro clear_eip
|
||||
msrclr r0, MSR_EIP
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_ee
|
||||
msrset r0, MSR_EE
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro disable_irq
|
||||
msrclr r0, MSR_IE
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro enable_irq
|
||||
msrset r0, MSR_IE
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_ums
|
||||
msrset r0, MSR_UMS
|
||||
nop
|
||||
msrclr r0, MSR_VMS
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_vms
|
||||
msrclr r0, MSR_UMS
|
||||
nop
|
||||
msrset r0, MSR_VMS
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro clear_ums
|
||||
msrclr r0, MSR_UMS
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro clear_vms_ums
|
||||
msrclr r0, MSR_VMS | MSR_UMS
|
||||
nop
|
||||
.endm
|
||||
#else
|
||||
.macro clear_bip
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
andi r11, r11, ~MSR_BIP
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_bip
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
ori r11, r11, MSR_BIP
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro clear_eip
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
andi r11, r11, ~MSR_EIP
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_ee
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
ori r11, r11, MSR_EE
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro disable_irq
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
andi r11, r11, ~MSR_IE
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro enable_irq
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
ori r11, r11, MSR_IE
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_ums
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
ori r11, r11, MSR_VMS
|
||||
andni r11, r11, MSR_UMS
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro set_vms
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
ori r11, r11, MSR_VMS
|
||||
andni r11, r11, MSR_UMS
|
||||
mts rmsr, r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro clear_ums
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
andni r11, r11, MSR_UMS
|
||||
mts rmsr,r11
|
||||
nop
|
||||
.endm
|
||||
|
||||
.macro clear_vms_ums
|
||||
mfs r11, rmsr
|
||||
nop
|
||||
andni r11, r11, (MSR_VMS|MSR_UMS)
|
||||
mts rmsr,r11
|
||||
nop
|
||||
.endm
|
||||
#endif
|
||||
|
||||
|
|
@ -233,13 +201,11 @@
|
|||
swi r30, r1, PTO+PT_R30; \
|
||||
swi r31, r1, PTO+PT_R31; /* Save current task reg */ \
|
||||
mfs r11, rmsr; /* save MSR */ \
|
||||
nop; \
|
||||
swi r11, r1, PTO+PT_MSR;
|
||||
|
||||
#define RESTORE_REGS \
|
||||
lwi r11, r1, PTO+PT_MSR; \
|
||||
mts rmsr , r11; \
|
||||
nop; \
|
||||
lwi r2, r1, PTO+PT_R2; /* restore SDA */ \
|
||||
lwi r3, r1, PTO+PT_R3; \
|
||||
lwi r4, r1, PTO+PT_R4; \
|
||||
|
|
@ -273,7 +239,6 @@
|
|||
swi r1, r0, TOPHYS(PER_CPU(ENTRY_SP)); /* save stack */ \
|
||||
/* See if already in kernel mode.*/ \
|
||||
mfs r1, rmsr; \
|
||||
nop; \
|
||||
andi r1, r1, MSR_UMS; \
|
||||
bnei r1, 1f; \
|
||||
/* Kernel-mode state save. */ \
|
||||
|
|
@ -518,11 +483,8 @@ C_ENTRY(full_exception_trap):
|
|||
/* where the trap should return need -8 to adjust for rtsd r15, 8 */
|
||||
addik r15, r0, ret_from_exc - 8
|
||||
mfs r6, resr
|
||||
nop
|
||||
mfs r7, rfsr; /* save FSR */
|
||||
nop
|
||||
mts rfsr, r0; /* Clear sticky fsr */
|
||||
nop
|
||||
rted r0, full_exception
|
||||
addik r5, r1, PTO /* parameter struct pt_regs * regs */
|
||||
|
||||
|
|
@ -555,9 +517,7 @@ C_ENTRY(unaligned_data_trap):
|
|||
/* where the trap should return need -8 to adjust for rtsd r15, 8 */
|
||||
addik r15, r0, ret_from_exc-8
|
||||
mfs r3, resr /* ESR */
|
||||
nop
|
||||
mfs r4, rear /* EAR */
|
||||
nop
|
||||
rtbd r0, _unaligned_data_exception
|
||||
addik r7, r1, PTO /* parameter struct pt_regs * regs */
|
||||
|
||||
|
|
@ -587,9 +547,7 @@ C_ENTRY(page_fault_data_trap):
|
|||
/* where the trap should return need -8 to adjust for rtsd r15, 8 */
|
||||
addik r15, r0, ret_from_exc-8
|
||||
mfs r6, rear /* parameter unsigned long address */
|
||||
nop
|
||||
mfs r7, resr /* parameter unsigned long error_code */
|
||||
nop
|
||||
rted r0, do_page_fault
|
||||
addik r5, r1, PTO /* parameter struct pt_regs * regs */
|
||||
|
||||
|
|
@ -601,7 +559,6 @@ C_ENTRY(page_fault_instr_trap):
|
|||
/* where the trap should return need -8 to adjust for rtsd r15, 8 */
|
||||
addik r15, r0, ret_from_exc-8
|
||||
mfs r6, rear /* parameter unsigned long address */
|
||||
nop
|
||||
ori r7, r0, 0 /* parameter unsigned long error_code */
|
||||
rted r0, do_page_fault
|
||||
addik r5, r1, PTO /* parameter struct pt_regs * regs */
|
||||
|
|
@ -936,16 +893,12 @@ ENTRY(_switch_to)
|
|||
swi r30, r11, CC_R30
|
||||
/* special purpose registers */
|
||||
mfs r12, rmsr
|
||||
nop
|
||||
swi r12, r11, CC_MSR
|
||||
mfs r12, rear
|
||||
nop
|
||||
swi r12, r11, CC_EAR
|
||||
mfs r12, resr
|
||||
nop
|
||||
swi r12, r11, CC_ESR
|
||||
mfs r12, rfsr
|
||||
nop
|
||||
swi r12, r11, CC_FSR
|
||||
|
||||
/* update r31, the current-give me pointer to task which will be next */
|
||||
|
|
@ -984,10 +937,8 @@ ENTRY(_switch_to)
|
|||
/* special purpose registers */
|
||||
lwi r12, r11, CC_FSR
|
||||
mts rfsr, r12
|
||||
nop
|
||||
lwi r12, r11, CC_MSR
|
||||
mts rmsr, r12
|
||||
nop
|
||||
|
||||
rtsd r15, 8
|
||||
nop
|
||||
|
|
@ -997,10 +948,8 @@ ENTRY(_reset)
|
|||
|
||||
ENTRY(_break)
|
||||
mfs r5, rmsr
|
||||
nop
|
||||
swi r5, r0, 0x250 + TOPHYS(r0_ram)
|
||||
mfs r5, resr
|
||||
nop
|
||||
swi r5, r0, 0x254 + TOPHYS(r0_ram)
|
||||
bri 0
|
||||
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче