xref: /openbmc/linux/arch/powerpc/kernel/head_44x.S (revision bee86f14d51a5a9a3b1897e301da1e415df0ba23)
114cf11afSPaul Mackerras/*
214cf11afSPaul Mackerras * Kernel execution entry point code.
314cf11afSPaul Mackerras *
414cf11afSPaul Mackerras *    Copyright (c) 1995-1996 Gary Thomas <gdt@linuxppc.org>
514cf11afSPaul Mackerras *      Initial PowerPC version.
614cf11afSPaul Mackerras *    Copyright (c) 1996 Cort Dougan <cort@cs.nmt.edu>
714cf11afSPaul Mackerras *      Rewritten for PReP
814cf11afSPaul Mackerras *    Copyright (c) 1996 Paul Mackerras <paulus@cs.anu.edu.au>
914cf11afSPaul Mackerras *      Low-level exception handers, MMU support, and rewrite.
1014cf11afSPaul Mackerras *    Copyright (c) 1997 Dan Malek <dmalek@jlc.net>
1114cf11afSPaul Mackerras *      PowerPC 8xx modifications.
1214cf11afSPaul Mackerras *    Copyright (c) 1998-1999 TiVo, Inc.
1314cf11afSPaul Mackerras *      PowerPC 403GCX modifications.
1414cf11afSPaul Mackerras *    Copyright (c) 1999 Grant Erickson <grant@lcse.umn.edu>
1514cf11afSPaul Mackerras *      PowerPC 403GCX/405GP modifications.
1614cf11afSPaul Mackerras *    Copyright 2000 MontaVista Software Inc.
1714cf11afSPaul Mackerras *	PPC405 modifications
1814cf11afSPaul Mackerras *      PowerPC 403GCX/405GP modifications.
1914cf11afSPaul Mackerras * 	Author: MontaVista Software, Inc.
2014cf11afSPaul Mackerras *         	frank_rowand@mvista.com or source@mvista.com
2114cf11afSPaul Mackerras * 	   	debbie_chu@mvista.com
2214cf11afSPaul Mackerras *    Copyright 2002-2005 MontaVista Software, Inc.
2314cf11afSPaul Mackerras *      PowerPC 44x support, Matt Porter <mporter@kernel.crashing.org>
2414cf11afSPaul Mackerras *
2514cf11afSPaul Mackerras * This program is free software; you can redistribute  it and/or modify it
2614cf11afSPaul Mackerras * under  the terms of  the GNU General  Public License as published by the
2714cf11afSPaul Mackerras * Free Software Foundation;  either version 2 of the  License, or (at your
2814cf11afSPaul Mackerras * option) any later version.
2914cf11afSPaul Mackerras */
3014cf11afSPaul Mackerras
3114cf11afSPaul Mackerras#include <asm/processor.h>
3214cf11afSPaul Mackerras#include <asm/page.h>
3314cf11afSPaul Mackerras#include <asm/mmu.h>
3414cf11afSPaul Mackerras#include <asm/pgtable.h>
3514cf11afSPaul Mackerras#include <asm/cputable.h>
3614cf11afSPaul Mackerras#include <asm/thread_info.h>
3714cf11afSPaul Mackerras#include <asm/ppc_asm.h>
3814cf11afSPaul Mackerras#include <asm/asm-offsets.h>
3914cf11afSPaul Mackerras#include "head_booke.h"
4014cf11afSPaul Mackerras
4114cf11afSPaul Mackerras
4214cf11afSPaul Mackerras/* As with the other PowerPC ports, it is expected that when code
4314cf11afSPaul Mackerras * execution begins here, the following registers contain valid, yet
4414cf11afSPaul Mackerras * optional, information:
4514cf11afSPaul Mackerras *
4614cf11afSPaul Mackerras *   r3 - Board info structure pointer (DRAM, frequency, MAC address, etc.)
4714cf11afSPaul Mackerras *   r4 - Starting address of the init RAM disk
4814cf11afSPaul Mackerras *   r5 - Ending address of the init RAM disk
4914cf11afSPaul Mackerras *   r6 - Start of kernel command line string (e.g. "mem=128")
5014cf11afSPaul Mackerras *   r7 - End of kernel command line string
5114cf11afSPaul Mackerras *
5214cf11afSPaul Mackerras */
53748a7683SKumar Gala	.section	.text.head, "ax"
54748a7683SKumar Gala_ENTRY(_stext);
55748a7683SKumar Gala_ENTRY(_start);
5614cf11afSPaul Mackerras	/*
5714cf11afSPaul Mackerras	 * Reserve a word at a fixed location to store the address
5814cf11afSPaul Mackerras	 * of abatron_pteptrs
5914cf11afSPaul Mackerras	 */
6014cf11afSPaul Mackerras	nop
6114cf11afSPaul Mackerras/*
6214cf11afSPaul Mackerras * Save parameters we are passed
6314cf11afSPaul Mackerras */
6414cf11afSPaul Mackerras	mr	r31,r3
6514cf11afSPaul Mackerras	mr	r30,r4
6614cf11afSPaul Mackerras	mr	r29,r5
6714cf11afSPaul Mackerras	mr	r28,r6
6814cf11afSPaul Mackerras	mr	r27,r7
6914cf11afSPaul Mackerras	li	r24,0		/* CPU number */
7014cf11afSPaul Mackerras
7114cf11afSPaul Mackerras/*
7214cf11afSPaul Mackerras * Set up the initial MMU state
7314cf11afSPaul Mackerras *
7414cf11afSPaul Mackerras * We are still executing code at the virtual address
7514cf11afSPaul Mackerras * mappings set by the firmware for the base of RAM.
7614cf11afSPaul Mackerras *
7714cf11afSPaul Mackerras * We first invalidate all TLB entries but the one
7814cf11afSPaul Mackerras * we are running from.  We then load the KERNELBASE
7914cf11afSPaul Mackerras * mappings so we can begin to use kernel addresses
8014cf11afSPaul Mackerras * natively and so the interrupt vector locations are
8114cf11afSPaul Mackerras * permanently pinned (necessary since Book E
8214cf11afSPaul Mackerras * implementations always have translation enabled).
8314cf11afSPaul Mackerras *
8414cf11afSPaul Mackerras * TODO: Use the known TLB entry we are running from to
8514cf11afSPaul Mackerras *	 determine which physical region we are located
8614cf11afSPaul Mackerras *	 in.  This can be used to determine where in RAM
8714cf11afSPaul Mackerras *	 (on a shared CPU system) or PCI memory space
8814cf11afSPaul Mackerras *	 (on a DRAMless system) we are located.
8914cf11afSPaul Mackerras *       For now, we assume a perfect world which means
9014cf11afSPaul Mackerras *	 we are located at the base of DRAM (physical 0).
9114cf11afSPaul Mackerras */
9214cf11afSPaul Mackerras
9314cf11afSPaul Mackerras/*
9414cf11afSPaul Mackerras * Search TLB for entry that we are currently using.
9514cf11afSPaul Mackerras * Invalidate all entries but the one we are using.
9614cf11afSPaul Mackerras */
9714cf11afSPaul Mackerras	/* Load our current PID->MMUCR TID and MSR IS->MMUCR STS */
9814cf11afSPaul Mackerras	mfspr	r3,SPRN_PID			/* Get PID */
9914cf11afSPaul Mackerras	mfmsr	r4				/* Get MSR */
10014cf11afSPaul Mackerras	andi.	r4,r4,MSR_IS@l			/* TS=1? */
10114cf11afSPaul Mackerras	beq	wmmucr				/* If not, leave STS=0 */
10214cf11afSPaul Mackerras	oris	r3,r3,PPC44x_MMUCR_STS@h	/* Set STS=1 */
10314cf11afSPaul Mackerraswmmucr:	mtspr	SPRN_MMUCR,r3			/* Put MMUCR */
10414cf11afSPaul Mackerras	sync
10514cf11afSPaul Mackerras
10614cf11afSPaul Mackerras	bl	invstr				/* Find our address */
10714cf11afSPaul Mackerrasinvstr:	mflr	r5				/* Make it accessible */
10814cf11afSPaul Mackerras	tlbsx	r23,0,r5			/* Find entry we are in */
10914cf11afSPaul Mackerras	li	r4,0				/* Start at TLB entry 0 */
11014cf11afSPaul Mackerras	li	r3,0				/* Set PAGEID inval value */
11114cf11afSPaul Mackerras1:	cmpw	r23,r4				/* Is this our entry? */
11214cf11afSPaul Mackerras	beq	skpinv				/* If so, skip the inval */
11314cf11afSPaul Mackerras	tlbwe	r3,r4,PPC44x_TLB_PAGEID		/* If not, inval the entry */
11414cf11afSPaul Mackerrasskpinv:	addi	r4,r4,1				/* Increment */
11514cf11afSPaul Mackerras	cmpwi	r4,64				/* Are we done? */
11614cf11afSPaul Mackerras	bne	1b				/* If not, repeat */
11714cf11afSPaul Mackerras	isync					/* If so, context change */
11814cf11afSPaul Mackerras
11914cf11afSPaul Mackerras/*
12014cf11afSPaul Mackerras * Configure and load pinned entry into TLB slot 63.
12114cf11afSPaul Mackerras */
12214cf11afSPaul Mackerras
12357d7909eSDavid Gibson	lis	r3,PAGE_OFFSET@h
12457d7909eSDavid Gibson	ori	r3,r3,PAGE_OFFSET@l
12514cf11afSPaul Mackerras
12614cf11afSPaul Mackerras	/* Kernel is at the base of RAM */
12714cf11afSPaul Mackerras	li r4, 0			/* Load the kernel physical address */
12814cf11afSPaul Mackerras
12914cf11afSPaul Mackerras	/* Load the kernel PID = 0 */
13014cf11afSPaul Mackerras	li	r0,0
13114cf11afSPaul Mackerras	mtspr	SPRN_PID,r0
13214cf11afSPaul Mackerras	sync
13314cf11afSPaul Mackerras
13414cf11afSPaul Mackerras	/* Initialize MMUCR */
13514cf11afSPaul Mackerras	li	r5,0
13614cf11afSPaul Mackerras	mtspr	SPRN_MMUCR,r5
13714cf11afSPaul Mackerras	sync
13814cf11afSPaul Mackerras
13914cf11afSPaul Mackerras 	/* pageid fields */
14014cf11afSPaul Mackerras	clrrwi	r3,r3,10		/* Mask off the effective page number */
14114cf11afSPaul Mackerras	ori	r3,r3,PPC44x_TLB_VALID | PPC44x_TLB_256M
14214cf11afSPaul Mackerras
14314cf11afSPaul Mackerras	/* xlat fields */
14414cf11afSPaul Mackerras	clrrwi	r4,r4,10		/* Mask off the real page number */
14514cf11afSPaul Mackerras					/* ERPN is 0 for first 4GB page */
14614cf11afSPaul Mackerras
14714cf11afSPaul Mackerras	/* attrib fields */
14814cf11afSPaul Mackerras	/* Added guarded bit to protect against speculative loads/stores */
14914cf11afSPaul Mackerras	li	r5,0
15014cf11afSPaul Mackerras	ori	r5,r5,(PPC44x_TLB_SW | PPC44x_TLB_SR | PPC44x_TLB_SX | PPC44x_TLB_G)
15114cf11afSPaul Mackerras
15214cf11afSPaul Mackerras        li      r0,63                    /* TLB slot 63 */
15314cf11afSPaul Mackerras
15414cf11afSPaul Mackerras	tlbwe	r3,r0,PPC44x_TLB_PAGEID	/* Load the pageid fields */
15514cf11afSPaul Mackerras	tlbwe	r4,r0,PPC44x_TLB_XLAT	/* Load the translation fields */
15614cf11afSPaul Mackerras	tlbwe	r5,r0,PPC44x_TLB_ATTRIB	/* Load the attrib/access fields */
15714cf11afSPaul Mackerras
15814cf11afSPaul Mackerras	/* Force context change */
15914cf11afSPaul Mackerras	mfmsr	r0
16014cf11afSPaul Mackerras	mtspr	SPRN_SRR1, r0
16114cf11afSPaul Mackerras	lis	r0,3f@h
16214cf11afSPaul Mackerras	ori	r0,r0,3f@l
16314cf11afSPaul Mackerras	mtspr	SPRN_SRR0,r0
16414cf11afSPaul Mackerras	sync
16514cf11afSPaul Mackerras	rfi
16614cf11afSPaul Mackerras
16714cf11afSPaul Mackerras	/* If necessary, invalidate original entry we used */
16814cf11afSPaul Mackerras3:	cmpwi	r23,63
16914cf11afSPaul Mackerras	beq	4f
17014cf11afSPaul Mackerras	li	r6,0
17114cf11afSPaul Mackerras	tlbwe   r6,r23,PPC44x_TLB_PAGEID
17214cf11afSPaul Mackerras	isync
17314cf11afSPaul Mackerras
17414cf11afSPaul Mackerras4:
175d9b55a03SDavid Gibson#ifdef CONFIG_PPC_EARLY_DEBUG_44x
176d9b55a03SDavid Gibson	/* Add UART mapping for early debug. */
177d9b55a03SDavid Gibson
17814cf11afSPaul Mackerras 	/* pageid fields */
179d9b55a03SDavid Gibson	lis	r3,PPC44x_EARLY_DEBUG_VIRTADDR@h
180d9b55a03SDavid Gibson	ori	r3,r3,PPC44x_TLB_VALID|PPC44x_TLB_TS|PPC44x_TLB_64K
18114cf11afSPaul Mackerras
18214cf11afSPaul Mackerras	/* xlat fields */
183d9b55a03SDavid Gibson	lis	r4,CONFIG_PPC_EARLY_DEBUG_44x_PHYSLOW@h
184d9b55a03SDavid Gibson	ori	r4,r4,CONFIG_PPC_EARLY_DEBUG_44x_PHYSHIGH
18514cf11afSPaul Mackerras
18614cf11afSPaul Mackerras	/* attrib fields */
187d9b55a03SDavid Gibson	li	r5,(PPC44x_TLB_SW|PPC44x_TLB_SR|PPC44x_TLB_I|PPC44x_TLB_G)
188d9b55a03SDavid Gibson        li      r0,62                    /* TLB slot 0 */
18914cf11afSPaul Mackerras
190d9b55a03SDavid Gibson	tlbwe	r3,r0,PPC44x_TLB_PAGEID
191d9b55a03SDavid Gibson	tlbwe	r4,r0,PPC44x_TLB_XLAT
192d9b55a03SDavid Gibson	tlbwe	r5,r0,PPC44x_TLB_ATTRIB
19314cf11afSPaul Mackerras
19414cf11afSPaul Mackerras	/* Force context change */
19514cf11afSPaul Mackerras	isync
196d9b55a03SDavid Gibson#endif /* CONFIG_PPC_EARLY_DEBUG_44x */
19714cf11afSPaul Mackerras
19814cf11afSPaul Mackerras	/* Establish the interrupt vector offsets */
19914cf11afSPaul Mackerras	SET_IVOR(0,  CriticalInput);
20014cf11afSPaul Mackerras	SET_IVOR(1,  MachineCheck);
20114cf11afSPaul Mackerras	SET_IVOR(2,  DataStorage);
20214cf11afSPaul Mackerras	SET_IVOR(3,  InstructionStorage);
20314cf11afSPaul Mackerras	SET_IVOR(4,  ExternalInput);
20414cf11afSPaul Mackerras	SET_IVOR(5,  Alignment);
20514cf11afSPaul Mackerras	SET_IVOR(6,  Program);
20614cf11afSPaul Mackerras	SET_IVOR(7,  FloatingPointUnavailable);
20714cf11afSPaul Mackerras	SET_IVOR(8,  SystemCall);
20814cf11afSPaul Mackerras	SET_IVOR(9,  AuxillaryProcessorUnavailable);
20914cf11afSPaul Mackerras	SET_IVOR(10, Decrementer);
21014cf11afSPaul Mackerras	SET_IVOR(11, FixedIntervalTimer);
21114cf11afSPaul Mackerras	SET_IVOR(12, WatchdogTimer);
21214cf11afSPaul Mackerras	SET_IVOR(13, DataTLBError);
21314cf11afSPaul Mackerras	SET_IVOR(14, InstructionTLBError);
21414cf11afSPaul Mackerras	SET_IVOR(15, Debug);
21514cf11afSPaul Mackerras
21614cf11afSPaul Mackerras	/* Establish the interrupt vector base */
21714cf11afSPaul Mackerras	lis	r4,interrupt_base@h	/* IVPR only uses the high 16-bits */
21814cf11afSPaul Mackerras	mtspr	SPRN_IVPR,r4
21914cf11afSPaul Mackerras
22014cf11afSPaul Mackerras	/*
22114cf11afSPaul Mackerras	 * This is where the main kernel code starts.
22214cf11afSPaul Mackerras	 */
22314cf11afSPaul Mackerras
22414cf11afSPaul Mackerras	/* ptr to current */
22514cf11afSPaul Mackerras	lis	r2,init_task@h
22614cf11afSPaul Mackerras	ori	r2,r2,init_task@l
22714cf11afSPaul Mackerras
22814cf11afSPaul Mackerras	/* ptr to current thread */
22914cf11afSPaul Mackerras	addi	r4,r2,THREAD	/* init task's THREAD */
23014cf11afSPaul Mackerras	mtspr	SPRN_SPRG3,r4
23114cf11afSPaul Mackerras
23214cf11afSPaul Mackerras	/* stack */
23314cf11afSPaul Mackerras	lis	r1,init_thread_union@h
23414cf11afSPaul Mackerras	ori	r1,r1,init_thread_union@l
23514cf11afSPaul Mackerras	li	r0,0
23614cf11afSPaul Mackerras	stwu	r0,THREAD_SIZE-STACK_FRAME_OVERHEAD(r1)
23714cf11afSPaul Mackerras
23814cf11afSPaul Mackerras	bl	early_init
23914cf11afSPaul Mackerras
24014cf11afSPaul Mackerras/*
24114cf11afSPaul Mackerras * Decide what sort of machine this is and initialize the MMU.
24214cf11afSPaul Mackerras */
24314cf11afSPaul Mackerras	mr	r3,r31
24414cf11afSPaul Mackerras	mr	r4,r30
24514cf11afSPaul Mackerras	mr	r5,r29
24614cf11afSPaul Mackerras	mr	r6,r28
24714cf11afSPaul Mackerras	mr	r7,r27
24814cf11afSPaul Mackerras	bl	machine_init
24914cf11afSPaul Mackerras	bl	MMU_init
25014cf11afSPaul Mackerras
25114cf11afSPaul Mackerras	/* Setup PTE pointers for the Abatron bdiGDB */
25214cf11afSPaul Mackerras	lis	r6, swapper_pg_dir@h
25314cf11afSPaul Mackerras	ori	r6, r6, swapper_pg_dir@l
25414cf11afSPaul Mackerras	lis	r5, abatron_pteptrs@h
25514cf11afSPaul Mackerras	ori	r5, r5, abatron_pteptrs@l
25614cf11afSPaul Mackerras	lis	r4, KERNELBASE@h
25714cf11afSPaul Mackerras	ori	r4, r4, KERNELBASE@l
25814cf11afSPaul Mackerras	stw	r5, 0(r4)	/* Save abatron_pteptrs at a fixed location */
25914cf11afSPaul Mackerras	stw	r6, 0(r5)
26014cf11afSPaul Mackerras
26114cf11afSPaul Mackerras	/* Let's move on */
26214cf11afSPaul Mackerras	lis	r4,start_kernel@h
26314cf11afSPaul Mackerras	ori	r4,r4,start_kernel@l
26414cf11afSPaul Mackerras	lis	r3,MSR_KERNEL@h
26514cf11afSPaul Mackerras	ori	r3,r3,MSR_KERNEL@l
26614cf11afSPaul Mackerras	mtspr	SPRN_SRR0,r4
26714cf11afSPaul Mackerras	mtspr	SPRN_SRR1,r3
26814cf11afSPaul Mackerras	rfi			/* change context and jump to start_kernel */
26914cf11afSPaul Mackerras
27014cf11afSPaul Mackerras/*
27114cf11afSPaul Mackerras * Interrupt vector entry code
27214cf11afSPaul Mackerras *
27314cf11afSPaul Mackerras * The Book E MMUs are always on so we don't need to handle
27414cf11afSPaul Mackerras * interrupts in real mode as with previous PPC processors. In
27514cf11afSPaul Mackerras * this case we handle interrupts in the kernel virtual address
27614cf11afSPaul Mackerras * space.
27714cf11afSPaul Mackerras *
27814cf11afSPaul Mackerras * Interrupt vectors are dynamically placed relative to the
27914cf11afSPaul Mackerras * interrupt prefix as determined by the address of interrupt_base.
28014cf11afSPaul Mackerras * The interrupt vectors offsets are programmed using the labels
28114cf11afSPaul Mackerras * for each interrupt vector entry.
28214cf11afSPaul Mackerras *
28314cf11afSPaul Mackerras * Interrupt vectors must be aligned on a 16 byte boundary.
28414cf11afSPaul Mackerras * We align on a 32 byte cache line boundary for good measure.
28514cf11afSPaul Mackerras */
28614cf11afSPaul Mackerras
28714cf11afSPaul Mackerrasinterrupt_base:
28814cf11afSPaul Mackerras	/* Critical Input Interrupt */
289dc1c1ca3SStephen Rothwell	CRITICAL_EXCEPTION(0x0100, CriticalInput, unknown_exception)
29014cf11afSPaul Mackerras
29114cf11afSPaul Mackerras	/* Machine Check Interrupt */
29214cf11afSPaul Mackerras#ifdef CONFIG_440A
293dc1c1ca3SStephen Rothwell	MCHECK_EXCEPTION(0x0200, MachineCheck, machine_check_exception)
29414cf11afSPaul Mackerras#else
295dc1c1ca3SStephen Rothwell	CRITICAL_EXCEPTION(0x0200, MachineCheck, machine_check_exception)
29614cf11afSPaul Mackerras#endif
29714cf11afSPaul Mackerras
29814cf11afSPaul Mackerras	/* Data Storage Interrupt */
29914cf11afSPaul Mackerras	START_EXCEPTION(DataStorage)
30014cf11afSPaul Mackerras	mtspr	SPRN_SPRG0, r10		/* Save some working registers */
30114cf11afSPaul Mackerras	mtspr	SPRN_SPRG1, r11
30214cf11afSPaul Mackerras	mtspr	SPRN_SPRG4W, r12
30314cf11afSPaul Mackerras	mtspr	SPRN_SPRG5W, r13
30414cf11afSPaul Mackerras	mfcr	r11
30514cf11afSPaul Mackerras	mtspr	SPRN_SPRG7W, r11
30614cf11afSPaul Mackerras
30714cf11afSPaul Mackerras	/*
30814cf11afSPaul Mackerras	 * Check if it was a store fault, if not then bail
30914cf11afSPaul Mackerras	 * because a user tried to access a kernel or
31014cf11afSPaul Mackerras	 * read-protected page.  Otherwise, get the
31114cf11afSPaul Mackerras	 * offending address and handle it.
31214cf11afSPaul Mackerras	 */
31314cf11afSPaul Mackerras	mfspr	r10, SPRN_ESR
31414cf11afSPaul Mackerras	andis.	r10, r10, ESR_ST@h
31514cf11afSPaul Mackerras	beq	2f
31614cf11afSPaul Mackerras
31714cf11afSPaul Mackerras	mfspr	r10, SPRN_DEAR		/* Get faulting address */
31814cf11afSPaul Mackerras
31914cf11afSPaul Mackerras	/* If we are faulting a kernel address, we have to use the
32014cf11afSPaul Mackerras	 * kernel page tables.
32114cf11afSPaul Mackerras	 */
3228a13c4f9SKumar Gala	lis	r11, PAGE_OFFSET@h
32314cf11afSPaul Mackerras	cmplw	r10, r11
32414cf11afSPaul Mackerras	blt+	3f
32514cf11afSPaul Mackerras	lis	r11, swapper_pg_dir@h
32614cf11afSPaul Mackerras	ori	r11, r11, swapper_pg_dir@l
32714cf11afSPaul Mackerras
32814cf11afSPaul Mackerras	mfspr   r12,SPRN_MMUCR
32914cf11afSPaul Mackerras	rlwinm	r12,r12,0,0,23		/* Clear TID */
33014cf11afSPaul Mackerras
33114cf11afSPaul Mackerras	b	4f
33214cf11afSPaul Mackerras
33314cf11afSPaul Mackerras	/* Get the PGD for the current thread */
33414cf11afSPaul Mackerras3:
33514cf11afSPaul Mackerras	mfspr	r11,SPRN_SPRG3
33614cf11afSPaul Mackerras	lwz	r11,PGDIR(r11)
33714cf11afSPaul Mackerras
33814cf11afSPaul Mackerras	/* Load PID into MMUCR TID */
33914cf11afSPaul Mackerras	mfspr	r12,SPRN_MMUCR		/* Get MMUCR */
34014cf11afSPaul Mackerras	mfspr   r13,SPRN_PID		/* Get PID */
34114cf11afSPaul Mackerras	rlwimi	r12,r13,0,24,31		/* Set TID */
34214cf11afSPaul Mackerras
34314cf11afSPaul Mackerras4:
34414cf11afSPaul Mackerras	mtspr   SPRN_MMUCR,r12
34514cf11afSPaul Mackerras
34614cf11afSPaul Mackerras	rlwinm  r12, r10, 13, 19, 29    /* Compute pgdir/pmd offset */
34714cf11afSPaul Mackerras	lwzx    r11, r12, r11           /* Get pgd/pmd entry */
34814cf11afSPaul Mackerras	rlwinm. r12, r11, 0, 0, 20      /* Extract pt base address */
34914cf11afSPaul Mackerras	beq     2f                      /* Bail if no table */
35014cf11afSPaul Mackerras
35114cf11afSPaul Mackerras	rlwimi  r12, r10, 23, 20, 28    /* Compute pte address */
35214cf11afSPaul Mackerras	lwz     r11, 4(r12)             /* Get pte entry */
35314cf11afSPaul Mackerras
35414cf11afSPaul Mackerras	andi.	r13, r11, _PAGE_RW	/* Is it writeable? */
35514cf11afSPaul Mackerras	beq	2f			/* Bail if not */
35614cf11afSPaul Mackerras
35714cf11afSPaul Mackerras	/* Update 'changed'.
35814cf11afSPaul Mackerras	*/
35914cf11afSPaul Mackerras	ori	r11, r11, _PAGE_DIRTY|_PAGE_ACCESSED|_PAGE_HWWRITE
36014cf11afSPaul Mackerras	stw	r11, 4(r12)		/* Update Linux page table */
36114cf11afSPaul Mackerras
36214cf11afSPaul Mackerras	li	r13, PPC44x_TLB_SR@l	/* Set SR */
36314cf11afSPaul Mackerras	rlwimi	r13, r11, 29, 29, 29	/* SX = _PAGE_HWEXEC */
36414cf11afSPaul Mackerras	rlwimi	r13, r11, 0, 30, 30	/* SW = _PAGE_RW */
36514cf11afSPaul Mackerras	rlwimi	r13, r11, 29, 28, 28	/* UR = _PAGE_USER */
36614cf11afSPaul Mackerras	rlwimi	r12, r11, 31, 26, 26	/* (_PAGE_USER>>1)->r12 */
36714cf11afSPaul Mackerras	rlwimi	r12, r11, 29, 30, 30	/* (_PAGE_USER>>3)->r12 */
36814cf11afSPaul Mackerras	and	r12, r12, r11		/* HWEXEC/RW & USER */
36914cf11afSPaul Mackerras	rlwimi	r13, r12, 0, 26, 26	/* UX = HWEXEC & USER */
37014cf11afSPaul Mackerras	rlwimi	r13, r12, 3, 27, 27	/* UW = RW & USER */
37114cf11afSPaul Mackerras
37214cf11afSPaul Mackerras	rlwimi	r11,r13,0,26,31		/* Insert static perms */
37314cf11afSPaul Mackerras
37414cf11afSPaul Mackerras	rlwinm	r11,r11,0,20,15		/* Clear U0-U3 */
37514cf11afSPaul Mackerras
37614cf11afSPaul Mackerras	/* find the TLB index that caused the fault.  It has to be here. */
37714cf11afSPaul Mackerras	tlbsx	r10, 0, r10
37814cf11afSPaul Mackerras
37914cf11afSPaul Mackerras	tlbwe	r11, r10, PPC44x_TLB_ATTRIB	/* Write ATTRIB */
38014cf11afSPaul Mackerras
38114cf11afSPaul Mackerras	/* Done...restore registers and get out of here.
38214cf11afSPaul Mackerras	*/
38314cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG7R
38414cf11afSPaul Mackerras	mtcr	r11
38514cf11afSPaul Mackerras	mfspr	r13, SPRN_SPRG5R
38614cf11afSPaul Mackerras	mfspr	r12, SPRN_SPRG4R
38714cf11afSPaul Mackerras
38814cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG1
38914cf11afSPaul Mackerras	mfspr	r10, SPRN_SPRG0
39014cf11afSPaul Mackerras	rfi			/* Force context change */
39114cf11afSPaul Mackerras
39214cf11afSPaul Mackerras2:
39314cf11afSPaul Mackerras	/*
39414cf11afSPaul Mackerras	 * The bailout.  Restore registers to pre-exception conditions
39514cf11afSPaul Mackerras	 * and call the heavyweights to help us out.
39614cf11afSPaul Mackerras	 */
39714cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG7R
39814cf11afSPaul Mackerras	mtcr	r11
39914cf11afSPaul Mackerras	mfspr	r13, SPRN_SPRG5R
40014cf11afSPaul Mackerras	mfspr	r12, SPRN_SPRG4R
40114cf11afSPaul Mackerras
40214cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG1
40314cf11afSPaul Mackerras	mfspr	r10, SPRN_SPRG0
40414cf11afSPaul Mackerras	b	data_access
40514cf11afSPaul Mackerras
40614cf11afSPaul Mackerras	/* Instruction Storage Interrupt */
40714cf11afSPaul Mackerras	INSTRUCTION_STORAGE_EXCEPTION
40814cf11afSPaul Mackerras
40914cf11afSPaul Mackerras	/* External Input Interrupt */
41014cf11afSPaul Mackerras	EXCEPTION(0x0500, ExternalInput, do_IRQ, EXC_XFER_LITE)
41114cf11afSPaul Mackerras
41214cf11afSPaul Mackerras	/* Alignment Interrupt */
41314cf11afSPaul Mackerras	ALIGNMENT_EXCEPTION
41414cf11afSPaul Mackerras
41514cf11afSPaul Mackerras	/* Program Interrupt */
41614cf11afSPaul Mackerras	PROGRAM_EXCEPTION
41714cf11afSPaul Mackerras
41814cf11afSPaul Mackerras	/* Floating Point Unavailable Interrupt */
41914cf11afSPaul Mackerras#ifdef CONFIG_PPC_FPU
42014cf11afSPaul Mackerras	FP_UNAVAILABLE_EXCEPTION
42114cf11afSPaul Mackerras#else
422dc1c1ca3SStephen Rothwell	EXCEPTION(0x2010, FloatingPointUnavailable, unknown_exception, EXC_XFER_EE)
42314cf11afSPaul Mackerras#endif
42414cf11afSPaul Mackerras
42514cf11afSPaul Mackerras	/* System Call Interrupt */
42614cf11afSPaul Mackerras	START_EXCEPTION(SystemCall)
42714cf11afSPaul Mackerras	NORMAL_EXCEPTION_PROLOG
42814cf11afSPaul Mackerras	EXC_XFER_EE_LITE(0x0c00, DoSyscall)
42914cf11afSPaul Mackerras
43014cf11afSPaul Mackerras	/* Auxillary Processor Unavailable Interrupt */
431dc1c1ca3SStephen Rothwell	EXCEPTION(0x2020, AuxillaryProcessorUnavailable, unknown_exception, EXC_XFER_EE)
43214cf11afSPaul Mackerras
43314cf11afSPaul Mackerras	/* Decrementer Interrupt */
43414cf11afSPaul Mackerras	DECREMENTER_EXCEPTION
43514cf11afSPaul Mackerras
43614cf11afSPaul Mackerras	/* Fixed Internal Timer Interrupt */
43714cf11afSPaul Mackerras	/* TODO: Add FIT support */
438dc1c1ca3SStephen Rothwell	EXCEPTION(0x1010, FixedIntervalTimer, unknown_exception, EXC_XFER_EE)
43914cf11afSPaul Mackerras
44014cf11afSPaul Mackerras	/* Watchdog Timer Interrupt */
44114cf11afSPaul Mackerras	/* TODO: Add watchdog support */
44214cf11afSPaul Mackerras#ifdef CONFIG_BOOKE_WDT
44314cf11afSPaul Mackerras	CRITICAL_EXCEPTION(0x1020, WatchdogTimer, WatchdogException)
44414cf11afSPaul Mackerras#else
445dc1c1ca3SStephen Rothwell	CRITICAL_EXCEPTION(0x1020, WatchdogTimer, unknown_exception)
44614cf11afSPaul Mackerras#endif
44714cf11afSPaul Mackerras
44814cf11afSPaul Mackerras	/* Data TLB Error Interrupt */
44914cf11afSPaul Mackerras	START_EXCEPTION(DataTLBError)
45014cf11afSPaul Mackerras	mtspr	SPRN_SPRG0, r10		/* Save some working registers */
45114cf11afSPaul Mackerras	mtspr	SPRN_SPRG1, r11
45214cf11afSPaul Mackerras	mtspr	SPRN_SPRG4W, r12
45314cf11afSPaul Mackerras	mtspr	SPRN_SPRG5W, r13
45414cf11afSPaul Mackerras	mfcr	r11
45514cf11afSPaul Mackerras	mtspr	SPRN_SPRG7W, r11
45614cf11afSPaul Mackerras	mfspr	r10, SPRN_DEAR		/* Get faulting address */
45714cf11afSPaul Mackerras
45814cf11afSPaul Mackerras	/* If we are faulting a kernel address, we have to use the
45914cf11afSPaul Mackerras	 * kernel page tables.
46014cf11afSPaul Mackerras	 */
4618a13c4f9SKumar Gala	lis	r11, PAGE_OFFSET@h
46214cf11afSPaul Mackerras	cmplw	r10, r11
46314cf11afSPaul Mackerras	blt+	3f
46414cf11afSPaul Mackerras	lis	r11, swapper_pg_dir@h
46514cf11afSPaul Mackerras	ori	r11, r11, swapper_pg_dir@l
46614cf11afSPaul Mackerras
46714cf11afSPaul Mackerras	mfspr	r12,SPRN_MMUCR
46814cf11afSPaul Mackerras	rlwinm	r12,r12,0,0,23		/* Clear TID */
46914cf11afSPaul Mackerras
47014cf11afSPaul Mackerras	b	4f
47114cf11afSPaul Mackerras
47214cf11afSPaul Mackerras	/* Get the PGD for the current thread */
47314cf11afSPaul Mackerras3:
47414cf11afSPaul Mackerras	mfspr	r11,SPRN_SPRG3
47514cf11afSPaul Mackerras	lwz	r11,PGDIR(r11)
47614cf11afSPaul Mackerras
47714cf11afSPaul Mackerras	/* Load PID into MMUCR TID */
47814cf11afSPaul Mackerras	mfspr	r12,SPRN_MMUCR
47914cf11afSPaul Mackerras	mfspr   r13,SPRN_PID		/* Get PID */
48014cf11afSPaul Mackerras	rlwimi	r12,r13,0,24,31		/* Set TID */
48114cf11afSPaul Mackerras
48214cf11afSPaul Mackerras4:
48314cf11afSPaul Mackerras	mtspr	SPRN_MMUCR,r12
48414cf11afSPaul Mackerras
48514cf11afSPaul Mackerras	rlwinm 	r12, r10, 13, 19, 29	/* Compute pgdir/pmd offset */
48614cf11afSPaul Mackerras	lwzx	r11, r12, r11		/* Get pgd/pmd entry */
48714cf11afSPaul Mackerras	rlwinm.	r12, r11, 0, 0, 20	/* Extract pt base address */
48814cf11afSPaul Mackerras	beq	2f			/* Bail if no table */
48914cf11afSPaul Mackerras
49014cf11afSPaul Mackerras	rlwimi	r12, r10, 23, 20, 28	/* Compute pte address */
49114cf11afSPaul Mackerras	lwz	r11, 4(r12)		/* Get pte entry */
49214cf11afSPaul Mackerras	andi.	r13, r11, _PAGE_PRESENT	/* Is the page present? */
49314cf11afSPaul Mackerras	beq	2f			/* Bail if not present */
49414cf11afSPaul Mackerras
49514cf11afSPaul Mackerras	ori	r11, r11, _PAGE_ACCESSED
49614cf11afSPaul Mackerras	stw	r11, 4(r12)
49714cf11afSPaul Mackerras
49814cf11afSPaul Mackerras	 /* Jump to common tlb load */
49914cf11afSPaul Mackerras	b	finish_tlb_load
50014cf11afSPaul Mackerras
50114cf11afSPaul Mackerras2:
50214cf11afSPaul Mackerras	/* The bailout.  Restore registers to pre-exception conditions
50314cf11afSPaul Mackerras	 * and call the heavyweights to help us out.
50414cf11afSPaul Mackerras	 */
50514cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG7R
50614cf11afSPaul Mackerras	mtcr	r11
50714cf11afSPaul Mackerras	mfspr	r13, SPRN_SPRG5R
50814cf11afSPaul Mackerras	mfspr	r12, SPRN_SPRG4R
50914cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG1
51014cf11afSPaul Mackerras	mfspr	r10, SPRN_SPRG0
51114cf11afSPaul Mackerras	b	data_access
51214cf11afSPaul Mackerras
51314cf11afSPaul Mackerras	/* Instruction TLB Error Interrupt */
51414cf11afSPaul Mackerras	/*
51514cf11afSPaul Mackerras	 * Nearly the same as above, except we get our
51614cf11afSPaul Mackerras	 * information from different registers and bailout
51714cf11afSPaul Mackerras	 * to a different point.
51814cf11afSPaul Mackerras	 */
51914cf11afSPaul Mackerras	START_EXCEPTION(InstructionTLBError)
52014cf11afSPaul Mackerras	mtspr	SPRN_SPRG0, r10		/* Save some working registers */
52114cf11afSPaul Mackerras	mtspr	SPRN_SPRG1, r11
52214cf11afSPaul Mackerras	mtspr	SPRN_SPRG4W, r12
52314cf11afSPaul Mackerras	mtspr	SPRN_SPRG5W, r13
52414cf11afSPaul Mackerras	mfcr	r11
52514cf11afSPaul Mackerras	mtspr	SPRN_SPRG7W, r11
52614cf11afSPaul Mackerras	mfspr	r10, SPRN_SRR0		/* Get faulting address */
52714cf11afSPaul Mackerras
52814cf11afSPaul Mackerras	/* If we are faulting a kernel address, we have to use the
52914cf11afSPaul Mackerras	 * kernel page tables.
53014cf11afSPaul Mackerras	 */
5318a13c4f9SKumar Gala	lis	r11, PAGE_OFFSET@h
53214cf11afSPaul Mackerras	cmplw	r10, r11
53314cf11afSPaul Mackerras	blt+	3f
53414cf11afSPaul Mackerras	lis	r11, swapper_pg_dir@h
53514cf11afSPaul Mackerras	ori	r11, r11, swapper_pg_dir@l
53614cf11afSPaul Mackerras
53714cf11afSPaul Mackerras	mfspr	r12,SPRN_MMUCR
53814cf11afSPaul Mackerras	rlwinm	r12,r12,0,0,23		/* Clear TID */
53914cf11afSPaul Mackerras
54014cf11afSPaul Mackerras	b	4f
54114cf11afSPaul Mackerras
54214cf11afSPaul Mackerras	/* Get the PGD for the current thread */
54314cf11afSPaul Mackerras3:
54414cf11afSPaul Mackerras	mfspr	r11,SPRN_SPRG3
54514cf11afSPaul Mackerras	lwz	r11,PGDIR(r11)
54614cf11afSPaul Mackerras
54714cf11afSPaul Mackerras	/* Load PID into MMUCR TID */
54814cf11afSPaul Mackerras	mfspr	r12,SPRN_MMUCR
54914cf11afSPaul Mackerras	mfspr   r13,SPRN_PID		/* Get PID */
55014cf11afSPaul Mackerras	rlwimi	r12,r13,0,24,31		/* Set TID */
55114cf11afSPaul Mackerras
55214cf11afSPaul Mackerras4:
55314cf11afSPaul Mackerras	mtspr	SPRN_MMUCR,r12
55414cf11afSPaul Mackerras
55514cf11afSPaul Mackerras	rlwinm	r12, r10, 13, 19, 29	/* Compute pgdir/pmd offset */
55614cf11afSPaul Mackerras	lwzx	r11, r12, r11		/* Get pgd/pmd entry */
55714cf11afSPaul Mackerras	rlwinm.	r12, r11, 0, 0, 20	/* Extract pt base address */
55814cf11afSPaul Mackerras	beq	2f			/* Bail if no table */
55914cf11afSPaul Mackerras
56014cf11afSPaul Mackerras	rlwimi	r12, r10, 23, 20, 28	/* Compute pte address */
56114cf11afSPaul Mackerras	lwz	r11, 4(r12)		/* Get pte entry */
56214cf11afSPaul Mackerras	andi.	r13, r11, _PAGE_PRESENT	/* Is the page present? */
56314cf11afSPaul Mackerras	beq	2f			/* Bail if not present */
56414cf11afSPaul Mackerras
56514cf11afSPaul Mackerras	ori	r11, r11, _PAGE_ACCESSED
56614cf11afSPaul Mackerras	stw	r11, 4(r12)
56714cf11afSPaul Mackerras
56814cf11afSPaul Mackerras	/* Jump to common TLB load point */
56914cf11afSPaul Mackerras	b	finish_tlb_load
57014cf11afSPaul Mackerras
57114cf11afSPaul Mackerras2:
57214cf11afSPaul Mackerras	/* The bailout.  Restore registers to pre-exception conditions
57314cf11afSPaul Mackerras	 * and call the heavyweights to help us out.
57414cf11afSPaul Mackerras	 */
57514cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG7R
57614cf11afSPaul Mackerras	mtcr	r11
57714cf11afSPaul Mackerras	mfspr	r13, SPRN_SPRG5R
57814cf11afSPaul Mackerras	mfspr	r12, SPRN_SPRG4R
57914cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG1
58014cf11afSPaul Mackerras	mfspr	r10, SPRN_SPRG0
58114cf11afSPaul Mackerras	b	InstructionStorage
58214cf11afSPaul Mackerras
58314cf11afSPaul Mackerras	/* Debug Interrupt */
58414cf11afSPaul Mackerras	DEBUG_EXCEPTION
58514cf11afSPaul Mackerras
58614cf11afSPaul Mackerras/*
58714cf11afSPaul Mackerras * Local functions
58814cf11afSPaul Mackerras */
58914cf11afSPaul Mackerras	/*
59014cf11afSPaul Mackerras	 * Data TLB exceptions will bail out to this point
59114cf11afSPaul Mackerras	 * if they can't resolve the lightweight TLB fault.
59214cf11afSPaul Mackerras	 */
59314cf11afSPaul Mackerrasdata_access:
59414cf11afSPaul Mackerras	NORMAL_EXCEPTION_PROLOG
59514cf11afSPaul Mackerras	mfspr	r5,SPRN_ESR		/* Grab the ESR, save it, pass arg3 */
59614cf11afSPaul Mackerras	stw	r5,_ESR(r11)
59714cf11afSPaul Mackerras	mfspr	r4,SPRN_DEAR		/* Grab the DEAR, save it, pass arg2 */
59814cf11afSPaul Mackerras	EXC_XFER_EE_LITE(0x0300, handle_page_fault)
59914cf11afSPaul Mackerras
60014cf11afSPaul Mackerras/*
60114cf11afSPaul Mackerras
60214cf11afSPaul Mackerras * Both the instruction and data TLB miss get to this
60314cf11afSPaul Mackerras * point to load the TLB.
60414cf11afSPaul Mackerras * 	r10 - EA of fault
60514cf11afSPaul Mackerras * 	r11 - available to use
60614cf11afSPaul Mackerras *	r12 - Pointer to the 64-bit PTE
60714cf11afSPaul Mackerras *	r13 - available to use
60814cf11afSPaul Mackerras *	MMUCR - loaded with proper value when we get here
60914cf11afSPaul Mackerras *	Upon exit, we reload everything and RFI.
61014cf11afSPaul Mackerras */
61114cf11afSPaul Mackerrasfinish_tlb_load:
61214cf11afSPaul Mackerras	/*
61314cf11afSPaul Mackerras	 * We set execute, because we don't have the granularity to
61414cf11afSPaul Mackerras	 * properly set this at the page level (Linux problem).
61514cf11afSPaul Mackerras	 * If shared is set, we cause a zero PID->TID load.
61614cf11afSPaul Mackerras	 * Many of these bits are software only.  Bits we don't set
61714cf11afSPaul Mackerras	 * here we (properly should) assume have the appropriate value.
61814cf11afSPaul Mackerras	 */
61914cf11afSPaul Mackerras
62014cf11afSPaul Mackerras	/* Load the next available TLB index */
62114cf11afSPaul Mackerras	lis	r13, tlb_44x_index@ha
62214cf11afSPaul Mackerras	lwz	r13, tlb_44x_index@l(r13)
62314cf11afSPaul Mackerras	/* Load the TLB high watermark */
62414cf11afSPaul Mackerras	lis	r11, tlb_44x_hwater@ha
62514cf11afSPaul Mackerras	lwz	r11, tlb_44x_hwater@l(r11)
62614cf11afSPaul Mackerras
62714cf11afSPaul Mackerras	/* Increment, rollover, and store TLB index */
62814cf11afSPaul Mackerras	addi	r13, r13, 1
62914cf11afSPaul Mackerras	cmpw	0, r13, r11			/* reserve entries */
63014cf11afSPaul Mackerras	ble	7f
63114cf11afSPaul Mackerras	li	r13, 0
63214cf11afSPaul Mackerras7:
63314cf11afSPaul Mackerras	/* Store the next available TLB index */
63414cf11afSPaul Mackerras	lis	r11, tlb_44x_index@ha
63514cf11afSPaul Mackerras	stw	r13, tlb_44x_index@l(r11)
63614cf11afSPaul Mackerras
63714cf11afSPaul Mackerras	lwz	r11, 0(r12)			/* Get MS word of PTE */
63814cf11afSPaul Mackerras	lwz	r12, 4(r12)			/* Get LS word of PTE */
63914cf11afSPaul Mackerras	rlwimi	r11, r12, 0, 0 , 19		/* Insert RPN */
64014cf11afSPaul Mackerras	tlbwe	r11, r13, PPC44x_TLB_XLAT	/* Write XLAT */
64114cf11afSPaul Mackerras
64214cf11afSPaul Mackerras	/*
64314cf11afSPaul Mackerras	 * Create PAGEID. This is the faulting address,
64414cf11afSPaul Mackerras	 * page size, and valid flag.
64514cf11afSPaul Mackerras	 */
64614cf11afSPaul Mackerras	li	r11, PPC44x_TLB_VALID | PPC44x_TLB_4K
64714cf11afSPaul Mackerras	rlwimi	r10, r11, 0, 20, 31		/* Insert valid and page size */
64814cf11afSPaul Mackerras	tlbwe	r10, r13, PPC44x_TLB_PAGEID	/* Write PAGEID */
64914cf11afSPaul Mackerras
65014cf11afSPaul Mackerras	li	r10, PPC44x_TLB_SR@l		/* Set SR */
65114cf11afSPaul Mackerras	rlwimi	r10, r12, 0, 30, 30		/* Set SW = _PAGE_RW */
65214cf11afSPaul Mackerras	rlwimi	r10, r12, 29, 29, 29		/* SX = _PAGE_HWEXEC */
65314cf11afSPaul Mackerras	rlwimi	r10, r12, 29, 28, 28		/* UR = _PAGE_USER */
65414cf11afSPaul Mackerras	rlwimi	r11, r12, 31, 26, 26		/* (_PAGE_USER>>1)->r12 */
65514cf11afSPaul Mackerras	and	r11, r12, r11			/* HWEXEC & USER */
65614cf11afSPaul Mackerras	rlwimi	r10, r11, 0, 26, 26		/* UX = HWEXEC & USER */
65714cf11afSPaul Mackerras
65814cf11afSPaul Mackerras	rlwimi	r12, r10, 0, 26, 31		/* Insert static perms */
65914cf11afSPaul Mackerras	rlwinm	r12, r12, 0, 20, 15		/* Clear U0-U3 */
66014cf11afSPaul Mackerras	tlbwe	r12, r13, PPC44x_TLB_ATTRIB	/* Write ATTRIB */
66114cf11afSPaul Mackerras
66214cf11afSPaul Mackerras	/* Done...restore registers and get out of here.
66314cf11afSPaul Mackerras	*/
66414cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG7R
66514cf11afSPaul Mackerras	mtcr	r11
66614cf11afSPaul Mackerras	mfspr	r13, SPRN_SPRG5R
66714cf11afSPaul Mackerras	mfspr	r12, SPRN_SPRG4R
66814cf11afSPaul Mackerras	mfspr	r11, SPRN_SPRG1
66914cf11afSPaul Mackerras	mfspr	r10, SPRN_SPRG0
67014cf11afSPaul Mackerras	rfi					/* Force context change */
67114cf11afSPaul Mackerras
67214cf11afSPaul Mackerras/*
67314cf11afSPaul Mackerras * Global functions
67414cf11afSPaul Mackerras */
67514cf11afSPaul Mackerras
67614cf11afSPaul Mackerras/*
67714cf11afSPaul Mackerras * extern void giveup_altivec(struct task_struct *prev)
67814cf11afSPaul Mackerras *
67914cf11afSPaul Mackerras * The 44x core does not have an AltiVec unit.
68014cf11afSPaul Mackerras */
68114cf11afSPaul Mackerras_GLOBAL(giveup_altivec)
68214cf11afSPaul Mackerras	blr
68314cf11afSPaul Mackerras
68414cf11afSPaul Mackerras/*
68514cf11afSPaul Mackerras * extern void giveup_fpu(struct task_struct *prev)
68614cf11afSPaul Mackerras *
68714cf11afSPaul Mackerras * The 44x core does not have an FPU.
68814cf11afSPaul Mackerras */
68914cf11afSPaul Mackerras#ifndef CONFIG_PPC_FPU
69014cf11afSPaul Mackerras_GLOBAL(giveup_fpu)
69114cf11afSPaul Mackerras	blr
69214cf11afSPaul Mackerras#endif
69314cf11afSPaul Mackerras
69414cf11afSPaul Mackerras_GLOBAL(set_context)
69514cf11afSPaul Mackerras
69614cf11afSPaul Mackerras#ifdef CONFIG_BDI_SWITCH
69714cf11afSPaul Mackerras	/* Context switch the PTE pointer for the Abatron BDI2000.
69814cf11afSPaul Mackerras	 * The PGDIR is the second parameter.
69914cf11afSPaul Mackerras	 */
70014cf11afSPaul Mackerras	lis	r5, abatron_pteptrs@h
70114cf11afSPaul Mackerras	ori	r5, r5, abatron_pteptrs@l
70214cf11afSPaul Mackerras	stw	r4, 0x4(r5)
70314cf11afSPaul Mackerras#endif
70414cf11afSPaul Mackerras	mtspr	SPRN_PID,r3
70514cf11afSPaul Mackerras	isync			/* Force context change */
70614cf11afSPaul Mackerras	blr
70714cf11afSPaul Mackerras
70814cf11afSPaul Mackerras/*
70914cf11afSPaul Mackerras * We put a few things here that have to be page-aligned. This stuff
71014cf11afSPaul Mackerras * goes at the beginning of the data segment, which is page-aligned.
71114cf11afSPaul Mackerras */
71214cf11afSPaul Mackerras	.data
713ea703ce2SKumar Gala	.align	12
714ea703ce2SKumar Gala	.globl	sdata
715ea703ce2SKumar Galasdata:
716ea703ce2SKumar Gala	.globl	empty_zero_page
717ea703ce2SKumar Galaempty_zero_page:
71814cf11afSPaul Mackerras	.space	4096
71914cf11afSPaul Mackerras
72014cf11afSPaul Mackerras/*
72114cf11afSPaul Mackerras * To support >32-bit physical addresses, we use an 8KB pgdir.
72214cf11afSPaul Mackerras */
723ea703ce2SKumar Gala	.globl	swapper_pg_dir
724ea703ce2SKumar Galaswapper_pg_dir:
725*bee86f14SKumar Gala	.space	PGD_TABLE_SIZE
72614cf11afSPaul Mackerras
72714cf11afSPaul Mackerras/* Reserved 4k for the critical exception stack & 4k for the machine
72814cf11afSPaul Mackerras * check stack per CPU for kernel mode exceptions */
72914cf11afSPaul Mackerras	.section .bss
73014cf11afSPaul Mackerras        .align 12
73114cf11afSPaul Mackerrasexception_stack_bottom:
73214cf11afSPaul Mackerras	.space	BOOKE_EXCEPTION_STACK_SIZE
733ea703ce2SKumar Gala	.globl	exception_stack_top
734ea703ce2SKumar Galaexception_stack_top:
73514cf11afSPaul Mackerras
73614cf11afSPaul Mackerras/*
73714cf11afSPaul Mackerras * Room for two PTE pointers, usually the kernel and current user pointers
73814cf11afSPaul Mackerras * to their respective root page table.
73914cf11afSPaul Mackerras */
74014cf11afSPaul Mackerrasabatron_pteptrs:
74114cf11afSPaul Mackerras	.space	8
742