version 1.8, 2003/04/26 18:13:16 |
version 1.43.4.10, 2007/02/01 04:17:13 |
|
|
/* $NetBSD$ */ |
/* $NetBSD$ */ |
|
|
/*- |
/*- |
* Copyright (c) 1998, 2000 The NetBSD Foundation, Inc. |
* Copyright (c) 1998, 2000, 2004 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 |
|
|
* 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_compat_netbsd.h" |
|
#include "opt_compat_oldboot.h" |
#include "opt_cputype.h" |
#include "opt_cputype.h" |
#include "opt_ddb.h" |
#include "opt_ddb.h" |
#include "opt_ipkdb.h" |
#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_multiprocessor.h" |
|
#include "opt_lockdebug.h" |
#include "opt_lockdebug.h" |
|
#include "opt_multiprocessor.h" |
#include "opt_realmem.h" |
#include "opt_realmem.h" |
|
#include "opt_user_ldt.h" |
|
#include "opt_vm86.h" |
|
|
#include "npx.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 "ksyms.h" |
|
|
#include <sys/syscall.h> |
#include <sys/syscall.h> |
|
|
#include <machine/cputypes.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 |
#if NLAPIC > 0 |
#include <machine/i82489reg.h> |
#include <machine/i82489reg.h> |
#endif |
#endif |
|
|
|
#include <machine/multiboot.h> |
|
|
/* LINTSTUB: include <sys/types.h> */ |
/* LINTSTUB: include <sys/types.h> */ |
/* LINTSTUB: include <machine/cpu.h> */ |
/* LINTSTUB: include <machine/cpu.h> */ |
/* LINTSTUB: include <sys/systm.h> */ |
/* LINTSTUB: include <sys/systm.h> */ |
|
|
#include <machine/asm.h> |
#include <machine/asm.h> |
|
|
#if defined(MULTIPROCESSOR) |
#if defined(MULTIPROCESSOR) |
|
|
#define SET_CURLWP(lwp,cpu) \ |
#define SET_CURLWP(lwp,cpu) \ |
movl CPUVAR(SELF),cpu ; \ |
movl CPUVAR(SELF),cpu ; \ |
movl lwp,CPUVAR(CURLWP) ; \ |
movl lwp,CPUVAR(CURLWP) ; \ |
movl cpu,L_CPU(lwp) |
movl cpu,L_CPU(lwp) |
|
|
#else |
#else |
|
|
#define SET_CURLWP(lwp,tcpu) movl lwp,CPUVAR(CURLWP) |
#define SET_CURLWP(lwp,tcpu) movl lwp,CPUVAR(CURLWP) |
|
|
|
|
#endif |
#endif |
|
|
#define GET_CURPCB(reg) movl CPUVAR(CURPCB),reg |
|
#define SET_CURPCB(reg) movl reg,CPUVAR(CURPCB) |
#define SET_CURPCB(reg) movl reg,CPUVAR(CURPCB) |
|
|
#define CLEAR_RESCHED(reg) movl reg,CPUVAR(RESCHED) |
#define CLEAR_RESCHED(reg) movl reg,CPUVAR(RESCHED) |
|
|
/* XXX temporary kluge; these should not be here */ |
/* XXX temporary kluge; these should not be here */ |
|
|
#ifdef MULTIPROCESSOR |
#ifdef MULTIPROCESSOR |
#include <machine/i82489reg.h> |
#include <machine/i82489reg.h> |
#endif |
#endif |
|
|
/* |
|
* PTmap is recursive pagemap at top of virtual address space. |
|
* Within PTmap, the page directory can be found (third indirection). |
|
* |
|
* XXX 4 == sizeof pde |
|
*/ |
|
.set _C_LABEL(PTmap),(PDSLOT_PTE << PDSHIFT) |
|
.set _C_LABEL(PTD),(_C_LABEL(PTmap) + PDSLOT_PTE * PAGE_SIZE) |
|
.set _C_LABEL(PTDpde),(_C_LABEL(PTD) + PDSLOT_PTE * 4) |
|
|
|
/* |
|
* APTmap, APTD is the alternate recursive pagemap. |
|
* It's used when modifying another process's page tables. |
|
* |
|
* XXX 4 == sizeof pde |
|
*/ |
|
.set _C_LABEL(APTmap),(PDSLOT_APTE << PDSHIFT) |
|
.set _C_LABEL(APTD),(_C_LABEL(APTmap) + PDSLOT_APTE * PAGE_SIZE) |
|
.set _C_LABEL(APTDpde),(_C_LABEL(PTD) + PDSLOT_APTE * 4) |
|
|
|
|
|
/* |
/* |
* Initialization |
* Initialization |
|
|
.data |
.data |
|
|
.globl _C_LABEL(cpu) |
.globl _C_LABEL(cpu) |
.globl _C_LABEL(cpu_feature) |
.globl _C_LABEL(esym) |
.globl _C_LABEL(esym),_C_LABEL(boothowto) |
.globl _C_LABEL(atdevbase) |
.globl _C_LABEL(bootinfo),_C_LABEL(atdevbase) |
.globl _C_LABEL(proc0uarea),_C_LABEL(PDPpaddr) |
#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) |
.globl _C_LABEL(gdt) |
#ifdef I586_CPU |
#ifdef I586_CPU |
.globl _C_LABEL(idt) |
.globl _C_LABEL(idt) |
#endif |
#endif |
.globl _C_LABEL(lapic_tpr) |
.globl _C_LABEL(lapic_tpr) |
|
|
#if NLAPIC > 0 |
#if NLAPIC > 0 |
#ifdef __ELF__ |
#ifdef __ELF__ |
.align PAGE_SIZE |
.align PAGE_SIZE |
|
|
.globl _C_LABEL(local_apic), _C_LABEL(lapic_id) |
.globl _C_LABEL(local_apic), _C_LABEL(lapic_id) |
_C_LABEL(local_apic): |
_C_LABEL(local_apic): |
.space LAPIC_ID |
.space LAPIC_ID |
_C_LABEL(lapic_id): |
_C_LABEL(lapic_id): |
.long 0x00000000 |
.long 0x00000000 |
.space LAPIC_TPRI-(LAPIC_ID+4) |
.space LAPIC_TPRI-(LAPIC_ID+4) |
_C_LABEL(lapic_tpr): |
_C_LABEL(lapic_tpr): |
.space LAPIC_PPRI-LAPIC_TPRI |
.space LAPIC_PPRI-LAPIC_TPRI |
_C_LABEL(lapic_ppr): |
_C_LABEL(lapic_ppr): |
.space LAPIC_ISR-LAPIC_PPRI |
.space LAPIC_ISR-LAPIC_PPRI |
_C_LABEL(lapic_isr): |
_C_LABEL(lapic_isr): |
.space PAGE_SIZE-LAPIC_ISR |
.space PAGE_SIZE-LAPIC_ISR |
#else |
#else |
_C_LABEL(lapic_tpr): |
_C_LABEL(lapic_tpr): |
.long 0 |
.long 0 |
#endif |
#endif |
|
|
|
|
_C_LABEL(cpu): .long 0 # are we 386, 386sx, or 486, |
_C_LABEL(cpu): .long 0 # are we 386, 386sx, or 486, |
# or Pentium, or.. |
# 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(atdevbase): .long 0 # location of start of iomem in virtual |
_C_LABEL(proc0paddr): .long 0 |
_C_LABEL(proc0uarea): .long 0 |
_C_LABEL(PTDpaddr): .long 0 # paddr of PTD, for libkvm |
_C_LABEL(PDPpaddr): .long 0 # paddr of PDP, 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 |
.space 512 |
tmpstk: |
tmpstk: |
|
|
|
|
.globl start |
.globl start |
start: movw $0x1234,0x472 # warm boot |
start: movw $0x1234,0x472 # warm boot |
|
|
/* |
#if defined(MULTIBOOT) |
* Load parameters from stack |
jmp 1f |
* (howto, [bootdev], bootinfo, esym, basemem, extmem). |
|
*/ |
.align 4 |
movl 4(%esp),%eax |
.globl Multiboot_Header |
movl %eax,RELOC(boothowto) |
_C_LABEL(Multiboot_Header): |
#ifdef COMPAT_OLDBOOT |
#define MULTIBOOT_HEADER_FLAGS (MULTIBOOT_HEADER_WANT_MEMORY) |
movl 8(%esp),%eax |
.long MULTIBOOT_HEADER_MAGIC |
movl %eax,RELOC(bootdev) |
.long MULTIBOOT_HEADER_FLAGS |
#endif |
.long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS) |
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: |
|
/* Check if we are being executed by a Multiboot-compliant boot |
|
* loader. */ |
|
cmpl $MULTIBOOT_INFO_MAGIC,%eax |
|
jne 1f |
|
|
movl 16(%esp),%eax |
/* |
testl %eax,%eax |
* Indeed, a multiboot-compliant boot loader executed us. We copy |
jz 1f |
* the received Multiboot information structure into kernel's data |
addl $KERNBASE,%eax |
* space to process it later -- after we are relocated. It will |
1: movl %eax,RELOC(esym) |
* be safer to run complex C code than doing it at this point. |
|
*/ |
|
pushl %ebx # Address of Multiboot information |
|
call _C_LABEL(multiboot_pre_reloc) |
|
addl $4,%esp |
|
jmp 2f |
|
#endif |
|
|
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: |
1: |
|
/* |
|
* At this point, we know that a NetBSD-specific boot loader |
|
* booted this kernel. The stack carries the following parameters: |
|
* (boothowto, [bootdev], bootinfo, esym, biosextmem, biosbasemem), |
|
* 4 bytes each. |
|
*/ |
|
addl $4,%esp # Discard return address to boot loader |
|
call _C_LABEL(native_loader) |
|
addl $24,%esp |
|
|
|
2: |
/* First, reset the PSL. */ |
/* First, reset the PSL. */ |
pushl $PSL_MBO |
pushl $PSL_MBO |
popfl |
popfl |
Line 504 try586: /* Use the `cpuid' instruction. |
|
Line 439 try586: /* Use the `cpuid' instruction. |
|
/* |
/* |
* Virtual address space of kernel: |
* Virtual address space of kernel: |
* |
* |
* text | data | bss | [syms] | page dir | proc0 kstack |
* text | data | bss | [syms] | page dir | proc0 kstack |
* 0 1 2 3 |
* 0 1 2 3 |
*/ |
*/ |
#define PROC0PDIR ((0) * PAGE_SIZE) |
#define PROC0PDIR ((0) * PAGE_SIZE) |
Line 531 try586: /* Use the `cpuid' instruction. |
|
Line 466 try586: /* Use the `cpuid' instruction. |
|
|
|
/* |
/* |
* Calculate the size of the kernel page table directory, and |
* Calculate the size of the kernel page table directory, and |
* how many entries it will have. |
* how many entries it will have. Adjust nkpde to the actual |
|
* kernel size automatically. Account for the bootstrap tables, |
|
* round up, and add an extra 4MB. |
*/ |
*/ |
|
leal TABLESIZE+NBPD+PDOFSET(%edi),%eax |
|
shrl $PDSHIFT,%eax |
movl RELOC(nkpde),%ecx # get nkpde |
movl RELOC(nkpde),%ecx # get nkpde |
cmpl $NKPTP_MIN,%ecx # larger than min? |
cmpl %ecx,%eax |
|
jb 1f |
|
movl %eax,%ecx |
|
1: cmpl $NKPTP_MIN,%ecx # larger than min? |
jge 1f |
jge 1f |
movl $NKPTP_MIN,%ecx # set at min |
movl $NKPTP_MIN,%ecx # set at min |
jmp 2f |
jmp 2f |
1: cmpl $NKPTP_MAX,%ecx # larger than max? |
1: cmpl $NKPTP_MAX,%ecx # larger than max? |
jle 2f |
jle 2f |
movl $NKPTP_MAX,%ecx |
movl $NKPTP_MAX,%ecx |
2: |
2: movl %ecx,RELOC(nkpde) |
|
|
/* Clear memory for bootstrap tables. */ |
/* Clear memory for bootstrap tables. */ |
shll $PGSHIFT,%ecx |
shll $PGSHIFT,%ecx |
Line 572 try586: /* Use the `cpuid' instruction. |
|
Line 514 try586: /* Use the `cpuid' instruction. |
|
/* Calculate end of text segment, rounded to a page. */ |
/* Calculate end of text segment, rounded to a page. */ |
leal (RELOC(etext)+PGOFSET),%edx |
leal (RELOC(etext)+PGOFSET),%edx |
andl $~PGOFSET,%edx |
andl $~PGOFSET,%edx |
|
|
/* Skip over the first 1MB. */ |
/* Skip over the first 1MB. */ |
movl $_RELOC(KERNTEXTOFF),%eax |
movl $_RELOC(KERNTEXTOFF),%eax |
movl %eax,%ecx |
movl %eax,%ecx |
Line 620 try586: /* Use the `cpuid' instruction. |
|
Line 562 try586: /* Use the `cpuid' instruction. |
|
leal (PROC0PDIR+PG_V|PG_KW)(%esi),%eax # pte for ptd |
leal (PROC0PDIR+PG_V|PG_KW)(%esi),%eax # pte for ptd |
movl %eax,(PROC0PDIR+PDSLOT_PTE*4)(%esi) # recursive PD slot |
movl %eax,(PROC0PDIR+PDSLOT_PTE*4)(%esi) # recursive PD slot |
|
|
/* Save phys. addr of PTD, for libkvm. */ |
/* Save phys. addr of PDP, for libkvm. */ |
movl %esi,RELOC(PTDpaddr) |
movl %esi,RELOC(PDPpaddr) |
|
|
/* Load base of page directory and enable mapping. */ |
/* Load base of page directory and enable mapping. */ |
movl %esi,%eax # phys address of ptd in proc 0 |
movl %esi,%eax # phys address of ptd in proc 0 |
|
|
|
|
/* Set up bootstrap stack. */ |
/* Set up bootstrap stack. */ |
leal (PROC0STACK+KERNBASE)(%esi),%eax |
leal (PROC0STACK+KERNBASE)(%esi),%eax |
movl %eax,_C_LABEL(proc0paddr) |
movl %eax,_C_LABEL(proc0uarea) |
leal (USPACE-FRAMESIZE)(%eax),%esp |
leal (KSTACK_SIZE-FRAMESIZE)(%eax),%esp |
movl %esi,PCB_CR3(%eax) # pcb->pcb_cr3 |
movl %esi,(KSTACK_SIZE+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 |
movl _C_LABEL(nkpde),%eax |
shll $PGSHIFT,%eax |
shll $PGSHIFT,%eax |
addl $TABLESIZE,%eax |
addl $TABLESIZE,%eax |
Line 708 NENTRY(proc_trampoline) |
|
Line 658 NENTRY(proc_trampoline) |
|
pushl %ebx |
pushl %ebx |
call *%esi |
call *%esi |
addl $4,%esp |
addl $4,%esp |
|
DO_DEFERRED_SWITCH(%eax) |
INTRFASTEXIT |
INTRFASTEXIT |
/* NOTREACHED */ |
/* NOTREACHED */ |
|
|
/*****************************************************************************/ |
/*****************************************************************************/ |
|
#ifdef COMPAT_16 |
/* |
/* |
* Signal trampoline; copied to top of user stack. |
* Signal trampoline; copied to top of user stack. |
*/ |
*/ |
|
|
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___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): |
|
|
/*****************************************************************************/ |
|
|
|
/* |
|
* The following primitives are used to fill and copy regions of memory. |
|
*/ |
|
|
|
/* |
|
* XXX No section 9 man page for fillw. |
|
* fillw seems to be very sparsely used (only in pccons it seems.) |
|
* 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 $PAGE_SIZE,%ecx |
|
subl %eax,%ecx # ecx = PAGE_SIZE - (src % PAGE_SIZE) |
|
|
|
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 $PAGE_SIZE,%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(CURLWP),%ecx |
|
movl L_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 |
#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(CURLWP),%ecx |
|
movl L_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 |
|
|
|
/*****************************************************************************/ |
/*****************************************************************************/ |
|
|
/* |
/* |
|
|
pushl %eax |
pushl %eax |
lret |
lret |
|
|
|
NENTRY(x86_flush) |
|
/* Reload code selector by doing intersegment return. */ |
|
popl %eax |
|
pushl $GSEL(GCODE_SEL, SEL_KPL) |
|
pushl %eax |
|
lret |
|
|
/*****************************************************************************/ |
/*****************************************************************************/ |
|
|
/* |
/* |
Line 1661 NENTRY(switch_error) |
|
Line 775 NENTRY(switch_error) |
|
|
|
/* |
/* |
* void cpu_switch(struct lwp *) |
* void cpu_switch(struct lwp *) |
* Find a runnable process and switch to it. Wait if necessary. If the new |
* Find a runnable lwp and switch to it. Wait if necessary. If the new |
* process is the same as the old one, we short-circuit the context save and |
* lwp is the same as the old one, we short-circuit the context save and |
* restore. |
* restore. |
* |
* |
* Note that the stack frame layout is known to "struct switchframe" |
* Note that the stack frame layout is known to "struct switchframe" |
* in <machine/frame.h> and to the code in cpu_fork() which initializes |
* in <machine/frame.h> and to the code in cpu_fork() which initializes |
* it for a new lwp. |
* it for a new lwp. |
*/ |
*/ |
ENTRY(cpu_switch) |
ENTRY(cpu_switch) |
Line 1681 ENTRY(cpu_switch) |
|
Line 795 ENTRY(cpu_switch) |
|
call _C_LABEL(panic) |
call _C_LABEL(panic) |
/* NOTREACHED */ |
/* NOTREACHED */ |
2: .asciz "not splsched() in cpu_switch!" |
2: .asciz "not splsched() in cpu_switch!" |
1: |
1: |
#endif /* DEBUG */ |
#endif /* DEBUG */ |
|
|
movl 16(%esp),%esi # current |
movl 16(%esp),%esi # current |
|
|
/* |
/* |
Line 1722 ENTRY(cpu_switch) |
|
Line 836 ENTRY(cpu_switch) |
|
*/ |
*/ |
|
|
pushl %esi |
pushl %esi |
call _C_LABEL(pmap_deactivate) # pmap_deactivate(oldproc) |
call _C_LABEL(pmap_deactivate2) # pmap_deactivate(oldproc) |
addl $4,%esp |
addl $4,%esp |
|
|
movl L_ADDR(%esi),%esi |
movl L_ADDR(%esi),%esi |
Line 1749 ENTRY(cpu_switch) |
|
Line 863 ENTRY(cpu_switch) |
|
movl PCB_ESP(%edi),%esp |
movl PCB_ESP(%edi),%esp |
movl PCB_EBP(%edi),%ebp |
movl PCB_EBP(%edi),%ebp |
|
|
|
|
/* Switch address space. */ |
|
movl PCB_CR3(%edi),%ecx |
|
movl %ecx,%cr3 |
|
|
|
/* Switch TSS. Reset "task busy" flag before loading. */ |
/* Switch TSS. Reset "task busy" flag before loading. */ |
|
movl %cr3,%eax |
|
movl %eax,PCB_CR3(%edi) |
#ifdef MULTIPROCESSOR |
#ifdef MULTIPROCESSOR |
movl CPUVAR(GDT),%eax |
movl CPUVAR(GDT),%eax |
#else |
#else |
Line 1774 ENTRY(cpu_switch) |
|
Line 885 ENTRY(cpu_switch) |
|
|
|
xorl %esi,%esi |
xorl %esi,%esi |
sti |
sti |
idle_unlock: |
idle_unlock: |
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG) |
|
call _C_LABEL(sched_unlock_idle) |
call _C_LABEL(sched_unlock_idle) |
#endif |
|
/* Interrupts are okay again. */ |
/* Interrupts are okay again. */ |
pushl $IPL_NONE # spl0() |
pushl $IPL_NONE # spl0() |
call _C_LABEL(Xspllower) # process pending interrupts |
call _C_LABEL(spllower) # process pending interrupts |
addl $4,%esp |
addl $4,%esp |
jmp idle_start |
jmp idle_start |
idle_zero: |
idle_zero: |
sti |
sti |
call _C_LABEL(uvm_pageidlezero) |
call _C_LABEL(uvm_pageidlezero) |
cli |
cli |
|
|
sti |
sti |
hlt |
hlt |
NENTRY(mpidle) |
NENTRY(mpidle) |
idle_start: |
idle_start: |
cli |
cli |
cmpl $0,_C_LABEL(sched_whichqs) |
cmpl $0,_C_LABEL(sched_whichqs) |
jz idle_loop |
jz idle_loop |
idle_exit: |
idle_exit: |
movl $IPL_HIGH,CPUVAR(ILEVEL) # splhigh |
movl $IPL_HIGH,CPUVAR(ILEVEL) # splhigh |
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG) |
sti |
call _C_LABEL(sched_lock_idle) |
call _C_LABEL(sched_lock_idle) |
#endif |
|
movl _C_LABEL(sched_whichqs),%ecx |
movl _C_LABEL(sched_whichqs),%ecx |
bsfl %ecx,%ebx |
bsfl %ecx,%ebx |
jz idle_unlock |
jz idle_unlock |
|
|
switch_dequeue: |
switch_dequeue: |
/* |
/* |
* we're running at splhigh(), but it's otherwise okay to take |
* we're running at splhigh(), but it's otherwise okay to take |
* interrupts here. |
* interrupts here. |
*/ |
*/ |
sti |
sti |
leal _C_LABEL(sched_qs)(,%ebx,8),%eax # select q |
leal _C_LABEL(sched_qs)(,%ebx,8),%eax # select q |
|
|
SET_CURLWP(%edi,%ecx) |
SET_CURLWP(%edi,%ecx) |
|
|
/* Skip context switch if same lwp. */ |
/* Skip context switch if same lwp. */ |
movl $1, %eax |
xorl %ebx,%ebx |
cmpl %edi,%esi |
cmpl %edi,%esi |
je switch_return |
je switch_return |
|
|
|
|
*/ |
*/ |
|
|
pushl %esi |
pushl %esi |
call _C_LABEL(pmap_deactivate) # pmap_deactivate(oldproc) |
call _C_LABEL(pmap_deactivate2) # pmap_deactivate(oldproc) |
addl $4,%esp |
addl $4,%esp |
|
|
movl L_ADDR(%esi),%esi |
movl L_ADDR(%esi),%esi |
|
|
jnz switch_restored |
jnz switch_restored |
#endif |
#endif |
|
|
|
/* Switch TSS. Reset "task busy" flag before loading. */ |
|
movl %cr3,%eax |
|
movl %eax,PCB_CR3(%esi) /* XXX should be done by pmap_activate? */ |
#ifdef MULTIPROCESSOR |
#ifdef MULTIPROCESSOR |
movl CPUVAR(GDT),%eax |
movl CPUVAR(GDT),%eax |
#else |
#else |
/* Load TSS info. */ |
/* Load TSS info. */ |
movl _C_LABEL(gdt),%eax |
movl _C_LABEL(gdt),%eax |
#endif |
#endif |
movl L_MD_TSS_SEL(%edi),%edx |
movl L_MD_TSS_SEL(%edi),%edx |
|
|
/* Switch TSS. Reset "task busy" flag before loading. */ |
|
andl $~0x0200,4(%eax,%edx, 1) |
andl $~0x0200,4(%eax,%edx, 1) |
ltr %dx |
ltr %dx |
|
|
Line 1926 switch_restored: |
|
Line 1036 switch_restored: |
|
/* Restore cr0 (including FPU state). */ |
/* Restore cr0 (including FPU state). */ |
movl PCB_CR0(%esi),%ecx |
movl PCB_CR0(%esi),%ecx |
#ifdef MULTIPROCESSOR |
#ifdef MULTIPROCESSOR |
/* |
/* |
* If our floating point registers are on a different cpu, |
* If our floating point registers are on a different CPU, |
* clear CR0_TS so we'll trap rather than reuse bogus state. |
* clear CR0_TS so we'll trap rather than reuse bogus state. |
*/ |
*/ |
movl PCB_FPCPU(%esi),%ebx |
movl PCB_FPCPU(%esi),%ebx |
cmpl CPUVAR(SELF),%ebx |
cmpl CPUVAR(SELF),%ebx |
jz 1f |
jz 1f |
orl $CR0_TS,%ecx |
orl $CR0_TS,%ecx |
1: |
1: |
#endif |
#endif |
movl %ecx,%cr0 |
movl %ecx,%cr0 |
|
|
/* Record new pcb. */ |
/* Record new pcb. */ |
Line 1949 switch_restored: |
|
Line 1059 switch_restored: |
|
*/ |
*/ |
movl CPUVAR(CURLWP),%edi |
movl CPUVAR(CURLWP),%edi |
movl L_PROC(%edi),%esi |
movl L_PROC(%edi),%esi |
cmpl $0,P_NRAS(%esi) |
cmpl $0,P_RASLIST(%esi) |
je 1f |
jne 2f |
movl L_MD_REGS(%edi),%ebx |
|
movl TF_EIP(%ebx),%eax |
|
pushl %eax |
|
pushl %esi |
|
call _C_LABEL(ras_lookup) |
|
addl $8,%esp |
|
cmpl $-1,%eax |
|
je 1f |
|
movl %eax,TF_EIP(%ebx) |
|
1: |
1: |
xor %eax,%eax |
movl $1,%ebx |
|
|
switch_return: |
switch_return: |
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG) |
|
call _C_LABEL(sched_unlock_idle) |
call _C_LABEL(sched_unlock_idle) |
#endif |
cmpl $0,CPUVAR(IPENDING) |
|
jz 3f |
pushl $IPL_NONE # spl0() |
pushl $IPL_NONE # spl0() |
call _C_LABEL(Xspllower) # process pending interrupts |
call _C_LABEL(spllower) # process pending interrupts |
addl $4,%esp |
addl $4,%esp |
|
3: |
movl $IPL_HIGH,CPUVAR(ILEVEL) # splhigh() |
movl $IPL_HIGH,CPUVAR(ILEVEL) # splhigh() |
|
|
|
movl %ebx,%eax |
|
|
popl %edi |
popl %edi |
popl %esi |
popl %esi |
popl %ebx |
popl %ebx |
ret |
ret |
|
|
|
2: # check RAS list |
|
movl L_MD_REGS(%edi),%ebx |
|
movl TF_EIP(%ebx),%eax |
|
pushl %eax |
|
pushl %esi |
|
call _C_LABEL(ras_lookup) |
|
addl $8,%esp |
|
cmpl $-1,%eax |
|
je 1b |
|
movl %eax,TF_EIP(%ebx) |
|
jmp 1b |
|
|
/* |
/* |
* void cpu_switchto(struct lwp *current, struct lwp *next) |
* void cpu_switchto(struct lwp *current, struct lwp *next) |
* Switch to the specified next LWP. |
* Switch to the specified next LWP. |
Line 2021 ENTRY(cpu_switchto) |
|
Line 1137 ENTRY(cpu_switchto) |
|
jmp switch_resume |
jmp switch_resume |
|
|
/* |
/* |
* void switch_exit(struct lwp *l, void (*exit)(struct lwp *)); |
* void cpu_exit(struct lwp *l) |
* Switch to the appropriate idle context (lwp0's if uniprocessor; the cpu's |
* Switch to the appropriate idle context (lwp0's if uniprocessor; the CPU's |
* if multiprocessor) and deallocate the address space and kernel stack for p. |
* 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. |
* Then jump into cpu_switch(), as if we were in the idle proc all along. |
*/ |
*/ |
#ifndef MULTIPROCESSOR |
#ifndef MULTIPROCESSOR |
.globl _C_LABEL(lwp0) |
.globl _C_LABEL(lwp0) |
#endif |
#endif |
.globl _C_LABEL(uvmspace_free),_C_LABEL(kernel_map) |
/* LINTSTUB: Func: void cpu_exit(struct lwp *l) */ |
.globl _C_LABEL(uvm_km_free),_C_LABEL(tss_free) |
ENTRY(cpu_exit) |
/* LINTSTUB: Func: void switch_exit(struct lwp *l, void (*exit)(struct lwp *)) */ |
|
ENTRY(switch_exit) |
|
movl 4(%esp),%edi # old process |
movl 4(%esp),%edi # old process |
movl 8(%esp),%eax # exit func |
|
#ifndef MULTIPROCESSOR |
#ifndef MULTIPROCESSOR |
movl $_C_LABEL(lwp0),%ebx |
movl $_C_LABEL(lwp0),%ebx |
movl L_ADDR(%ebx),%esi |
movl L_ADDR(%ebx),%esi |
Line 2043 ENTRY(switch_exit) |
|
Line 1156 ENTRY(switch_exit) |
|
movl CPUVAR(IDLE_PCB),%esi |
movl CPUVAR(IDLE_PCB),%esi |
movl CPUVAR(IDLE_TSS_SEL),%edx |
movl CPUVAR(IDLE_TSS_SEL),%edx |
#endif |
#endif |
/* In case we fault... */ |
|
movl $0,CPUVAR(CURLWP) |
|
|
|
/* Restore the idle context. */ |
/* Restore the idle context. */ |
cli |
cli |
Line 2053 ENTRY(switch_exit) |
|
Line 1164 ENTRY(switch_exit) |
|
movl PCB_ESP(%esi),%esp |
movl PCB_ESP(%esi),%esp |
movl PCB_EBP(%esi),%ebp |
movl PCB_EBP(%esi),%ebp |
|
|
/* Save exit func. */ |
/* Switch TSS. Reset "task busy" flag before loading. */ |
pushl %eax |
movl %cr3,%eax |
|
movl %eax,PCB_CR3(%esi) |
/* Load TSS info. */ |
|
#ifdef MULTIPROCESSOR |
#ifdef MULTIPROCESSOR |
movl CPUVAR(GDT),%eax |
movl CPUVAR(GDT),%eax |
#else |
#else |
/* Load TSS info. */ |
/* Load TSS info. */ |
movl _C_LABEL(gdt),%eax |
movl _C_LABEL(gdt),%eax |
#endif |
#endif |
|
|
/* Switch address space. */ |
|
movl PCB_CR3(%esi),%ecx |
|
movl %ecx,%cr3 |
|
|
|
/* Switch TSS. */ |
|
andl $~0x0200,4-SEL_KPL(%eax,%edx,1) |
andl $~0x0200,4-SEL_KPL(%eax,%edx,1) |
ltr %dx |
ltr %dx |
|
|
Line 2081 ENTRY(switch_exit) |
|
Line 1186 ENTRY(switch_exit) |
|
/* Record new pcb. */ |
/* Record new pcb. */ |
SET_CURPCB(%esi) |
SET_CURPCB(%esi) |
|
|
|
/* Now off the CPU. */ |
|
movl $0,CPUVAR(CURLWP) |
|
|
/* Interrupts are okay again. */ |
/* Interrupts are okay again. */ |
sti |
sti |
|
|
/* |
|
* Schedule the dead process's vmspace and stack to be freed. |
|
*/ |
|
movl 0(%esp),%eax /* %eax = exit func */ |
|
movl %edi,0(%esp) /* {lwp_}exit2(l) */ |
|
call *%eax |
|
addl $4,%esp |
|
|
|
/* Jump into cpu_switch() with the right state. */ |
/* Jump into cpu_switch() with the right state. */ |
xorl %esi,%esi |
xorl %esi,%esi |
movl %esi,CPUVAR(CURLWP) |
|
jmp idle_start |
jmp idle_start |
|
|
/* |
/* |
Line 2104 ENTRY(switch_exit) |
|
Line 1203 ENTRY(switch_exit) |
|
/* LINTSTUB: Func: void savectx(struct pcb *pcb) */ |
/* LINTSTUB: Func: void savectx(struct pcb *pcb) */ |
ENTRY(savectx) |
ENTRY(savectx) |
movl 4(%esp),%edx # edx = p->p_addr |
movl 4(%esp),%edx # edx = p->p_addr |
|
|
/* Save stack pointers. */ |
/* Save stack pointers. */ |
movl %esp,PCB_ESP(%edx) |
movl %esp,PCB_ESP(%edx) |
movl %ebp,PCB_EBP(%edx) |
movl %ebp,PCB_EBP(%edx) |
|
|
INTRENTRY |
INTRENTRY |
|
|
#ifdef DIAGNOSTIC |
#ifdef DIAGNOSTIC |
|
cmpl $0, CPUVAR(WANT_PMAPLOAD) |
|
jz 1f |
|
pushl $6f |
|
call _C_LABEL(printf) |
|
addl $4, %esp |
|
1: |
movl CPUVAR(ILEVEL),%ebx |
movl CPUVAR(ILEVEL),%ebx |
testl %ebx,%ebx |
testl %ebx,%ebx |
jz 1f |
jz 1f |
|
|
#ifdef DDB |
#ifdef DDB |
int $3 |
int $3 |
#endif |
#endif |
1: |
1: |
#endif /* DIAGNOSTIC */ |
#endif /* DIAGNOSTIC */ |
movl CPUVAR(CURLWP),%edx |
movl CPUVAR(CURLWP),%edx |
movl %esp,L_MD_REGS(%edx) # save pointer to frame |
movl %esp,L_MD_REGS(%edx) # save pointer to frame |
movl L_PROC(%edx),%edx |
movl L_PROC(%edx),%edx |
|
pushl %esp |
call *P_MD_SYSCALL(%edx) # get pointer to syscall() function |
call *P_MD_SYSCALL(%edx) # get pointer to syscall() function |
2: /* Check for ASTs on exit to user mode. */ |
addl $4,%esp |
|
.Lsyscall_checkast: |
|
/* Check for ASTs on exit to user mode. */ |
cli |
cli |
CHECK_ASTPENDING(%eax) |
CHECK_ASTPENDING(%eax) |
je 1f |
je 1f |
|
|
CLEAR_ASTPENDING(%eax) |
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) |
jmp 2b |
addl $4,%esp |
|
jmp .Lsyscall_checkast /* re-check ASTs */ |
|
1: CHECK_DEFERRED_SWITCH(%eax) |
|
jnz 9f |
#ifndef DIAGNOSTIC |
#ifndef DIAGNOSTIC |
1: INTRFASTEXIT |
INTRFASTEXIT |
#else /* DIAGNOSTIC */ |
#else /* DIAGNOSTIC */ |
1: cmpl $IPL_NONE,CPUVAR(ILEVEL) |
cmpl $IPL_NONE,CPUVAR(ILEVEL) |
jne 3f |
jne 3f |
INTRFASTEXIT |
INTRFASTEXIT |
3: sti |
3: sti |
|
|
movl $IPL_NONE,CPUVAR(ILEVEL) |
movl $IPL_NONE,CPUVAR(ILEVEL) |
jmp 2b |
jmp 2b |
4: .asciz "WARNING: SPL NOT LOWERED ON SYSCALL EXIT\n" |
4: .asciz "WARNING: SPL NOT LOWERED ON SYSCALL EXIT\n" |
5: .asciz "WARNING: SPL NOT ZERO ON SYSCALL ENTRY\n" |
5: .asciz "WARNING: SPL NOT ZERO ON SYSCALL ENTRY\n" |
|
6: .asciz "WARNING: WANT PMAPLOAD ON SYSCALL ENTRY\n" |
#endif /* DIAGNOSTIC */ |
#endif /* DIAGNOSTIC */ |
|
9: sti |
|
call _C_LABEL(pmap_load) |
|
jmp .Lsyscall_checkast /* re-check ASTs */ |
|
|
#if NNPX > 0 |
#if NNPX > 0 |
/* |
/* |