1 files changed, 162 insertions, 0 deletions

diff --git a/arch/sparc/kernel/trampoline.S b/arch/sparc/kernel/trampoline.S
new file mode 100644
index 000000000000..2dcdaa1fd8cd
--- /dev/null
+++ b/arch/sparc/kernel/trampoline.S
@@ -0,0 +1,162 @@
+/* $Id: trampoline.S,v 1.14 2002/01/11 08:45:38 davem Exp $
+ * trampoline.S: SMP cpu boot-up trampoline code.
+ *
+ * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
+ * Copyright (C) 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
+ */
+
+#include <linux/init.h>
+#include <asm/head.h>
+#include <asm/psr.h>
+#include <asm/page.h>
+#include <asm/asi.h>
+#include <asm/ptrace.h>
+#include <asm/vaddrs.h>
+#include <asm/contregs.h>
+#include <asm/thread_info.h>
+
+        .globl sun4m_cpu_startup, __smp4m_processor_id
+        .globl sun4d_cpu_startup, __smp4d_processor_id
+
+        __INIT
+        .align 4
+
+/* When we start up a cpu for the first time it enters this routine.
+ * This initializes the chip from whatever state the prom left it
+ * in and sets PIL in %psr to 15, no irqs.
+ */
+
+sun4m_cpu_startup:
+cpu1_startup:
+        sethi   %hi(trapbase_cpu1), %g3
+        b       1f
+         or     %g3, %lo(trapbase_cpu1), %g3
+
+cpu2_startup:
+        sethi   %hi(trapbase_cpu2), %g3
+        b       1f
+         or     %g3, %lo(trapbase_cpu2), %g3
+
+cpu3_startup:
+        sethi   %hi(trapbase_cpu3), %g3
+        b       1f
+         or     %g3, %lo(trapbase_cpu3), %g3
+
+1:
+        /* Set up a sane %psr -- PIL<0xf> S<0x1> PS<0x1> CWP<0x0> */
+        set     (PSR_PIL | PSR_S | PSR_PS), %g1
+        wr      %g1, 0x0, %psr          ! traps off though
+        WRITE_PAUSE
+
+        /* Our %wim is one behind CWP */
+        mov     2, %g1
+        wr      %g1, 0x0, %wim
+        WRITE_PAUSE
+
+        /* This identifies "this cpu". */
+        wr      %g3, 0x0, %tbr
+        WRITE_PAUSE
+
+        /* Give ourselves a stack and curptr. */
+        set     current_set, %g5
+        srl     %g3, 10, %g4
+        and     %g4, 0xc, %g4
+        ld      [%g5 + %g4], %g6
+
+        sethi   %hi(THREAD_SIZE - STACKFRAME_SZ), %sp
+        or      %sp, %lo(THREAD_SIZE - STACKFRAME_SZ), %sp
+        add     %g6, %sp, %sp
+
+        /* Turn on traps (PSR_ET). */
+        rd      %psr, %g1
+        wr      %g1, PSR_ET, %psr       ! traps on
+        WRITE_PAUSE
+
+        /* Init our caches, etc. */
+        set     poke_srmmu, %g5
+        ld      [%g5], %g5
+        call    %g5
+         nop
+
+        /* Start this processor. */
+        call    smp4m_callin
+         nop
+
+        b,a     smp_do_cpu_idle
+
+        .text
+        .align  4
+
+smp_do_cpu_idle:
+        call    cpu_idle
+         mov    0, %o0
+
+        call    cpu_panic
+         nop
+
+__smp4m_processor_id:
+        rd      %tbr, %g2
+        srl     %g2, 12, %g2
+        and     %g2, 3, %g2
+        retl
+         mov    %g1, %o7
+
+__smp4d_processor_id:
+        lda     [%g0] ASI_M_VIKING_TMP1, %g2
+        retl
+         mov    %g1, %o7
+
+/* CPUID in bootbus can be found at PA 0xff0140000 */
+#define SUN4D_BOOTBUS_CPUID     0xf0140000
+
+        __INIT
+        .align  4
+
+sun4d_cpu_startup:
+        /* Set up a sane %psr -- PIL<0xf> S<0x1> PS<0x1> CWP<0x0> */
+        set     (PSR_PIL | PSR_S | PSR_PS), %g1
+        wr      %g1, 0x0, %psr          ! traps off though
+        WRITE_PAUSE
+
+        /* Our %wim is one behind CWP */
+        mov     2, %g1
+        wr      %g1, 0x0, %wim
+        WRITE_PAUSE
+
+        /* Set tbr - we use just one trap table. */
+        set     trapbase, %g1
+        wr      %g1, 0x0, %tbr
+        WRITE_PAUSE
+
+        /* Get our CPU id out of bootbus */
+        set     SUN4D_BOOTBUS_CPUID, %g3
+        lduba   [%g3] ASI_M_CTL, %g3
+        and     %g3, 0xf8, %g3
+        srl     %g3, 3, %g1
+        sta     %g1, [%g0] ASI_M_VIKING_TMP1
+
+        /* Give ourselves a stack and curptr. */
+        set     current_set, %g5
+        srl     %g3, 1, %g4
+        ld      [%g5 + %g4], %g6
+
+        sethi   %hi(THREAD_SIZE - STACKFRAME_SZ), %sp
+        or      %sp, %lo(THREAD_SIZE - STACKFRAME_SZ), %sp
+        add     %g6, %sp, %sp
+
+        /* Turn on traps (PSR_ET). */
+        rd      %psr, %g1
+        wr      %g1, PSR_ET, %psr       ! traps on
+        WRITE_PAUSE
+
+        /* Init our caches, etc. */
+        set     poke_srmmu, %g5
+        ld      [%g5], %g5
+        call    %g5
+         nop
+
+        /* Start this processor. */
+        call    smp4d_callin
+         nop
+
+        b,a     smp_do_cpu_idle