| /* |
| * Copyright 2007-2009 Analog Devices Inc. |
| * |
| * Licensed under the GPL-2 or later. |
| */ |
| |
| /* |
| * NOTE! The single-stepping code assumes that all interrupt handlers |
| * start by saving SYSCFG on the stack with their first instruction. |
| */ |
| |
| /* |
| * Code to save processor context. |
| * We even save the register which are preserved by a function call |
| * - r4, r5, r6, r7, p3, p4, p5 |
| */ |
| .macro save_context_with_interrupts |
| [--sp] = SYSCFG; |
| |
| [--sp] = P0; /*orig_p0*/ |
| [--sp] = R0; /*orig_r0*/ |
| |
| [--sp] = ( R7:0, P5:0 ); |
| [--sp] = fp; |
| [--sp] = usp; |
| |
| [--sp] = i0; |
| [--sp] = i1; |
| [--sp] = i2; |
| [--sp] = i3; |
| |
| [--sp] = m0; |
| [--sp] = m1; |
| [--sp] = m2; |
| [--sp] = m3; |
| |
| [--sp] = l0; |
| [--sp] = l1; |
| [--sp] = l2; |
| [--sp] = l3; |
| |
| [--sp] = b0; |
| [--sp] = b1; |
| [--sp] = b2; |
| [--sp] = b3; |
| [--sp] = a0.x; |
| [--sp] = a0.w; |
| [--sp] = a1.x; |
| [--sp] = a1.w; |
| |
| [--sp] = LC0; |
| [--sp] = LC1; |
| [--sp] = LT0; |
| [--sp] = LT1; |
| [--sp] = LB0; |
| [--sp] = LB1; |
| |
| [--sp] = ASTAT; |
| |
| [--sp] = r0; /* Skip reserved */ |
| [--sp] = RETS; |
| r0 = RETI; |
| [--sp] = r0; |
| [--sp] = RETX; |
| [--sp] = RETN; |
| [--sp] = RETE; |
| [--sp] = SEQSTAT; |
| [--sp] = r0; /* Skip IPEND as well. */ |
| /* Switch to other method of keeping interrupts disabled. */ |
| #ifdef CONFIG_DEBUG_HWERR |
| r0 = 0x3f; |
| sti r0; |
| #else |
| cli r0; |
| #endif |
| [--sp] = RETI; /*orig_pc*/ |
| /* Clear all L registers. */ |
| r0 = 0 (x); |
| l0 = r0; |
| l1 = r0; |
| l2 = r0; |
| l3 = r0; |
| .endm |
| |
| .macro save_context_syscall |
| [--sp] = SYSCFG; |
| |
| [--sp] = P0; /*orig_p0*/ |
| [--sp] = R0; /*orig_r0*/ |
| [--sp] = ( R7:0, P5:0 ); |
| [--sp] = fp; |
| [--sp] = usp; |
| |
| [--sp] = i0; |
| [--sp] = i1; |
| [--sp] = i2; |
| [--sp] = i3; |
| |
| [--sp] = m0; |
| [--sp] = m1; |
| [--sp] = m2; |
| [--sp] = m3; |
| |
| [--sp] = l0; |
| [--sp] = l1; |
| [--sp] = l2; |
| [--sp] = l3; |
| |
| [--sp] = b0; |
| [--sp] = b1; |
| [--sp] = b2; |
| [--sp] = b3; |
| [--sp] = a0.x; |
| [--sp] = a0.w; |
| [--sp] = a1.x; |
| [--sp] = a1.w; |
| |
| [--sp] = LC0; |
| [--sp] = LC1; |
| [--sp] = LT0; |
| [--sp] = LT1; |
| [--sp] = LB0; |
| [--sp] = LB1; |
| |
| [--sp] = ASTAT; |
| |
| [--sp] = r0; /* Skip reserved */ |
| [--sp] = RETS; |
| r0 = RETI; |
| [--sp] = r0; |
| [--sp] = RETX; |
| [--sp] = RETN; |
| [--sp] = RETE; |
| [--sp] = SEQSTAT; |
| [--sp] = r0; /* Skip IPEND as well. */ |
| [--sp] = RETI; /*orig_pc*/ |
| /* Clear all L registers. */ |
| r0 = 0 (x); |
| l0 = r0; |
| l1 = r0; |
| l2 = r0; |
| l3 = r0; |
| .endm |
| |
| .macro save_context_no_interrupts |
| [--sp] = SYSCFG; |
| [--sp] = P0; /* orig_p0 */ |
| [--sp] = R0; /* orig_r0 */ |
| [--sp] = ( R7:0, P5:0 ); |
| [--sp] = fp; |
| [--sp] = usp; |
| |
| [--sp] = i0; |
| [--sp] = i1; |
| [--sp] = i2; |
| [--sp] = i3; |
| |
| [--sp] = m0; |
| [--sp] = m1; |
| [--sp] = m2; |
| [--sp] = m3; |
| |
| [--sp] = l0; |
| [--sp] = l1; |
| [--sp] = l2; |
| [--sp] = l3; |
| |
| [--sp] = b0; |
| [--sp] = b1; |
| [--sp] = b2; |
| [--sp] = b3; |
| [--sp] = a0.x; |
| [--sp] = a0.w; |
| [--sp] = a1.x; |
| [--sp] = a1.w; |
| |
| [--sp] = LC0; |
| [--sp] = LC1; |
| [--sp] = LT0; |
| [--sp] = LT1; |
| [--sp] = LB0; |
| [--sp] = LB1; |
| |
| [--sp] = ASTAT; |
| |
| #ifdef CONFIG_KGDB |
| fp = 0(Z); |
| r1 = sp; |
| r1 += 60; |
| r1 += 60; |
| r1 += 60; |
| [--sp] = r1; |
| #else |
| [--sp] = r0; /* Skip reserved */ |
| #endif |
| [--sp] = RETS; |
| r0 = RETI; |
| [--sp] = r0; |
| [--sp] = RETX; |
| [--sp] = RETN; |
| [--sp] = RETE; |
| [--sp] = SEQSTAT; |
| #ifdef CONFIG_DEBUG_KERNEL |
| p1.l = lo(IPEND); |
| p1.h = hi(IPEND); |
| r1 = [p1]; |
| [--sp] = r1; |
| #else |
| [--sp] = r0; /* Skip IPEND as well. */ |
| #endif |
| [--sp] = r0; /*orig_pc*/ |
| /* Clear all L registers. */ |
| r0 = 0 (x); |
| l0 = r0; |
| l1 = r0; |
| l2 = r0; |
| l3 = r0; |
| .endm |
| |
| .macro restore_context_no_interrupts |
| sp += 4; /* Skip orig_pc */ |
| sp += 4; /* Skip IPEND */ |
| SEQSTAT = [sp++]; |
| RETE = [sp++]; |
| RETN = [sp++]; |
| RETX = [sp++]; |
| r0 = [sp++]; |
| RETI = r0; /* Restore RETI indirectly when in exception */ |
| RETS = [sp++]; |
| |
| sp += 4; /* Skip Reserved */ |
| |
| ASTAT = [sp++]; |
| |
| LB1 = [sp++]; |
| LB0 = [sp++]; |
| LT1 = [sp++]; |
| LT0 = [sp++]; |
| LC1 = [sp++]; |
| LC0 = [sp++]; |
| |
| a1.w = [sp++]; |
| a1.x = [sp++]; |
| a0.w = [sp++]; |
| a0.x = [sp++]; |
| b3 = [sp++]; |
| b2 = [sp++]; |
| b1 = [sp++]; |
| b0 = [sp++]; |
| |
| l3 = [sp++]; |
| l2 = [sp++]; |
| l1 = [sp++]; |
| l0 = [sp++]; |
| |
| m3 = [sp++]; |
| m2 = [sp++]; |
| m1 = [sp++]; |
| m0 = [sp++]; |
| |
| i3 = [sp++]; |
| i2 = [sp++]; |
| i1 = [sp++]; |
| i0 = [sp++]; |
| |
| sp += 4; |
| fp = [sp++]; |
| |
| ( R7 : 0, P5 : 0) = [ SP ++ ]; |
| sp += 8; /* Skip orig_r0/orig_p0 */ |
| SYSCFG = [sp++]; |
| .endm |
| |
| .macro restore_context_with_interrupts |
| sp += 4; /* Skip orig_pc */ |
| sp += 4; /* Skip IPEND */ |
| SEQSTAT = [sp++]; |
| RETE = [sp++]; |
| RETN = [sp++]; |
| RETX = [sp++]; |
| RETI = [sp++]; |
| RETS = [sp++]; |
| |
| #ifdef CONFIG_SMP |
| GET_PDA(p0, r0); |
| r0 = [p0 + PDA_IRQFLAGS]; |
| #else |
| p0.h = _bfin_irq_flags; |
| p0.l = _bfin_irq_flags; |
| r0 = [p0]; |
| #endif |
| sti r0; |
| |
| sp += 4; /* Skip Reserved */ |
| |
| ASTAT = [sp++]; |
| |
| LB1 = [sp++]; |
| LB0 = [sp++]; |
| LT1 = [sp++]; |
| LT0 = [sp++]; |
| LC1 = [sp++]; |
| LC0 = [sp++]; |
| |
| a1.w = [sp++]; |
| a1.x = [sp++]; |
| a0.w = [sp++]; |
| a0.x = [sp++]; |
| b3 = [sp++]; |
| b2 = [sp++]; |
| b1 = [sp++]; |
| b0 = [sp++]; |
| |
| l3 = [sp++]; |
| l2 = [sp++]; |
| l1 = [sp++]; |
| l0 = [sp++]; |
| |
| m3 = [sp++]; |
| m2 = [sp++]; |
| m1 = [sp++]; |
| m0 = [sp++]; |
| |
| i3 = [sp++]; |
| i2 = [sp++]; |
| i1 = [sp++]; |
| i0 = [sp++]; |
| |
| sp += 4; |
| fp = [sp++]; |
| |
| ( R7 : 0, P5 : 0) = [ SP ++ ]; |
| sp += 8; /* Skip orig_r0/orig_p0 */ |
| csync; |
| SYSCFG = [sp++]; |
| csync; |
| .endm |
| |
| .macro save_context_cplb |
| [--sp] = (R7:0, P5:0); |
| [--sp] = fp; |
| |
| [--sp] = a0.x; |
| [--sp] = a0.w; |
| [--sp] = a1.x; |
| [--sp] = a1.w; |
| |
| [--sp] = LC0; |
| [--sp] = LC1; |
| [--sp] = LT0; |
| [--sp] = LT1; |
| [--sp] = LB0; |
| [--sp] = LB1; |
| |
| [--sp] = RETS; |
| .endm |
| |
| .macro restore_context_cplb |
| RETS = [sp++]; |
| |
| LB1 = [sp++]; |
| LB0 = [sp++]; |
| LT1 = [sp++]; |
| LT0 = [sp++]; |
| LC1 = [sp++]; |
| LC0 = [sp++]; |
| |
| a1.w = [sp++]; |
| a1.x = [sp++]; |
| a0.w = [sp++]; |
| a0.x = [sp++]; |
| |
| fp = [sp++]; |
| |
| (R7:0, P5:0) = [SP++]; |
| .endm |
| |
| .macro pseudo_long_call func:req, scratch:req |
| #ifdef CONFIG_ROMKERNEL |
| \scratch\().l = \func; |
| \scratch\().h = \func; |
| call (\scratch); |
| #else |
| call \func; |
| #endif |
| .endm |