version 1.80, 2008/11/13 10:53:30 |
version 1.115, 2016/05/11 17:48:05 |
|
|
* 2. Redistributions in binary form must reproduce the above copyright |
* 2. Redistributions in binary form must reproduce the above copyright |
* notice, this list of conditions and the following disclaimer in the |
* notice, this list of conditions and the following disclaimer in the |
* documentation and/or other materials provided with the distribution. |
* 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 by Manuel Bouyer. |
|
* 4. The name of the author may not be used to endorse or promote products |
|
* derived from this software without specific prior written permission. |
|
* |
* |
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
|
|
* POSSIBILITY OF SUCH DAMAGE. |
* POSSIBILITY OF SUCH DAMAGE. |
*/ |
*/ |
|
|
|
|
/*- |
/*- |
* Copyright (c) 1998, 2000, 2004, 2006, 2007 The NetBSD Foundation, Inc. |
* Copyright (c) 1998, 2000, 2004, 2006, 2007, 2009 The NetBSD Foundation, Inc. |
* All rights reserved. |
* All rights reserved. |
* |
* |
* This code is derived from software contributed to The NetBSD Foundation |
* This code is derived from software contributed to The NetBSD Foundation |
* by Charles M. Hannum. |
* by Charles M. Hannum, and by Andrew Doran. |
* |
* |
* Redistribution and use in source and binary forms, with or without |
* Redistribution and use in source and binary forms, with or without |
* modification, are permitted provided that the following conditions |
* modification, are permitted provided that the following conditions |
|
|
__KERNEL_RCSID(0, "$NetBSD$"); |
__KERNEL_RCSID(0, "$NetBSD$"); |
|
|
#include "opt_compat_oldboot.h" |
#include "opt_compat_oldboot.h" |
|
#include "opt_copy_symtab.h" |
#include "opt_ddb.h" |
#include "opt_ddb.h" |
|
#include "opt_modular.h" |
#include "opt_multiboot.h" |
#include "opt_multiboot.h" |
#include "opt_realmem.h" |
#include "opt_realmem.h" |
#include "opt_vm86.h" |
#include "opt_vm86.h" |
#include "opt_xen.h" |
#include "opt_xen.h" |
|
|
#include "npx.h" |
|
#include "assym.h" |
#include "assym.h" |
#include "lapic.h" |
#include "lapic.h" |
#include "ioapic.h" |
#include "ioapic.h" |
Line 163 __KERNEL_RCSID(0, "$NetBSD$"); |
|
Line 158 __KERNEL_RCSID(0, "$NetBSD$"); |
|
#include <machine/multiboot.h> |
#include <machine/multiboot.h> |
#endif |
#endif |
|
|
/* XXX temporary kluge; these should not be here */ |
|
/* Get definitions for IOM_BEGIN, IOM_END, and IOM_SIZE */ |
/* Get definitions for IOM_BEGIN, IOM_END, and IOM_SIZE */ |
#include <dev/isa/isareg.h> |
#include <dev/isa/isareg.h> |
|
|
|
#ifndef XEN |
|
#define _RELOC(x) ((x) - KERNBASE) |
|
#else |
|
#define _RELOC(x) ((x)) |
|
#endif /* XEN */ |
|
#define RELOC(x) _RELOC(_C_LABEL(x)) |
|
|
|
#ifndef PAE |
|
#define PROC0_PDIR_OFF 0 |
|
#else |
|
#define PROC0_L3_OFF 0 |
|
#define PROC0_PDIR_OFF 1 * PAGE_SIZE |
|
#endif |
|
|
|
#define PROC0_STK_OFF (PROC0_PDIR_OFF + PDP_SIZE * PAGE_SIZE) |
|
#define PROC0_PTP1_OFF (PROC0_STK_OFF + UPAGES * PAGE_SIZE) |
|
|
|
/* |
|
* fillkpt - Fill in a kernel page table |
|
* eax = pte (page frame | control | status) |
|
* ebx = page table address |
|
* ecx = number of pages to map |
|
* |
|
* For PAE, each entry is 8 bytes long: we must set the 4 upper bytes to 0. |
|
* This is done by the first instruction of fillkpt. In the non-PAE case, this |
|
* instruction just clears the page table entry. |
|
*/ |
|
|
|
#define fillkpt \ |
|
1: movl $0,(PDE_SIZE-4)(%ebx) ; /* upper 32 bits: 0 */ \ |
|
movl %eax,(%ebx) ; /* store phys addr */ \ |
|
addl $PDE_SIZE,%ebx ; /* next PTE/PDE */ \ |
|
addl $PAGE_SIZE,%eax ; /* next phys page */ \ |
|
loop 1b ; |
|
|
|
|
#ifdef XEN |
#ifdef XEN |
/* |
/* |
* Xen guest identifier and loader selection |
* Xen guest identifier and loader selection |
*/ |
*/ |
.section __xen_guest |
.section __xen_guest |
#ifdef XEN3 |
|
.ascii "GUEST_OS=netbsd,GUEST_VER=3.0,XEN_VER=xen-3.0" |
.ascii "GUEST_OS=netbsd,GUEST_VER=3.0,XEN_VER=xen-3.0" |
#if defined(DOM0OPS) || !defined(XEN_COMPAT_030001) |
.ascii ",VIRT_BASE=0xc0000000" /* KERNBASE */ |
.ascii ",VIRT_BASE=0xc0000000" /* KERNBASE */ |
.ascii ",ELF_PADDR_OFFSET=0xc0000000" /* KERNBASE */ |
.ascii ",ELF_PADDR_OFFSET=0xc0000000" /* KERNBASE */ |
.ascii ",VIRT_ENTRY=0xc0100000" /* KERNTEXTOFF */ |
#else |
.ascii ",HYPERCALL_PAGE=0x00000101" |
.ascii ",VIRT_BASE=0xc0100000" /* KERNTEXTOFF */ |
|
.ascii ",ELF_PADDR_OFFSET=0xc0100000" /* KERNTEXTOFF */ |
|
#endif |
|
.ascii ",VIRT_ENTRY=0xc0100000" /* KERNTEXTOFF */ |
|
#if !defined(XEN_COMPAT_030001) |
|
.ascii ",HYPERCALL_PAGE=0x00000101" |
|
/* (???+HYPERCALL_PAGE_OFFSET)/PAGE_SIZE) */ |
/* (???+HYPERCALL_PAGE_OFFSET)/PAGE_SIZE) */ |
#endif |
|
#ifdef PAE |
#ifdef PAE |
.ascii ",PAE=yes[extended-cr3]" |
.ascii ",PAE=yes[extended-cr3]" |
#endif |
#endif |
#else /* !XEN3 */ |
|
.ascii "GUEST_OS=netbsd,GUEST_VER=2.0,XEN_VER=2.0" |
|
#endif /* XEN3 */ |
|
.ascii ",LOADER=generic" |
.ascii ",LOADER=generic" |
#if (NKSYMS || defined(DDB) || defined(MODULAR)) && !defined(SYMTAB_SPACE) |
#if (NKSYMS || defined(DDB) || defined(MODULAR)) && !defined(makeoptions_COPY_SYMTAB) |
.ascii ",BSD_SYMTAB=yes" |
.ascii ",BSD_SYMTAB=yes" |
#endif |
#endif |
.byte 0 |
.byte 0 |
#endif |
#endif /* XEN */ |
|
|
/* |
/* |
* Initialization |
* Initialization |
*/ |
*/ |
.data |
.data |
|
|
.globl _C_LABEL(cpu) |
.globl _C_LABEL(cputype) |
.globl _C_LABEL(cpuid_level) |
.globl _C_LABEL(cpuid_level) |
.globl _C_LABEL(esym) |
.globl _C_LABEL(esym) |
.globl _C_LABEL(eblob) |
.globl _C_LABEL(eblob) |
.globl _C_LABEL(atdevbase) |
.globl _C_LABEL(atdevbase) |
.globl _C_LABEL(proc0uarea),_C_LABEL(PDPpaddr) |
.globl _C_LABEL(lwp0uarea) |
|
.globl _C_LABEL(PDPpaddr) |
.globl _C_LABEL(gdt) |
.globl _C_LABEL(gdt) |
.globl _C_LABEL(idt) |
.globl _C_LABEL(idt) |
.globl _C_LABEL(lapic_tpr) |
.globl _C_LABEL(lapic_tpr) |
Line 221 __KERNEL_RCSID(0, "$NetBSD$"); |
|
Line 241 __KERNEL_RCSID(0, "$NetBSD$"); |
|
.align 12 |
.align 12 |
#endif |
#endif |
.globl _C_LABEL(local_apic), _C_LABEL(lapic_id) |
.globl _C_LABEL(local_apic), _C_LABEL(lapic_id) |
_C_LABEL(local_apic): |
.type _C_LABEL(local_apic), @object |
|
LABEL(local_apic) |
.space LAPIC_ID |
.space LAPIC_ID |
_C_LABEL(lapic_id): |
END(local_apic) |
|
.type _C_LABEL(lapic_id), @object |
|
LABEL(lapic_id) |
.long 0x00000000 |
.long 0x00000000 |
.space LAPIC_TPRI-(LAPIC_ID+4) |
.space LAPIC_TPRI-(LAPIC_ID+4) |
_C_LABEL(lapic_tpr): |
END(lapic_id) |
.space LAPIC_PPRI-LAPIC_TPRI |
.type _C_LABEL(lapic_tpr), @object |
|
LABEL(lapic_tpr) |
|
.space LAPIC_PPRI-LAPIC_TPRI |
|
END(lapic_tpr) |
|
.type _C_LABEL(lapic_ppr), @object |
_C_LABEL(lapic_ppr): |
_C_LABEL(lapic_ppr): |
.space LAPIC_ISR-LAPIC_PPRI |
.space LAPIC_ISR-LAPIC_PPRI |
|
END(lapic_ppr) |
|
.type _C_LABEL(lapic_isr), @object |
_C_LABEL(lapic_isr): |
_C_LABEL(lapic_isr): |
.space PAGE_SIZE-LAPIC_ISR |
.space PAGE_SIZE-LAPIC_ISR |
|
END(lapic_isr) |
#else |
#else |
_C_LABEL(lapic_tpr): |
.type _C_LABEL(lapic_tpr), @object |
|
LABEL(lapic_tpr) |
.long 0 |
.long 0 |
|
END(lapic_tpr) |
#endif |
#endif |
|
.type _C_LABEL(cputype), @object |
_C_LABEL(cpu): .long 0 # are we 80486, Pentium, or.. |
LABEL(cputype) .long 0 /* are we 80486, Pentium, or.. */ |
_C_LABEL(cpuid_level): .long 0 |
END(cputype) |
_C_LABEL(atdevbase): .long 0 # location of start of iomem in virtual |
.type _C_LABEL(cpuid_level), @object |
_C_LABEL(proc0uarea): .long 0 |
LABEL(cpuid_level) .long 0 |
_C_LABEL(PDPpaddr): .long 0 # paddr of PDP, for libkvm |
END(cpuid_level) |
|
.type _C_LABEL(atdevbase), @object |
|
LABEL(atdevbase) .long 0 /* location of start of iomem in virt */ |
|
END(atdevbase) |
|
.type _C_LABEL(lwp0uarea), @object |
|
LABEL(lwp0uarea) .long 0 |
|
END(lwp0uarea) |
|
.type _C_LABEL(PDPpaddr), @object |
|
LABEL(PDPpaddr) .long 0 /* paddr of PDP, for libkvm */ |
|
END(PDPpaddr) |
|
.type _C_LABEL(tablesize), @object |
_C_LABEL(tablesize): .long 0 |
_C_LABEL(tablesize): .long 0 |
|
END(tablesize) |
|
|
.space 512 |
/* Space for the temporary stack */ |
|
.size tmpstk, tmpstk - . |
|
.space 512 |
tmpstk: |
tmpstk: |
|
#ifdef XEN |
#ifndef XEN |
.align PAGE_SIZE, 0x0 /* Align on page boundary */ |
#define _RELOC(x) ((x) - KERNBASE) |
LABEL(tmpgdt) |
#else |
.space PAGE_SIZE /* Xen expects a page */ |
#define _RELOC(x) ((x)) |
END(tmpgdt) |
#endif /* XEN */ |
#endif /* XEN */ |
#define RELOC(x) _RELOC(_C_LABEL(x)) |
|
|
|
.text |
.text |
.globl _C_LABEL(kernel_text) |
.globl _C_LABEL(kernel_text) |
.set _C_LABEL(kernel_text),KERNTEXTOFF |
.set _C_LABEL(kernel_text),KERNTEXTOFF |
|
|
.globl start |
ENTRY(start) |
#ifndef XEN |
#ifndef XEN |
start: movw $0x1234,0x472 # warm boot |
|
|
/* Warm boot */ |
|
movw $0x1234,0x472 |
|
|
#if defined(MULTIBOOT) |
#if defined(MULTIBOOT) |
jmp 1f |
jmp 1f |
Line 285 _C_LABEL(Multiboot_Header): |
|
Line 331 _C_LABEL(Multiboot_Header): |
|
* space to process it later -- after we are relocated. It will |
* space to process it later -- after we are relocated. It will |
* be safer to run complex C code than doing it at this point. |
* be safer to run complex C code than doing it at this point. |
*/ |
*/ |
pushl %ebx # Address of Multiboot information |
pushl %ebx /* Address of Multiboot information */ |
call _C_LABEL(multiboot_pre_reloc) |
call _C_LABEL(multiboot_pre_reloc) |
addl $4,%esp |
addl $4,%esp |
jmp 2f |
jmp 2f |
Line 298 _C_LABEL(Multiboot_Header): |
|
Line 344 _C_LABEL(Multiboot_Header): |
|
* (boothowto, [bootdev], bootinfo, esym, biosextmem, biosbasemem), |
* (boothowto, [bootdev], bootinfo, esym, biosextmem, biosbasemem), |
* 4 bytes each. |
* 4 bytes each. |
*/ |
*/ |
addl $4,%esp # Discard return address to boot loader |
addl $4,%esp /* Discard return address to boot loader */ |
call _C_LABEL(native_loader) |
call _C_LABEL(native_loader) |
addl $24,%esp |
addl $24,%esp |
|
|
|
|
* Don't try cpuid, as Nx586s reportedly don't support the |
* Don't try cpuid, as Nx586s reportedly don't support the |
* PSL_ID bit. |
* PSL_ID bit. |
*/ |
*/ |
movl $CPU_NX586,RELOC(cpu) |
movl $CPU_NX586,RELOC(cputype) |
jmp 2f |
jmp 2f |
|
|
is386: |
is386: |
movl $CPU_386,RELOC(cpu) |
movl $CPU_386,RELOC(cputype) |
jmp 2f |
jmp 2f |
|
|
try486: /* Try to toggle identification flag; does not exist on early 486s. */ |
try486: /* Try to toggle identification flag; does not exist on early 486s. */ |
Line 372 try486: /* Try to toggle identification |
|
Line 418 try486: /* Try to toggle identification |
|
|
|
testl %eax,%eax |
testl %eax,%eax |
jnz try586 |
jnz try586 |
is486: movl $CPU_486,RELOC(cpu) |
is486: movl $CPU_486,RELOC(cputype) |
/* |
/* |
* Check Cyrix CPU |
* Check Cyrix CPU |
* Cyrix CPUs do not change the undefined flags following |
* Cyrix CPUs do not change the undefined flags following |
Line 390 is486: movl $CPU_486,RELOC(cpu) |
|
Line 436 is486: movl $CPU_486,RELOC(cpu) |
|
popfl |
popfl |
jmp 2f |
jmp 2f |
trycyrix486: |
trycyrix486: |
movl $CPU_6x86,RELOC(cpu) # set CPU type |
movl $CPU_6x86,RELOC(cputype) /* set CPU type */ |
/* |
/* |
* Check for Cyrix 486 CPU by seeing if the flags change during a |
* Check for Cyrix 486 CPU by seeing if the flags change during a |
* divide. This is documented in the Cx486SLC/e SMM Programmer's |
* divide. This is documented in the Cx486SLC/e SMM Programmer's |
* Guide. |
* Guide. |
*/ |
*/ |
xorl %edx,%edx |
xorl %edx,%edx |
cmpl %edx,%edx # set flags to known state |
cmpl %edx,%edx /* set flags to known state */ |
pushfl |
pushfl |
popl %ecx # store flags in ecx |
popl %ecx /* store flags in ecx */ |
movl $-1,%eax |
movl $-1,%eax |
movl $4,%ebx |
movl $4,%ebx |
divl %ebx # do a long division |
divl %ebx /* do a long division */ |
pushfl |
pushfl |
popl %eax |
popl %eax |
xorl %ecx,%eax # are the flags different? |
xorl %ecx,%eax /* are the flags different? */ |
testl $0x8d5,%eax # only check C|PF|AF|Z|N|V |
testl $0x8d5,%eax /* only check C|PF|AF|Z|N|V */ |
jne 2f # yes; must be Cyrix 6x86 CPU |
jne 2f /* yes; must be Cyrix 6x86 CPU */ |
movl $CPU_486DLC,RELOC(cpu) # set CPU type |
movl $CPU_486DLC,RELOC(cputype) /* set CPU type */ |
|
|
#ifndef CYRIX_CACHE_WORKS |
#ifndef CYRIX_CACHE_WORKS |
/* Disable caching of the ISA hole only. */ |
/* Disable caching of the ISA hole only. */ |
invd |
invd |
movb $CCR0,%al # Configuration Register index (CCR0) |
movb $CCR0,%al /* Configuration Register index (CCR0) */ |
outb %al,$0x22 |
outb %al,$0x22 |
inb $0x23,%al |
inb $0x23,%al |
orb $(CCR0_NC1|CCR0_BARB),%al |
orb $(CCR0_NC1|CCR0_BARB),%al |
|
|
invd |
invd |
#else /* CYRIX_CACHE_WORKS */ |
#else /* CYRIX_CACHE_WORKS */ |
/* Set cache parameters */ |
/* Set cache parameters */ |
invd # Start with guaranteed clean cache |
invd /* Start with guaranteed clean cache */ |
movb $CCR0,%al # Configuration Register index (CCR0) |
movb $CCR0,%al /* Configuration Register index (CCR0) */ |
outb %al,$0x22 |
outb %al,$0x22 |
inb $0x23,%al |
inb $0x23,%al |
andb $~CCR0_NC0,%al |
andb $~CCR0_NC0,%al |
Line 484 try586: /* Use the `cpuid' instruction. |
|
Line 530 try586: /* Use the `cpuid' instruction. |
|
* The boot program should check: |
* The boot program should check: |
* text+data <= &stack_variable - more_space_for_stack |
* text+data <= &stack_variable - more_space_for_stack |
* text+data+bss+pad+space_for_page_tables <= end_of_memory |
* text+data+bss+pad+space_for_page_tables <= end_of_memory |
* Oops, the gdt is in the carcass of the boot program so clearing |
* |
|
* XXX: the gdt is in the carcass of the boot program so clearing |
* the rest of memory is still not possible. |
* the rest of memory is still not possible. |
*/ |
*/ |
movl $_RELOC(tmpstk),%esp # bootstrap stack end location |
movl $_RELOC(tmpstk),%esp |
|
|
/* |
/* |
* Virtual address space of kernel: |
* Virtual address space of kernel, without PAE. The page dir is 1 page long. |
* |
* |
* text | data | bss | [syms] | [blobs] | page dir | proc0 kstack | L1 ptp |
* text | data | bss | [syms] | [blobs] | page dir | proc0 kstack | L1 ptp |
* 0 1 2 3 |
* 0 1 2 3 |
|
* |
|
* Virtual address space of kernel, with PAE. We need 4 pages for the page dir |
|
* and 1 page for the L3. |
|
* text | data | bss | [syms] | [blobs] | L3 | page dir | proc0 kstack | L1 ptp |
|
* 0 1 5 6 7 |
*/ |
*/ |
|
|
#define PROC0_PDIR_OFF 0 |
|
#define PROC0_STK_OFF (PROC0_PDIR_OFF + PAGE_SIZE) |
|
#define PROC0_PTP1_OFF (PROC0_STK_OFF + 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 |
|
|
#if (NKSYMS || defined(DDB) || defined(MODULAR)) && !defined(SYMTAB_SPACE) |
#if (NKSYMS || defined(DDB) || defined(MODULAR)) && !defined(makeoptions_COPY_SYMTAB) |
/* Save the symbols (if loaded). */ |
/* Save the symbols (if loaded). */ |
movl RELOC(esym),%eax |
movl RELOC(esym),%eax |
testl %eax,%eax |
testl %eax,%eax |
Line 536 try586: /* Use the `cpuid' instruction. |
|
Line 570 try586: /* Use the `cpuid' instruction. |
|
1: |
1: |
/* Compute sizes */ |
/* Compute sizes */ |
movl %edi,%esi |
movl %edi,%esi |
addl $PGOFSET,%esi # page align up |
addl $PGOFSET,%esi |
andl $~PGOFSET,%esi |
andl $~PGOFSET,%esi |
|
|
/* nkptp[1] = (esi + ~L2_FRAME) >> L2_SHIFT + 1; */ |
/* nkptp[1] = (esi + ~L2_FRAME) >> L2_SHIFT + 1; */ |
Line 546 try586: /* Use the `cpuid' instruction. |
|
Line 580 try586: /* Use the `cpuid' instruction. |
|
incl %eax /* one more ptp for VAs stolen by bootstrap */ |
incl %eax /* one more ptp for VAs stolen by bootstrap */ |
1: movl %eax,RELOC(nkptp)+1*4 |
1: movl %eax,RELOC(nkptp)+1*4 |
|
|
/* tablesize = (1 + UPAGES + nkptp) << PGSHIFT; */ |
/* tablesize = (PDP_SIZE + UPAGES + nkptp) << PGSHIFT; */ |
addl $(1+UPAGES),%eax |
addl $(PDP_SIZE+UPAGES),%eax |
|
#ifdef PAE |
|
incl %eax /* one more page for the L3 PD */ |
|
shll $PGSHIFT+1,%eax /* PTP tables are twice larger with PAE */ |
|
#else |
shll $PGSHIFT,%eax |
shll $PGSHIFT,%eax |
|
#endif |
movl %eax,RELOC(tablesize) |
movl %eax,RELOC(tablesize) |
|
|
/* ensure that nkptp covers bootstrap tables */ |
/* ensure that nkptp covers bootstrap tables */ |
Line 559 try586: /* Use the `cpuid' instruction. |
|
Line 598 try586: /* Use the `cpuid' instruction. |
|
cmpl %eax,RELOC(nkptp)+1*4 |
cmpl %eax,RELOC(nkptp)+1*4 |
jnz 1b |
jnz 1b |
|
|
/* Clear tables */ |
/* Clear tables */ |
movl %esi,%edi |
movl %esi,%edi |
xorl %eax,%eax |
xorl %eax,%eax |
cld |
cld |
movl RELOC(tablesize),%ecx |
movl RELOC(tablesize),%ecx |
shrl $2,%ecx |
shrl $2,%ecx |
rep |
rep |
stosl |
stosl |
|
|
leal (PROC0_PTP1_OFF)(%esi), %ebx |
leal (PROC0_PTP1_OFF)(%esi), %ebx |
|
|
/* |
/* |
* Build initial page tables. |
* Build initial page tables. |
*/ |
*/ |
/* |
/* |
* Compute &__data_start - KERNBASE. This can't be > 4G, |
* Compute &__data_start - KERNBASE. This can't be > 4G, |
* or we can't deal with it anyway, since we can't load it in |
* or we can't deal with it anyway, since we can't load it in |
* 32 bit mode. So use the bottom 32 bits. |
* 32 bit mode. So use the bottom 32 bits. |
*/ |
*/ |
movl $RELOC(__data_start),%edx |
movl $RELOC(__data_start),%edx |
andl $~PGOFSET,%edx |
andl $~PGOFSET,%edx |
|
|
/* |
/* |
* Skip the first MB. |
* Skip the first MB. |
*/ |
*/ |
movl $_RELOC(KERNTEXTOFF),%eax |
movl $_RELOC(KERNTEXTOFF),%eax |
movl %eax,%ecx |
movl %eax,%ecx |
shrl $(PGSHIFT-2),%ecx /* ((n >> PGSHIFT) << 2) for # pdes */ |
shrl $(PGSHIFT-2),%ecx /* ((n >> PGSHIFT) << 2) for # pdes */ |
addl %ecx,%ebx |
#ifdef PAE |
|
shll $1,%ecx /* pdes are twice larger with PAE */ |
|
#endif |
|
addl %ecx,%ebx |
|
|
/* Map the kernel text read-only. */ |
/* Map the kernel text read-only. */ |
movl %edx,%ecx |
movl %edx,%ecx |
Line 599 try586: /* Use the `cpuid' instruction. |
|
Line 641 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(tablesize),%ecx |
movl RELOC(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 mem (later atdevbase) */ |
/* 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 |
movl $(IOM_SIZE>>PGSHIFT),%ecx # for this many pte s, |
movl $(IOM_SIZE>>PGSHIFT),%ecx |
fillkpt |
fillkpt |
|
|
/* |
/* |
* Construct a page table directory. |
* Construct a page table directory. |
*/ |
*/ |
/* Set up top level entries for identity mapping */ |
/* Set up top level entries for identity mapping */ |
leal (PROC0_PDIR_OFF)(%esi),%ebx |
leal (PROC0_PDIR_OFF)(%esi),%ebx |
leal (PROC0_PTP1_OFF)(%esi),%eax |
leal (PROC0_PTP1_OFF)(%esi),%eax |
orl $(PG_V|PG_KW), %eax |
orl $(PG_V|PG_KW), %eax |
movl RELOC(nkptp)+1*4,%ecx |
movl RELOC(nkptp)+1*4,%ecx |
fillkpt |
fillkpt |
|
|
/* Set up top level entries for actual kernel mapping */ |
/* Set up top level entries for actual kernel mapping */ |
leal (PROC0_PDIR_OFF + L2_SLOT_KERNBASE*4)(%esi),%ebx |
leal (PROC0_PDIR_OFF + L2_SLOT_KERNBASE*PDE_SIZE)(%esi),%ebx |
leal (PROC0_PTP1_OFF)(%esi),%eax |
leal (PROC0_PTP1_OFF)(%esi),%eax |
orl $(PG_V|PG_KW), %eax |
orl $(PG_V|PG_KW), %eax |
movl RELOC(nkptp)+1*4,%ecx |
movl RELOC(nkptp)+1*4,%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 (PROC0_PDIR_OFF + PDIR_SLOT_PTE*4)(%esi),%ebx |
leal (PROC0_PDIR_OFF + PDIR_SLOT_PTE*PDE_SIZE)(%esi),%ebx |
leal (PROC0_PDIR_OFF)(%esi),%eax |
leal (PROC0_PDIR_OFF)(%esi),%eax |
orl $(PG_V|PG_KW),%eax |
orl $(PG_V|PG_KW),%eax |
movl %eax,(%ebx) |
movl $PDP_SIZE,%ecx |
|
fillkpt |
|
|
|
#ifdef PAE |
|
/* Fill in proc0 L3 page with entries pointing to the page dirs */ |
|
leal (PROC0_L3_OFF)(%esi),%ebx |
|
leal (PROC0_PDIR_OFF)(%esi),%eax |
|
orl $(PG_V),%eax |
|
movl $PDP_SIZE,%ecx |
|
fillkpt |
|
|
|
/* Enable PAE mode */ |
|
movl %cr4,%eax |
|
orl $CR4_PAE,%eax |
|
movl %eax,%cr4 |
|
#endif |
|
|
/* Save phys. addr of PDP, for libkvm. */ |
/* Save phys. addr of PDP, for libkvm. */ |
movl %esi,RELOC(PDPpaddr) |
leal (PROC0_PDIR_OFF)(%esi),%eax |
|
movl %eax,RELOC(PDPpaddr) |
|
|
/* |
/* |
* Startup checklist: |
* Startup checklist: |
* 1. Load %cr3 with pointer to PDIR. |
* 1. Load %cr3 with pointer to PDIR (or L3 PD page for PAE). |
*/ |
*/ |
movl %esi,%eax # phys address of ptd in proc 0 |
movl %esi,%eax /* phys address of PTD in proc0 */ |
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 |
|
# enable paging & NPX emulation |
|
orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_EM|CR0_MP),%eax |
|
movl %eax,%cr0 # and page NOW! |
|
|
|
pushl $begin # jump to high mem |
/* |
|
* 2. Enable paging and the rest of it. |
|
*/ |
|
movl %cr0,%eax |
|
orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_MP|CR0_WP|CR0_AM),%eax |
|
movl %eax,%cr0 |
|
|
|
pushl $begin /* jump to high mem */ |
ret |
ret |
|
|
begin: |
begin: |
/* |
/* |
* We have arrived. |
* We have arrived. |
* There's no need anymore for the identity mapping in low |
* There's no need anymore for the identity mapping in low |
* memory, remove it. |
* memory, remove it. |
*/ |
*/ |
movl _C_LABEL(nkptp)+1*4,%ecx |
movl _C_LABEL(nkptp)+1*4,%ecx |
leal (PROC0_PDIR_OFF)(%esi),%ebx # old, phys address of PDIR |
leal (PROC0_PDIR_OFF)(%esi),%ebx /* old, phys address of PDIR */ |
addl $(KERNBASE), %ebx # new, virtual address of PDIR |
addl $(KERNBASE), %ebx /* new, virt address of PDIR */ |
1: movl $0,(%ebx) |
1: movl $0,(PDE_SIZE-4)(%ebx) /* upper bits (for PAE) */ |
addl $4,%ebx |
movl $0,(%ebx) |
|
addl $PDE_SIZE,%ebx |
loop 1b |
loop 1b |
|
|
/* Relocate atdevbase. */ |
/* Relocate atdevbase. */ |
|
|
movl %edx,_C_LABEL(atdevbase) |
movl %edx,_C_LABEL(atdevbase) |
|
|
/* Set up bootstrap stack. */ |
/* Set up bootstrap stack. */ |
leal (PROC0_STK_OFF+KERNBASE)(%esi),%eax |
leal (PROC0_STK_OFF+KERNBASE)(%esi),%eax |
movl %eax,_C_LABEL(proc0uarea) |
movl %eax,_C_LABEL(lwp0uarea) |
leal (KSTACK_SIZE-FRAMESIZE)(%eax),%esp |
leal (USPACE-FRAMESIZE)(%eax),%esp |
movl %esi,(KSTACK_SIZE+PCB_CR3)(%eax) # pcb->pcb_cr3 |
movl %esi,PCB_CR3(%eax) /* pcb->pcb_cr3 */ |
xorl %ebp,%ebp # mark end of frames |
xorl %ebp,%ebp /* mark end of frames */ |
|
|
#if defined(MULTIBOOT) |
#if defined(MULTIBOOT) |
/* It is now safe to parse the Multiboot information structure |
/* It is now safe to parse the Multiboot information structure |
|
|
call _C_LABEL(multiboot_post_reloc) |
call _C_LABEL(multiboot_post_reloc) |
#endif |
#endif |
|
|
subl $NGDT*8, %esp # space for temporary gdt |
subl $NGDT*8, %esp /* space for temporary gdt */ |
pushl %esp |
pushl %esp |
call _C_LABEL(initgdt) |
call _C_LABEL(initgdt) |
addl $4,%esp |
addl $4,%esp |
|
|
movl _C_LABEL(tablesize),%eax |
movl _C_LABEL(tablesize),%eax |
addl %esi,%eax # skip past stack and page tables |
addl %esi,%eax /* skip past stack and page tables */ |
|
|
|
#ifdef PAE |
|
pushl $0 /* init386() expects a 64 bits paddr_t with PAE */ |
|
#endif |
pushl %eax |
pushl %eax |
call _C_LABEL(init386) # wire 386 chip for unix operation |
call _C_LABEL(init386) /* wire 386 chip for unix operation */ |
addl $4+NGDT*8,%esp # pop temporary gdt |
addl $PDE_SIZE,%esp /* pop paddr_t */ |
|
addl $NGDT*8,%esp /* pop temporary gdt */ |
|
|
#ifdef SAFARI_FIFO_HACK |
#ifdef SAFARI_FIFO_HACK |
movb $5,%al |
movb $5,%al |
|
|
|
|
call _C_LABEL(main) |
call _C_LABEL(main) |
#else /* XEN */ |
#else /* XEN */ |
start: |
|
/* First, reset the PSL. */ |
/* First, reset the PSL. */ |
pushl $PSL_MBO |
pushl $PSL_MBO |
popfl |
popfl |
|
|
cld |
cld |
#ifdef XEN3 |
movl %esp, %ebx /* save start of available space */ |
movl %esp, %ebx # save start of available space |
movl $_RELOC(tmpstk),%esp /* bootstrap stack end location */ |
#else |
|
movl %esi,%ebx # save start_info pointer |
|
#endif |
|
movl $_RELOC(tmpstk),%esp # bootstrap stack end location |
|
|
|
/* Clear BSS first so that there are no surprises... */ |
/* Clear BSS. */ |
xorl %eax,%eax |
xorl %eax,%eax |
movl $RELOC(__bss_start),%edi |
movl $RELOC(__bss_start),%edi |
movl $RELOC(_end),%ecx |
movl $RELOC(_end),%ecx |
|
|
rep stosb |
rep stosb |
|
|
/* Copy the necessary stuff from start_info structure. */ |
/* Copy the necessary stuff from start_info structure. */ |
/* We need to copy shared_info early, so that sti/cli work */ |
/* We need to copy shared_info early, so that sti/cli work */ |
movl $RELOC(start_info_union),%edi |
movl $RELOC(start_info_union),%edi |
movl $128,%ecx |
movl $128,%ecx |
rep movsl |
rep movsl |
|
|
cpuid |
cpuid |
movl %eax,RELOC(cpuid_level) |
movl %eax,RELOC(cpuid_level) |
|
|
|
/* |
|
* Use a temp page. We'll re- add it to uvm(9) once we're |
|
* done using it. |
|
*/ |
|
movl $RELOC(tmpgdt), %eax |
|
pushl %eax /* start of temporary gdt */ |
|
call _C_LABEL(initgdt) |
|
addl $4,%esp |
|
|
call xen_pmap_bootstrap |
call xen_pmap_bootstrap |
|
|
/* |
/* |
* First avail returned by xen_pmap_bootstrap in %eax |
* First avail returned by xen_pmap_bootstrap in %eax |
*/ |
*/ |
movl %eax, %esi; |
movl %eax, %esi; |
movl %esi, _C_LABEL(proc0uarea) |
movl %esi, _C_LABEL(lwp0uarea) |
|
|
#define PROC0PDIR ((0) * PAGE_SIZE) |
|
#define PROC0STACK ((1) * PAGE_SIZE) |
|
|
|
/* Set up bootstrap stack. */ |
/* Set up bootstrap stack. */ |
leal (KSTACK_SIZE-FRAMESIZE)(%eax),%esp |
leal (USPACE-FRAMESIZE)(%eax),%esp |
xorl %ebp,%ebp # mark end of frames |
xorl %ebp,%ebp /* mark end of frames */ |
|
|
addl $USPACE, %esi |
addl $USPACE, %esi |
subl $KERNBASE, %esi #init386 want a physical address |
subl $KERNBASE, %esi /* init386 wants a physical address */ |
|
|
|
#ifdef PAE |
|
pushl $0 /* init386() expects a 64 bits paddr_t with PAE */ |
|
#endif |
pushl %esi |
pushl %esi |
call _C_LABEL(init386) # wire 386 chip for unix operation |
call _C_LABEL(init386) /* wire 386 chip for unix operation */ |
addl $4,%esp |
addl $PDE_SIZE,%esp /* pop paddr_t */ |
call _C_LABEL(main) |
call _C_LABEL(main) |
|
#endif /* XEN */ |
|
END(start) |
|
|
#if defined(XEN3) && !defined(XEN_COMPAT_030001) |
#if defined(XEN) |
/* space for the hypercall call page */ |
/* space for the hypercall call page */ |
#define HYPERCALL_PAGE_OFFSET 0x1000 |
#define HYPERCALL_PAGE_OFFSET 0x1000 |
.org HYPERCALL_PAGE_OFFSET |
.org HYPERCALL_PAGE_OFFSET |
ENTRY(hypercall_page) |
ENTRY(hypercall_page) |
.skip 0x1000 |
.skip 0x1000 |
#endif /* defined(XEN3) && !defined(XEN_COMPAT_030001) */ |
END(hypercall_page) |
|
|
/* |
/* |
* void lgdt_finish(void); |
* void lgdt_finish(void); |
Line 817 END(lgdt_finish) |
|
Line 886 END(lgdt_finish) |
|
* |
* |
* This is a trampoline function pushed onto the stack of a newly created |
* This is a trampoline function pushed onto the stack of a newly created |
* process in order to do some additional setup. The trampoline is entered by |
* process in order to do some additional setup. The trampoline is entered by |
* cpu_switch()ing to the process, so we abuse the callee-saved registers used |
* cpu_switchto()ing to the process, so we abuse the callee-saved |
* by cpu_switch() to store the information about the stub to call. |
* registers used by cpu_switchto() to store the information about the |
|
* stub to call. |
* NOTE: This function does not have a normal calling sequence! |
* NOTE: This function does not have a normal calling sequence! |
*/ |
*/ |
NENTRY(lwp_trampoline) |
NENTRY(lwp_trampoline) |
|
|
* Handler has returned here as if we called it. The sigcontext |
* Handler has returned here as if we called it. The sigcontext |
* is on the stack after the 3 args "we" pushed. |
* is on the stack after the 3 args "we" pushed. |
*/ |
*/ |
leal 12(%esp),%eax # get pointer to sigcontext |
leal 12(%esp),%eax /* get pointer to sigcontext */ |
movl %eax,4(%esp) # put it in the argument slot |
movl %eax,4(%esp) /* put it in the argument slot */ |
# fake return address already there |
/* fake return address already there */ |
movl $SYS_compat_16___sigreturn14,%eax |
movl $SYS_compat_16___sigreturn14,%eax |
int $0x80 # enter kernel with args on stack |
int $0x80 /* enter kernel with args on stack */ |
movl $SYS_exit,%eax |
movl $SYS_exit,%eax |
int $0x80 # exit if sigreturn fails |
int $0x80 /* exit if sigreturn fails */ |
.globl _C_LABEL(esigcode) |
.globl _C_LABEL(esigcode) |
_C_LABEL(esigcode): |
_C_LABEL(esigcode): |
END(sigcode) |
END(sigcode) |
|
|
*/ |
*/ |
ENTRY(setjmp) |
ENTRY(setjmp) |
movl 4(%esp),%eax |
movl 4(%esp),%eax |
movl %ebx,(%eax) # save ebx |
movl %ebx,(%eax) /* save ebx */ |
movl %esp,4(%eax) # save esp |
movl %esp,4(%eax) /* save esp */ |
movl %ebp,8(%eax) # save ebp |
movl %ebp,8(%eax) /* save ebp */ |
movl %esi,12(%eax) # save esi |
movl %esi,12(%eax) /* save esi */ |
movl %edi,16(%eax) # save edi |
movl %edi,16(%eax) /* save edi */ |
movl (%esp),%edx # get rta |
movl (%esp),%edx /* get rta */ |
movl %edx,20(%eax) # save eip |
movl %edx,20(%eax) /* save eip */ |
xorl %eax,%eax # return 0 |
xorl %eax,%eax /* return 0 */ |
ret |
ret |
END(setjmp) |
END(setjmp) |
|
|
|
|
*/ |
*/ |
ENTRY(longjmp) |
ENTRY(longjmp) |
movl 4(%esp),%eax |
movl 4(%esp),%eax |
movl (%eax),%ebx # restore ebx |
movl (%eax),%ebx /* restore ebx */ |
movl 4(%eax),%esp # restore esp |
movl 4(%eax),%esp /* restore esp */ |
movl 8(%eax),%ebp # restore ebp |
movl 8(%eax),%ebp /* restore ebp */ |
movl 12(%eax),%esi # restore esi |
movl 12(%eax),%esi /* restore esi */ |
movl 16(%eax),%edi # restore edi |
movl 16(%eax),%edi /* restore edi */ |
movl 20(%eax),%edx # get rta |
movl 20(%eax),%edx /* get rta */ |
movl %edx,(%esp) # put in return frame |
movl %edx,(%esp) /* put in return frame */ |
movl $1,%eax # return 1 |
movl $1,%eax /* return 1 */ |
ret |
ret |
END(longjmp) |
END(longjmp) |
|
|
|
|
* Mimic cpu_switchto() for postmortem debugging. |
* Mimic cpu_switchto() for postmortem debugging. |
*/ |
*/ |
ENTRY(dumpsys) |
ENTRY(dumpsys) |
pushl %ebx # set up fake switchframe |
pushl %ebx /* set up fake switchframe */ |
pushl %esi # and save context |
pushl %esi /* and save context */ |
pushl %edi |
pushl %edi |
movl %esp,_C_LABEL(dumppcb)+PCB_ESP |
movl %esp,_C_LABEL(dumppcb)+PCB_ESP |
movl %ebp,_C_LABEL(dumppcb)+PCB_EBP |
movl %ebp,_C_LABEL(dumppcb)+PCB_EBP |
call _C_LABEL(dodumpsys) # dump! |
call _C_LABEL(dodumpsys) /* dump! */ |
addl $(3*4), %esp # unwind switchframe |
addl $(3*4), %esp /* unwind switchframe */ |
ret |
ret |
END(dumpsys) |
END(dumpsys) |
|
|
/* |
/* |
* struct lwp *cpu_switchto(struct lwp *oldlwp, struct *newlwp, |
* struct lwp *cpu_switchto(struct lwp *oldlwp, struct lwp *newlwp, |
* bool returning) |
* bool returning) |
* |
* |
* 1. if (oldlwp != NULL), save its context. |
* 1. if (oldlwp != NULL), save its context. |
Line 936 ENTRY(cpu_switchto) |
|
Line 1006 ENTRY(cpu_switchto) |
|
0: |
0: |
#endif |
#endif |
|
|
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 |
movl 24(%esp),%edx /* returning */ |
testl %esi,%esi |
testl %esi,%esi |
jz 1f |
jz 1f |
|
|
/* Save old context. */ |
/* Save old context. */ |
movl L_ADDR(%esi),%eax |
movl L_PCB(%esi),%eax |
movl %esp,PCB_ESP(%eax) |
movl %esp,PCB_ESP(%eax) |
movl %ebp,PCB_EBP(%eax) |
movl %ebp,PCB_EBP(%eax) |
|
|
/* Switch to newlwp's stack. */ |
/* Switch to newlwp's stack. */ |
1: movl L_ADDR(%edi),%ebx |
1: movl L_PCB(%edi),%ebx |
movl PCB_EBP(%ebx),%ebp |
movl PCB_EBP(%ebx),%ebp |
movl PCB_ESP(%ebx),%esp |
movl PCB_ESP(%ebx),%esp |
|
|
Line 967 ENTRY(cpu_switchto) |
|
Line 1037 ENTRY(cpu_switchto) |
|
pushl %edi |
pushl %edi |
call _C_LABEL(i386_switch_context) |
call _C_LABEL(i386_switch_context) |
addl $4,%esp |
addl $4,%esp |
#else /* XEN */ |
#else /* !XEN */ |
/* Switch ring0 esp */ |
/* Switch ring0 esp */ |
movl PCB_ESP0(%ebx),%eax |
movl PCB_ESP0(%ebx),%eax |
movl %eax,CPUVAR(ESP0) |
movl %eax,CPUVAR(ESP0) |
|
#endif /* !XEN */ |
|
|
/* 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 |
|
|
|
#ifndef XEN |
/* Restore thread-private %fs/%gs descriptors. */ |
/* Restore thread-private %fs/%gs descriptors. */ |
movl CPUVAR(GDT),%ecx |
movl CPUVAR(GDT),%ecx |
movl PCB_FSD(%ebx), %eax |
movl PCB_FSD(%ebx), %eax |
Line 986 ENTRY(cpu_switchto) |
|
Line 1058 ENTRY(cpu_switchto) |
|
movl PCB_GSD+4(%ebx), %edx |
movl PCB_GSD+4(%ebx), %edx |
movl %eax, (GUGS_SEL*8)(%ecx) |
movl %eax, (GUGS_SEL*8)(%ecx) |
movl %edx, (GUGS_SEL*8+4)(%ecx) |
movl %edx, (GUGS_SEL*8+4)(%ecx) |
#endif /* XEN */ |
#endif /* !XEN */ |
|
|
/* Switch I/O bitmap */ |
/* Switch I/O bitmap */ |
movl PCB_IOMAP(%ebx),%eax |
movl PCB_IOMAP(%ebx),%eax |
orl %eax,%eax |
orl %eax,%eax |
jnz,pn .Lcopy_iobitmap |
jnz .Lcopy_iobitmap |
movl $(IOMAP_INVALOFF << 16),CPUVAR(IOBASE) |
movl $(IOMAP_INVALOFF << 16),CPUVAR(IOBASE) |
.Liobitmap_done: |
.Liobitmap_done: |
|
|
Line 1001 ENTRY(cpu_switchto) |
|
Line 1073 ENTRY(cpu_switchto) |
|
jne 5f |
jne 5f |
|
|
/* |
/* |
* Restore cr0 (including FPU state). Raise the IPL to IPL_IPI. |
* Restore cr0 (including FPU state). Raise the IPL to IPL_HIGH. |
* FPU IPIs can alter the LWP's saved cr0. Dropping the priority |
* FPU IPIs can alter the LWP's saved cr0. Dropping the priority |
* is deferred until mi_switch(), when cpu_switchto() returns. |
* is deferred until mi_switch(), when cpu_switchto() returns. |
*/ |
*/ |
2: |
2: |
#ifndef XEN |
#ifdef XEN |
movl $IPL_IPI,CPUVAR(ILEVEL) |
pushl %edi |
|
call _C_LABEL(i386_tls_switch) |
|
addl $4,%esp |
|
#else /* !XEN */ |
|
movl $IPL_HIGH,CPUVAR(ILEVEL) |
movl PCB_CR0(%ebx),%ecx /* has CR0_TS clear */ |
movl PCB_CR0(%ebx),%ecx /* has CR0_TS clear */ |
movl %cr0,%edx |
movl %cr0,%edx |
|
|
Line 1023 ENTRY(cpu_switchto) |
|
Line 1099 ENTRY(cpu_switchto) |
|
3: cmpl %edx,%ecx |
3: cmpl %edx,%ecx |
je 4f |
je 4f |
movl %ecx,%cr0 |
movl %ecx,%cr0 |
#endif /* XEN */ |
#endif /* !XEN */ |
|
|
/* Return to the new LWP, returning 'oldlwp' in %eax. */ |
/* Return to the new LWP, returning 'oldlwp' in %eax. */ |
4: movl %esi,%eax |
4: movl %esi,%eax |
Line 1046 ENTRY(cpu_switchto) |
|
Line 1122 ENTRY(cpu_switchto) |
|
|
|
.Lcopy_iobitmap: |
.Lcopy_iobitmap: |
/* Copy I/O bitmap. */ |
/* Copy I/O bitmap. */ |
|
incl _C_LABEL(pmap_iobmp_evcnt)+EV_COUNT |
movl $(IOMAPSIZE/4),%ecx |
movl $(IOMAPSIZE/4),%ecx |
pushl %esi |
pushl %esi |
pushl %edi |
pushl %edi |
Line 1066 END(cpu_switchto) |
|
Line 1143 END(cpu_switchto) |
|
* Update pcb, saving current processor state. |
* Update pcb, saving current processor state. |
*/ |
*/ |
ENTRY(savectx) |
ENTRY(savectx) |
movl 4(%esp),%edx # edx = pcb |
movl 4(%esp),%edx /* edx = pcb */ |
movl %esp,PCB_ESP(%edx) |
movl %esp,PCB_ESP(%edx) |
movl %ebp,PCB_EBP(%edx) |
movl %ebp,PCB_EBP(%edx) |
ret |
ret |
|
|
* Old call gate entry for syscall |
* Old call gate entry for syscall |
*/ |
*/ |
IDTVEC(osyscall) |
IDTVEC(osyscall) |
pushfl # set eflags in trap frame |
#ifndef XEN |
|
/* XXX we are in trouble! interrupts be off here. */ |
|
cli /* must be first instruction */ |
|
#endif |
|
pushfl /* set eflags in trap frame */ |
popl 8(%esp) |
popl 8(%esp) |
pushl $7 # size of instruction for restart |
orl $PSL_I,8(%esp) /* re-enable ints on return to user */ |
|
pushl $7 /* size of instruction for restart */ |
jmp syscall1 |
jmp syscall1 |
IDTVEC_END(osyscall) |
IDTVEC_END(osyscall) |
|
|
Line 1090 IDTVEC_END(osyscall) |
|
Line 1172 IDTVEC_END(osyscall) |
|
* Trap gate entry for syscall |
* Trap gate entry for syscall |
*/ |
*/ |
IDTVEC(syscall) |
IDTVEC(syscall) |
pushl $2 # size of instruction for restart |
pushl $2 /* size of instruction for restart */ |
syscall1: |
syscall1: |
pushl $T_ASTFLT # trap # for doing ASTs |
pushl $T_ASTFLT /* trap # for doing ASTs */ |
INTRENTRY |
INTRENTRY |
|
STI(%eax) |
#ifdef DIAGNOSTIC |
#ifdef DIAGNOSTIC |
movl CPUVAR(ILEVEL),%ebx |
movl CPUVAR(ILEVEL),%ebx |
testl %ebx,%ebx |
testl %ebx,%ebx |
jz 1f |
jz 1f |
pushl $5f |
pushl $5f |
call _C_LABEL(printf) |
call _C_LABEL(panic) |
addl $4,%esp |
addl $4,%esp |
#ifdef DDB |
#ifdef DDB |
int $3 |
int $3 |
#endif |
#endif |
1: |
1: |
#endif /* DIAGNOSTIC */ |
#endif /* DIAGNOSTIC */ |
incl CPUVAR(NSYSCALL) # count it atomically |
addl $1,CPUVAR(NSYSCALL) /* count it atomically */ |
|
adcl $0,CPUVAR(NSYSCALL)+4 /* count it atomically */ |
movl CPUVAR(CURLWP),%edi |
movl CPUVAR(CURLWP),%edi |
movl L_PROC(%edi),%edx |
movl L_PROC(%edi),%edx |
movl %esp,L_MD_REGS(%edi) # save pointer to frame |
movl %esp,L_MD_REGS(%edi) /* save pointer to frame */ |
pushl %esp |
pushl %esp |
call *P_MD_SYSCALL(%edx) # get pointer to syscall() function |
call *P_MD_SYSCALL(%edx) /* get pointer to syscall() function */ |
addl $4,%esp |
addl $4,%esp |
.Lsyscall_checkast: |
.Lsyscall_checkast: |
/* Check for ASTs on exit to user mode. */ |
/* Check for ASTs on exit to user mode. */ |
|
|
/* process pending interrupts */ |
/* process pending interrupts */ |
CLI(%eax) |
CLI(%eax) |
movl CPUVAR(ILEVEL), %ebx |
movl CPUVAR(ILEVEL), %ebx |
movl $.Lsyscall_resume, %esi # address to resume loop at |
movl $.Lsyscall_resume, %esi /* address to resume loop at */ |
.Lsyscall_resume: |
.Lsyscall_resume: |
movl %ebx,%eax # get cpl |
movl %ebx,%eax /* get cpl */ |
movl CPUVAR(IUNMASK)(,%eax,4),%eax |
movl CPUVAR(IUNMASK)(,%eax,4),%eax |
andl CPUVAR(IPENDING),%eax # any non-masked bits left? |
andl CPUVAR(IPENDING),%eax /* any non-masked bits left? */ |
jz 17f |
jz 17f |
bsrl %eax,%eax |
bsrl %eax,%eax |
btrl %eax,CPUVAR(IPENDING) |
btrl %eax,CPUVAR(IPENDING) |
movl CPUVAR(ISOURCES)(,%eax,4),%eax |
movl CPUVAR(ISOURCES)(,%eax,4),%eax |
jmp *IS_RESUME(%eax) |
jmp *IS_RESUME(%eax) |
17: movl %ebx, CPUVAR(ILEVEL) #restore cpl |
17: movl %ebx, CPUVAR(ILEVEL) /* restore cpl */ |
jmp .Lsyscall_checkast |
jmp .Lsyscall_checkast |
14: |
14: |
#endif /* XEN */ |
#endif /* XEN */ |
|
|
INTRFASTEXIT |
INTRFASTEXIT |
3: STI(%eax) |
3: STI(%eax) |
pushl $4f |
pushl $4f |
call _C_LABEL(printf) |
call _C_LABEL(panic) |
addl $4,%esp |
addl $4,%esp |
pushl $IPL_NONE |
pushl $IPL_NONE |
call _C_LABEL(spllower) |
call _C_LABEL(spllower) |
addl $4,%esp |
addl $4,%esp |
jmp .Lsyscall_checkast |
jmp .Lsyscall_checkast |
4: .asciz "WARNING: SPL NOT LOWERED ON SYSCALL EXIT\n" |
4: .asciz "SPL NOT LOWERED ON SYSCALL EXIT\n" |
5: .asciz "WARNING: SPL NOT ZERO ON SYSCALL ENTRY\n" |
5: .asciz "SPL NOT ZERO ON SYSCALL ENTRY\n" |
#endif /* DIAGNOSTIC */ |
#endif /* DIAGNOSTIC */ |
9: |
9: |
cmpl $0, CPUVAR(WANT_PMAPLOAD) |
cmpl $0, CPUVAR(WANT_PMAPLOAD) |
|
|
jmp .Lsyscall_checkast /* re-check ASTs */ |
jmp .Lsyscall_checkast /* re-check ASTs */ |
IDTVEC_END(syscall) |
IDTVEC_END(syscall) |
|
|
#if NNPX > 0 |
IDTVEC(svr4_fasttrap) |
/* |
pushl $2 /* size of instruction for restart */ |
* Special interrupt handlers. Someday intr0-intr15 will be used to count |
pushl $T_ASTFLT /* trap # for doing ASTs */ |
* interrupts. We'll still need a special exception 16 handler. The busy |
INTRENTRY |
* latch stuff in probintr() can be moved to npxprobe(). |
STI(%eax) |
*/ |
pushl $RW_READER |
|
pushl $_C_LABEL(svr4_fasttrap_lock) |
/* |
call _C_LABEL(rw_enter) |
* void probeintr(void) |
addl $8,%esp |
*/ |
call *_C_LABEL(svr4_fasttrap_vec) |
NENTRY(probeintr) |
pushl $_C_LABEL(svr4_fasttrap_lock) |
ss |
call _C_LABEL(rw_exit) |
incl _C_LABEL(npx_intrs_while_probing) |
addl $4,%esp |
pushl %eax |
2: /* Check for ASTs on exit to user mode. */ |
movb $0x20,%al # EOI (asm in strings loses cpp features) |
cli |
outb %al,$0xa0 # IO_ICU2 |
CHECK_ASTPENDING(%eax) |
outb %al,$0x20 # IO_ICU1 |
je 1f |
movb $0,%al |
/* Always returning to user mode here. */ |
outb %al,$0xf0 # clear BUSY# latch |
CLEAR_ASTPENDING(%eax) |
popl %eax |
sti |
iret |
/* Pushed T_ASTFLT into tf_trapno on entry. */ |
END(probeintr) |
pushl %esp |
|
call _C_LABEL(trap) |
/* |
addl $4,%esp |
* void probetrap(void) |
jmp 2b |
*/ |
1: CHECK_DEFERRED_SWITCH |
NENTRY(probetrap) |
jnz 9f |
ss |
INTRFASTEXIT |
incl _C_LABEL(npx_traps_while_probing) |
9: sti |
fnclex |
call _C_LABEL(pmap_load) |
iret |
cli |
END(probetrap) |
jmp 2b |
|
|
/* |
/* |
* int npx586bug1(int a, int b) |
* int npx586bug1(int a, int b) |
|
* Used when checking for the FDIV bug on first generations pentiums. |
|
* Anything 120MHz or above is fine. |
*/ |
*/ |
NENTRY(npx586bug1) |
NENTRY(npx586bug1) |
fildl 4(%esp) # x |
fildl 4(%esp) /* x */ |
fildl 8(%esp) # y |
fildl 8(%esp) /* y */ |
fld %st(1) |
fld %st(1) |
fdiv %st(1),%st # x/y |
fdiv %st(1),%st /* x/y */ |
fmulp %st,%st(1) # (x/y)*y |
fmulp %st,%st(1) /* (x/y)*y */ |
fsubrp %st,%st(1) # x-(x/y)*y |
fsubrp %st,%st(1) /* x-(x/y)*y */ |
pushl $0 |
pushl $0 |
fistpl (%esp) |
fistpl (%esp) |
popl %eax |
popl %eax |
ret |
ret |
END(npx586bug1) |
END(npx586bug1) |
#endif /* NNPX > 0 */ |
|
|
|
/* |
/* |
* void sse2_idlezero_page(void *pg) |
* void sse2_idlezero_page(void *pg) |
Line 1240 ENTRY(sse2_idlezero_page) |
|
Line 1325 ENTRY(sse2_idlezero_page) |
|
xorl %eax, %eax |
xorl %eax, %eax |
.align 16 |
.align 16 |
1: |
1: |
cmpl $0, CPUVAR(RESCHED) |
testl $RESCHED_KPREEMPT, CPUVAR(RESCHED) |
jnz 2f |
jnz 2f |
movnti %eax, 0(%edx) |
movnti %eax, 0(%edx) |
movnti %eax, 4(%edx) |
movnti %eax, 4(%edx) |