freebsd-dev/sys/boot/sparc64/loader/locore.S

/*
 * Initial implementation:
 * Copyright (c) 2001 Robert Drehmel
 * All rights reserved.
 *
 * As long as the above copyright statement and this notice remain
 * unchanged, you can do what ever you want with this file. 
 *
 * $FreeBSD$
 */
#include <machine/asi.h>
#include <machine/asm.h>
#include <machine/pstate.h>

#define	PAGE_SIZE	8192
#define	PAGE_SHIFT	13

#define	SPOFF		2047
#define	STACK_SIZE	(2 * PAGE_SIZE)

ENTRY(_start)
	/* limit interrupts */
	wrpr	%g0, 13, %pil

	/*
	 * PSTATE: privileged, interrupts enabled, floating point
	 * unit enabled
	 */
	wrpr	%g0, PSTATE_PRIV|PSTATE_IE|PSTATE_PEF, %pstate
	wr	%g0, 0x4, %fprs

	setx	stack + STACK_SIZE - SPOFF - CCFSZ, %l7, %l6
	mov	%l6, %sp
	call	main
	 mov	%o4, %o0
	illtrap

/*
 * %o0 input VA constant
 * %o1 current iTLB offset
 * %o2 current iTLB TTE tag
 */
ENTRY(itlb_va_to_pa)
	clr	%o1
0:	ldxa	[%o1] ASI_ITLB_TAG_READ_REG, %o2
	cmp	%o2, %o0
	bne,a	%xcc, 1f
	 nop
	/* return PA of matching entry */
	ldxa	[%o1] ASI_ITLB_DATA_ACCESS_REG, %o0
	sllx	%o0, 23, %o0
	srlx	%o0, PAGE_SHIFT+23, %o0
	sllx	%o0, PAGE_SHIFT, %o0
	retl
	 mov	%o0, %o1
1:	cmp	%o1, 63<<3
	blu	%xcc, 0b
	 add	%o1, 8, %o1
	clr	%o0
	retl
	 not	%o0

ENTRY(dtlb_va_to_pa)
	clr	%o1
0:	ldxa	[%o1] ASI_DTLB_TAG_READ_REG, %o2
	cmp	%o2, %o0
	bne,a	%xcc, 1f
	 nop
	/* return PA of matching entry */
	ldxa	[%o1] ASI_DTLB_DATA_ACCESS_REG, %o0
	sllx	%o0, 23, %o0
	srlx	%o0, PAGE_SHIFT+23, %o0
	sllx	%o0, PAGE_SHIFT, %o0
	retl
	 mov	%o0, %o1
1:	cmp	%o1, 63<<3
	blu	%xcc, 0b
	 add	%o1, 8, %o1
	clr	%o0
	retl
	 not	%o0

/*
 * %o0 = slot number
 * %o1 = pa
 * %o2 = va
 * %o3 = flags
 */
ENTRY(itlb_enter)
	rdpr	%pstate, %o4
	wrpr	%o4, PSTATE_IE, %pstate
	sllx	%o0, 3, %o0
	or	%o1, %o3, %o1
	mov	AA_IMMU_TAR, %o3
	stxa	%o2, [%o3] ASI_IMMU
	stxa	%o1, [%o0] ASI_ITLB_DATA_ACCESS_REG
	membar	#Sync
	retl
	 wrpr	%o4, 0, %pstate

ENTRY(dtlb_enter)
	rdpr	%pstate, %o4
	wrpr	%o4, PSTATE_IE, %pstate
	sllx	%o0, 3, %o0
	or	%o1, %o3, %o1
	mov	AA_DMMU_TAR, %o3
	stxa	%o2, [%o3] ASI_DMMU
	stxa	%o1, [%o0] ASI_DTLB_DATA_ACCESS_REG
	membar	#Sync
	retl
	 wrpr	%o4, 0, %pstate

	.comm	stack, STACK_SIZE, 32
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`/*`
			`* Initial implementation:`
			`* Copyright (c) 2001 Robert Drehmel`
			`* All rights reserved.`
			`*`
			`* As long as the above copyright statement and this notice remain`
			`* unchanged, you can do what ever you want with this file.`
			`*`
			`* $FreeBSD$`
			`*/`
			`#include <machine/asi.h>`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`#include <machine/asm.h>`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`#include <machine/pstate.h>`
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00
			`#define PAGE_SIZE 8192`
			`#define PAGE_SHIFT 13`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`#define SPOFF 2047`
			`#define STACK_SIZE (2 * PAGE_SIZE)`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`ENTRY(_start)`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`/* limit interrupts */`
			`wrpr %g0, 13, %pil`

			`/*`
			`* PSTATE: privileged, interrupts enabled, floating point`
			`* unit enabled`
			`*/`
			`wrpr %g0, PSTATE_PRIV\|PSTATE_IE\|PSTATE_PEF, %pstate`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`wr %g0, 0x4, %fprs`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00			`setx stack + STACK_SIZE - SPOFF - CCFSZ, %l7, %l6`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`mov %l6, %sp`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`call main`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`mov %o4, %o0`
			`illtrap`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00
			`/*`
			`* %o0 input VA constant`
			`* %o1 current iTLB offset`
			`* %o2 current iTLB TTE tag`
			`*/`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`ENTRY(itlb_va_to_pa)`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`clr %o1`
			`0: ldxa [%o1] ASI_ITLB_TAG_READ_REG, %o2`
			`cmp %o2, %o0`
			`bne,a %xcc, 1f`
			`nop`
			`/* return PA of matching entry */`
			`ldxa [%o1] ASI_ITLB_DATA_ACCESS_REG, %o0`
			`sllx %o0, 23, %o0`
			`srlx %o0, PAGE_SHIFT+23, %o0`
			`sllx %o0, PAGE_SHIFT, %o0`
			`retl`
			`mov %o0, %o1`
			`1: cmp %o1, 63<<3`
			`blu %xcc, 0b`
			`add %o1, 8, %o1`
			`clr %o0`
			`retl`
			`not %o0`

Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`ENTRY(dtlb_va_to_pa)`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`clr %o1`
			`0: ldxa [%o1] ASI_DTLB_TAG_READ_REG, %o2`
			`cmp %o2, %o0`
			`bne,a %xcc, 1f`
			`nop`
			`/* return PA of matching entry */`
			`ldxa [%o1] ASI_DTLB_DATA_ACCESS_REG, %o0`
			`sllx %o0, 23, %o0`
			`srlx %o0, PAGE_SHIFT+23, %o0`
			`sllx %o0, PAGE_SHIFT, %o0`
			`retl`
			`mov %o0, %o1`
			`1: cmp %o1, 63<<3`
			`blu %xcc, 0b`
			`add %o1, 8, %o1`
			`clr %o0`
			`retl`
			`not %o0`

			`/*`
			`* %o0 = slot number`
			`* %o1 = pa`
			`* %o2 = va`
			`* %o3 = flags`
			`*/`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`ENTRY(itlb_enter)`
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00			`rdpr %pstate, %o4`
			`wrpr %o4, PSTATE_IE, %pstate`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`sllx %o0, 3, %o0`
			`or %o1, %o3, %o1`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`mov AA_IMMU_TAR, %o3`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`stxa %o2, [%o3] ASI_IMMU`
			`stxa %o1, [%o0] ASI_ITLB_DATA_ACCESS_REG`
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00			`membar #Sync`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`retl`
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00			`wrpr %o4, 0, %pstate`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`ENTRY(dtlb_enter)`
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00			`rdpr %pstate, %o4`
			`wrpr %o4, PSTATE_IE, %pstate`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`sllx %o0, 3, %o0`
			`or %o1, %o3, %o1`
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`mov AA_DMMU_TAR, %o3`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`stxa %o2, [%o3] ASI_DMMU`
			`stxa %o1, [%o0] ASI_DTLB_DATA_ACCESS_REG`
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00			`membar #Sync`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00			`retl`
Allocate a frame on our initial stack so that it doesn't run off into random memory. Disable interrupts while loading the tlb. Submitted by: tmm 2002-02-23 03:38:18 +00:00			`wrpr %o4, 0, %pstate`
Add the FreeBSD/sparc64 boot loader source files. 2001-10-15 14:35:39 +00:00
Use ENTRY() for defining functions in asm. Remove asm functions to call the openfirmware and kernel entry points; we can just call them directly. Don't use the stack pointer for an intermediate result in setx. Put the stack in the bss. 2001-10-30 06:27:34 +00:00			`.comm stack, STACK_SIZE, 32`