version 1.3, 2002/12/17 19:47:15 |
version 1.127, 2016/06/04 09:45:57 |
|
|
/* $NetBSD$ */ |
/* $NetBSD$ */ |
|
|
/*- |
/* |
* Copyright (c) 1998, 2000 The NetBSD Foundation, Inc. |
* Copyright-o-rama! |
* All rights reserved. |
*/ |
|
|
|
/* |
|
* Copyright (c) 1998, 2000, 2004, 2006, 2007, 2009, 2016 |
|
* The NetBSD Foundation, Inc., 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, by Andrew Doran and by Maxime Villard. |
* |
* |
* 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 |
|
|
* 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 the NetBSD |
|
* Foundation, Inc. and its contributors. |
|
* 4. Neither the name of The NetBSD Foundation nor the names of its |
|
* contributors may be used to endorse or promote products derived |
|
* from this software without specific prior written permission. |
|
* |
* |
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS |
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS |
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED |
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED |
|
|
* POSSIBILITY OF SUCH DAMAGE. |
* POSSIBILITY OF SUCH DAMAGE. |
*/ |
*/ |
|
|
|
/* |
|
* Copyright (c) 2006 Manuel Bouyer. |
|
* |
|
* 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. |
|
* |
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 THE AUTHOR 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) 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) 1990 The Regents of the University of California. |
* Copyright (c) 1990 The Regents of the University of California. |
* All rights reserved. |
* All rights reserved. |
|
|
* 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 |
* 3. Neither the name of the University nor the names of its contributors |
* must display the following acknowledgement: |
|
* This product includes software developed by the University of |
|
* California, Berkeley and its contributors. |
|
* 4. Neither the name of the University nor the names of its contributors |
|
* may be used to endorse or promote products derived from this software |
* may be used to endorse or promote products derived from this software |
* without specific prior written permission. |
* without specific prior written permission. |
* |
* |
|
|
* @(#)locore.s 7.3 (Berkeley) 5/13/91 |
* @(#)locore.s 7.3 (Berkeley) 5/13/91 |
*/ |
*/ |
|
|
#include "opt_cputype.h" |
#include <machine/asm.h> |
#include "opt_ddb.h" |
__KERNEL_RCSID(0, "$NetBSD$"); |
#include "opt_ipkdb.h" |
|
#include "opt_vm86.h" |
|
#include "opt_user_ldt.h" |
|
#include "opt_dummy_nops.h" |
|
#include "opt_compat_oldboot.h" |
#include "opt_compat_oldboot.h" |
#include "opt_multiprocessor.h" |
#include "opt_copy_symtab.h" |
#include "opt_lockdebug.h" |
#include "opt_ddb.h" |
|
#include "opt_modular.h" |
|
#include "opt_multiboot.h" |
#include "opt_realmem.h" |
#include "opt_realmem.h" |
|
#include "opt_vm86.h" |
|
#include "opt_xen.h" |
|
|
#include "npx.h" |
|
#include "assym.h" |
#include "assym.h" |
#include "apm.h" |
|
#include "lapic.h" |
#include "lapic.h" |
#include "ioapic.h" |
#include "ioapic.h" |
|
#include "ksyms.h" |
|
|
#include <sys/errno.h> |
#include <sys/errno.h> |
#include <sys/syscall.h> |
#include <sys/syscall.h> |
|
|
#include <machine/cputypes.h> |
|
#include <machine/param.h> |
|
#include <machine/pte.h> |
|
#include <machine/segments.h> |
#include <machine/segments.h> |
#include <machine/specialreg.h> |
#include <machine/specialreg.h> |
#include <machine/trap.h> |
#include <machine/trap.h> |
#include <machine/bootinfo.h> |
|
|
|
#if NLAPIC > 0 |
|
#include <machine/i82489reg.h> |
#include <machine/i82489reg.h> |
#endif |
#include <machine/frameasm.h> |
|
#include <machine/i82489reg.h> |
/* LINTSTUB: include <sys/types.h> */ |
#include <machine/cputypes.h> |
/* LINTSTUB: include <machine/cpu.h> */ |
|
/* LINTSTUB: include <sys/systm.h> */ |
|
|
|
#include <machine/asm.h> |
|
|
|
#if defined(MULTIPROCESSOR) |
|
|
|
#define SET_CURPROC(proc,cpu) \ |
|
movl CPUVAR(SELF),cpu ; \ |
|
movl proc,CPUVAR(CURPROC) ; \ |
|
movl cpu,P_CPU(proc) |
|
|
|
#else |
|
|
|
#define SET_CURPROC(proc,tcpu) movl proc,CPUVAR(CURPROC) |
|
#define GET_CURPROC(reg) movl CPUVAR(CURPROC),reg |
|
|
|
|
#ifndef XEN |
|
#include <machine/multiboot.h> |
#endif |
#endif |
|
|
#define GET_CURPCB(reg) movl CPUVAR(CURPCB),reg |
|
#define SET_CURPCB(reg) movl reg,CPUVAR(CURPCB) |
|
|
|
#define CLEAR_RESCHED(reg) movl reg,CPUVAR(RESCHED) |
|
|
|
/* 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)) |
|
|
/* Disallow old names for REALBASEMEM */ |
/* 32bit version of PG_NX */ |
#ifdef BIOSBASEMEM |
#define PG_NX32 0x80000000 |
#error BIOSBASEMEM option deprecated; use REALBASEMEM only if memory size reported by latest boot block is incorrect |
|
#endif |
|
|
|
/* Disallow old names for REALEXTMEM */ |
#ifndef PAE |
#ifdef EXTMEM_SIZE |
#define PROC0_PDIR_OFF 0 |
#error EXTMEM_SIZE option deprecated; use REALEXTMEM only if memory size reported by latest boot block is incorrect |
#else |
#endif |
#define PROC0_L3_OFF 0 |
#ifdef BIOSEXTMEM |
#define PROC0_PDIR_OFF 1 * PAGE_SIZE |
#error BIOSEXTMEM option deprecated; use REALEXTMEM only if memory size reported by latest boot block is incorrect |
|
#endif |
#endif |
|
|
#include <machine/frameasm.h> |
#define PROC0_STK_OFF (PROC0_PDIR_OFF + PDP_SIZE * PAGE_SIZE) |
|
#define PROC0_PTP1_OFF (PROC0_STK_OFF + UPAGES * PAGE_SIZE) |
|
|
#ifdef MULTIPROCESSOR |
|
#include <machine/i82489reg.h> |
|
#endif |
|
|
|
/* |
/* |
* PTmap is recursive pagemap at top of virtual address space. |
* fillkpt - Fill in a kernel page table |
* Within PTmap, the page directory can be found (third indirection). |
* eax = pte (page frame | control | status) |
|
* ebx = page table address |
|
* ecx = number of pages to map |
* |
* |
* XXX 4 == sizeof pde |
* 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 |
.set _C_LABEL(PTmap),(PDSLOT_PTE << PDSHIFT) |
* instruction just clears the page table entry. |
.set _C_LABEL(PTD),(_C_LABEL(PTmap) + PDSLOT_PTE * NBPG) |
*/ |
.set _C_LABEL(PTDpde),(_C_LABEL(PTD) + PDSLOT_PTE * 4) |
#define fillkpt \ |
|
cmpl $0,%ecx ; /* zero-sized? */ \ |
|
je 2f ; \ |
|
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 ; \ |
|
2: ; |
|
|
|
/* |
|
* fillkpt_nox - Same as fillkpt, but sets the NX/XD bit. |
|
*/ |
|
#define fillkpt_nox \ |
|
cmpl $0,%ecx ; /* zero-sized? */ \ |
|
je 2f ; \ |
|
pushl %ebp ; \ |
|
movl RELOC(nox_flag),%ebp ; \ |
|
1: movl %ebp,(PDE_SIZE-4)(%ebx) ; /* upper 32 bits: NX */ \ |
|
movl %eax,(%ebx) ; /* store phys addr */ \ |
|
addl $PDE_SIZE,%ebx ; /* next PTE/PDE */ \ |
|
addl $PAGE_SIZE,%eax ; /* next phys page */ \ |
|
loop 1b ; \ |
|
popl %ebp ; \ |
|
2: ; |
|
|
/* |
/* |
* APTmap, APTD is the alternate recursive pagemap. |
* killkpt - Destroy a kernel page table |
* It's used when modifying another process's page tables. |
* ebx = page table address |
* |
* ecx = number of pages to destroy |
* XXX 4 == sizeof pde |
|
*/ |
*/ |
.set _C_LABEL(APTmap),(PDSLOT_APTE << PDSHIFT) |
#define killkpt \ |
.set _C_LABEL(APTD),(_C_LABEL(APTmap) + PDSLOT_APTE * NBPG) |
1: movl $0,(PDE_SIZE-4)(%ebx) ; /* upper bits (for PAE) */ \ |
.set _C_LABEL(APTDpde),(_C_LABEL(PTD) + PDSLOT_APTE * 4) |
movl $0,(%ebx) ; \ |
|
addl $PDE_SIZE,%ebx ; \ |
|
loop 1b ; |
|
|
|
|
|
#ifdef XEN |
|
/* |
|
* Xen guest identifier and loader selection |
|
*/ |
|
.section __xen_guest |
|
.ascii "GUEST_OS=netbsd,GUEST_VER=3.0,XEN_VER=xen-3.0" |
|
.ascii ",VIRT_BASE=0xc0000000" /* KERNBASE */ |
|
.ascii ",ELF_PADDR_OFFSET=0xc0000000" /* KERNBASE */ |
|
.ascii ",VIRT_ENTRY=0xc0100000" /* KERNTEXTOFF */ |
|
.ascii ",HYPERCALL_PAGE=0x00000101" |
|
/* (???+HYPERCALL_PAGE_OFFSET)/PAGE_SIZE) */ |
|
#ifdef PAE |
|
.ascii ",PAE=yes[extended-cr3]" |
|
#endif |
|
.ascii ",LOADER=generic" |
|
#if (NKSYMS || defined(DDB) || defined(MODULAR)) && !defined(makeoptions_COPY_SYMTAB) |
|
.ascii ",BSD_SYMTAB=yes" |
|
#endif |
|
.byte 0 |
|
#endif /* XEN */ |
|
|
/* |
/* |
* Initialization |
* Initialization |
*/ |
*/ |
.data |
.data |
|
|
.globl _C_LABEL(cpu) |
.globl _C_LABEL(lapic_tpr) |
.globl _C_LABEL(cpu_feature) |
|
.globl _C_LABEL(esym),_C_LABEL(boothowto) |
|
.globl _C_LABEL(bootinfo),_C_LABEL(atdevbase) |
|
#ifdef COMPAT_OLDBOOT |
|
.globl _C_LABEL(bootdev) |
|
#endif |
|
.globl _C_LABEL(proc0paddr),_C_LABEL(PTDpaddr) |
|
.globl _C_LABEL(biosbasemem),_C_LABEL(biosextmem) |
|
.globl _C_LABEL(gdt) |
|
#ifdef I586_CPU |
|
.globl _C_LABEL(idt) |
|
#endif |
|
.globl _C_LABEL(lapic_tpr) |
|
|
|
#if NLAPIC > 0 |
#if NLAPIC > 0 |
#ifdef __ELF__ |
#ifdef __ELF__ |
.align NBPG |
.align PAGE_SIZE |
#else |
#else |
.align 12 |
.align 12 |
#endif |
#endif |
.globl _C_LABEL(local_apic), _C_LABEL(lapic_id) |
.globl _C_LABEL(local_apic) |
_C_LABEL(local_apic): |
.globl _C_LABEL(lapic_id) |
|
|
|
.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 |
_C_LABEL(lapic_ppr): |
LABEL(lapic_tpr) |
|
.space LAPIC_PPRI-LAPIC_TPRI |
|
END(lapic_tpr) |
|
.type _C_LABEL(lapic_ppr), @object |
|
_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 NBPG-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 |
|
|
|
|
_C_LABEL(cpu): .long 0 # are we 386, 386sx, or 486, |
|
# or Pentium, or.. |
|
_C_LABEL(cpu_feature): .long 0 # feature flags from 'cpuid' |
|
# instruction |
|
_C_LABEL(esym): .long 0 # ptr to end of syms |
|
_C_LABEL(atdevbase): .long 0 # location of start of iomem in virtual |
|
_C_LABEL(proc0paddr): .long 0 |
|
_C_LABEL(PTDpaddr): .long 0 # paddr of PTD, for libkvm |
|
#ifndef REALBASEMEM |
|
_C_LABEL(biosbasemem): .long 0 # base memory reported by BIOS |
|
#else |
|
_C_LABEL(biosbasemem): .long REALBASEMEM |
|
#endif |
|
#ifndef REALEXTMEM |
|
_C_LABEL(biosextmem): .long 0 # extended memory reported by BIOS |
|
#else |
|
_C_LABEL(biosextmem): .long REALEXTMEM |
|
#endif |
|
|
|
.space 512 |
|
tmpstk: |
|
|
|
|
.globl _C_LABEL(tablesize) |
|
.globl _C_LABEL(nox_flag) |
|
.globl _C_LABEL(cputype) |
|
.globl _C_LABEL(cpuid_level) |
|
.globl _C_LABEL(esym) |
|
.globl _C_LABEL(eblob) |
|
.globl _C_LABEL(atdevbase) |
|
.globl _C_LABEL(PDPpaddr) |
|
.globl _C_LABEL(lwp0uarea) |
|
.globl _C_LABEL(gdt) |
|
.globl _C_LABEL(idt) |
|
|
#define _RELOC(x) ((x) - KERNBASE) |
.type _C_LABEL(tablesize), @object |
#define RELOC(x) _RELOC(_C_LABEL(x)) |
_C_LABEL(tablesize): .long 0 |
|
END(tablesize) |
|
.type _C_LABEL(nox_flag), @object |
|
LABEL(nox_flag) .long 0 /* 32bit NOX flag, set if supported */ |
|
END(nox_flag) |
|
.type _C_LABEL(cputype), @object |
|
LABEL(cputype) .long 0 /* are we 80486, Pentium, or.. */ |
|
END(cputype) |
|
.type _C_LABEL(cpuid_level), @object |
|
LABEL(cpuid_level) .long 0 /* max. level accepted by cpuid instr */ |
|
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) |
|
|
|
/* Space for the temporary stack */ |
|
.size tmpstk, tmpstk - . |
|
.space 512 |
|
tmpstk: |
|
#ifdef XEN |
|
.align PAGE_SIZE, 0x0 /* Align on page boundary */ |
|
LABEL(tmpgdt) |
|
.space PAGE_SIZE /* Xen expects a page */ |
|
END(tmpgdt) |
|
#endif /* XEN */ |
|
|
.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) |
start: movw $0x1234,0x472 # warm boot |
#ifndef XEN |
|
|
|
/* Warm boot */ |
|
movw $0x1234,0x472 |
|
|
|
#if defined(MULTIBOOT) |
|
jmp 1f |
|
|
|
.align 4 |
|
.globl Multiboot_Header |
|
_C_LABEL(Multiboot_Header): |
|
#define MULTIBOOT_HEADER_FLAGS (MULTIBOOT_HEADER_WANT_MEMORY) |
|
.long MULTIBOOT_HEADER_MAGIC |
|
.long MULTIBOOT_HEADER_FLAGS |
|
.long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS) |
|
|
|
1: |
|
/* Check if we are being executed by a Multiboot-compliant boot |
|
* loader. */ |
|
cmpl $MULTIBOOT_INFO_MAGIC,%eax |
|
jne 1f |
|
|
/* |
/* |
* Load parameters from stack |
* Indeed, a multiboot-compliant boot loader executed us. We copy |
* (howto, [bootdev], bootinfo, esym, basemem, extmem). |
* the received Multiboot information structure into kernel's data |
|
* space to process it later -- after we are relocated. It will |
|
* be safer to run complex C code than doing it at this point. |
*/ |
*/ |
movl 4(%esp),%eax |
pushl %ebx /* Address of Multiboot information */ |
movl %eax,RELOC(boothowto) |
call _C_LABEL(multiboot_pre_reloc) |
#ifdef COMPAT_OLDBOOT |
addl $4,%esp |
movl 8(%esp),%eax |
jmp 2f |
movl %eax,RELOC(bootdev) |
|
#endif |
#endif |
movl 12(%esp),%eax |
|
|
|
testl %eax, %eax |
|
jz 1f |
|
movl (%eax), %ebx /* number of entries */ |
|
movl $RELOC(bootinfo), %edi |
|
movl %ebx, (%edi) |
|
addl $4, %edi |
|
2: |
|
testl %ebx, %ebx |
|
jz 1f |
|
addl $4, %eax |
|
movl (%eax), %ecx /* address of entry */ |
|
pushl %eax |
|
pushl (%ecx) /* len */ |
|
pushl %ecx |
|
pushl %edi |
|
addl (%ecx), %edi /* update dest pointer */ |
|
cmpl $_RELOC(_C_LABEL(bootinfo) + BOOTINFO_MAXSIZE), %edi |
|
jg 2f |
|
call _C_LABEL(memcpy) |
|
addl $12, %esp |
|
popl %eax |
|
subl $1, %ebx |
|
jmp 2b |
|
2: /* cleanup for overflow case */ |
|
addl $16, %esp |
|
movl $RELOC(bootinfo), %edi |
|
subl %ebx, (%edi) /* correct number of entries */ |
|
1: |
1: |
|
/* |
|
* At this point, we know that a NetBSD-specific boot loader |
|
* booted this kernel. |
|
* |
|
* Load parameters from the stack (32 bits): |
|
* boothowto, [bootdev], bootinfo, esym, biosextmem, biosbasemem |
|
* We are not interested in 'bootdev'. |
|
*/ |
|
|
movl 16(%esp),%eax |
addl $4,%esp /* Discard return address to boot loader */ |
testl %eax,%eax |
call _C_LABEL(native_loader) |
jz 1f |
addl $24,%esp |
addl $KERNBASE,%eax |
|
1: movl %eax,RELOC(esym) |
|
|
|
movl RELOC(biosextmem),%eax |
|
testl %eax,%eax |
|
jnz 1f |
|
movl 20(%esp),%eax |
|
movl %eax,RELOC(biosextmem) |
|
1: |
|
movl RELOC(biosbasemem),%eax |
|
testl %eax,%eax |
|
jnz 1f |
|
movl 24(%esp),%eax |
|
movl %eax,RELOC(biosbasemem) |
|
1: |
|
|
|
|
2: |
/* First, reset the PSL. */ |
/* First, reset the PSL. */ |
pushl $PSL_MBO |
pushl $PSL_MBO |
popfl |
popfl |
Line 323 start: movw $0x1234,0x472 # warm boot |
|
Line 403 start: movw $0x1234,0x472 # warm boot |
|
movw %ax,%fs |
movw %ax,%fs |
movw %ax,%gs |
movw %ax,%gs |
decl %eax |
decl %eax |
movl %eax,RELOC(cpu_info_primary)+CPU_INFO_LEVEL |
movl %eax,RELOC(cpuid_level) |
|
|
/* Find out our CPU type. */ |
/* Find out our CPU type. */ |
|
|
|
|
* 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 383 try486: /* Try to toggle identification |
|
Line 463 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 401 is486: movl $CPU_486,RELOC(cpu) |
|
Line 481 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 |
|
|
try586: /* Use the `cpuid' instruction. */ |
try586: /* Use the `cpuid' instruction. */ |
xorl %eax,%eax |
xorl %eax,%eax |
cpuid |
cpuid |
movl %eax,RELOC(cpu_info_primary)+CPU_INFO_LEVEL |
movl %eax,RELOC(cpuid_level) |
|
|
|
/* |
|
* Retrieve the NX/XD flag. We use the 32bit version of PG_NX. |
|
*/ |
|
movl $0x80000001,%eax |
|
cpuid |
|
andl $CPUID_NOX,%edx |
|
jz no_NOX |
|
movl $PG_NX32,RELOC(nox_flag) |
|
no_NOX: |
|
|
2: |
2: |
/* |
/* |
Line 495 try586: /* Use the `cpuid' instruction. |
|
Line 585 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: |
* There are two different layouts possible, depending on whether PAE is |
|
* enabled or not. |
|
* |
|
* If PAE is not enabled, there are two levels of pages: PD -> PT. They will |
|
* be referred to as: L2 -> L1. L2 is 1 page long. The BOOTSTRAP TABLES have |
|
* the following layout: |
|
* +-----+------------+----+ |
|
* | L2 -> PROC0 STK -> L1 | |
|
* +-----+------------+----+ |
|
* |
|
* If PAE is enabled, there are three levels of pages: PDP -> PD -> PT. They |
|
* will be referred to as: L3 -> L2 -> L1. L3 is 1 page long, L2 is 4 page |
|
* long. The BOOTSTRAP TABLES have the following layout: |
|
* +-----+-----+------------+----+ |
|
* | L3 -> L2 -> PROC0 STK -> L1 | |
|
* +-----+-----+------------+----+ |
|
* |
|
* Virtual address space of the kernel in both cases: |
|
* +------+--------+------+-----+--------+---------------------+----------- |
|
* | TEXT | RODATA | DATA | BSS | [SYMS] | [PRELOADED MODULES] | BOOTSTRAP |
|
* +------+--------+------+-----+--------+---------------------+----------- |
|
* (1) (2) (3) |
* |
* |
* text | data | bss | [syms] | page dir | proc0 kstack |
* -------+------------+ |
* 0 1 2 3 |
* TABLES | ISA IO MEM | |
|
* -------+------------+ |
|
* (4) |
|
* |
|
* PROC0 STK is obviously not linked as a page level. It just happens to be |
|
* caught between L2 and L1. |
|
* |
|
* Important note: the kernel segments are properly 4k-aligned |
|
* (see kern.ldscript), so there's no need to enforce alignment. |
*/ |
*/ |
#define PROC0PDIR ((0) * NBPG) |
|
#define PROC0STACK ((1) * NBPG) |
|
#define SYSMAP ((1+UPAGES) * NBPG) |
|
#define TABLESIZE ((1+UPAGES) * NBPG) /* + nkpde * NBPG */ |
|
|
|
/* Find end of kernel image. */ |
/* Find end of kernel image; brings us on (1). */ |
movl $RELOC(end),%edi |
movl $RELOC(end),%edi |
#if defined(DDB) && !defined(SYMTAB_SPACE) |
|
/* Save the symbols (if loaded). */ |
#if (NKSYMS || defined(DDB) || defined(MODULAR)) && !defined(makeoptions_COPY_SYMTAB) |
|
/* Save the symbols (if loaded); brinds us on (2). */ |
movl RELOC(esym),%eax |
movl RELOC(esym),%eax |
testl %eax,%eax |
testl %eax,%eax |
jz 1f |
jz 1f |
Line 523 try586: /* Use the `cpuid' instruction. |
|
Line 640 try586: /* Use the `cpuid' instruction. |
|
1: |
1: |
#endif |
#endif |
|
|
/* Calculate where to start the bootstrap tables. */ |
/* Skip over any modules/blobs; brings us on (3). */ |
movl %edi,%esi # edi = esym ? esym : end |
movl RELOC(eblob),%eax |
addl $PGOFSET,%esi # page align up |
testl %eax,%eax |
|
jz 1f |
|
subl $KERNBASE,%eax |
|
movl %eax,%edi |
|
1: |
|
|
|
/* We are on (3). Align up for BOOTSTRAP TABLES. */ |
|
movl %edi,%esi |
|
addl $PGOFSET,%esi |
andl $~PGOFSET,%esi |
andl $~PGOFSET,%esi |
|
|
/* |
/* nkptp[1] = (esi + ~L2_FRAME) >> L2_SHIFT + 1; */ |
* Calculate the size of the kernel page table directory, and |
movl %esi,%eax |
* how many entries it will have. |
addl $~L2_FRAME,%eax |
*/ |
shrl $L2_SHIFT,%eax |
movl RELOC(nkpde),%ecx # get nkpde |
incl %eax /* one more PTP for VAs stolen by bootstrap */ |
cmpl $NKPTP_MIN,%ecx # larger than min? |
1: movl %eax,RELOC(nkptp)+1*4 |
jge 1f |
|
movl $NKPTP_MIN,%ecx # set at min |
/* tablesize = (PDP_SIZE + UPAGES + nkptp) << PGSHIFT; */ |
jmp 2f |
addl $(PDP_SIZE+UPAGES),%eax |
1: cmpl $NKPTP_MAX,%ecx # larger than max? |
#ifdef PAE |
jle 2f |
incl %eax /* one more page for L3 */ |
movl $NKPTP_MAX,%ecx |
shll $PGSHIFT+1,%eax /* PTP tables are twice larger with PAE */ |
2: |
#else |
|
shll $PGSHIFT,%eax |
|
#endif |
|
movl %eax,RELOC(tablesize) |
|
|
/* Clear memory for bootstrap tables. */ |
/* Ensure that nkptp covers BOOTSTRAP TABLES. */ |
shll $PGSHIFT,%ecx |
addl %esi,%eax |
addl $TABLESIZE,%ecx |
addl $~L2_FRAME,%eax |
addl %esi,%ecx # end of tables |
shrl $L2_SHIFT,%eax |
subl %edi,%ecx # size of tables |
incl %eax |
shrl $2,%ecx |
cmpl %eax,RELOC(nkptp)+1*4 |
|
jnz 1b |
|
|
|
/* Now, zero out the BOOTSTRAP TABLES (before filling them in). */ |
|
movl %esi,%edi |
xorl %eax,%eax |
xorl %eax,%eax |
cld |
cld |
|
movl RELOC(tablesize),%ecx |
|
shrl $2,%ecx |
rep |
rep |
stosl |
stosl /* copy eax -> edi */ |
|
|
/* |
/* |
* fillkpt |
* Build the page tables and levels. We go from L1 to L2/L3, and link the levels |
* eax = pte (page frame | control | status) |
* together. Note: RELOC computes &addr - KERNBASE in 32 bits; the value can't |
* ebx = page table address |
* be > 4G, or we can't deal with it anyway, since we are in 32bit mode. |
* ecx = number of pages to map |
|
*/ |
*/ |
#define fillkpt \ |
/* |
1: movl %eax,(%ebx) ; \ |
* Build L1. |
addl $NBPG,%eax ; /* increment physical address */ \ |
*/ |
addl $4,%ebx ; /* next pte */ \ |
leal (PROC0_PTP1_OFF)(%esi),%ebx |
loop 1b ; |
|
|
|
/* |
/* Skip the first MB. */ |
* Build initial page tables. |
movl $(KERNTEXTOFF - KERNBASE),%eax |
*/ |
|
/* Calculate end of text segment, rounded to a page. */ |
|
leal (RELOC(etext)+PGOFSET),%edx |
|
andl $~PGOFSET,%edx |
|
|
|
/* Skip over the first 1MB. */ |
|
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 |
#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 RX. */ |
movl %edx,%ecx |
movl $RELOC(__rodata_start),%ecx |
subl %eax,%ecx |
subl %eax,%ecx |
shrl $PGSHIFT,%ecx |
shrl $PGSHIFT,%ecx |
orl $(PG_V|PG_KR),%eax |
orl $(PG_V|PG_KR),%eax |
fillkpt |
fillkpt |
|
|
/* Map the data, BSS, and bootstrap tables read-write. */ |
/* Map the kernel rodata R. */ |
leal (PG_V|PG_KW)(%edx),%eax |
movl $RELOC(__rodata_start),%eax |
movl RELOC(nkpde),%ecx |
movl $RELOC(__data_start),%ecx |
shll $PGSHIFT,%ecx |
subl %eax,%ecx |
addl $TABLESIZE,%ecx |
shrl $PGSHIFT,%ecx |
addl %esi,%ecx # end of tables |
orl $(PG_V|PG_KR),%eax |
subl %edx,%ecx # subtract end of text |
fillkpt_nox |
|
|
|
/* Map the kernel data+bss RW. */ |
|
movl $RELOC(__data_start),%eax |
|
movl $RELOC(__kernel_end),%ecx |
|
subl %eax,%ecx |
|
shrl $PGSHIFT,%ecx |
|
orl $(PG_V|PG_KW),%eax |
|
fillkpt_nox |
|
|
|
/* Map [SYMS]+[PRELOADED MODULES] RWX. */ |
|
movl $RELOC(__kernel_end),%eax |
|
movl %esi,%ecx /* start of BOOTSTRAP TABLES */ |
|
subl %eax,%ecx |
shrl $PGSHIFT,%ecx |
shrl $PGSHIFT,%ecx |
|
orl $(PG_V|PG_KW),%eax |
fillkpt |
fillkpt |
|
|
/* Map ISA I/O memory. */ |
/* Map the BOOTSTRAP TABLES RW. */ |
movl $(IOM_BEGIN|PG_V|PG_KW/*|PG_N*/),%eax # having these bits set |
movl %esi,%eax /* start of BOOTSTRAP TABLES */ |
movl $(IOM_SIZE>>PGSHIFT),%ecx # for this many pte s, |
movl RELOC(tablesize),%ecx /* length of BOOTSTRAP TABLES */ |
|
shrl $PGSHIFT,%ecx |
|
orl $(PG_V|PG_KW),%eax |
|
fillkpt_nox |
|
|
|
/* We are on (4). Map ISA I/O mem (later atdevbase) RWX. */ |
|
movl $(IOM_BEGIN|PG_V|PG_KW/*|PG_N*/),%eax |
|
movl $(IOM_SIZE>>PGSHIFT),%ecx |
fillkpt |
fillkpt |
|
|
/* |
/* |
* Construct a page table directory. |
* Build L2 for identity mapping. Linked to L1. |
*/ |
*/ |
/* Install PDEs for temporary double map of kernel. */ |
leal (PROC0_PDIR_OFF)(%esi),%ebx |
movl RELOC(nkpde),%ecx # for this many pde s, |
leal (PROC0_PTP1_OFF)(%esi),%eax |
leal (PROC0PDIR+0*4)(%esi),%ebx # which is where temp maps! |
orl $(PG_V|PG_KW),%eax |
leal (SYSMAP+PG_V|PG_KW)(%esi),%eax # pte for KPT in proc 0, |
movl RELOC(nkptp)+1*4,%ecx |
fillkpt |
fillkpt |
|
|
/* Map kernel PDEs. */ |
/* Set up L2 entries for actual kernel mapping */ |
movl RELOC(nkpde),%ecx # for this many pde s, |
leal (PROC0_PDIR_OFF + L2_SLOT_KERNBASE * PDE_SIZE)(%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 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 (PROC0PDIR+PG_V|PG_KW)(%esi),%eax # pte for ptd |
leal (PROC0_PDIR_OFF + PDIR_SLOT_PTE * PDE_SIZE)(%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 $PDP_SIZE,%ecx |
|
fillkpt |
|
|
|
#ifdef PAE |
|
/* |
|
* Build L3. Linked to L2. |
|
*/ |
|
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 physical address of L2. */ |
|
leal (PROC0_PDIR_OFF)(%esi),%eax |
|
movl %eax,RELOC(PDPpaddr) |
|
|
|
/* |
|
* Startup checklist: |
|
* 1. Load %cr3 with pointer to L2 (or L3 for PAE). |
|
*/ |
|
movl %esi,%eax |
|
movl %eax,%cr3 |
|
|
/* Save phys. addr of PTD, for libkvm. */ |
/* |
movl %esi,RELOC(PTDpaddr) |
* 2. Set NOX in EFER, if available. |
|
*/ |
|
movl RELOC(nox_flag),%ebx |
|
cmpl $0,%ebx |
|
je skip_NOX |
|
movl $MSR_EFER,%ecx |
|
rdmsr |
|
xorl %eax,%eax |
|
orl $(EFER_NXE),%eax |
|
wrmsr |
|
skip_NOX: |
|
|
/* Load base of page directory and enable mapping. */ |
/* |
movl %esi,%eax # phys address of ptd in proc 0 |
* 3. Enable paging and the rest of it. |
movl %eax,%cr3 # load ptd addr into mmu |
*/ |
movl %cr0,%eax # get control word |
movl %cr0,%eax |
# enable paging & NPX emulation |
orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_MP|CR0_WP|CR0_AM),%eax |
orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_EM|CR0_MP),%eax |
movl %eax,%cr0 |
movl %eax,%cr0 # and let's page NOW! |
|
|
|
pushl $begin # jump to high mem |
pushl $begin /* jump to high mem */ |
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. There's no need anymore for the identity mapping in |
leal (PROC0PDIR+0*4)(%esi),%ebx # which is where temp maps! |
* low memory, remove it. |
addl $(KERNBASE), %ebx # now use relocated address |
*/ |
1: movl $0,(%ebx) |
movl _C_LABEL(nkptp)+1*4,%ecx |
addl $4,%ebx # next pde |
leal (PROC0_PDIR_OFF)(%esi),%ebx /* old, phys address of PDIR */ |
loop 1b |
addl $(KERNBASE), %ebx /* new, virt address of PDIR */ |
|
killkpt |
|
|
/* Relocate atdevbase. */ |
/* Relocate atdevbase. */ |
movl _C_LABEL(nkpde),%edx |
movl $KERNBASE,%edx |
shll $PGSHIFT,%edx |
addl _C_LABEL(tablesize),%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(proc0paddr) |
movl %eax,_C_LABEL(lwp0uarea) |
leal (USPACE-FRAMESIZE)(%eax),%esp |
leal (USPACE-FRAMESIZE)(%eax),%esp |
movl %esi,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) |
|
/* It is now safe to parse the Multiboot information structure |
|
* we saved before from C code. Note that we cannot delay its |
|
* parsing any more because initgdt (called below) needs to make |
|
* use of this information. */ |
|
call _C_LABEL(multiboot_post_reloc) |
|
#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(nkpde),%eax |
|
shll $PGSHIFT,%eax |
|
addl $TABLESIZE,%eax |
|
addl %esi,%eax # skip past stack and page tables |
|
|
|
|
movl _C_LABEL(tablesize),%eax |
|
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 |
|
|
#endif /* SAFARI_FIFO_HACK */ |
#endif /* SAFARI_FIFO_HACK */ |
|
|
call _C_LABEL(main) |
call _C_LABEL(main) |
|
#else /* XEN */ |
|
/* First, reset the PSL. */ |
|
pushl $PSL_MBO |
|
popfl |
|
|
/* |
cld |
* void proc_trampoline(void); |
movl %esp, %ebx /* save start of available space */ |
* This is a trampoline function pushed onto the stack of a newly created |
movl $_RELOC(tmpstk),%esp /* bootstrap stack end location */ |
* 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 |
/* Clear BSS. */ |
* by cpu_switch() to store the information about the stub to call. |
xorl %eax,%eax |
* NOTE: This function does not have a normal calling sequence! |
movl $RELOC(__bss_start),%edi |
*/ |
movl $RELOC(_end),%ecx |
/* LINTSTUB: Func: void proc_trampoline(void) */ |
subl %edi,%ecx |
NENTRY(proc_trampoline) |
rep stosb |
#ifdef MULTIPROCESSOR |
|
call _C_LABEL(proc_trampoline_mp) |
/* Copy the necessary stuff from start_info structure. */ |
#endif |
/* We need to copy shared_info early, so that sti/cli work */ |
movl $IPL_NONE,CPUVAR(ILEVEL) |
movl $RELOC(start_info_union),%edi |
pushl %ebx |
movl $128,%ecx |
call *%esi |
rep movsl |
|
|
|
/* Clear segment registers; always null in proc0. */ |
|
xorl %eax,%eax |
|
movw %ax,%fs |
|
movw %ax,%gs |
|
decl %eax |
|
movl %eax,RELOC(cpuid_level) |
|
|
|
xorl %eax,%eax |
|
cpuid |
|
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 |
addl $4,%esp |
INTRFASTEXIT |
|
/* NOTREACHED */ |
|
|
|
/*****************************************************************************/ |
call xen_pmap_bootstrap |
|
|
/* |
|
* Signal trampoline; copied to top of user stack. |
|
*/ |
|
/* LINTSTUB: Var: char sigcode[1], esigcode[1]; */ |
|
NENTRY(sigcode) |
|
/* |
/* |
* Handler has returned here as if we called it. The sigcontext |
* First avail returned by xen_pmap_bootstrap in %eax |
* is on the stack after the 3 args "we" pushed. |
|
*/ |
*/ |
leal 12(%esp),%eax # get pointer to sigcontext |
movl %eax, %esi; |
movl %eax,4(%esp) # put it in the argument slot |
movl %esi, _C_LABEL(lwp0uarea) |
# fake return address already there |
|
movl $SYS___sigreturn14,%eax |
|
int $0x80 # enter kernel with args on stack |
|
movl $SYS_exit,%eax |
|
int $0x80 # exit if sigreturn fails |
|
.globl _C_LABEL(esigcode) |
|
_C_LABEL(esigcode): |
|
|
|
/*****************************************************************************/ |
/* Set up bootstrap stack. */ |
|
leal (USPACE-FRAMESIZE)(%eax),%esp |
|
xorl %ebp,%ebp /* mark end of frames */ |
|
|
/* |
addl $USPACE, %esi |
* The following primitives are used to fill and copy regions of memory. |
subl $KERNBASE, %esi /* init386 wants a physical address */ |
*/ |
|
|
#ifdef PAE |
|
pushl $0 /* init386() expects a 64 bits paddr_t with PAE */ |
|
#endif |
|
pushl %esi |
|
call _C_LABEL(init386) /* wire 386 chip for unix operation */ |
|
addl $PDE_SIZE,%esp /* pop paddr_t */ |
|
call _C_LABEL(main) |
|
#endif /* XEN */ |
|
END(start) |
|
|
|
#if defined(XEN) |
|
/* space for the hypercall call page */ |
|
#define HYPERCALL_PAGE_OFFSET 0x1000 |
|
.org HYPERCALL_PAGE_OFFSET |
|
ENTRY(hypercall_page) |
|
.skip 0x1000 |
|
END(hypercall_page) |
|
|
/* |
/* |
* XXX No section 9 man page for fillw. |
* void lgdt_finish(void); |
* fillw seems to be very sparsely used (only in pccons it seems.) |
* Finish load a new GDT pointer (do any necessary cleanup). |
* One wonders if it couldn't be done without. |
|
* -- Perry Metzger, May 7, 2001 |
|
*/ |
|
/* |
|
* void fillw(short pattern, void *addr, size_t len); |
|
* Write len copies of pattern at addr. |
|
*/ |
|
/* LINTSTUB: Func: void fillw(short pattern, void *addr, size_t len) */ |
|
ENTRY(fillw) |
|
pushl %edi |
|
movl 8(%esp),%eax |
|
movl 12(%esp),%edi |
|
movw %ax,%cx |
|
rorl $16,%eax |
|
movw %cx,%ax |
|
cld |
|
movl 16(%esp),%ecx |
|
shrl %ecx # do longwords |
|
rep |
|
stosl |
|
movl 16(%esp),%ecx |
|
andl $1,%ecx # do remainder |
|
rep |
|
stosw |
|
popl %edi |
|
ret |
|
|
|
/* |
|
* int kcopy(const void *from, void *to, size_t len); |
|
* Copy len bytes, abort on fault. |
|
*/ |
|
/* LINTSTUB: Func: int kcopy(const void *from, void *to, size_t len) */ |
|
ENTRY(kcopy) |
|
pushl %esi |
|
pushl %edi |
|
GET_CURPCB(%eax) # load curpcb into eax and set on-fault |
|
pushl PCB_ONFAULT(%eax) |
|
movl $_C_LABEL(copy_fault), PCB_ONFAULT(%eax) |
|
|
|
movl 16(%esp),%esi |
|
movl 20(%esp),%edi |
|
movl 24(%esp),%ecx |
|
movl %edi,%eax |
|
subl %esi,%eax |
|
cmpl %ecx,%eax # overlapping? |
|
jb 1f |
|
cld # nope, copy forward |
|
shrl $2,%ecx # copy by 32-bit words |
|
rep |
|
movsl |
|
movl 24(%esp),%ecx |
|
andl $3,%ecx # any bytes left? |
|
rep |
|
movsb |
|
|
|
GET_CURPCB(%edx) # XXX save curpcb? |
|
popl PCB_ONFAULT(%edx) |
|
popl %edi |
|
popl %esi |
|
xorl %eax,%eax |
|
ret |
|
|
|
ALIGN_TEXT |
|
1: addl %ecx,%edi # copy backward |
|
addl %ecx,%esi |
|
std |
|
andl $3,%ecx # any fractional bytes? |
|
decl %edi |
|
decl %esi |
|
rep |
|
movsb |
|
movl 24(%esp),%ecx # copy remainder by 32-bit words |
|
shrl $2,%ecx |
|
subl $3,%esi |
|
subl $3,%edi |
|
rep |
|
movsl |
|
cld |
|
|
|
GET_CURPCB(%edx) |
|
popl PCB_ONFAULT(%edx) |
|
popl %edi |
|
popl %esi |
|
xorl %eax,%eax |
|
ret |
|
|
|
/*****************************************************************************/ |
|
|
|
/* |
|
* The following primitives are used to copy data in and out of the user's |
|
* address space. |
|
*/ |
|
|
|
/* |
|
* Default to the lowest-common-denominator. We will improve it |
|
* later. |
|
*/ |
|
#if defined(I386_CPU) |
|
#define DEFAULT_COPYOUT _C_LABEL(i386_copyout) |
|
#define DEFAULT_COPYIN _C_LABEL(i386_copyin) |
|
#elif defined(I486_CPU) |
|
#define DEFAULT_COPYOUT _C_LABEL(i486_copyout) |
|
#define DEFAULT_COPYIN _C_LABEL(i386_copyin) |
|
#elif defined(I586_CPU) |
|
#define DEFAULT_COPYOUT _C_LABEL(i486_copyout) /* XXX */ |
|
#define DEFAULT_COPYIN _C_LABEL(i386_copyin) /* XXX */ |
|
#elif defined(I686_CPU) |
|
#define DEFAULT_COPYOUT _C_LABEL(i486_copyout) /* XXX */ |
|
#define DEFAULT_COPYIN _C_LABEL(i386_copyin) /* XXX */ |
|
#endif |
|
|
|
.data |
|
|
|
.globl _C_LABEL(copyout_func) |
|
_C_LABEL(copyout_func): |
|
.long DEFAULT_COPYOUT |
|
|
|
.globl _C_LABEL(copyin_func) |
|
_C_LABEL(copyin_func): |
|
.long DEFAULT_COPYIN |
|
|
|
.text |
|
|
|
/* |
|
* int copyout(const void *from, void *to, size_t len); |
|
* Copy len bytes into the user's address space. |
|
* see copyout(9) |
|
*/ |
|
/* LINTSTUB: Func: int copyout(const void *kaddr, void *uaddr, size_t len) */ |
|
ENTRY(copyout) |
|
jmp *_C_LABEL(copyout_func) |
|
|
|
#if defined(I386_CPU) |
|
/* LINTSTUB: Func: int i386_copyout(const void *kaddr, void *uaddr, size_t len) */ |
|
ENTRY(i386_copyout) |
|
pushl %esi |
|
pushl %edi |
|
pushl $0 |
|
|
|
movl 16(%esp),%esi |
|
movl 20(%esp),%edi |
|
movl 24(%esp),%eax |
|
|
|
/* |
|
* We check that the end of the destination buffer is not past the end |
|
* of the user's address space. If it's not, then we only need to |
|
* check that each page is writable. The 486 will do this for us; the |
|
* 386 will not. (We assume that pages in user space that are not |
|
* writable by the user are not writable by the kernel either.) |
|
*/ |
|
movl %edi,%edx |
|
addl %eax,%edx |
|
jc _C_LABEL(copy_efault) |
|
cmpl $VM_MAXUSER_ADDRESS,%edx |
|
ja _C_LABEL(copy_efault) |
|
|
|
testl %eax,%eax # anything to do? |
|
jz 3f |
|
|
|
/* |
|
* We have to check each PTE for (write) permission, since the CPU |
|
* doesn't do it for us. |
|
*/ |
|
|
|
/* Compute number of pages. */ |
|
movl %edi,%ecx |
|
andl $PGOFSET,%ecx |
|
addl %eax,%ecx |
|
decl %ecx |
|
shrl $PGSHIFT,%ecx |
|
|
|
/* Compute PTE offset for start address. */ |
|
shrl $PGSHIFT,%edi |
|
|
|
GET_CURPCB(%edx) |
|
movl $2f,PCB_ONFAULT(%edx) |
|
|
|
1: /* Check PTE for each page. */ |
|
testb $PG_RW,_C_LABEL(PTmap)(,%edi,4) |
|
jz 2f |
|
|
|
4: incl %edi |
|
decl %ecx |
|
jns 1b |
|
|
|
movl 20(%esp),%edi |
|
movl 24(%esp),%eax |
|
jmp 3f |
|
|
|
2: /* Simulate a trap. */ |
|
pushl %ecx |
|
movl %edi,%eax |
|
shll $PGSHIFT,%eax |
|
pushl %eax |
|
call _C_LABEL(trapwrite) # trapwrite(addr) |
|
addl $4,%esp # pop argument |
|
popl %ecx |
|
testl %eax,%eax # if not ok, return EFAULT |
|
jz 4b |
|
jmp _C_LABEL(copy_efault) |
|
|
|
3: GET_CURPCB(%edx) |
|
movl $_C_LABEL(copy_fault),PCB_ONFAULT(%edx) |
|
|
|
/* bcopy(%esi, %edi, %eax); */ |
|
cld |
|
movl %eax,%ecx |
|
shrl $2,%ecx |
|
rep |
|
movsl |
|
movl %eax,%ecx |
|
andl $3,%ecx |
|
rep |
|
movsb |
|
|
|
popl PCB_ONFAULT(%edx) |
|
popl %edi |
|
popl %esi |
|
xorl %eax,%eax |
|
ret |
|
#endif /* I386_CPU */ |
|
|
|
#if defined(I486_CPU) || defined(I586_CPU) || defined(I686_CPU) |
|
/* LINTSTUB: Func: int i486_copyout(const void *kaddr, void *uaddr, size_t len) */ |
|
ENTRY(i486_copyout) |
|
pushl %esi |
|
pushl %edi |
|
pushl $0 |
|
|
|
movl 16(%esp),%esi |
|
movl 20(%esp),%edi |
|
movl 24(%esp),%eax |
|
|
|
/* |
|
* We check that the end of the destination buffer is not past the end |
|
* of the user's address space. |
|
*/ |
|
movl %edi,%edx |
|
addl %eax,%edx |
|
jc _C_LABEL(copy_efault) |
|
cmpl $VM_MAXUSER_ADDRESS,%edx |
|
ja _C_LABEL(copy_efault) |
|
|
|
GET_CURPCB(%edx) |
|
movl $_C_LABEL(copy_fault),PCB_ONFAULT(%edx) |
|
|
|
/* bcopy(%esi, %edi, %eax); */ |
|
cld |
|
movl %eax,%ecx |
|
shrl $2,%ecx |
|
rep |
|
movsl |
|
movl %eax,%ecx |
|
andl $3,%ecx |
|
rep |
|
movsb |
|
|
|
popl PCB_ONFAULT(%edx) |
|
popl %edi |
|
popl %esi |
|
xorl %eax,%eax |
|
ret |
|
#endif /* I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
/* |
|
* int copyin(const void *from, void *to, size_t len); |
|
* Copy len bytes from the user's address space. |
|
* see copyin(9) |
|
*/ |
|
/* LINTSTUB: Func: int copyin(const void *uaddr, void *kaddr, size_t len) */ |
|
ENTRY(copyin) |
|
jmp *_C_LABEL(copyin_func) |
|
|
|
#if defined(I386_CPU) || defined(I486_CPU) || defined(I586_CPU) || \ |
|
defined(I686_CPU) |
|
/* LINTSTUB: Func: int i386_copyin(const void *uaddr, void *kaddr, size_t len) */ |
|
ENTRY(i386_copyin) |
|
pushl %esi |
|
pushl %edi |
|
GET_CURPCB(%eax) |
|
pushl $0 |
|
movl $_C_LABEL(copy_fault),PCB_ONFAULT(%eax) |
|
|
|
movl 16(%esp),%esi |
|
movl 20(%esp),%edi |
|
movl 24(%esp),%eax |
|
|
|
/* |
|
* We check that the end of the destination buffer is not past the end |
|
* of the user's address space. If it's not, then we only need to |
|
* check that each page is readable, and the CPU will do that for us. |
|
*/ |
|
movl %esi,%edx |
|
addl %eax,%edx |
|
jc _C_LABEL(copy_efault) |
|
cmpl $VM_MAXUSER_ADDRESS,%edx |
|
ja _C_LABEL(copy_efault) |
|
|
|
/* bcopy(%esi, %edi, %eax); */ |
|
cld |
|
movl %eax,%ecx |
|
shrl $2,%ecx |
|
rep |
|
movsl |
|
movl %eax,%ecx |
|
andl $3,%ecx |
|
rep |
|
movsb |
|
|
|
GET_CURPCB(%edx) |
|
popl PCB_ONFAULT(%edx) |
|
popl %edi |
|
popl %esi |
|
xorl %eax,%eax |
|
ret |
|
#endif /* I386_CPU || I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
/* LINTSTUB: Ignore */ |
|
NENTRY(copy_efault) |
|
movl $EFAULT,%eax |
|
|
|
/* LINTSTUB: Ignore */ |
|
NENTRY(copy_fault) |
|
GET_CURPCB(%edx) |
|
popl PCB_ONFAULT(%edx) |
|
popl %edi |
|
popl %esi |
|
ret |
|
|
|
/* |
|
* int copyoutstr(const void *from, void *to, size_t maxlen, size_t *lencopied); |
|
* Copy a NUL-terminated string, at most maxlen characters long, into the |
|
* user's address space. Return the number of characters copied (including the |
|
* NUL) in *lencopied. If the string is too long, return ENAMETOOLONG; else |
|
* return 0 or EFAULT. |
|
* see copyoutstr(9) |
|
*/ |
|
/* LINTSTUB: Func: int copyoutstr(const void *kaddr, void *uaddr, size_t len, size_t *done) */ |
|
ENTRY(copyoutstr) |
|
pushl %esi |
|
pushl %edi |
|
|
|
movl 12(%esp),%esi # esi = from |
|
movl 16(%esp),%edi # edi = to |
|
movl 20(%esp),%edx # edx = maxlen |
|
|
|
#if defined(I386_CPU) |
|
#if defined(I486_CPU) || defined(I586_CPU) || defined(I686_CPU) |
|
cmpl $CPUCLASS_386,_C_LABEL(cpu_class) |
|
jne 5f |
|
#endif /* I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
/* Compute number of bytes in first page. */ |
|
movl %edi,%eax |
|
andl $PGOFSET,%eax |
|
movl $NBPG,%ecx |
|
subl %eax,%ecx # ecx = NBPG - (src % NBPG) |
|
|
|
GET_CURPCB(%eax) |
|
movl $6f,PCB_ONFAULT(%eax) |
|
|
|
1: /* |
|
* Once per page, check that we are still within the bounds of user |
|
* space, and check for a write fault. |
|
*/ |
|
cmpl $VM_MAXUSER_ADDRESS,%edi |
|
jae _C_LABEL(copystr_efault) |
|
|
|
/* Compute PTE offset. */ |
|
movl %edi,%eax |
|
shrl $PGSHIFT,%eax # calculate pte address |
|
|
|
testb $PG_RW,_C_LABEL(PTmap)(,%eax,4) |
|
jnz 2f |
|
|
|
6: /* Simulate a trap. */ |
|
pushl %edx |
|
pushl %edi |
|
call _C_LABEL(trapwrite) # trapwrite(addr) |
|
addl $4,%esp # clear argument from stack |
|
popl %edx |
|
testl %eax,%eax |
|
jnz _C_LABEL(copystr_efault) |
|
|
|
2: /* Copy up to end of this page. */ |
|
subl %ecx,%edx # predecrement total count |
|
jnc 3f |
|
addl %edx,%ecx # ecx += (edx - ecx) = edx |
|
xorl %edx,%edx |
|
|
|
3: decl %ecx |
|
js 4f |
|
lodsb |
|
stosb |
|
testb %al,%al |
|
jnz 3b |
|
|
|
/* Success -- 0 byte reached. */ |
|
addl %ecx,%edx # add back residual for this page |
|
xorl %eax,%eax |
|
jmp copystr_return |
|
|
|
4: /* Go to next page, if any. */ |
|
movl $NBPG,%ecx |
|
testl %edx,%edx |
|
jnz 1b |
|
|
|
/* edx is zero -- return ENAMETOOLONG. */ |
|
movl $ENAMETOOLONG,%eax |
|
jmp copystr_return |
|
#endif /* I386_CPU */ |
|
|
|
#if defined(I486_CPU) || defined(I586_CPU) || defined(I686_CPU) |
|
5: GET_CURPCB(%eax) |
|
movl $_C_LABEL(copystr_fault),PCB_ONFAULT(%eax) |
|
/* |
|
* Get min(%edx, VM_MAXUSER_ADDRESS-%edi). |
|
*/ |
|
movl $VM_MAXUSER_ADDRESS,%eax |
|
subl %edi,%eax |
|
cmpl %edx,%eax |
|
jae 1f |
|
movl %eax,%edx |
|
movl %eax,20(%esp) |
|
|
|
1: incl %edx |
|
cld |
|
|
|
1: decl %edx |
|
jz 2f |
|
lodsb |
|
stosb |
|
testb %al,%al |
|
jnz 1b |
|
|
|
/* Success -- 0 byte reached. */ |
|
decl %edx |
|
xorl %eax,%eax |
|
jmp copystr_return |
|
|
|
2: /* edx is zero -- return EFAULT or ENAMETOOLONG. */ |
|
cmpl $VM_MAXUSER_ADDRESS,%edi |
|
jae _C_LABEL(copystr_efault) |
|
movl $ENAMETOOLONG,%eax |
|
jmp copystr_return |
|
#endif /* I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
/* |
|
* int copyinstr(const void *from, void *to, size_t maxlen, size_t *lencopied); |
|
* Copy a NUL-terminated string, at most maxlen characters long, from the |
|
* user's address space. Return the number of characters copied (including the |
|
* NUL) in *lencopied. If the string is too long, return ENAMETOOLONG; else |
|
* return 0 or EFAULT. |
|
* see copyinstr(9) |
|
*/ |
|
/* LINTSTUB: Func: int copyinstr(const void *uaddr, void *kaddr, size_t len, size_t *done) */ |
|
ENTRY(copyinstr) |
|
pushl %esi |
|
pushl %edi |
|
GET_CURPCB(%ecx) |
|
movl $_C_LABEL(copystr_fault),PCB_ONFAULT(%ecx) |
|
|
|
movl 12(%esp),%esi # %esi = from |
|
movl 16(%esp),%edi # %edi = to |
|
movl 20(%esp),%edx # %edx = maxlen |
|
|
|
/* |
|
* Get min(%edx, VM_MAXUSER_ADDRESS-%esi). |
|
*/ |
|
movl $VM_MAXUSER_ADDRESS,%eax |
|
subl %esi,%eax |
|
cmpl %edx,%eax |
|
jae 1f |
|
movl %eax,%edx |
|
movl %eax,20(%esp) |
|
|
|
1: incl %edx |
|
cld |
|
|
|
1: decl %edx |
|
jz 2f |
|
lodsb |
|
stosb |
|
testb %al,%al |
|
jnz 1b |
|
|
|
/* Success -- 0 byte reached. */ |
|
decl %edx |
|
xorl %eax,%eax |
|
jmp copystr_return |
|
|
|
2: /* edx is zero -- return EFAULT or ENAMETOOLONG. */ |
|
cmpl $VM_MAXUSER_ADDRESS,%esi |
|
jae _C_LABEL(copystr_efault) |
|
movl $ENAMETOOLONG,%eax |
|
jmp copystr_return |
|
|
|
/* LINTSTUB: Ignore */ |
|
NENTRY(copystr_efault) |
|
movl $EFAULT,%eax |
|
|
|
/* LINTSTUB: Ignore */ |
|
NENTRY(copystr_fault) |
|
copystr_return: |
|
/* Set *lencopied and return %eax. */ |
|
GET_CURPCB(%ecx) |
|
movl $0,PCB_ONFAULT(%ecx) |
|
movl 20(%esp),%ecx |
|
subl %edx,%ecx |
|
movl 24(%esp),%edx |
|
testl %edx,%edx |
|
jz 8f |
|
movl %ecx,(%edx) |
|
|
|
8: popl %edi |
|
popl %esi |
|
ret |
|
|
|
/* |
|
* int copystr(const void *from, void *to, size_t maxlen, size_t *lencopied); |
|
* Copy a NUL-terminated string, at most maxlen characters long. Return the |
|
* number of characters copied (including the NUL) in *lencopied. If the |
|
* string is too long, return ENAMETOOLONG; else return 0. |
|
* see copystr(9) |
|
*/ |
|
/* LINTSTUB: Func: int copystr(const void *kfaddr, void *kdaddr, size_t len, size_t *done) */ |
|
ENTRY(copystr) |
|
pushl %esi |
|
pushl %edi |
|
|
|
movl 12(%esp),%esi # esi = from |
|
movl 16(%esp),%edi # edi = to |
|
movl 20(%esp),%edx # edx = maxlen |
|
incl %edx |
|
cld |
|
|
|
1: decl %edx |
|
jz 4f |
|
lodsb |
|
stosb |
|
testb %al,%al |
|
jnz 1b |
|
|
|
/* Success -- 0 byte reached. */ |
|
decl %edx |
|
xorl %eax,%eax |
|
jmp 6f |
|
|
|
4: /* edx is zero -- return ENAMETOOLONG. */ |
|
movl $ENAMETOOLONG,%eax |
|
|
|
6: /* Set *lencopied and return %eax. */ |
|
movl 20(%esp),%ecx |
|
subl %edx,%ecx |
|
movl 24(%esp),%edx |
|
testl %edx,%edx |
|
jz 7f |
|
movl %ecx,(%edx) |
|
|
|
7: popl %edi |
|
popl %esi |
|
ret |
|
|
|
/* |
|
* long fuword(const void *uaddr); |
|
* Fetch an int from the user's address space. |
|
* see fuword(9) |
|
*/ |
|
/* LINTSTUB: Func: long fuword(const void *base) */ |
|
ENTRY(fuword) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-4,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
GET_CURPCB(%ecx) |
|
movl $_C_LABEL(fusufault),PCB_ONFAULT(%ecx) |
|
movl (%edx),%eax |
|
movl $0,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/* |
|
* int fusword(const void *uaddr); |
|
* Fetch a short from the user's address space. |
|
* see fusword(9) |
|
*/ |
|
/* LINTSTUB: Func: int fusword(const void *base) */ |
|
ENTRY(fusword) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-2,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
GET_CURPCB(%ecx) |
|
movl $_C_LABEL(fusufault),PCB_ONFAULT(%ecx) |
|
movzwl (%edx),%eax |
|
movl $0,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/* |
|
* int fuswintr(const void *uaddr); |
|
* Fetch a short from the user's address space. Can be called during an |
|
* interrupt. |
|
* see fuswintr(9) |
|
*/ |
|
/* LINTSTUB: Func: int fuswintr(const void *base) */ |
|
ENTRY(fuswintr) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-2,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
movl CPUVAR(CURPROC),%ecx |
|
movl P_ADDR(%ecx),%ecx |
|
movl $_C_LABEL(fusubail),PCB_ONFAULT(%ecx) |
|
movzwl (%edx),%eax |
|
movl $0,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/* |
|
* int fubyte(const void *uaddr); |
|
* Fetch a byte from the user's address space. |
|
* see fubyte(9) |
|
*/ |
|
/* LINTSTUB: Func: int fubyte(const void *base) */ |
|
ENTRY(fubyte) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-1,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
GET_CURPCB(%ecx) |
|
movl $_C_LABEL(fusufault),PCB_ONFAULT(%ecx) |
|
movzbl (%edx),%eax |
|
movl $0,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/* |
|
* Handle faults from [fs]u*(). Clean up and return -1. |
|
*/ |
|
/* LINTSTUB: Ignore */ |
|
NENTRY(fusufault) |
|
movl $0,PCB_ONFAULT(%ecx) |
|
movl $-1,%eax |
|
ret |
|
|
|
/* |
|
* Handle faults from [fs]u*(). Clean up and return -1. This differs from |
|
* fusufault() in that trap() will recognize it and return immediately rather |
|
* than trying to page fault. |
|
*/ |
|
/* LINTSTUB: Ignore */ |
|
NENTRY(fusubail) |
|
movl $0,PCB_ONFAULT(%ecx) |
|
movl $-1,%eax |
|
ret |
|
|
|
/* |
|
* Handle earlier faults from [fs]u*(), due to our of range addresses. |
|
*/ |
|
/* LINTSTUB: Ignore */ |
|
NENTRY(fusuaddrfault) |
|
movl $-1,%eax |
|
ret |
|
|
|
/* |
|
* int suword(void *uaddr, long x); |
|
* Store an int in the user's address space. |
|
* see suword(9) |
|
*/ |
|
/* LINTSTUB: Func: int suword(void *base, long c) */ |
|
ENTRY(suword) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-4,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
|
|
#if defined(I386_CPU) |
|
#if defined(I486_CPU) || defined(I586_CPU) || defined(I686_CPU) |
|
cmpl $CPUCLASS_386,_C_LABEL(cpu_class) |
|
jne 2f |
|
#endif /* I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
GET_CURPCB(%eax) |
|
movl $3f,PCB_ONFAULT(%eax) |
|
|
|
movl %edx,%eax |
|
shrl $PGSHIFT,%eax # calculate pte address |
|
testb $PG_RW,_C_LABEL(PTmap)(,%eax,4) |
|
jnz 1f |
|
|
|
3: /* Simulate a trap. */ |
|
pushl %edx |
|
pushl %edx |
|
call _C_LABEL(trapwrite) # trapwrite(addr) |
|
addl $4,%esp # clear parameter from the stack |
|
popl %edx |
|
GET_CURPCB(%ecx) |
|
testl %eax,%eax |
|
jnz _C_LABEL(fusufault) |
|
|
|
1: /* XXX also need to check the following 3 bytes for validity! */ |
|
#endif |
|
|
|
2: GET_CURPCB(%ecx) |
|
movl $_C_LABEL(fusufault),PCB_ONFAULT(%ecx) |
|
|
|
movl 8(%esp),%eax |
|
movl %eax,(%edx) |
|
xorl %eax,%eax |
|
movl %eax,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/* |
|
* int susword(void *uaddr, short x); |
|
* Store a short in the user's address space. |
|
* see susword(9) |
|
*/ |
|
/* LINTSTUB: Func: int susword(void *base, short c) */ |
|
ENTRY(susword) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-2,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
|
|
#if defined(I386_CPU) |
|
#if defined(I486_CPU) || defined(I586_CPU) || defined(I686_CPU) |
|
cmpl $CPUCLASS_386,_C_LABEL(cpu_class) |
|
jne 2f |
|
#endif /* I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
GET_CURPCB(%eax) |
|
movl $3f,PCB_ONFAULT(%eax) |
|
|
|
movl %edx,%eax |
|
shrl $PGSHIFT,%eax # calculate pte address |
|
testb $PG_RW,_C_LABEL(PTmap)(,%eax,4) |
|
jnz 1f |
|
|
|
3: /* Simulate a trap. */ |
|
pushl %edx |
|
pushl %edx |
|
call _C_LABEL(trapwrite) # trapwrite(addr) |
|
addl $4,%esp # clear parameter from the stack |
|
popl %edx |
|
GET_CURPCB(%ecx) |
|
testl %eax,%eax |
|
jnz _C_LABEL(fusufault) |
|
|
|
1: /* XXX also need to check the following byte for validity! */ |
|
#endif |
|
|
|
2: GET_CURPCB(%ecx) |
|
movl $_C_LABEL(fusufault),PCB_ONFAULT(%ecx) |
|
|
|
movl 8(%esp),%eax |
|
movw %ax,(%edx) |
|
xorl %eax,%eax |
|
movl %eax,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/* |
|
* int suswintr(void *uaddr, short x); |
|
* Store a short in the user's address space. Can be called during an |
|
* interrupt. |
|
* see suswintr(9) |
|
*/ |
|
/* LINTSTUB: Func: int suswintr(void *base, short c) */ |
|
ENTRY(suswintr) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-2,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
movl CPUVAR(CURPROC),%ecx |
|
movl P_ADDR(%ecx),%ecx |
|
movl $_C_LABEL(fusubail),PCB_ONFAULT(%ecx) |
|
|
|
#if defined(I386_CPU) |
|
#if defined(I486_CPU) || defined(I586_CPU) || defined(I686_CPU) |
|
cmpl $CPUCLASS_386,_C_LABEL(cpu_class) |
|
jne 2f |
|
#endif /* I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
movl %edx,%eax |
|
shrl $PGSHIFT,%eax # calculate pte address |
|
testb $PG_RW,_C_LABEL(PTmap)(,%eax,4) |
|
jnz 1f |
|
|
|
/* Simulate a trap. */ |
|
jmp _C_LABEL(fusubail) |
|
|
|
1: /* XXX also need to check the following byte for validity! */ |
|
#endif |
|
|
|
2: movl 8(%esp),%eax |
|
movw %ax,(%edx) |
|
xorl %eax,%eax |
|
movl %eax,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/* |
|
* int subyte(void *uaddr, char x); |
|
* Store a byte in the user's address space. |
|
* see subyte(9) |
|
*/ |
|
/* LINTSTUB: Func: int subyte(void *base, int c) */ |
|
ENTRY(subyte) |
|
movl 4(%esp),%edx |
|
cmpl $VM_MAXUSER_ADDRESS-1,%edx |
|
ja _C_LABEL(fusuaddrfault) |
|
|
|
#if defined(I386_CPU) |
|
#if defined(I486_CPU) || defined(I586_CPU) || defined(I686_CPU) |
|
cmpl $CPUCLASS_386,_C_LABEL(cpu_class) |
|
jne 2f |
|
#endif /* I486_CPU || I586_CPU || I686_CPU */ |
|
|
|
GET_CURPCB(%eax) |
|
movl $3f,PCB_ONFAULT(%eax) |
|
|
|
movl %edx,%eax |
|
shrl $PGSHIFT,%eax # calculate pte address |
|
testb $PG_RW,_C_LABEL(PTmap)(,%eax,4) |
|
jnz 1f |
|
|
|
3: /* Simulate a trap. */ |
|
pushl %edx |
|
pushl %edx |
|
call _C_LABEL(trapwrite) # trapwrite(addr) |
|
addl $4,%esp # clear parameter from the stack |
|
popl %edx |
|
GET_CURPCB(%ecx) |
|
testl %eax,%eax |
|
jnz _C_LABEL(fusufault) |
|
|
|
1: |
|
#endif |
|
|
|
2: GET_CURPCB(%ecx) |
|
movl $_C_LABEL(fusufault),PCB_ONFAULT(%ecx) |
|
|
|
movb 8(%esp),%al |
|
movb %al,(%edx) |
|
xorl %eax,%eax |
|
movl %eax,PCB_ONFAULT(%ecx) |
|
ret |
|
|
|
/*****************************************************************************/ |
|
|
|
/* |
|
* The following is i386-specific nonsense. |
|
*/ |
|
|
|
/* |
|
* void lgdt(struct region_descriptor *rdp); |
|
* Load a new GDT pointer (and do any necessary cleanup). |
|
* XXX It's somewhat questionable whether reloading all the segment registers |
* XXX It's somewhat questionable whether reloading all the segment registers |
* is necessary, since the actual descriptor data is not changed except by |
* is necessary, since the actual descriptor data is not changed except by |
* process creation and exit, both of which clean up via task switches. OTOH, |
* process creation and exit, both of which clean up via task switches. OTOH, |
* this only happens at run time when the GDT is resized. |
* this only happens at run time when the GDT is resized. |
*/ |
*/ |
/* LINTSTUB: Func: void lgdt(struct region_descriptor *rdp) */ |
/* LINTSTUB: Func: void lgdt_finish(void) */ |
NENTRY(lgdt) |
NENTRY(lgdt_finish) |
/* Reload the descriptor table. */ |
|
movl 4(%esp),%eax |
|
lgdt (%eax) |
|
/* Flush the prefetch queue. */ |
|
jmp 1f |
|
nop |
|
1: /* Reload "stale" selectors. */ |
|
movl $GSEL(GDATA_SEL, SEL_KPL),%eax |
movl $GSEL(GDATA_SEL, SEL_KPL),%eax |
movw %ax,%ds |
movw %ax,%ds |
movw %ax,%es |
movw %ax,%es |
|
|
pushl $GSEL(GCODE_SEL, SEL_KPL) |
pushl $GSEL(GCODE_SEL, SEL_KPL) |
pushl %eax |
pushl %eax |
lret |
lret |
|
END(lgdt_finish) |
|
|
/*****************************************************************************/ |
#endif /* XEN */ |
|
|
/* |
/* |
* These functions are primarily used by DDB. |
* void lwp_trampoline(void); |
|
* |
|
* 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 |
|
* cpu_switchto()ing to the process, so we abuse the callee-saved |
|
* registers used by cpu_switchto() to store the information about the |
|
* stub to call. |
|
* NOTE: This function does not have a normal calling sequence! |
*/ |
*/ |
|
NENTRY(lwp_trampoline) |
|
movl %ebp,%edi /* for .Lsyscall_checkast */ |
|
xorl %ebp,%ebp |
|
pushl %edi |
|
pushl %eax |
|
call _C_LABEL(lwp_startup) |
|
addl $8,%esp |
|
pushl %ebx |
|
call *%esi |
|
addl $4,%esp |
|
jmp .Lsyscall_checkast |
|
/* NOTREACHED */ |
|
END(lwp_trampoline) |
|
|
/* LINTSTUB: Func: int setjmp (label_t *l) */ |
/* |
|
* sigcode() |
|
* |
|
* Signal trampoline; copied to top of user stack. Used only for |
|
* compatibility with old releases of NetBSD. |
|
*/ |
|
NENTRY(sigcode) |
|
/* |
|
* Handler has returned here as if we called it. The sigcontext |
|
* is on the stack after the 3 args "we" pushed. |
|
*/ |
|
leal 12(%esp),%eax /* get pointer to sigcontext */ |
|
movl %eax,4(%esp) /* put it in the argument slot */ |
|
/* fake return address already there */ |
|
movl $SYS_compat_16___sigreturn14,%eax |
|
int $0x80 /* enter kernel with args on stack */ |
|
movl $SYS_exit,%eax |
|
int $0x80 /* exit if sigreturn fails */ |
|
.globl _C_LABEL(esigcode) |
|
_C_LABEL(esigcode): |
|
END(sigcode) |
|
|
|
/* |
|
* int setjmp(label_t *) |
|
* |
|
* Used primarily by DDB. |
|
*/ |
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) |
|
|
/* LINTSTUB: Func: void longjmp (label_t *l) */ |
/* |
|
* int longjmp(label_t *) |
|
* |
|
* Used primarily by DDB. |
|
*/ |
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 */ |
xorl %eax,%eax # return (1); |
movl $1,%eax /* return 1 */ |
incl %eax |
|
ret |
ret |
|
END(longjmp) |
|
|
/*****************************************************************************/ |
/* |
|
* void dumpsys(void) |
.globl _C_LABEL(sched_whichqs),_C_LABEL(sched_qs) |
* |
.globl _C_LABEL(uvmexp),_C_LABEL(panic) |
* Mimic cpu_switchto() for postmortem debugging. |
|
*/ |
#ifdef DIAGNOSTIC |
ENTRY(dumpsys) |
NENTRY(switch_error) |
pushl %ebx /* set up fake switchframe */ |
pushl $1f |
pushl %esi /* and save context */ |
call _C_LABEL(panic) |
pushl %edi |
/* NOTREACHED */ |
movl %esp,_C_LABEL(dumppcb)+PCB_ESP |
1: .asciz "cpu_switch" |
movl %ebp,_C_LABEL(dumppcb)+PCB_EBP |
#endif /* DIAGNOSTIC */ |
call _C_LABEL(dodumpsys) /* dump! */ |
|
addl $(3*4), %esp /* unwind switchframe */ |
|
ret |
|
END(dumpsys) |
|
|
/* |
/* |
* void cpu_switch(struct proc *) |
* struct lwp *cpu_switchto(struct lwp *oldlwp, struct lwp *newlwp, |
* Find a runnable process and switch to it. Wait if necessary. If the new |
* bool returning) |
* process is the same as the old one, we short-circuit the context save and |
* |
* restore. |
* 1. if (oldlwp != NULL), save its context. |
* |
* 2. then, restore context of newlwp. |
* Note that the stack frame layout is known to "struct switchframe" |
* |
* in <machine/frame.h> and to the code in cpu_fork() which initializes |
* Note that the stack frame layout is known to "struct switchframe" in |
* it for a new process. |
* <machine/frame.h> and to the code in cpu_lwp_fork() which initializes |
|
* it for a new lwp. |
*/ |
*/ |
ENTRY(cpu_switch) |
ENTRY(cpu_switchto) |
pushl %ebx |
pushl %ebx |
pushl %esi |
pushl %esi |
pushl %edi |
pushl %edi |
|
|
#ifdef DEBUG |
#if defined(DIAGNOSTIC) && !defined(XEN) |
cmpl $IPL_SCHED,CPUVAR(ILEVEL) |
cmpl $IPL_SCHED,CPUVAR(ILEVEL) |
jae 1f |
jbe 0f |
pushl 2f |
pushl CPUVAR(ILEVEL) |
|
pushl $.Lstr |
call _C_LABEL(panic) |
call _C_LABEL(panic) |
/* NOTREACHED */ |
addl $8,%esp |
2: .asciz "not splhigh() in cpu_switch!" |
.Lstr: .string "cpu_switchto: switching above IPL_SCHED (%d)\0" |
|
0: |
1: |
|
#endif /* DEBUG */ |
|
|
|
movl CPUVAR(CURPROC),%esi |
|
|
|
/* |
|
* Clear curproc so that we don't accumulate system time while idle. |
|
* This also insures that schedcpu() will move the old process to |
|
* the correct queue if it happens to get called from the spllower() |
|
* below and changes the priority. (See corresponding comment in |
|
* userret()). |
|
*/ |
|
movl $0,CPUVAR(CURPROC) |
|
/* |
|
* First phase: find new process. |
|
* |
|
* Registers: |
|
* %eax - queue head, scratch, then zero |
|
* %ebx - queue number |
|
* %ecx - cached value of whichqs |
|
* %edx - next process in queue |
|
* %esi - old process |
|
* %edi - new process |
|
*/ |
|
|
|
/* Look for new process. */ |
|
cli # splhigh doesn't do a cli |
|
movl _C_LABEL(sched_whichqs),%ecx |
|
bsfl %ecx,%ebx # find a full q |
|
jnz switch_dequeue |
|
|
|
/* |
|
* idling: save old context. |
|
* |
|
* Registers: |
|
* %eax, %ecx - scratch |
|
* %esi - old process, then old pcb |
|
* %edi - idle pcb |
|
*/ |
|
|
|
pushl %esi |
|
call _C_LABEL(pmap_deactivate) # pmap_deactivate(oldproc) |
|
addl $4,%esp |
|
|
|
movl P_ADDR(%esi),%esi |
|
|
|
/* Save stack pointers. */ |
|
movl %esp,PCB_ESP(%esi) |
|
movl %ebp,PCB_EBP(%esi) |
|
|
|
/* Find idle PCB for this CPU */ |
|
#ifndef MULTIPROCESSOR |
|
movl $_C_LABEL(proc0),%ebx |
|
movl P_ADDR(%ebx),%edi |
|
movl P_MD_TSS_SEL(%ebx),%edx |
|
#else |
|
movl CPUVAR(IDLE_PCB),%edi |
|
movl CPUVAR(IDLE_TSS_SEL),%edx |
|
#endif |
|
movl $0,CPUVAR(CURPROC) /* In case we fault... */ |
|
|
|
/* Restore the idle context (avoid interrupts) */ |
|
cli |
|
|
|
/* Restore stack pointers. */ |
|
movl PCB_ESP(%edi),%esp |
|
movl PCB_EBP(%edi),%ebp |
|
|
|
|
|
/* Switch address space. */ |
|
movl PCB_CR3(%edi),%ecx |
|
movl %ecx,%cr3 |
|
|
|
/* Switch TSS. Reset "task busy" flag before loading. */ |
|
#ifdef MULTIPROCESSOR |
|
movl CPUVAR(GDT),%eax |
|
#else |
|
movl _C_LABEL(gdt),%eax |
|
#endif |
|
andl $~0x0200,4-SEL_KPL(%eax,%edx,1) |
|
ltr %dx |
|
|
|
/* We're always in the kernel, so we don't need the LDT. */ |
|
|
|
/* Restore cr0 (including FPU state). */ |
|
movl PCB_CR0(%edi),%ecx |
|
movl %ecx,%cr0 |
|
|
|
/* Record new pcb. */ |
|
SET_CURPCB(%edi) |
|
|
|
xorl %esi,%esi |
|
sti |
|
idle_unlock: |
|
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG) |
|
call _C_LABEL(sched_unlock_idle) |
|
#endif |
|
/* Interrupts are okay again. */ |
|
pushl $IPL_NONE # spl0() |
|
call _C_LABEL(Xspllower) # process pending interrupts |
|
addl $4,%esp |
|
jmp idle_start |
|
idle_zero: |
|
sti |
|
call _C_LABEL(uvm_pageidlezero) |
|
cli |
|
cmpl $0,_C_LABEL(sched_whichqs) |
|
jnz idle_exit |
|
idle_loop: |
|
/* Try to zero some pages. */ |
|
movl _C_LABEL(uvm)+UVM_PAGE_IDLE_ZERO,%ecx |
|
testl %ecx,%ecx |
|
jnz idle_zero |
|
sti |
|
hlt |
|
NENTRY(mpidle) |
|
idle_start: |
|
cli |
|
cmpl $0,_C_LABEL(sched_whichqs) |
|
jz idle_loop |
|
idle_exit: |
|
movl $IPL_HIGH,CPUVAR(ILEVEL) # splhigh |
|
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG) |
|
call _C_LABEL(sched_lock_idle) |
|
#endif |
#endif |
movl _C_LABEL(sched_whichqs),%ecx |
|
bsfl %ecx,%ebx |
|
jz idle_unlock |
|
|
|
switch_dequeue: |
|
/* |
|
* we're running at splhigh(), but it's otherwise okay to take |
|
* interrupts here. |
|
*/ |
|
sti |
|
leal _C_LABEL(sched_qs)(,%ebx,8),%eax # select q |
|
|
|
movl P_FORW(%eax),%edi # unlink from front of process q |
|
#ifdef DIAGNOSTIC |
|
cmpl %edi,%eax # linked to self (i.e. nothing queued)? |
|
je _C_LABEL(switch_error) # not possible |
|
#endif /* DIAGNOSTIC */ |
|
movl P_FORW(%edi),%edx |
|
movl %edx,P_FORW(%eax) |
|
movl %eax,P_BACK(%edx) |
|
|
|
cmpl %edx,%eax # q empty? |
|
jne 3f |
|
|
|
btrl %ebx,%ecx # yes, clear to indicate empty |
movl 16(%esp),%esi /* oldlwp */ |
movl %ecx,_C_LABEL(sched_whichqs) # update q status |
movl 20(%esp),%edi /* newlwp */ |
|
movl 24(%esp),%edx /* returning */ |
3: /* We just did it. */ |
|
xorl %eax,%eax |
|
CLEAR_RESCHED(%eax) |
|
|
|
#ifdef DIAGNOSTIC |
|
cmpl %eax,P_WCHAN(%edi) # Waiting for something? |
|
jne _C_LABEL(switch_error) # Yes; shouldn't be queued. |
|
cmpb $SRUN,P_STAT(%edi) # In run state? |
|
jne _C_LABEL(switch_error) # No; shouldn't be queued. |
|
#endif /* DIAGNOSTIC */ |
|
|
|
/* Isolate process. XXX Is this necessary? */ |
|
movl %eax,P_BACK(%edi) |
|
|
|
/* Record new process. */ |
|
movb $SONPROC,P_STAT(%edi) # p->p_stat = SONPROC |
|
SET_CURPROC(%edi,%ecx) |
|
|
|
/* Skip context switch if same process. */ |
|
cmpl %edi,%esi |
|
je switch_return |
|
|
|
/* If old process exited, don't bother. */ |
|
testl %esi,%esi |
testl %esi,%esi |
jz switch_exited |
jz 1f |
|
|
/* |
|
* Second phase: save old context. |
|
* |
|
* Registers: |
|
* %eax, %ecx - scratch |
|
* %esi - old process, then old pcb |
|
* %edi - new process |
|
*/ |
|
|
|
pushl %esi |
|
call _C_LABEL(pmap_deactivate) # pmap_deactivate(oldproc) |
|
addl $4,%esp |
|
|
|
movl P_ADDR(%esi),%esi |
|
|
|
/* Save stack pointers. */ |
/* Save old context. */ |
movl %esp,PCB_ESP(%esi) |
movl L_PCB(%esi),%eax |
movl %ebp,PCB_EBP(%esi) |
movl %esp,PCB_ESP(%eax) |
|
movl %ebp,PCB_EBP(%eax) |
|
|
|
/* Switch to newlwp's stack. */ |
|
1: movl L_PCB(%edi),%ebx |
|
movl PCB_EBP(%ebx),%ebp |
|
movl PCB_ESP(%ebx),%esp |
|
|
switch_exited: |
|
/* |
/* |
* Third phase: restore saved context. |
* Set curlwp. This must be globally visible in order to permit |
* |
* non-interlocked mutex release. |
* Registers: |
|
* %eax, %ebx, %ecx, %edx - scratch |
|
* %esi - new pcb |
|
* %edi - new process |
|
*/ |
*/ |
|
movl %edi,%ecx |
|
xchgl %ecx,CPUVAR(CURLWP) |
|
|
/* No interrupts while loading new state. */ |
/* Skip the rest if returning to a pinned LWP. */ |
cli |
testl %edx,%edx |
movl P_ADDR(%edi),%esi |
jnz 4f |
|
|
/* Restore stack pointers. */ |
#ifdef XEN |
movl PCB_ESP(%esi),%esp |
pushl %edi |
movl PCB_EBP(%esi),%ebp |
call _C_LABEL(i386_switch_context) |
|
addl $4,%esp |
|
#else /* !XEN */ |
|
/* Switch ring0 esp */ |
|
movl PCB_ESP0(%ebx),%eax |
|
movl %eax,CPUVAR(ESP0) |
|
#endif /* !XEN */ |
|
|
#if 0 |
|
/* 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 $P_SYSTEM,P_FLAG(%edi) |
testl $LW_SYSTEM,L_FLAG(%edi) |
jnz switch_restored |
jnz 4f |
#endif |
|
|
|
#ifdef MULTIPROCESSOR |
#ifndef XEN |
movl CPUVAR(GDT),%eax |
/* Restore thread-private %fs/%gs descriptors. */ |
#else |
movl CPUVAR(GDT),%ecx |
/* Load TSS info. */ |
movl PCB_FSD(%ebx), %eax |
movl _C_LABEL(gdt),%eax |
movl PCB_FSD+4(%ebx), %edx |
#endif |
movl %eax, (GUFS_SEL*8)(%ecx) |
movl P_MD_TSS_SEL(%edi),%edx |
movl %edx, (GUFS_SEL*8+4)(%ecx) |
|
movl PCB_GSD(%ebx), %eax |
/* Switch TSS. Reset "task busy" flag before loading. */ |
movl PCB_GSD+4(%ebx), %edx |
andl $~0x0200,4(%eax,%edx, 1) |
movl %eax, (GUGS_SEL*8)(%ecx) |
ltr %dx |
movl %edx, (GUGS_SEL*8+4)(%ecx) |
|
#endif /* !XEN */ |
|
|
|
/* Switch I/O bitmap */ |
|
movl PCB_IOMAP(%ebx),%eax |
|
orl %eax,%eax |
|
jnz .Lcopy_iobitmap |
|
movl $(IOMAP_INVALOFF << 16),CPUVAR(IOBASE) |
|
.Liobitmap_done: |
|
|
|
/* Is this process using RAS (restartable atomic sequences)? */ |
|
movl L_PROC(%edi),%eax |
|
cmpl $0,P_RASLIST(%eax) |
|
jne 5f |
|
|
|
/* |
|
* Restore cr0 (including FPU state). Raise the IPL to IPL_HIGH. |
|
* FPU IPIs can alter the LWP's saved cr0. Dropping the priority |
|
* is deferred until mi_switch(), when cpu_switchto() returns. |
|
*/ |
|
2: |
|
#ifdef XEN |
pushl %edi |
pushl %edi |
call _C_LABEL(pmap_activate) # pmap_activate(p) |
call _C_LABEL(i386_tls_switch) |
addl $4,%esp |
addl $4,%esp |
|
#else /* !XEN */ |
|
movl $IPL_HIGH,CPUVAR(ILEVEL) |
|
movl PCB_CR0(%ebx),%ecx /* has CR0_TS clear */ |
|
movl %cr0,%edx |
|
|
#if 0 |
/* |
switch_restored: |
* If our floating point registers are on a different CPU, |
#endif |
* set CR0_TS so we'll trap rather than reuse bogus state. |
/* Restore cr0 (including FPU state). */ |
|
movl PCB_CR0(%esi),%ecx |
|
#ifdef MULTIPROCESSOR |
|
/* |
|
* If our floating point registers are on a different cpu, |
|
* clear CR0_TS so we'll trap rather than reuse bogus state. |
|
*/ |
*/ |
movl PCB_FPCPU(%esi),%ebx |
cmpl CPUVAR(FPCURLWP),%edi |
cmpl CPUVAR(SELF),%ebx |
je 3f |
jz 1f |
|
orl $CR0_TS,%ecx |
orl $CR0_TS,%ecx |
1: |
|
#endif |
|
movl %ecx,%cr0 |
|
|
|
/* Record new pcb. */ |
/* Reloading CR0 is very expensive - avoid if possible. */ |
SET_CURPCB(%esi) |
3: cmpl %edx,%ecx |
|
je 4f |
|
movl %ecx,%cr0 |
|
#endif /* !XEN */ |
|
|
/* Interrupts are okay again. */ |
/* Return to the new LWP, returning 'oldlwp' in %eax. */ |
sti |
4: movl %esi,%eax |
|
popl %edi |
|
popl %esi |
|
popl %ebx |
|
ret |
|
|
/* |
/* Check for restartable atomic sequences (RAS). */ |
* Check for restartable atomic sequences (RAS) |
5: movl L_MD_REGS(%edi),%ecx |
* XXX %edi reloads are not necessary here as %edi is callee-saved! |
pushl TF_EIP(%ecx) |
*/ |
|
movl CPUVAR(CURPROC),%edi |
|
cmpl $0,P_NRAS(%edi) |
|
je 1f |
|
movl P_MD_REGS(%edi),%edx |
|
movl TF_EIP(%edx),%eax |
|
pushl %eax |
pushl %eax |
pushl %edi |
|
call _C_LABEL(ras_lookup) |
call _C_LABEL(ras_lookup) |
addl $8,%esp |
addl $8,%esp |
cmpl $-1,%eax |
cmpl $-1,%eax |
je 1f |
je 2b |
movl CPUVAR(CURPROC),%edi |
movl L_MD_REGS(%edi),%ecx |
movl P_MD_REGS(%edi),%edx |
movl %eax,TF_EIP(%ecx) |
movl %eax,TF_EIP(%edx) |
jmp 2b |
1: |
|
|
|
switch_return: |
.Lcopy_iobitmap: |
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG) |
/* Copy I/O bitmap. */ |
call _C_LABEL(sched_unlock_idle) |
incl _C_LABEL(pmap_iobmp_evcnt)+EV_COUNT |
#endif |
movl $(IOMAPSIZE/4),%ecx |
pushl $IPL_NONE # spl0() |
pushl %esi |
call _C_LABEL(Xspllower) # process pending interrupts |
pushl %edi |
addl $4,%esp |
movl %eax,%esi /* pcb_iomap */ |
movl $IPL_HIGH,CPUVAR(ILEVEL) # splhigh() |
movl CPUVAR(SELF),%edi |
|
leal CPU_INFO_IOMAP(%edi),%edi |
movl %edi,%eax # return (p); |
rep |
|
movsl |
popl %edi |
popl %edi |
popl %esi |
popl %esi |
popl %ebx |
movl $((CPU_INFO_IOMAP - CPU_INFO_TSS) << 16),CPUVAR(IOBASE) |
ret |
jmp .Liobitmap_done |
|
END(cpu_switchto) |
/* |
|
* void switch_exit(struct proc *p); |
|
* switch_exit(struct proc *p); |
|
* Switch to the appropriate idle context (proc0's if uniprocessor; the cpu's |
|
* if multiprocessor) and deallocate the address space and kernel stack for p. |
|
* Then jump into cpu_switch(), as if we were in the idle proc all along. |
|
*/ |
|
#ifndef MULTIPROCESSOR |
|
.globl _C_LABEL(proc0) |
|
#endif |
|
.globl _C_LABEL(uvmspace_free),_C_LABEL(kernel_map) |
|
.globl _C_LABEL(uvm_km_free),_C_LABEL(tss_free) |
|
/* LINTSTUB: Func: void switch_exit(struct proc *p) */ |
|
ENTRY(switch_exit) |
|
movl 4(%esp),%edi # old process |
|
#ifndef MULTIPROCESSOR |
|
movl $_C_LABEL(proc0),%ebx |
|
movl P_ADDR(%ebx),%esi |
|
movl P_MD_TSS_SEL(%ebx),%edx |
|
#else |
|
movl CPUVAR(IDLE_PCB),%esi |
|
movl CPUVAR(IDLE_TSS_SEL),%edx |
|
#endif |
|
/* In case we fault... */ |
|
movl $0,CPUVAR(CURPROC) |
|
|
|
/* Restore the idle context. */ |
|
cli |
|
|
|
/* Restore stack pointers. */ |
|
movl PCB_ESP(%esi),%esp |
|
movl PCB_EBP(%esi),%ebp |
|
|
|
/* Load TSS info. */ |
|
#ifdef MULTIPROCESSOR |
|
movl CPUVAR(GDT),%eax |
|
#else |
|
/* Load TSS info. */ |
|
movl _C_LABEL(gdt),%eax |
|
#endif |
|
|
|
/* Switch address space. */ |
|
movl PCB_CR3(%esi),%ecx |
|
movl %ecx,%cr3 |
|
|
|
/* Switch TSS. */ |
|
andl $~0x0200,4-SEL_KPL(%eax,%edx,1) |
|
ltr %dx |
|
|
|
/* We're always in the kernel, so we don't need the LDT. */ |
|
|
|
/* Restore cr0 (including FPU state). */ |
|
movl PCB_CR0(%esi),%ecx |
|
movl %ecx,%cr0 |
|
|
|
/* Record new pcb. */ |
|
SET_CURPCB(%esi) |
|
|
|
/* Interrupts are okay again. */ |
|
sti |
|
|
|
/* |
|
* Schedule the dead process's vmspace and stack to be freed. |
|
*/ |
|
pushl %edi /* exit2(p) */ |
|
call _C_LABEL(exit2) |
|
addl $4,%esp |
|
|
|
/* Jump into cpu_switch() with the right state. */ |
|
xorl %esi,%esi |
|
movl %esi,CPUVAR(CURPROC) |
|
jmp idle_start |
|
|
|
/* |
/* |
* void savectx(struct pcb *pcb); |
* void savectx(struct pcb *pcb); |
|
* |
* Update pcb, saving current processor state. |
* Update pcb, saving current processor state. |
*/ |
*/ |
/* LINTSTUB: Func: void savectx(struct pcb *pcb) */ |
|
ENTRY(savectx) |
ENTRY(savectx) |
movl 4(%esp),%edx # edx = p->p_addr |
movl 4(%esp),%edx /* edx = pcb */ |
|
|
/* Save stack pointers. */ |
|
movl %esp,PCB_ESP(%edx) |
movl %esp,PCB_ESP(%edx) |
movl %ebp,PCB_EBP(%edx) |
movl %ebp,PCB_EBP(%edx) |
|
|
ret |
ret |
|
END(savectx) |
|
|
/* |
/* |
|
* osyscall() |
|
* |
* Old call gate entry for syscall |
* Old call gate entry for syscall |
*/ |
*/ |
/* LINTSTUB: Var: char Xosyscall[1]; */ |
|
IDTVEC(osyscall) |
IDTVEC(osyscall) |
/* Set eflags in trap frame. */ |
#ifndef XEN |
pushfl |
/* 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) |
|
|
/* |
/* |
|
* syscall() |
|
* |
* Trap gate entry for syscall |
* Trap gate entry for syscall |
*/ |
*/ |
/* LINTSTUB: Var: char Xsyscall[1]; */ |
|
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 */ |
|
addl $1,CPUVAR(NSYSCALL) /* count it atomically */ |
|
adcl $0,CPUVAR(NSYSCALL)+4 /* count it atomically */ |
|
movl CPUVAR(CURLWP),%edi |
|
movl L_PROC(%edi),%edx |
|
movl %esp,L_MD_REGS(%edi) /* save pointer to frame */ |
|
pushl %esp |
|
call *P_MD_SYSCALL(%edx) /* get pointer to syscall() function */ |
|
addl $4,%esp |
|
.Lsyscall_checkast: |
|
/* Check for ASTs on exit to user mode. */ |
|
CLI(%eax) |
|
movl L_MD_ASTPENDING(%edi), %eax |
|
orl CPUVAR(WANT_PMAPLOAD), %eax |
|
jnz 9f |
|
#ifdef XEN |
|
STIC(%eax) |
|
jz 14f |
|
call _C_LABEL(stipending) |
|
testl %eax,%eax |
|
jz 14f |
|
/* process pending interrupts */ |
|
CLI(%eax) |
|
movl CPUVAR(ILEVEL), %ebx |
|
movl $.Lsyscall_resume, %esi /* address to resume loop at */ |
|
.Lsyscall_resume: |
|
movl %ebx,%eax /* get cpl */ |
|
movl CPUVAR(IUNMASK)(,%eax,4),%eax |
|
andl CPUVAR(IPENDING),%eax /* any non-masked bits left? */ |
|
jz 17f |
|
bsrl %eax,%eax |
|
btrl %eax,CPUVAR(IPENDING) |
|
movl CPUVAR(ISOURCES)(,%eax,4),%eax |
|
jmp *IS_RESUME(%eax) |
|
17: movl %ebx, CPUVAR(ILEVEL) /* restore cpl */ |
|
jmp .Lsyscall_checkast |
|
14: |
|
#endif /* XEN */ |
|
#ifndef DIAGNOSTIC |
|
INTRFASTEXIT |
|
#else /* DIAGNOSTIC */ |
|
cmpl $IPL_NONE,CPUVAR(ILEVEL) |
|
jne 3f |
|
INTRFASTEXIT |
|
3: STI(%eax) |
|
pushl $4f |
|
call _C_LABEL(panic) |
|
addl $4,%esp |
|
pushl $IPL_NONE |
|
call _C_LABEL(spllower) |
|
addl $4,%esp |
|
jmp .Lsyscall_checkast |
|
4: .asciz "SPL NOT LOWERED ON SYSCALL EXIT\n" |
|
5: .asciz "SPL NOT ZERO ON SYSCALL ENTRY\n" |
#endif /* DIAGNOSTIC */ |
#endif /* DIAGNOSTIC */ |
movl CPUVAR(CURPROC),%edx |
9: |
movl %esp,P_MD_REGS(%edx) # save pointer to frame |
cmpl $0, CPUVAR(WANT_PMAPLOAD) |
call *P_MD_SYSCALL(%edx) # get pointer to syscall() function |
jz 10f |
|
STI(%eax) |
|
call _C_LABEL(pmap_load) |
|
jmp .Lsyscall_checkast /* re-check ASTs */ |
|
10: |
|
/* Always returning to user mode here. */ |
|
movl $0, L_MD_ASTPENDING(%edi) |
|
STI(%eax) |
|
/* Pushed T_ASTFLT into tf_trapno on entry. */ |
|
pushl %esp |
|
call _C_LABEL(trap) |
|
addl $4,%esp |
|
jmp .Lsyscall_checkast /* re-check ASTs */ |
|
IDTVEC_END(syscall) |
|
|
|
IDTVEC(svr4_fasttrap) |
|
pushl $2 /* size of instruction for restart */ |
|
pushl $T_ASTFLT /* trap # for doing ASTs */ |
|
INTRENTRY |
|
STI(%eax) |
|
pushl $RW_READER |
|
pushl $_C_LABEL(svr4_fasttrap_lock) |
|
call _C_LABEL(rw_enter) |
|
addl $8,%esp |
|
call *_C_LABEL(svr4_fasttrap_vec) |
|
pushl $_C_LABEL(svr4_fasttrap_lock) |
|
call _C_LABEL(rw_exit) |
|
addl $4,%esp |
2: /* Check for ASTs on exit to user mode. */ |
2: /* Check for ASTs on exit to user mode. */ |
cli |
cli |
CHECK_ASTPENDING() |
CHECK_ASTPENDING(%eax) |
je 1f |
je 1f |
/* Always returning to user mode here. */ |
/* Always returning to user mode here. */ |
CLEAR_ASTPENDING() |
CLEAR_ASTPENDING(%eax) |
sti |
sti |
/* Pushed T_ASTFLT into tf_trapno on entry. */ |
/* Pushed T_ASTFLT into tf_trapno on entry. */ |
|
pushl %esp |
call _C_LABEL(trap) |
call _C_LABEL(trap) |
|
addl $4,%esp |
jmp 2b |
jmp 2b |
#ifndef DIAGNOSTIC |
1: CHECK_DEFERRED_SWITCH |
1: INTRFASTEXIT |
jnz 9f |
#else /* DIAGNOSTIC */ |
|
1: cmpl $IPL_NONE,CPUVAR(ILEVEL) |
|
jne 3f |
|
INTRFASTEXIT |
INTRFASTEXIT |
3: sti |
9: sti |
pushl $4f |
call _C_LABEL(pmap_load) |
call _C_LABEL(printf) |
cli |
addl $4,%esp |
|
#ifdef DDB |
|
int $3 |
|
#endif /* DDB */ |
|
movl $IPL_NONE,CPUVAR(ILEVEL) |
|
jmp 2b |
jmp 2b |
4: .asciz "WARNING: SPL NOT LOWERED ON SYSCALL EXIT\n" |
|
5: .asciz "WARNING: SPL NOT ZERO ON SYSCALL ENTRY\n" |
|
#endif /* DIAGNOSTIC */ |
|
|
|
#if NNPX > 0 |
|
/* |
/* |
* Special interrupt handlers. Someday intr0-intr15 will be used to count |
* int npx586bug1(int a, int b) |
* interrupts. We'll still need a special exception 16 handler. The busy |
* Used when checking for the FDIV bug on first generations pentiums. |
* latch stuff in probintr() can be moved to npxprobe(). |
* Anything 120MHz or above is fine. |
*/ |
*/ |
|
|
/* LINTSTUB: Func: void probeintr(void) */ |
|
NENTRY(probeintr) |
|
ss |
|
incl _C_LABEL(npx_intrs_while_probing) |
|
pushl %eax |
|
movb $0x20,%al # EOI (asm in strings loses cpp features) |
|
outb %al,$0xa0 # IO_ICU2 |
|
outb %al,$0x20 # IO_ICU1 |
|
movb $0,%al |
|
outb %al,$0xf0 # clear BUSY# latch |
|
popl %eax |
|
iret |
|
|
|
/* LINTSTUB: Func: void probetrap(void) */ |
|
NENTRY(probetrap) |
|
ss |
|
incl _C_LABEL(npx_traps_while_probing) |
|
fnclex |
|
iret |
|
|
|
/* LINTSTUB: Func: int npx586bug1(int a, int b) */ |
|
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 |
#endif /* NNPX > 0 */ |
END(npx586bug1) |
|
|
|
/* |
|
* void sse2_idlezero_page(void *pg) |
|
* |
|
* Zero a page without polluting the cache. Preemption must be |
|
* disabled by the caller. Abort if a preemption is pending. |
|
*/ |
|
ENTRY(sse2_idlezero_page) |
|
pushl %ebp |
|
movl %esp,%ebp |
|
movl 8(%esp), %edx |
|
movl $(PAGE_SIZE/32), %ecx |
|
xorl %eax, %eax |
|
.align 16 |
|
1: |
|
testl $RESCHED_KPREEMPT, CPUVAR(RESCHED) |
|
jnz 2f |
|
movnti %eax, 0(%edx) |
|
movnti %eax, 4(%edx) |
|
movnti %eax, 8(%edx) |
|
movnti %eax, 12(%edx) |
|
movnti %eax, 16(%edx) |
|
movnti %eax, 20(%edx) |
|
movnti %eax, 24(%edx) |
|
movnti %eax, 28(%edx) |
|
addl $32, %edx |
|
decl %ecx |
|
jnz 1b |
|
sfence |
|
incl %eax |
|
pop %ebp |
|
ret |
|
2: |
|
sfence |
|
popl %ebp |
|
ret |
|
END(sse2_idlezero_page) |