version 1.47.4.4, 2007/08/14 10:49:59 |
version 1.50.2.1, 2007/09/23 18:28:16 |
|
|
/* $NetBSD$ */ |
/* $NetBSD$ */ |
|
|
|
/* |
|
* Copyright-o-rama! |
|
*/ |
|
|
|
/* |
|
* Copyright (c) 2001 Wasabi Systems, Inc. |
|
* All rights reserved. |
|
* |
|
* Written by Frank van der Linden for Wasabi Systems, Inc. |
|
* |
|
* Redistribution and use in source and binary forms, with or without |
|
* modification, are permitted provided that the following conditions |
|
* are met: |
|
* 1. Redistributions of source code must retain the above copyright |
|
* notice, this list of conditions and the following disclaimer. |
|
* 2. Redistributions in binary form must reproduce the above copyright |
|
* notice, this list of conditions and the following disclaimer in the |
|
* documentation and/or other materials provided with the distribution. |
|
* 3. All advertising materials mentioning features or use of this software |
|
* must display the following acknowledgement: |
|
* This product includes software developed for the NetBSD Project by |
|
* Wasabi Systems, Inc. |
|
* 4. The name of Wasabi Systems, Inc. may not be used to endorse |
|
* or promote products derived from this software without specific prior |
|
* written permission. |
|
* |
|
* THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND |
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED |
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC |
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
|
* POSSIBILITY OF SUCH DAMAGE. |
|
*/ |
|
|
|
|
/*- |
/*- |
* Copyright (c) 1998, 2000, 2004, 2006, 2007 The NetBSD Foundation, Inc. |
* Copyright (c) 1998, 2000, 2004, 2006, 2007 The NetBSD Foundation, Inc. |
* All rights reserved. |
* All rights reserved. |
Line 387 try586: /* Use the `cpuid' instruction. |
|
Line 427 try586: /* Use the `cpuid' instruction. |
|
* text | data | bss | [syms] | page dir | proc0 kstack |
* text | data | bss | [syms] | page dir | proc0 kstack |
* 0 1 2 3 |
* 0 1 2 3 |
*/ |
*/ |
#define PROC0PDIR ((0) * PAGE_SIZE) |
|
#define PROC0STACK ((1) * PAGE_SIZE) |
#define PROC0_PDIR_OFF 0 |
#define SYSMAP ((1+UPAGES) * PAGE_SIZE) |
#define PROC0_STK_OFF (PROC0_PDIR_OFF + PAGE_SIZE) |
#define TABLESIZE ((1+UPAGES) * PAGE_SIZE) /* + nkpde * PAGE_SIZE */ |
#define PROC0_PTP1_OFF (PROC0_STK_OFF + UPAGES * PAGE_SIZE) |
|
|
|
#define TABLESIZE ((NKL2_KIMG_ENTRIES + 1 + UPAGES) * PAGE_SIZE) |
|
|
|
/* |
|
* fillkpt |
|
* eax = pte (page frame | control | status) |
|
* ebx = page table address |
|
* ecx = number of pages to map |
|
*/ |
|
|
|
#define fillkpt \ |
|
1: movl %eax,(%ebx) ; /* store phys addr */ \ |
|
addl $4,%ebx ; /* next pte/pde */ \ |
|
addl $PAGE_SIZE,%eax ; /* next phys page */ \ |
|
loop 1b ; \ |
|
|
|
|
/* Find end of kernel image. */ |
/* Find end of kernel image. */ |
movl $RELOC(end),%edi |
movl $RELOC(end),%edi |
Line 404 try586: /* Use the `cpuid' instruction. |
|
Line 460 try586: /* Use the `cpuid' instruction. |
|
1: |
1: |
#endif |
#endif |
|
|
/* Calculate where to start the bootstrap tables. */ |
/* Clear tables */ |
movl %edi,%esi # edi = esym ? esym : end |
movl %edi,%esi # edi = esym ? esym : end |
addl $PGOFSET,%esi # page align up |
addl $PGOFSET,%esi # page align up |
andl $~PGOFSET,%esi |
andl $~PGOFSET,%esi |
|
|
/* |
movl %esi,%edi |
* Calculate the size of the kernel page table directory, and |
|
* how many entries it will have. Adjust nkpde to the actual |
|
* kernel size automatically. Account for the bootstrap tables, |
|
* round up, and add an extra 4MB. |
|
*/ |
|
leal TABLESIZE+NBPD+PDOFSET(%edi),%eax |
|
shrl $PDSHIFT,%eax |
|
movl RELOC(nkpde),%ecx # get nkpde |
|
cmpl %ecx,%eax |
|
jb 1f |
|
movl %eax,%ecx |
|
1: cmpl $NKPTP_MIN,%ecx # larger than min? |
|
jge 1f |
|
movl $NKPTP_MIN,%ecx # set at min |
|
jmp 2f |
|
1: cmpl $NKPTP_MAX,%ecx # larger than max? |
|
jle 2f |
|
movl $NKPTP_MAX,%ecx |
|
2: movl %ecx,RELOC(nkpde) |
|
|
|
/* Clear memory for bootstrap tables. */ |
|
shll $PGSHIFT,%ecx |
|
addl $TABLESIZE,%ecx |
|
addl %esi,%ecx # end of tables |
|
subl %edi,%ecx # size of tables |
|
shrl $2,%ecx |
|
xorl %eax,%eax |
xorl %eax,%eax |
cld |
cld |
|
movl $TABLESIZE,%ecx |
|
shrl $2,%ecx |
rep |
rep |
stosl |
stosl |
|
|
/* |
leal (PROC0_PTP1_OFF)(%esi), %ebx |
* fillkpt |
|
* eax = pte (page frame | control | status) |
|
* ebx = page table address |
|
* ecx = number of pages to map |
|
*/ |
|
#define fillkpt \ |
|
1: movl %eax,(%ebx) ; \ |
|
addl $PAGE_SIZE,%eax ; /* increment physical address */ \ |
|
addl $4,%ebx ; /* next pte */ \ |
|
loop 1b ; |
|
|
|
/* |
/* |
* Build initial page tables. |
* Build initial page tables. |
*/ |
*/ |
/* Calculate end of text segment, rounded to a page. */ |
/* |
leal (RELOC(etext)+PGOFSET),%edx |
* Compute etext - KERNBASE. This can't be > 4G, or we can't deal |
|
* with it anyway, since we can't load it in 32 bit mode. So use |
|
* the bottom 32 bits. |
|
*/ |
|
movl $RELOC(etext),%edx |
|
addl $PGOFSET,%edx |
andl $~PGOFSET,%edx |
andl $~PGOFSET,%edx |
|
|
/* Skip over the first 1MB. */ |
/* |
|
* Skip the first MB. |
|
*/ |
movl $_RELOC(KERNTEXTOFF),%eax |
movl $_RELOC(KERNTEXTOFF),%eax |
movl %eax,%ecx |
movl %eax,%ecx |
shrl $PGSHIFT,%ecx |
shrl $(PGSHIFT-2),%ecx /* ((n >> PGSHIFT) << 2) for # pdes */ |
leal (SYSMAP)(%esi,%ecx,4),%ebx |
addl %ecx,%ebx |
|
|
/* Map the kernel text read-only. */ |
/* Map the kernel text read-only. */ |
movl %edx,%ecx |
movl %edx,%ecx |
Line 475 try586: /* Use the `cpuid' instruction. |
|
Line 504 try586: /* Use the `cpuid' instruction. |
|
|
|
/* Map the data, BSS, and bootstrap tables read-write. */ |
/* Map the data, BSS, and bootstrap tables read-write. */ |
leal (PG_V|PG_KW)(%edx),%eax |
leal (PG_V|PG_KW)(%edx),%eax |
movl RELOC(nkpde),%ecx |
movl $TABLESIZE,%ecx |
shll $PGSHIFT,%ecx |
|
addl $TABLESIZE,%ecx |
|
addl %esi,%ecx # end of tables |
addl %esi,%ecx # end of tables |
subl %edx,%ecx # subtract end of text |
subl %edx,%ecx # subtract end of text |
shrl $PGSHIFT,%ecx |
shrl $PGSHIFT,%ecx |
fillkpt |
fillkpt |
|
|
/* Map ISA I/O memory. */ |
/* Map ISA I/O mem (later atdevbase) */ |
movl $(IOM_BEGIN|PG_V|PG_KW/*|PG_N*/),%eax # having these bits set |
movl $(IOM_BEGIN|PG_V|PG_KW/*|PG_N*/),%eax # having these bits set |
movl $(IOM_SIZE>>PGSHIFT),%ecx # for this many pte s, |
movl $(IOM_SIZE>>PGSHIFT),%ecx # for this many pte s, |
fillkpt |
fillkpt |
Line 491 try586: /* Use the `cpuid' instruction. |
|
Line 518 try586: /* Use the `cpuid' instruction. |
|
/* |
/* |
* Construct a page table directory. |
* Construct a page table directory. |
*/ |
*/ |
/* Install PDEs for temporary double map of kernel. */ |
/* Set up top level entries for identity mapping */ |
movl RELOC(nkpde),%ecx # for this many pde s, |
leal (PROC0_PDIR_OFF)(%esi),%ebx |
leal (PROC0PDIR+0*4)(%esi),%ebx # which is where temp maps! |
leal (PROC0_PTP1_OFF)(%esi),%eax |
leal (SYSMAP+PG_V|PG_KW)(%esi),%eax # pte for KPT in proc 0, |
orl $(PG_V|PG_KW), %eax |
|
movl $NKL2_KIMG_ENTRIES,%ecx |
fillkpt |
fillkpt |
|
|
/* Map kernel PDEs. */ |
/* Set up top level entries for actual kernel mapping */ |
movl RELOC(nkpde),%ecx # for this many pde s, |
leal (PROC0_PDIR_OFF + L2_SLOT_KERNBASE*4)(%esi),%ebx |
leal (PROC0PDIR+PDSLOT_KERN*4)(%esi),%ebx # kernel pde offset |
leal (PROC0_PTP1_OFF)(%esi),%eax |
leal (SYSMAP+PG_V|PG_KW)(%esi),%eax # pte for KPT in proc 0, |
orl $(PG_V|PG_KW), %eax |
|
movl $NKL2_KIMG_ENTRIES,%ecx |
fillkpt |
fillkpt |
|
|
/* Install a PDE recursively mapping page directory as a page table! */ |
/* Install a PDE recursively mapping page directory as a page table! */ |
leal (PROC0PDIR+PG_V|PG_KW)(%esi),%eax # pte for ptd |
leal (PROC0_PDIR_OFF + PDIR_SLOT_PTE*4)(%esi),%ebx |
movl %eax,(PROC0PDIR+PDSLOT_PTE*4)(%esi) # recursive PD slot |
leal (PROC0_PDIR_OFF)(%esi),%eax |
|
orl $(PG_V|PG_KW),%eax |
|
movl %eax,(%ebx) |
|
|
|
|
/* Save phys. addr of PDP, for libkvm. */ |
/* Save phys. addr of PDP, for libkvm. */ |
movl %esi,RELOC(PDPpaddr) |
movl %esi,RELOC(PDPpaddr) |
|
|
/* Load base of page directory and enable mapping. */ |
/* |
|
* Startup checklist: |
|
* 1. Load %cr3 with pointer to PDIR. |
|
*/ |
movl %esi,%eax # phys address of ptd in proc 0 |
movl %esi,%eax # phys address of ptd in proc 0 |
movl %eax,%cr3 # load ptd addr into mmu |
movl %eax,%cr3 # load ptd addr into mmu |
|
|
|
/* |
|
* 2. Enable paging and the rest of it. |
|
*/ |
movl %cr0,%eax # get control word |
movl %cr0,%eax # get control word |
# enable paging & NPX emulation |
# enable paging & NPX emulation |
orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_EM|CR0_MP),%eax |
orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_EM|CR0_MP),%eax |
Line 522 try586: /* Use the `cpuid' instruction. |
|
Line 561 try586: /* Use the `cpuid' instruction. |
|
ret |
ret |
|
|
begin: |
begin: |
/* Now running relocated at KERNBASE. Remove double mapping. */ |
/* |
movl _C_LABEL(nkpde),%ecx # for this many pde s, |
* We have arrived. |
leal (PROC0PDIR+0*4)(%esi),%ebx # which is where temp maps! |
* There's no need anymore for the identity mapping in low |
addl $(KERNBASE), %ebx # now use relocated address |
* memory, remove it. |
|
*/ |
|
movl $NKL2_KIMG_ENTRIES,%ecx |
|
leal (PROC0_PDIR_OFF)(%esi),%ebx # old, phys address of PDIR |
|
addl $(KERNBASE), %ebx # new, virtual address of PDIR |
1: movl $0,(%ebx) |
1: movl $0,(%ebx) |
addl $4,%ebx # next pde |
addl $4,%ebx |
loop 1b |
loop 1b |
|
|
/* Relocate atdevbase. */ |
/* Relocate atdevbase. */ |
movl _C_LABEL(nkpde),%edx |
movl $(TABLESIZE+KERNBASE),%edx |
shll $PGSHIFT,%edx |
|
addl $(TABLESIZE+KERNBASE),%edx |
|
addl %esi,%edx |
addl %esi,%edx |
movl %edx,_C_LABEL(atdevbase) |
movl %edx,_C_LABEL(atdevbase) |
|
|
/* Set up bootstrap stack. */ |
/* Set up bootstrap stack. */ |
leal (PROC0STACK+KERNBASE)(%esi),%eax |
leal (PROC0_STK_OFF+KERNBASE)(%esi),%eax |
movl %eax,_C_LABEL(proc0uarea) |
movl %eax,_C_LABEL(proc0uarea) |
leal (KSTACK_SIZE-FRAMESIZE)(%eax),%esp |
leal (KSTACK_SIZE-FRAMESIZE)(%eax),%esp |
movl %esi,(KSTACK_SIZE+PCB_CR3)(%eax) # pcb->pcb_cr3 |
movl %esi,(KSTACK_SIZE+PCB_CR3)(%eax) # pcb->pcb_cr3 |
|
|
call _C_LABEL(initgdt) |
call _C_LABEL(initgdt) |
addl $4,%esp |
addl $4,%esp |
|
|
movl _C_LABEL(nkpde),%eax |
movl $TABLESIZE,%eax |
shll $PGSHIFT,%eax |
|
addl $TABLESIZE,%eax |
|
addl %esi,%eax # skip past stack and page tables |
addl %esi,%eax # skip past stack and page tables |
|
|
pushl %eax |
pushl %eax |
|
|
ret |
ret |
|
|
/* |
/* |
* struct lwp *cpu_switchto(struct lwp *oldlwp, struct newlwp, |
* struct lwp *cpu_switchto(struct lwp *oldlwp, struct newlwp) |
* bool returning) |
|
* |
* |
* 1. if (oldlwp != NULL), save its context. |
* 1. if (oldlwp != NULL), save its context. |
* 2. then, restore context of newlwp. |
* 2. then, restore context of newlwp. |
Line 722 ENTRY(cpu_switchto) |
|
Line 760 ENTRY(cpu_switchto) |
|
|
|
movl 16(%esp),%esi # oldlwp |
movl 16(%esp),%esi # oldlwp |
movl 20(%esp),%edi # newlwp |
movl 20(%esp),%edi # newlwp |
movl 24(%esp),%edx # returning |
|
testl %esi,%esi |
testl %esi,%esi |
jz 1f |
jz 1f |
|
|
Line 736 ENTRY(cpu_switchto) |
|
Line 773 ENTRY(cpu_switchto) |
|
movl PCB_EBP(%ebx),%ebp |
movl PCB_EBP(%ebx),%ebp |
movl PCB_ESP(%ebx),%esp |
movl PCB_ESP(%ebx),%esp |
|
|
/* Set curlwp. */ |
|
movl %edi,CPUVAR(CURLWP) |
|
|
|
/* Skip the rest if returning to a pinned LWP. */ |
|
testl %edx,%edx |
|
jnz 4f |
|
|
|
/* Switch TSS. Reset "task busy" flag before loading. */ |
/* Switch TSS. Reset "task busy" flag before loading. */ |
movl %cr3,%eax |
movl %cr3,%eax |
movl %eax,PCB_CR3(%ebx) # for TSS gates |
movl %eax,PCB_CR3(%ebx) # for TSS gates |
Line 751 ENTRY(cpu_switchto) |
|
Line 781 ENTRY(cpu_switchto) |
|
andl $~0x0200,4(%eax,%edx, 1) |
andl $~0x0200,4(%eax,%edx, 1) |
ltr %dx |
ltr %dx |
|
|
|
/* Set curlwp. */ |
|
movl %edi,CPUVAR(CURLWP) |
|
|
/* Don't bother with the rest if switching to a system process. */ |
/* Don't bother with the rest if switching to a system process. */ |
testl $LW_SYSTEM,L_FLAG(%edi) |
testl $LW_SYSTEM,L_FLAG(%edi) |
jnz 4f |
jnz 4f |
Line 798 ENTRY(cpu_switchto) |
|
Line 831 ENTRY(cpu_switchto) |
|
addl $8,%esp |
addl $8,%esp |
cmpl $-1,%eax |
cmpl $-1,%eax |
je 2b |
je 2b |
movl %eax,TF_EIP(%ebx) |
movl L_MD_REGS(%edi),%ecx |
|
movl %eax,TF_EIP(%ecx) |
jmp 2b |
jmp 2b |
|
|
/* |
/* |