/* * * This file is subject to the terms and conditions of the GNU General Public * License. See the file "COPYING" in the main directory of this archive * for more details. * * Copyright (C) 1999 by Helge Deller * Copyright 1999 SuSE GmbH (Philipp Rumpf) * Copyright 1999 Philipp Rumpf (prumpf@tux.org) * Copyright 2000 Hewlett Packard (Paul Bame, bame@puffin.external.hp.com) * Copyright (C) 2001 Grant Grundler (Hewlett Packard) * * Initial Version 04-23-1999 by Helge Deller */ #include /* for CONFIG_SMP */ #include #include #include #include #include /* for PDC_PSW defines */ .level 2.0w .data .export boot_args boot_args: .word 0 /* arg0 */ .word 0 /* arg1 */ .word 0 /* arg2 */ .word 0 /* arg3 */ .text .align 4 .export stext .export _stext,data /* Kernel want it this way! */ _stext: stext: .proc .callinfo /* Make sure sr4-sr7 are set to zero for the kernel address space */ mtsp %r0,%sr4 mtsp %r0,%sr5 mtsp %r0,%sr6 mtsp %r0,%sr7 /* Clear BSS (shouldn't the boot loader do this?) */ .import __bss_start,data .import __bss_stop,data ldil L%PA(__bss_start),%r3 ldo R%PA(__bss_start)(%r3),%r3 ldil L%PA(__bss_stop),%r4 ldo R%PA(__bss_stop)(%r4),%r4 $bss_loop: cmpb,<<,n %r3,%r4,$bss_loop stb,ma %r0,1(%r3) /* Save away the arguments the boot loader passed in (32 bit args) */ ldil L%PA(boot_args),%r1 ldo R%PA(boot_args)(%r1),%r1 stw,ma %arg0,4(%r1) stw,ma %arg1,4(%r1) stw,ma %arg2,4(%r1) stw,ma %arg3,4(%r1) /* Initialize startup VM. Just map first 8 MB of memory */ ldil L%PA(pg0),%r1 ldo R%PA(pg0)(%r1),%r1 ldil L%PA(pmd0),%r5 ldo R%PA(pmd0)(%r5),%r5 shrd %r5,PxD_VALUE_SHIFT,%r3 ldo (PxD_FLAG_PRESENT+PxD_FLAG_VALID)(%r3),%r3 ldil L%PA(swapper_pg_dir),%r4 ldo R%PA(swapper_pg_dir)(%r4),%r4 mtctl %r4,%cr24 /* Initialize kernel root pointer */ mtctl %r4,%cr25 /* Initialize user root pointer */ stw %r3,ASM_PGD_ENTRY*ASM_PGD_ENTRY_SIZE(%r4) shrd %r1,PxD_VALUE_SHIFT,%r3 ldo (PxD_FLAG_PRESENT+PxD_FLAG_VALID)(%r3),%r3 ldo ASM_PMD_ENTRY*ASM_PMD_ENTRY_SIZE(%r5),%r5 ldi ASM_PT_INITIAL,%r1 1: stw %r3,0(%r5) ldo (ASM_PAGE_SIZE >> PxD_VALUE_SHIFT)(%r3),%r3 addib,> -1,%r1,1b ldo ASM_PMD_ENTRY_SIZE(%r5),%r5 ldo _PAGE_KERNEL(%r0),%r3 /* Hardwired 0 phys addr start */ ldil L%PA(pg0),%r1 ldo R%PA(pg0)(%r1),%r1 $pgt_fill_loop: std,ma %r3,ASM_PTE_ENTRY_SIZE(%r1) ldo ASM_PAGE_SIZE(%r3),%r3 bb,>= %r3,31-KERNEL_INITIAL_ORDER,$pgt_fill_loop nop /* And the RFI Target address too */ load32 start_kernel, %r11 /* And the stack pointer too */ load32 PA(init_thread_union+THREAD_SZ_ALGN),%sp /* And the initial task pointer */ load32 init_thread_union,%r6 mtctl %r6,%cr30 /* And the interrupt stack */ load32 interrupt_stack,%r6 mtctl %r6,%cr31 /* Act like PDC just called us - that's how slave CPUs enter */ #define MEM_PDC_LO 0x388 #define MEM_PDC_HI 0x35C ldw MEM_PDC_LO(%r0),%r3 ldw MEM_PDC_HI(%r0),%r6 depd %r6, 31, 32, %r3 /* move to upper word */ #ifdef CONFIG_SMP /* Set the smp rendevous address into page zero. ** It would be safer to do this in init_smp_config() but ** it's just way easier to deal with here because ** of 64-bit function ptrs and the address is local to this file. */ ldil L%PA(smp_slave_stext),%r10 ldo R%PA(smp_slave_stext)(%r10),%r10 stw %r10,0x10(%r0) /* MEM_RENDEZ */ stw %r0,0x28(%r0) /* MEM_RENDEZ_HI - assume addr < 4GB */ /* FALLTHROUGH */ .procend /* ** Code Common to both Monarch and Slave processors. ** Entry: ** %r3 PDCE_PROC address ** %r11 RFI target address. ** ** Caller must init: SR4-7, %sp, %r10, %cr24/25, */ common_stext: .proc .callinfo #else /* CONFIG_SMP */ /* Clear PDC's CPU handoff address - we won't use it */ stw %r0,0x10(%r0) /* MEM_RENDEZ */ stw %r0,0x28(%r0) /* MEM_RENDEZ_HI */ #endif /* CONFIG_SMP */ /* Save the rfi target address */ ldd TI_TASK-THREAD_SZ_ALGN(%sp), %r10 tophys_r1 %r10 std %r11, TASK_PT_GR11(%r10) /* Switch to wide mode; Superdome doesn't support narrow PDC ** calls. */ 1: mfia %rp /* clear upper part of pcoq */ ldo 2f-1b(%rp),%rp depdi 0,31,32,%rp bv (%rp) ssm PSW_SM_W,%r0 2: /* Set Wide mode as the "Default" (eg for traps) ** First trap occurs *right* after (or part of) rfi for slave CPUs. ** Someday, palo might not do this for the Monarch either. */ ldo PDC_PSW(%r0),%arg0 /* 21 */ ldo PDC_PSW_SET_DEFAULTS(%r0),%arg1 /* 2 */ ldo PDC_PSW_WIDE_BIT(%r0),%arg2 /* 2 */ load32 PA(stext_pdc_ret), %rp bv (%r3) copy %r0,%arg3 stext_pdc_ret: /* restore rfi target address*/ ldd TI_TASK-THREAD_SZ_ALGN(%sp), %r10 tophys_r1 %r10 ldd TASK_PT_GR11(%r10), %r11 /* PARANOID: clear user scratch/user space SR's */ mtsp %r0,%sr0 mtsp %r0,%sr1 mtsp %r0,%sr2 mtsp %r0,%sr3 /* Initialize Protection Registers */ mtctl %r0,%cr8 mtctl %r0,%cr9 mtctl %r0,%cr12 mtctl %r0,%cr13 /* Prepare to RFI! Man all the cannons! */ tovirt_r1 %sp /* Initialize the global data pointer */ load32 __gp,%dp /* Set up our interrupt table. HPMCs might not work after this! */ ldil L%PA(fault_vector_20),%r10 ldo R%PA(fault_vector_20)(%r10),%r10 mtctl %r10,%cr14 b aligned_rfi nop /* the magic spell */ .align 256 aligned_rfi: ssm 0,0 nop /* 1 */ nop /* 2 */ nop /* 3 */ nop /* 4 */ nop /* 5 */ nop /* 6 */ nop /* 7 */ nop /* 8 */ /* turn off troublesome PSW bits */ rsm PSW_Q+PSW_I+PSW_D+PSW_P+PSW_R, %r0 /* kernel PSW: * - no interruptions except HPMC and TOC (which are handled by PDC) * - Q bit set (IODC / PDC interruptions) * - big-endian * - virtually mapped */ load32 KERNEL_PSW,%r10 mtctl %r10,%ipsw /* Set the space pointers for the post-RFI world ** Clear the two-level IIA Space Queue, effectively setting ** Kernel space. */ mtctl %r0,%cr17 /* Clear IIASQ tail */ mtctl %r0,%cr17 /* Clear IIASQ head */ /* Load RFI target into PC queue */ mtctl %r11,%cr18 /* IIAOQ head */ ldo 4(%r11),%r11 mtctl %r11,%cr18 /* IIAOQ tail */ /* Jump to hyperspace */ rfi nop .procend #ifdef CONFIG_SMP .import smp_init_current_idle_task,data .import smp_callin,code /*************************************************************************** * * smp_slave_stext is executed by all non-monarch Processors when the Monarch * pokes the slave CPUs in smp.c:smp_boot_cpus(). * * Once here, registers values are initialized in order to branch to virtual * mode. Once all available/eligible CPUs are in virtual mode, all are * released and start out by executing their own idle task. *****************************************************************************/ smp_slave_stext: .proc .callinfo /* ** Initialize Space registers */ mtsp %r0,%sr4 mtsp %r0,%sr5 mtsp %r0,%sr6 mtsp %r0,%sr7 /* Initialize the SP - monarch sets up smp_init_current_idle_task */ load32 PA(smp_init_current_idle_task),%sp ldd 0(%sp),%sp /* load task address */ tophys_r1 %sp ldd TASK_THREAD_INFO(%sp), %sp mtctl %sp,%cr30 /* store in cr30 */ ldo THREAD_SZ_ALGN(%sp),%sp tophys_r1 %sp /* point CPU to kernel page tables */ load32 PA(swapper_pg_dir),%r4 mtctl %r4,%cr24 /* Initialize kernel root pointer */ mtctl %r4,%cr25 /* Initialize user root pointer */ /* Setup PDCE_PROC entry */ copy %arg0,%r3 /* Load RFI target address. */ load32 smp_callin, %r11 /* ok...common code can handle the rest */ b common_stext nop .procend #endif /* CONFIG_SMP */