projects / unix-history / blobdiff
? search:
summary | tags | clone url | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
BSD 4_4_Lite1 release
[unix-history] / usr / src / sys / luna68k / luna68k / locore.s
diff --git a/usr/src/sys/luna68k/luna68k/locore.s b/usr/src/sys/luna68k/luna68k/locore.s
index a8b7476..5a4260e 100644 (file)
--- a/usr/src/sys/luna68k/luna68k/locore.s
+++ b/usr/src/sys/luna68k/luna68k/locore.s
@@ -1,19 +1,45 @@
 /*
  * Copyright (c) 1988 University of Utah.
  * Copyright (c) 1992 OMRON Corporation.
 /*
  * Copyright (c) 1988 University of Utah.
  * Copyright (c) 1992 OMRON Corporation.
- * Copyright (c) 1980, 1990 The Regents of the University of California.
- * All rights reserved.
+ * Copyright (c) 1980, 1990, 1993
+ *     The Regents of the University of California.  All rights reserved.
  *
  * This code is derived from software contributed to Berkeley by
  * the Systems Programming Group of the University of Utah Computer
  * Science Department.
  *
  *
  * This code is derived from software contributed to Berkeley by
  * the Systems Programming Group of the University of Utah Computer
  * Science Department.
  *
- * %sccs.include.redist.c%
+ * 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 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
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``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 REGENTS OR CONTRIBUTORS 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.
  *
  * from: Utah $Hdr: locore.s 1.62 92/01/20$
  *
  * from: Utah $Hdr: locore.s 1.62 92/01/20$
- * from: hp300/hp300/locore.s  7.20 (Berkeley) 12/28/92
+ * from: hp300/hp300/locore.s  8.5 (Berkeley) 11/14/93
  *
  *
- *     @(#)locore.s    7.8 (Berkeley) %G%
+ *     @(#)locore.s    8.4 (Berkeley) 12/6/93
  */
 
 /*
  */
 
 /*
@@ -74,15 +100,53 @@ _doadump:
        .globl  _trap, _nofault, _longjmp
 _buserr:
        tstl    _nofault                | device probe?
        .globl  _trap, _nofault, _longjmp
 _buserr:
        tstl    _nofault                | device probe?
-       jeq     _addrerr                | no, handle as usual
+       jeq     Lberr                   | no, handle as usual
        movl    _nofault,sp@-           | yes,
        jbsr    _longjmp                |  longjmp(nofault)
        movl    _nofault,sp@-           | yes,
        jbsr    _longjmp                |  longjmp(nofault)
+Lberr:
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     _addrerr                | no, skip
+       clrl    sp@-                    | stack adjust count
+       moveml  #0xFFFF,sp@-            | save user registers
+       movl    usp,a0                  | save the user SP
+       movl    a0,sp@(FR_SP)           |   in the savearea
+       lea     sp@(FR_HW),a1           | grab base of HW berr frame
+       moveq   #0,d0
+       movw    a1@(12),d0              | grab SSW
+       movl    a1@(20),d1              | and fault VA
+       btst    #11,d0                  | check for mis-aligned access
+       jeq     Lberr2                  | no, skip
+       addl    #3,d1                   | yes, get into next page
+       andl    #PG_FRAME,d1            | and truncate
+Lberr2:
+       movl    d1,sp@-                 | push fault VA
+       movl    d0,sp@-                 | and padded SSW
+       btst    #10,d0                  | ATC bit set?
+       jeq     Lisberr                 | no, must be a real bus error
+       movc    dfc,d1                  | yes, get MMU fault
+       movc    d0,dfc                  | store faulting function code
+       movl    sp@(4),a0               | get faulting address
+       .word   0xf568                  | ptestr a0@
+       movc    d1,dfc
+       .long   0x4e7a0805              | movc mmusr,d0
+       movw    d0,sp@                  | save (ONLY LOW 16 BITS!)
+       jra     Lismerr
+#endif
 _addrerr:
        clrl    sp@-                    | stack adjust count
        moveml  #0xFFFF,sp@-            | save user registers
        movl    usp,a0                  | save the user SP
        movl    a0,sp@(FR_SP)           |   in the savearea
        lea     sp@(FR_HW),a1           | grab base of HW berr frame
 _addrerr:
        clrl    sp@-                    | stack adjust count
        moveml  #0xFFFF,sp@-            | save user registers
        movl    usp,a0                  | save the user SP
        movl    a0,sp@(FR_SP)           |   in the savearea
        lea     sp@(FR_HW),a1           | grab base of HW berr frame
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lbenot040               | no, skip
+       movl    a1@(8),sp@-             | yes, push fault address
+       clrl    sp@-                    | no SSW for address fault
+       jra     Lisaerr                 | go deal with it
+Lbenot040:
+#endif
        moveq   #0,d0
        movw    a1@(10),d0              | grab SSW for fault processing
        btst    #12,d0                  | RB set?
        moveq   #0,d0
        movw    a1@(10),d0              | grab SSW for fault processing
        btst    #12,d0                  | RB set?
@@ -165,10 +229,38 @@ Lstkadj:
  * FP exceptions.
  */
 _fpfline:
  * FP exceptions.
  */
 _fpfline:
+#if defined(LUNA2)
+       cmpw    #0x202c,sp@(6)          | format type 2?
+       jne     _illinst                | no, not an FP emulation
+#ifdef HPFPLIB
+       .globl fpsp_unimp
+       jmp     fpsp_unimp              | yes, go handle it
+#else
+       clrl    sp@-                    | stack adjust count
+       moveml  #0xFFFF,sp@-            | save registers
+       moveq   #T_FPEMULI,d0           | denote as FP emulation trap
+       jra     fault                   | do it
+#endif
+#else
        jra     _illinst
        jra     _illinst
+#endif
 
 _fpunsupp:
 
 _fpunsupp:
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     _illinst                | no, treat as illinst
+#ifdef HPFPLIB
+       .globl  fpsp_unsupp
+       jmp     fpsp_unsupp             | yes, go handle it
+#else
+       clrl    sp@-                    | stack adjust count
+       moveml  #0xFFFF,sp@-            | save registers
+       moveq   #T_FPEMULD,d0           | denote as FP emulation trap
+       jra     fault                   | do it
+#endif
+#else
        jra     _illinst
        jra     _illinst
+#endif
 
 /*
  * Handles all other FP coprocessor exceptions.
 
 /*
  * Handles all other FP coprocessor exceptions.
@@ -200,6 +292,37 @@ Lfptnull:
        jra     _badtrap        | treat as an unexpected trap
 #endif
 
        jra     _badtrap        | treat as an unexpected trap
 #endif
 
+#ifdef HPFPLIB
+/*
+ * We wind up here from the 040 FP emulation library after
+ * the exception has been processed.
+ */
+       .globl  _fault
+_fault:
+       subql   #4,sp           | space for rts addr
+       movl    d0,sp@-         | scratch register
+       movw    sp@(14),d0      | get vector offset
+       andl    #0xFFF,d0       | mask out frame type and clear high word
+       cmpl    #0x100,d0       | HP-UX style reschedule trap?
+       jne     Lfault1         | no, skip
+       movl    sp@+,d0         | restore scratch register
+       addql   #4,sp           | pop space
+       jra     Lrei1           | go do AST
+Lfault1:
+       cmpl    #0xC0,d0        | FP exception?
+       jlt     Lfault2         | no, skip
+       movl    sp@+,d0         | yes, backoff
+       addql   #4,sp           |  and prepare for normal trap frame
+       jra     _fpfault        | go to it
+Lfault2:
+       addl    #Lvectab,d0     | convert to vector table offset
+       exg     d0,a0
+       movl    a0@,sp@(4)      | get exception vector and save for rts
+       exg     d0,a0
+       movl    sp@+,d0         |   scratch registers
+       rts                     | return to handler from vectab
+#endif
+
 /*
  * Coprocessor and format errors can generate mid-instruction stack
  * frames and cause signal delivery hence we need to check for potential
 /*
  * Coprocessor and format errors can generate mid-instruction stack
  * frames and cause signal delivery hence we need to check for potential
@@ -461,7 +584,7 @@ _lev5intr:
        .globl  _panicstr,_badkstack
        cmpl    #_kstack+NBPG,sp        | are we still in stack page?
        jcc     Lstackok                | yes, continue normally
        .globl  _panicstr,_badkstack
        cmpl    #_kstack+NBPG,sp        | are we still in stack page?
        jcc     Lstackok                | yes, continue normally
-       tstl    _curproc                | if !curproc could have swtch_exit'ed,
+       tstl    _curproc                | if !curproc could have switch_exited,
        jeq     Lstackok                |     might be on tmpstk
        tstl    _panicstr               | have we paniced?
        jne     Lstackok                | yes, do not re-panic
        jeq     Lstackok                |     might be on tmpstk
        tstl    _panicstr               | have we paniced?
        jne     Lstackok                | yes, do not re-panic
@@ -669,9 +792,15 @@ start:
        movc    d0,vbr                  | XXXX please remove these 2 lines
 /* 
  * a5 contains parameters address from booter.
        movc    d0,vbr                  | XXXX please remove these 2 lines
 /* 
  * a5 contains parameters address from booter.
- * First, we copy parameters to save area.
- * (Now just save maxmem and so on. Not complete yet.) XXXX
+ * First, we copy whole parameters to Kernel InterFace Field
  */
  */
+
+       movl    #KIFF_SIZE,sp@-         | KIFF size
+       pea     _KernInter              | KIFF address
+       pea     a5@                     | bootor's KIFF address
+       jbsr    _bcopy
+       lea     sp@(12),sp              | pop value args
+
        movl    a5@(KI_MAXADDR),d0      | maxaddr
        moveq   #PGSHIFT,d1
        lsrl    d1,d0                   | convert to page (click) number
        movl    a5@(KI_MAXADDR),d0      | maxaddr
        moveq   #PGSHIFT,d1
        lsrl    d1,d0                   | convert to page (click) number
@@ -682,6 +811,28 @@ start:
        movl    #CACHE_OFF,d0
        movc    d0,cacr                 | clear and disable on-chip cache(s)
 
        movl    #CACHE_OFF,d0
        movc    d0,cacr                 | clear and disable on-chip cache(s)
 
+#if defined(LUNA2)
+/* determine our CPU/MMU combo - check for all regardless of kernel config */
+       movl    #0x200,d0               | data freeze bit
+       movc    d0,cacr                 |   only exists on 68030
+       movc    cacr,d0                 | read it back
+       tstl    d0                      | zero?
+       jeq     Lnot68030               | yes, we have 68040(LUNA2)
+       movl    #1,_machineid           | no, must be a LUNA-I
+       movl    #-1,_mmutype            | set to reflect 68030 PMMU
+       jra     Lstart1
+Lnot68030:
+       movl    #2,_machineid           | must be a LUNA-II
+       movl    #-2,_mmutype            | set to reflect 68040 MMU
+#ifdef HPFPLIB
+       movl    #3,_processor           | HP-UX style processor id
+#endif
+Lstart1:
+#endif
+/* set 60 to hz, when running LUNA-I */
+       .globl  _modify_clock_param
+       jbsr    _modify_clock_param
+
 /* initialize source/destination control registers for movs */
        moveq   #FC_USERD,d0            | user space
        movc    d0,sfc                  |   as source
 /* initialize source/destination control registers for movs */
        moveq   #FC_USERD,d0            | user space
        movc    d0,sfc                  |   as source
@@ -690,10 +841,7 @@ start:
 /*
  * LUNA  PIO initialization.
  */
 /*
  * LUNA  PIO initialization.
  */
-       movb    #PIO_MODED,PIO0_CTL     | read dipswitch
-       movb    PIO0_B,d0               | dipsw-2 (from portB)
-       lsll    #8,d0
-       movb    PIO0_A,d0               | dipsw-1 (from portA)
+       movw    PIO0_A,d0               | dipsw-1,2 (from port A&B)
        movw    d0,_dipswitch
 
 /* configure kernel and proc0 VA space so we can get going */
        movw    d0,_dipswitch
 
 /* configure kernel and proc0 VA space so we can get going */
@@ -710,25 +858,48 @@ start:
 /*
  * Prepare to enable MMU.
  */
 /*
  * Prepare to enable MMU.
  */
-       movl    _Sysseg,a1              | system segment table addr read value (a KVA)
+       movl    _Sysseg,d1              | system segment table addr read value (a KVA)
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lmotommu1               | no, skip
+       
+       .long   0x4e7b1807              | movc d1,srp
+/* we must set tt-registers here */
+       movl    #0x403FA040,d0          | tt0 for LUNA2 0x40000000-0x7fffffff
+       .long   0x4e7b0004              | movc d0,itt0
+       .long   0x4e7b0006              | movc d0,dtt0
+       movl    #0x807FA040,d0          | tt1 for LUNA2 0x80000000-0xffffffff
+       .long   0x4e7b0005              | movc d0,itt1
+       .long   0x4e7b0007              | movc d0,dtt1
+       .word   0xf4d8                  | cinva bc
+       .word   0xf518                  | pflusha
+       movl    #0x8000,d0
+       .long   0x4e7b0003              | movc d0,tc
+       movl    #0x80008000,d0
+       movc    d0,cacr                 | turn on both caches
+       jmp     Lenab1
+Lmotommu1:
+#endif
        lea     _protorp,a0
        movl    #0x80000202,a0@         | nolimit + share global + 4 byte PTEs
        lea     _protorp,a0
        movl    #0x80000202,a0@         | nolimit + share global + 4 byte PTEs
-       movl    a1,a0@(4)               | + segtable address
+       movl    d1,a0@(4)               | + segtable address
        pmove   a0@,srp                 | load the supervisor root pointer
        movl    #0x80000002,a0@         | reinit upper half for CRP loads
 /* we must set tt-registers here */
        pmove   a0@,srp                 | load the supervisor root pointer
        movl    #0x80000002,a0@         | reinit upper half for CRP loads
 /* we must set tt-registers here */
-       lea     _protott0,a0
+       lea     _protott0,a0            | tt0 for LUNA1 0x40000000-0x7fffffff
        .word   0xf010                  | pmove a0@,mmutt0
        .word   0x0800
        .word   0xf010                  | pmove a0@,mmutt0
        .word   0x0800
-       lea     _protott1,a0
+       lea     _protott1,a0            | tt1 for LUNA1 0x80000000-0xffffffff
        .word   0xf010                  | pmove a0@,mmutt1
        .word   0x0c00
        .word   0xf010                  | pmove a0@,mmutt1
        .word   0x0c00
+       lea     _mapping_tc,a2
        movl    #0x82c0aa00,a2@         | value to load TC with
        pmove   a2@,tc                  | load it
 
 /*
  * Should be running mapped from this point on
  */
        movl    #0x82c0aa00,a2@         | value to load TC with
        pmove   a2@,tc                  | load it
 
 /*
  * Should be running mapped from this point on
  */
+Lenab1:
 #ifdef FPCOPROC
 /* fpp check */
        movl    a1,sp@-
 #ifdef FPCOPROC
 /* fpp check */
        movl    a1,sp@-
@@ -754,21 +925,48 @@ start:
 #endif
 /* flush TLB and turn on caches */
        jbsr    _TBIA                   | invalidate TLB
 #endif
 /* flush TLB and turn on caches */
        jbsr    _TBIA                   | invalidate TLB
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jeq     Lnocache0               | yes, cache already on
+#endif
        movl    #CACHE_ON,d0
        movc    d0,cacr                 | clear cache(s)
        movl    #CACHE_ON,d0
        movc    d0,cacr                 | clear cache(s)
+Lnocache0:
 /* final setup for C code */
        movw    #PSL_LOWIPL,sr          | lower SPL
        movl    d7,_boothowto           | save reboot flags
        movl    d6,_bootdev             |   and boot device
 /* final setup for C code */
        movw    #PSL_LOWIPL,sr          | lower SPL
        movl    d7,_boothowto           | save reboot flags
        movl    d6,_bootdev             |   and boot device
-       jbsr    _main                   | call main()
-
-/* proc[1] == init now running here;
- * create a null exception frame and return to user mode in icode
+/*
+ * Create a fake exception frame that returns to user mode,
+ * make space for the rest of a fake saved register set, and
+ * pass the first available RAM and a pointer to the register
+ * set to "main()".  "main()" will call "icode()", which fakes
+ * an "execve()" system call, which is why we need to do that
+ * ("main()" sets "u.u_ar0" to point to the register set).
+ * When "main()" returns, we're running in process 1 and have
+ * successfully faked the "execve()".  We load up the registers from
+ * that set; the "rte" loads the PC and PSR, which jumps to "init".
  */
  */
-       clrw    sp@-                    | vector offset/frame type
-       clrl    sp@-                    | return to icode location 0
-       movw    #PSL_USER,sp@-          | in user mode
-       rte
+       clrw    sp@-                    | vector offset/frame type
+       clrl    sp@-                    | PC - filled in by "execve"
+       movw    #PSL_USER,sp@-          | in user mode
+       clrw    sp@-                    | pad SR to longword
+       lea     sp@(-64),sp             | construct space for D0-D7/A0-A7
+       pea     sp@                     | addr of space for D0
+       jbsr    _main                   | main(firstaddr, r0)
+       addql   #4,sp                   | pop args
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lnoflush                | no, skip
+       .word   0xf478                  | cpusha dc
+       .word   0xf498                  | cinva ic
+Lnoflush:
+#endif
+       movl    sp@(60),a0              | grab and load
+       movl    a0,usp                  |   user SP
+       moveml  sp@+,#0x7FFF            | load most registers (all but SSP)
+       addql   #6,sp                   | pop SSP and align word
+       rte
 
 /*
  * Signal "trampoline" code (18 bytes).  Invoked from RTE setup by sendsig().
 
 /*
  * Signal "trampoline" code (18 bytes).  Invoked from RTE setup by sendsig().
@@ -798,47 +996,25 @@ _sigcodetrap:
        .align  2
 _esigcode:
 
        .align  2
 _esigcode:
 
-/*
- * Icode is copied out to process 1 to exec init.
- * If the exec fails, process 1 exits.
- */
-       .globl  _icode,_szicode
-       .text
-_icode:
-       clrl    sp@-
-       pea     pc@((argv-.)+2)
-       pea     pc@((init-.)+2)
-       clrl    sp@-
-       moveq   #SYS_execve,d0
-       trap    #0
-       moveq   #SYS_exit,d0
-       trap    #0
-init:
-       .asciz  "/sbin/init"
-       .even
-argv:
-       .long   init+6-_icode           | argv[0] = "init" ("/sbin/init" + 6)
-       .long   eicode-_icode           | argv[1] follows icode after copyout
-       .long   0
-eicode:
-
-_szicode:
-       .long   _szicode-_icode
-
 /*
  * Primitives
  */ 
 
 /*
  * Primitives
  */ 
 
+#ifdef __STDC__
+#define EXPORT(name)           .globl _ ## name; _ ## name:
+#else
+#define EXPORT(name)           .globl _/**/name; _/**/name:
+#endif
 #ifdef GPROF
 #ifdef GPROF
-#define        ENTRY(name) \
-       .globl _/**/name; _/**/name: link a6,#0; jbsr mcount; unlk a6
-#define ALTENTRY(name, rname) \
-       ENTRY(name); jra rname+12
+#if __GNUC__ >= 2
+#define                ENTRY(name)             EXPORT(name) link a6,\#0; jbsr mcount; unlk a6
+#else
+#define                ENTRY(name)             EXPORT(name) link a6,#0; jbsr mcount; unlk a6
+#endif
+#define ALTENTRY(name, rname) ENTRY(name); jra rname+12
 #else
 #else
-#define        ENTRY(name) \
-       .globl _/**/name; _/**/name:
-#define ALTENTRY(name, rname) \
-       .globl _/**/name; _/**/name:
+#define                ENTRY(name)             EXPORT(name)
+#define ALTENTRY(name, rname)          ENTRY(name)
 #endif
 
 /*
 #endif
 
 /*
@@ -847,12 +1023,45 @@ _szicode:
 ENTRY(__main)
        rts
 
 ENTRY(__main)
        rts
 
+/*
+ * copypage(fromaddr, toaddr)
+ *
+ * Optimized version of bcopy for a single page-aligned NBPG byte copy.
+ */
+ENTRY(copypage)
+       movl    sp@(4),a0               | source address
+       movl    sp@(8),a1               | destination address
+       movl    #NBPG/32,d0             | number of 32 byte chunks
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lmlloop                 | no, use movl
+Lm16loop:
+       .long   0xf6209000              | move16 a0@+,a1@+
+       .long   0xf6209000              | move16 a0@+,a1@+
+       subql   #1,d0
+       jne     Lm16loop
+       rts
+#endif
+Lmlloop:
+       movl    a0@+,a1@+
+       movl    a0@+,a1@+
+       movl    a0@+,a1@+
+       movl    a0@+,a1@+
+       movl    a0@+,a1@+
+       movl    a0@+,a1@+
+       movl    a0@+,a1@+
+       movl    a0@+,a1@+
+       subql   #1,d0
+       jne     Lmlloop
+       rts
+
 /*
  * copyinstr(fromaddr, toaddr, maxlength, &lencopied)
  *
  * Copy a null terminated string from the user address space into
  * the kernel address space.
 /*
  * copyinstr(fromaddr, toaddr, maxlength, &lencopied)
  *
  * Copy a null terminated string from the user address space into
  * the kernel address space.
- * NOTE: maxlength must be < 64K
+ *
+ * NOTE: maxlength must be < 64K (due to use of DBcc)
  */
 ENTRY(copyinstr)
        movl    _curpcb,a0              | current pcb
  */
 ENTRY(copyinstr)
        movl    _curpcb,a0              | current pcb
@@ -934,7 +1143,8 @@ Lcosflt2:
  *
  * Copy a null terminated string from one point to another in
  * the kernel address space.
  *
  * Copy a null terminated string from one point to another in
  * the kernel address space.
- * NOTE: maxlength must be < 64K
+ *
+ * NOTE: maxlength must be < 64K (due to use of DBcc)
  */
 ENTRY(copystr)
        movl    sp@(4),a0               | a0 = fromaddr
  */
 ENTRY(copystr)
        movl    sp@(4),a0               | a0 = fromaddr
@@ -977,104 +1187,110 @@ Lcsflt2:
  * fixing this code!
  */
 ENTRY(copyin)
  * fixing this code!
  */
 ENTRY(copyin)
+       movl    sp@(12),d0              | get size
+#ifdef MAPPEDCOPY
+       .globl  _mappedcopysize,_mappedcopyin
+       cmpl    _mappedcopysize,d0      | size >= mappedcopysize
+       jcc     _mappedcopyin           | yes, go do it the new way
+#endif
        movl    d2,sp@-                 | scratch register
        movl    _curpcb,a0              | current pcb
        movl    #Lciflt,a0@(PCB_ONFAULT) | set up to catch faults
        movl    d2,sp@-                 | scratch register
        movl    _curpcb,a0              | current pcb
        movl    #Lciflt,a0@(PCB_ONFAULT) | set up to catch faults
-       movl    sp@(16),d2              | check count
+       tstl    d0                      | check count
        jlt     Lciflt                  | negative, error
        jeq     Lcidone                 | zero, done
        movl    sp@(8),a0               | src address
        movl    sp@(12),a1              | dest address
        jlt     Lciflt                  | negative, error
        jeq     Lcidone                 | zero, done
        movl    sp@(8),a0               | src address
        movl    sp@(12),a1              | dest address
-       movl    a0,d0
-       btst    #0,d0                   | src address odd?
+       movl    a0,d2
+       btst    #0,d2                   | src address odd?
        jeq     Lcieven                 | no, go check dest
        movsb   a0@+,d1                 | yes, get a byte
        nop
        movb    d1,a1@+                 | put a byte
        jeq     Lcieven                 | no, go check dest
        movsb   a0@+,d1                 | yes, get a byte
        nop
        movb    d1,a1@+                 | put a byte
-       subql   #1,d2                   | adjust count
+       subql   #1,d0                   | adjust count
        jeq     Lcidone                 | exit if done
 Lcieven:
        jeq     Lcidone                 | exit if done
 Lcieven:
-       movl    a1,d0
-       btst    #0,d0                   | dest address odd?
-       jne     Lcibyte                 | yes, must copy by bytes
-       movl    d2,d0                   | no, get count
-       lsrl    #2,d0                   | convert to longwords
-       jeq     Lcibyte                 | no longwords, copy bytes
-       subql   #1,d0                   | set up for dbf
+       movl    a1,d2
+       btst    #0,d2                   | dest address odd?
+       jne     Lcibloop                | yes, must copy by bytes
+       movl    d0,d2                   | no, get count
+       lsrl    #2,d2                   | convert to longwords
+       jeq     Lcibloop                | no longwords, copy bytes
 Lcilloop:
        movsl   a0@+,d1                 | get a long
        nop
        movl    d1,a1@+                 | put a long
 Lcilloop:
        movsl   a0@+,d1                 | get a long
        nop
        movl    d1,a1@+                 | put a long
-       dbf     d0,Lcilloop             | til done
-       andl    #3,d2                   | what remains
+       subql   #1,d2
+       jne     Lcilloop                | til done
+       andl    #3,d0                   | what remains
        jeq     Lcidone                 | all done
        jeq     Lcidone                 | all done
-Lcibyte:
-       subql   #1,d2                   | set up for dbf
 Lcibloop:
        movsb   a0@+,d1                 | get a byte
        nop
        movb    d1,a1@+                 | put a byte
 Lcibloop:
        movsb   a0@+,d1                 | get a byte
        nop
        movb    d1,a1@+                 | put a byte
-       dbf     d2,Lcibloop             | til done
+       subql   #1,d0
+       jne     Lcibloop                | til done
 Lcidone:
 Lcidone:
-       moveq   #0,d0                   | success
-Lciexit:
        movl    _curpcb,a0              | current pcb
        clrl    a0@(PCB_ONFAULT)        | clear fault catcher
        movl    sp@+,d2                 | restore scratch reg
        rts
 Lciflt:
        moveq   #EFAULT,d0              | got a fault
        movl    _curpcb,a0              | current pcb
        clrl    a0@(PCB_ONFAULT)        | clear fault catcher
        movl    sp@+,d2                 | restore scratch reg
        rts
 Lciflt:
        moveq   #EFAULT,d0              | got a fault
-       jra     Lciexit
+       jra     Lcidone
 
 ENTRY(copyout)
 
 ENTRY(copyout)
+       movl    sp@(12),d0              | get size
+#ifdef MAPPEDCOPY
+       .globl  _mappedcopysize,_mappedcopyout
+       cmpl    _mappedcopysize,d0      | size >= mappedcopysize
+       jcc     _mappedcopyout          | yes, go do it the new way
+#endif
        movl    d2,sp@-                 | scratch register
        movl    _curpcb,a0              | current pcb
        movl    #Lcoflt,a0@(PCB_ONFAULT) | catch faults
        movl    d2,sp@-                 | scratch register
        movl    _curpcb,a0              | current pcb
        movl    #Lcoflt,a0@(PCB_ONFAULT) | catch faults
-       movl    sp@(16),d2              | check count
+       tstl    d0                      | check count
        jlt     Lcoflt                  | negative, error
        jeq     Lcodone                 | zero, done
        movl    sp@(8),a0               | src address
        movl    sp@(12),a1              | dest address
        jlt     Lcoflt                  | negative, error
        jeq     Lcodone                 | zero, done
        movl    sp@(8),a0               | src address
        movl    sp@(12),a1              | dest address
-       movl    a0,d0
-       btst    #0,d0                   | src address odd?
+       movl    a0,d2
+       btst    #0,d2                   | src address odd?
        jeq     Lcoeven                 | no, go check dest
        movb    a0@+,d1                 | yes, get a byte
        movsb   d1,a1@+                 | put a byte
        nop
        jeq     Lcoeven                 | no, go check dest
        movb    a0@+,d1                 | yes, get a byte
        movsb   d1,a1@+                 | put a byte
        nop
-       subql   #1,d2                   | adjust count
+       subql   #1,d0                   | adjust count
        jeq     Lcodone                 | exit if done
 Lcoeven:
        jeq     Lcodone                 | exit if done
 Lcoeven:
-       movl    a1,d0
-       btst    #0,d0                   | dest address odd?
-       jne     Lcobyte                 | yes, must copy by bytes
-       movl    d2,d0                   | no, get count
-       lsrl    #2,d0                   | convert to longwords
-       jeq     Lcobyte                 | no longwords, copy bytes
-       subql   #1,d0                   | set up for dbf
+       movl    a1,d2
+       btst    #0,d2                   | dest address odd?
+       jne     Lcobloop                | yes, must copy by bytes
+       movl    d0,d2                   | no, get count
+       lsrl    #2,d2                   | convert to longwords
+       jeq     Lcobloop                | no longwords, copy bytes
 Lcolloop:
        movl    a0@+,d1                 | get a long
        movsl   d1,a1@+                 | put a long
        nop
 Lcolloop:
        movl    a0@+,d1                 | get a long
        movsl   d1,a1@+                 | put a long
        nop
-       dbf     d0,Lcolloop             | til done
-       andl    #3,d2                   | what remains
+       subql   #1,d2
+       jne     Lcolloop                | til done
+       andl    #3,d0                   | what remains
        jeq     Lcodone                 | all done
        jeq     Lcodone                 | all done
-Lcobyte:
-       subql   #1,d2                   | set up for dbf
 Lcobloop:
        movb    a0@+,d1                 | get a byte
        movsb   d1,a1@+                 | put a byte
        nop
 Lcobloop:
        movb    a0@+,d1                 | get a byte
        movsb   d1,a1@+                 | put a byte
        nop
-       dbf     d2,Lcobloop             | til done
+       subql   #1,d0
+       jne     Lcobloop                | til done
 Lcodone:
 Lcodone:
-       moveq   #0,d0                   | success
-Lcoexit:
        movl    _curpcb,a0              | current pcb
        clrl    a0@(PCB_ONFAULT)        | clear fault catcher
        movl    sp@+,d2                 | restore scratch reg
        rts
 Lcoflt:
        moveq   #EFAULT,d0              | got a fault
        movl    _curpcb,a0              | current pcb
        clrl    a0@(PCB_ONFAULT)        | clear fault catcher
        movl    sp@+,d2                 | restore scratch reg
        rts
 Lcoflt:
        moveq   #EFAULT,d0              | got a fault
-       jra     Lcoexit
+       jra     Lcodone
 
 /*
  * non-local gotos
 
 /*
  * non-local gotos
@@ -1094,12 +1310,11 @@ ENTRY(longjmp)
        rts
 
 /*
        rts
 
 /*
- * The following primitives manipulate the run queues.
- * _whichqs tells which of the 32 queues _qs
- * have processes in them.  Setrq puts processes into queues, Remrq
- * removes them from queues.  The running process is on no queue,
- * other processes are on a queue related to p->p_pri, divided by 4
- * actually to shrink the 0-127 range of priorities into the 32 available
+ * The following primitives manipulate the run queues.  _whichqs tells which
+ * of the 32 queues _qs have processes in them.  Setrunqueue puts processes
+ * into queues, Remrq removes them from queues.  The running process is on
+ * no queue, other processes are on a queue related to p->p_priority, divided
+ * by 4 actually to shrink the 0-127 range of priorities into the 32 available
  * queues.
  */
 
  * queues.
  */
 
@@ -1107,35 +1322,35 @@ ENTRY(longjmp)
        .globl  _curproc,_want_resched
 
 /*
        .globl  _curproc,_want_resched
 
 /*
- * Setrq(p)
+ * Setrunqueue(p)
  *
  * Call should be made at spl6(), and p->p_stat should be SRUN
  */
  *
  * Call should be made at spl6(), and p->p_stat should be SRUN
  */
-ENTRY(setrq)
+ENTRY(setrunqueue)
        movl    sp@(4),a0
        movl    sp@(4),a0
-       tstl    a0@(P_RLINK)
+       tstl    a0@(P_BACK)
        jeq     Lset1
        movl    #Lset2,sp@-
        jbsr    _panic
 Lset1:
        clrl    d0
        jeq     Lset1
        movl    #Lset2,sp@-
        jbsr    _panic
 Lset1:
        clrl    d0
-       movb    a0@(P_PRI),d0
+       movb    a0@(P_PRIORITY),d0
        lsrb    #2,d0
        movl    _whichqs,d1
        bset    d0,d1
        movl    d1,_whichqs
        lslb    #3,d0
        addl    #_qs,d0
        lsrb    #2,d0
        movl    _whichqs,d1
        bset    d0,d1
        movl    d1,_whichqs
        lslb    #3,d0
        addl    #_qs,d0
-       movl    d0,a0@(P_LINK)
+       movl    d0,a0@(P_FORW)
        movl    d0,a1
        movl    d0,a1
-       movl    a1@(P_RLINK),a0@(P_RLINK)
-       movl    a0,a1@(P_RLINK)
-       movl    a0@(P_RLINK),a1
-       movl    a0,a1@(P_LINK)
+       movl    a1@(P_BACK),a0@(P_BACK)
+       movl    a0,a1@(P_BACK)
+       movl    a0@(P_BACK),a1
+       movl    a0,a1@(P_FORW)
        rts
 
 Lset2:
        rts
 
 Lset2:
-       .asciz  "setrq"
+       .asciz  "setrunqueue"
        .even
 
 /*
        .even
 
 /*
@@ -1146,7 +1361,7 @@ Lset2:
 ENTRY(remrq)
        movl    sp@(4),a0
        clrl    d0
 ENTRY(remrq)
        movl    sp@(4),a0
        clrl    d0
-       movb    a0@(P_PRI),d0
+       movb    a0@(P_PRIORITY),d0
        lsrb    #2,d0
        movl    _whichqs,d1
        bclr    d0,d1
        lsrb    #2,d0
        movl    _whichqs,d1
        bclr    d0,d1
@@ -1155,27 +1370,27 @@ ENTRY(remrq)
        jbsr    _panic
 Lrem1:
        movl    d1,_whichqs
        jbsr    _panic
 Lrem1:
        movl    d1,_whichqs
-       movl    a0@(P_LINK),a1
-       movl    a0@(P_RLINK),a1@(P_RLINK)
-       movl    a0@(P_RLINK),a1
-       movl    a0@(P_LINK),a1@(P_LINK)
+       movl    a0@(P_FORW),a1
+       movl    a0@(P_BACK),a1@(P_BACK)
+       movl    a0@(P_BACK),a1
+       movl    a0@(P_FORW),a1@(P_FORW)
        movl    #_qs,a1
        movl    d0,d1
        lslb    #3,d1
        addl    d1,a1
        movl    #_qs,a1
        movl    d0,d1
        lslb    #3,d1
        addl    d1,a1
-       cmpl    a1@(P_LINK),a1
+       cmpl    a1@(P_FORW),a1
        jeq     Lrem2
        movl    _whichqs,d1
        bset    d0,d1
        movl    d1,_whichqs
 Lrem2:
        jeq     Lrem2
        movl    _whichqs,d1
        bset    d0,d1
        movl    d1,_whichqs
 Lrem2:
-       clrl    a0@(P_RLINK)
+       clrl    a0@(P_BACK)
        rts
 
 Lrem3:
        .asciz  "remrq"
 Lsw0:
        rts
 
 Lrem3:
        .asciz  "remrq"
 Lsw0:
-       .asciz  "swtch"
+       .asciz  "switch"
        .even
 
        .globl  _curpcb
        .even
 
        .globl  _curpcb
@@ -1191,27 +1406,27 @@ mdpflag:
        .text
 
 /*
        .text
 
 /*
- * At exit of a process, do a swtch for the last time.
+ * At exit of a process, do a switch for the last time.
  * The mapping of the pcb at p->p_addr has already been deleted,
  * and the memory for the pcb+stack has been freed.
  * The ipl is high enough to prevent the memory from being reallocated.
  */
  * The mapping of the pcb at p->p_addr has already been deleted,
  * and the memory for the pcb+stack has been freed.
  * The ipl is high enough to prevent the memory from being reallocated.
  */
-ENTRY(swtch_exit)
+ENTRY(switch_exit)
        movl    #nullpcb,_curpcb        | save state into garbage pcb
        lea     tmpstk,sp               | goto a tmp stack
        movl    #nullpcb,_curpcb        | save state into garbage pcb
        lea     tmpstk,sp               | goto a tmp stack
-       jra     _cpu_swtch
+       jra     _cpu_switch
 
 /*
 
 /*
- * When no processes are on the runq, Swtch branches to idle
+ * When no processes are on the runq, Swtch branches to Idle
  * to wait for something to come ready.
  */
        .globl  idle
  * to wait for something to come ready.
  */
        .globl  idle
-Lidle:
-       stop    #PSL_LOWIPL
 idle:
 idle:
+       stop    #PSL_LOWIPL
+Idle:
        movw    #PSL_HIGHIPL,sr
        tstl    _whichqs
        movw    #PSL_HIGHIPL,sr
        tstl    _whichqs
-       jeq     Lidle
+       jeq     idle
        movw    #PSL_LOWIPL,sr
        jra     Lsw1
 
        movw    #PSL_LOWIPL,sr
        jra     Lsw1
 
@@ -1221,7 +1436,7 @@ Lbadsw:
        /*NOTREACHED*/
 
 /*
        /*NOTREACHED*/
 
 /*
- * cpu_swtch()
+ * cpu_switch()
  *
  * NOTE: On the mc68851 (318/319/330) we attempt to avoid flushing the
  * entire ATC.  The effort involved in selective flushing may not be
  *
  * NOTE: On the mc68851 (318/319/330) we attempt to avoid flushing the
  * entire ATC.  The effort involved in selective flushing may not be
@@ -1231,7 +1446,7 @@ Lbadsw:
  * user's PTEs have been changed (formerly denoted by the SPTECHG p_flag
  * bit).  For now, we just always flush the full ATC.
  */
  * user's PTEs have been changed (formerly denoted by the SPTECHG p_flag
  * bit).  For now, we just always flush the full ATC.
  */
-ENTRY(cpu_swtch)
+ENTRY(cpu_switch)
        movl    _curpcb,a0              | current pcb
        movw    sr,a0@(PCB_PS)          | save sr before changing ipl
 #ifdef notyet
        movl    _curpcb,a0              | current pcb
        movw    sr,a0@(PCB_PS)          | save sr before changing ipl
 #ifdef notyet
@@ -1254,7 +1469,7 @@ Lswchk:
        addqb   #1,d0
        cmpb    #32,d0
        jne     Lswchk
        addqb   #1,d0
        cmpb    #32,d0
        jne     Lswchk
-       jra     idle
+       jra     Idle
 Lswfnd:
        movw    #PSL_HIGHIPL,sr         | lock out interrupts
        movl    a0@,d1                  | and check again...
 Lswfnd:
        movw    #PSL_HIGHIPL,sr         | lock out interrupts
        movl    a0@,d1                  | and check again...
@@ -1275,13 +1490,13 @@ Lswok:
        lslb    #3,d1                   | convert queue number to index
        addl    #_qs,d1                 | locate queue (q)
        movl    d1,a1
        lslb    #3,d1                   | convert queue number to index
        addl    #_qs,d1                 | locate queue (q)
        movl    d1,a1
-       cmpl    a1@(P_LINK),a1          | anyone on queue?
+       cmpl    a1@(P_FORW),a1          | anyone on queue?
        jeq     Lbadsw                  | no, panic
        jeq     Lbadsw                  | no, panic
-       movl    a1@(P_LINK),a0                  | p = q->p_link
-       movl    a0@(P_LINK),a1@(P_LINK)         | q->p_link = p->p_link
-       movl    a0@(P_LINK),a1                  | q = p->p_link
-       movl    a0@(P_RLINK),a1@(P_RLINK)       | q->p_rlink = p->p_rlink
-       cmpl    a0@(P_LINK),d1          | anyone left on queue?
+       movl    a1@(P_FORW),a0          | p = q->p_forw
+       movl    a0@(P_FORW),a1@(P_FORW) | q->p_forw = p->p_forw
+       movl    a0@(P_FORW),a1          | q = p->p_forw
+       movl    a0@(P_BACK),a1@(P_BACK) | q->p_back = p->p_back
+       cmpl    a0@(P_FORW),d1          | anyone left on queue?
        jeq     Lsw2                    | no, skip
        movl    _whichqs,d1
        bset    d0,d1                   | yes, reset bit
        jeq     Lsw2                    | no, skip
        movl    _whichqs,d1
        bset    d0,d1                   | yes, reset bit
@@ -1317,7 +1532,7 @@ Lswnofpsave:
        cmpb    #SRUN,a0@(P_STAT)
        jne     Lbadsw
 #endif
        cmpb    #SRUN,a0@(P_STAT)
        jne     Lbadsw
 #endif
-       clrl    a0@(P_RLINK)            | clear back link
+       clrl    a0@(P_BACK)             | clear back link
        movb    a0@(P_MDFLAG+3),mdpflag | low byte of p_md.md_flags
        movl    a0@(P_ADDR),a1          | get p_addr
        movl    a1,_curpcb
        movb    a0@(P_MDFLAG+3),mdpflag | low byte of p_md.md_flags
        movl    a0@(P_ADDR),a1          | get p_addr
        movl    a1,_curpcb
@@ -1356,6 +1571,17 @@ Lres1:
        orl     #PG_RW+PG_V,d1          | ensure valid and writable
        movl    d1,a2@+                 | load it up
        dbf     d0,Lres1                | til done
        orl     #PG_RW+PG_V,d1          | ensure valid and writable
        movl    d1,a2@+                 | load it up
        dbf     d0,Lres1                | til done
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lres1a                  | no, skip
+       .word   0xf518                  | yes, pflusha
+       movl    a1@(PCB_USTP),d0        | get USTP
+       moveq   #PGSHIFT,d1
+       lsll    d1,d0                   | convert to addr
+       .long   0x4e7b0806              | movc d0,urp
+       jra     Lcxswdone
+Lres1a:
+#endif
        movl    #CACHE_CLR,d0
        movc    d0,cacr                 | invalidate cache(s)
        pflusha                         | flush entire TLB
        movl    #CACHE_CLR,d0
        movc    d0,cacr                 | invalidate cache(s)
        pflusha                         | flush entire TLB
@@ -1365,6 +1591,7 @@ Lres1:
        lea     _protorp,a0             | CRP prototype
        movl    d0,a0@(4)               | stash USTP
        pmove   a0@,crp                 | load new user root pointer
        lea     _protorp,a0             | CRP prototype
        movl    d0,a0@(4)               | stash USTP
        pmove   a0@,crp                 | load new user root pointer
+Lcxswdone:
        moveml  a1@(PCB_REGS),#0xFCFC   | and registers
        movl    a1@(PCB_USP),a0
        movl    a0,usp                  | and USP
        moveml  a1@(PCB_REGS),#0xFCFC   | and registers
        movl    a1@(PCB_USP),a0
        movl    a0,usp                  | and USP
@@ -1372,6 +1599,13 @@ Lres1:
        lea     a1@(PCB_FPCTX),a0       | pointer to FP save area
        tstb    a0@                     | null state frame?
        jeq     Lresfprest              | yes, easy
        lea     a1@(PCB_FPCTX),a0       | pointer to FP save area
        tstb    a0@                     | null state frame?
        jeq     Lresfprest              | yes, easy
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lresnot040              | no, skip
+       clrl    sp@-                    | yes...
+       frestore sp@+                   | ...magic!
+Lresnot040:
+#endif
        fmovem  a0@(312),fpcr/fpsr/fpi  | restore FP control registers
        fmovem  a0@(216),fp0-fp7        | restore FP general registers
 Lresfprest:
        fmovem  a0@(312),fpcr/fpsr/fpi  | restore FP control registers
        fmovem  a0@(216),fp0-fp7        | restore FP general registers
 Lresfprest:
@@ -1384,7 +1618,7 @@ Lresfprest:
 /*
  * savectx(pcb, altreturn)
  * Update pcb, saving current processor state and arranging
 /*
  * savectx(pcb, altreturn)
  * Update pcb, saving current processor state and arranging
- * for alternate return ala longjmp in swtch if altreturn is true.
+ * for alternate return ala longjmp in switch if altreturn is true.
  */
 ENTRY(savectx)
        movl    sp@(4),a1
  */
 ENTRY(savectx)
        movl    sp@(4),a1
@@ -1478,6 +1712,13 @@ ENTRY(suiword)
        movsl   d0,a0@                  | do write to user space
        nop
        moveq   #0,d0                   | indicate no fault
        movsl   d0,a0@                  | do write to user space
        nop
        moveq   #0,d0                   | indicate no fault
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lsuicpurge              | no, skip
+       .word   0xf498                  | cinva ic (XXX overkill)
+       jra     Lfsdone
+Lsuicpurge:
+#endif
        movl    #IC_CLEAR,d1
        movc    d1,cacr                 | invalidate i-cache
        jra     Lfsdone
        movl    #IC_CLEAR,d1
        movc    d1,cacr                 | invalidate i-cache
        jra     Lfsdone
@@ -1523,11 +1764,46 @@ ENTRY(subyte)
        moveq   #0,d0                   | indicate no fault
        jra     Lfsdone
 
        moveq   #0,d0                   | indicate no fault
        jra     Lfsdone
 
+#if defined(LUNA2)
+ENTRY(suline)
+       movl    sp@(4),a0               | address to write
+       movl    _curpcb,a1              | current pcb
+       movl    #Lslerr,a1@(PCB_ONFAULT) | where to return to on a fault
+       movl    sp@(8),a1               | address of line
+       movl    a1@+,d0                 | get lword
+       movsl   d0,a0@+                 | put lword
+       nop                             | sync
+       movl    a1@+,d0                 | get lword
+       movsl   d0,a0@+                 | put lword
+       nop                             | sync
+       movl    a1@+,d0                 | get lword
+       movsl   d0,a0@+                 | put lword
+       nop                             | sync
+       movl    a1@+,d0                 | get lword
+       movsl   d0,a0@+                 | put lword
+       nop                             | sync
+       moveq   #0,d0                   | indicate no fault
+       jra     Lsldone
+Lslerr:
+       moveq   #-1,d0
+Lsldone:
+       movl    _curpcb,a1              | current pcb
+       clrl    a1@(PCB_ONFAULT)        | clear fault address
+       rts
+#endif
+
 /*
  * Invalidate entire TLB.
  */
 ENTRY(TBIA)
 __TBIA:
 /*
  * Invalidate entire TLB.
  */
 ENTRY(TBIA)
 __TBIA:
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lmotommu3               | no, skip
+       .word   0xf518                  | yes, pflusha
+       rts
+Lmotommu3:
+#endif
        pflusha                         | flush entire TLB
        movl    #DC_CLEAR,d0
        movc    d0,cacr                 | invalidate on-chip d-cache
        pflusha                         | flush entire TLB
        movl    #DC_CLEAR,d0
        movc    d0,cacr                 | invalidate on-chip d-cache
@@ -1541,7 +1817,21 @@ ENTRY(TBIS)
        tstl    fulltflush              | being conservative?
        jne     __TBIA                  | yes, flush entire TLB
 #endif
        tstl    fulltflush              | being conservative?
        jne     __TBIA                  | yes, flush entire TLB
 #endif
-
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lmotommu4               | no, skip
+       movl    sp@(4),a0
+       movc    dfc,d1
+       moveq   #1,d0                   | user space
+       movc    d0,dfc
+       .word   0xf508                  | pflush a0@
+       moveq   #5,d0                   | super space
+       movc    d0,dfc
+       .word   0xf508                  | pflush a0@
+       movc    d1,dfc
+       rts
+Lmotommu4:
+#endif
        movl    sp@(4),a0               | get addr to flush
        pflush  #0,#0,a0@               | flush address from both sides
        movl    #DC_CLEAR,d0
        movl    sp@(4),a0               | get addr to flush
        pflush  #0,#0,a0@               | flush address from both sides
        movl    #DC_CLEAR,d0
@@ -1555,6 +1845,13 @@ ENTRY(TBIAS)
 #ifdef DEBUG
        tstl    fulltflush              | being conservative?
        jne     __TBIA                  | yes, flush everything
 #ifdef DEBUG
        tstl    fulltflush              | being conservative?
        jne     __TBIA                  | yes, flush everything
+#endif
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lmotommu5               | no, skip
+       .word   0xf518                  | yes, pflusha (for now) XXX
+       rts
+Lmotommu5:
 #endif
        pflush #4,#4                    | flush supervisor TLB entries
        movl    #DC_CLEAR,d0
 #endif
        pflush #4,#4                    | flush supervisor TLB entries
        movl    #DC_CLEAR,d0
@@ -1568,6 +1865,13 @@ ENTRY(TBIAU)
 #ifdef DEBUG
        tstl    fulltflush              | being conservative?
        jne     __TBIA                  | yes, flush everything
 #ifdef DEBUG
        tstl    fulltflush              | being conservative?
        jne     __TBIA                  | yes, flush everything
+#endif
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     Lmotommu6               | no, skip
+       .word   0xf518                  | yes, pflusha (for now) XXX
+       rts
+Lmotommu6:
 #endif
        pflush  #0,#4                   | flush user TLB entries
        movl    #DC_CLEAR,d0
 #endif
        pflush  #0,#4                   | flush user TLB entries
        movl    #DC_CLEAR,d0
@@ -1578,15 +1882,110 @@ ENTRY(TBIAU)
  * Invalidate instruction cache
  */
 ENTRY(ICIA)
  * Invalidate instruction cache
  */
 ENTRY(ICIA)
+#if defined(LUNA2)
+ENTRY(ICPA)
+       cmpl    #-2,_mmutype            | 68040
+       jne     Lmotommu7               | no, skip
+       .word   0xf498                  | cinva ic
+       rts
+Lmotommu7:
+#endif
        movl    #IC_CLEAR,d0
        movc    d0,cacr                 | invalidate i-cache
        rts
 
        movl    #IC_CLEAR,d0
        movc    d0,cacr                 | invalidate i-cache
        rts
 
+/*
+ * Invalidate data cache.
+ * NOTE: we do not flush 68030 on-chip cache as there are no aliasing
+ * problems with DC_WA.  The only cases we have to worry about are context
+ * switch and TLB changes, both of which are handled "in-line" in resume
+ * and TBI*.
+ */
+ENTRY(DCIA)
+__DCIA:
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040
+       jne     Lmotommu8               | no, skip
+       /* XXX implement */
+       rts
+Lmotommu8:
+#endif
+       rts
+
+ENTRY(DCIS)
+__DCIS:
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040
+       jne     Lmotommu9               | no, skip
+       /* XXX implement */
+       rts
+Lmotommu9:
+#endif
+       rts
+
+ENTRY(DCIU)
+__DCIU:
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040
+       jne     LmotommuA               | no, skip
+       /* XXX implement */
+       rts
+LmotommuA:
+#endif
+       rts
+
+#if defined(LUNA2)
+ENTRY(ICPL)
+       movl    sp@(4),a0               | address
+       .word   0xf488                  | cinvl ic,a0@
+       rts
+ENTRY(ICPP)
+       movl    sp@(4),a0               | address
+       .word   0xf490                  | cinvp ic,a0@
+       rts
+ENTRY(DCPL)
+       movl    sp@(4),a0               | address
+       .word   0xf448                  | cinvl dc,a0@
+       rts
+ENTRY(DCPP)
+       movl    sp@(4),a0               | address
+       .word   0xf450                  | cinvp dc,a0@
+       rts
+ENTRY(DCPA)
+       .word   0xf458                  | cinva dc
+       rts
+ENTRY(DCFL)
+       movl    sp@(4),a0               | address
+       .word   0xf468                  | cpushl dc,a0@
+       rts
+ENTRY(DCFP)
+       movl    sp@(4),a0               | address
+       .word   0xf470                  | cpushp dc,a0@
+       rts
+#endif
+
 ENTRY(PCIA)
 ENTRY(PCIA)
+#if defined(LUNA2)
+ENTRY(DCFA)
+       cmpl    #-2,_mmutype            | 68040
+       jne     LmotommuB               | no, skip
+       .word   0xf478                  | cpusha dc
+       rts
+LmotommuB:
+#endif
        movl    #DC_CLEAR,d0
        movc    d0,cacr                 | invalidate on-chip d-cache
        rts
 
        movl    #DC_CLEAR,d0
        movc    d0,cacr                 | invalidate on-chip d-cache
        rts
 
+#if 0 /****************************************************************/
+/* external cache control */
+ENTRY(ecacheon)
+       rts
+
+ENTRY(ecacheoff)
+       rts
+#endif /****************************************************************/
+
 /*
  * Get callers current SP value.
  * Note that simply taking the address of a local variable in a C function
 /*
  * Get callers current SP value.
  * Note that simply taking the address of a local variable in a C function
@@ -1614,6 +2013,13 @@ ENTRY(loadustp)
        movl    sp@(4),d0               | new USTP
        moveq   #PGSHIFT,d1
        lsll    d1,d0                   | convert to addr
        movl    sp@(4),d0               | new USTP
        moveq   #PGSHIFT,d1
        lsll    d1,d0                   | convert to addr
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     LmotommuC               | no, skip
+       .long   0x4e7b0806              | movc d0,urp
+       rts
+LmotommuC:
+#endif
        lea     _protorp,a0             | CRP prototype
        movl    d0,a0@(4)               | stash USTP
        pmove   a0@,crp                 | load root pointer
        lea     _protorp,a0             | CRP prototype
        movl    d0,a0@(4)               | stash USTP
        pmove   a0@,crp                 | load root pointer
@@ -1962,6 +2368,30 @@ _fpvec:  movl    a0,a2@(FLINE_VEC)       | restore vectors
 _doboot:
        movl    #0x41000004,a0
        movl    a0@,a1                  | get PROM restart entry address
 _doboot:
        movl    #0x41000004,a0
        movl    a0@,a1                  | get PROM restart entry address
+#if defined(LUNA2)
+       cmpl    #-2,_mmutype            | 68040?
+       jne     LmotommuF               | no, skip
+
+       movw    #PSL_HIGHIPL,sr         | no interrupts
+
+       movl    #0x41000000,a0
+       movl    a0@,d0
+       movc    d0,isp                  | set ISP
+
+       .word   0xf4f8                  | cpusha bc
+       movl    #0,d0
+       movc    d0,cacr                 | caches off
+       movql   #0,d0
+       .long   0x4e7b0004              | movc d0,itt0
+       .long   0x4e7b0005              | movc d0,itt1
+       .long   0x4e7b0006              | movc d0,dtt0
+       .long   0x4e7b0007              | movc d0,dtt1
+
+       .long   0x4e7b0003              | movc d0,tc
+
+       jmp     a1@                     | goto REBOOT
+LmotommuF:
+#endif
        movl    #CACHE_OFF,d0
        movc    d0,cacr                 | disable on-chip cache(s)
        movl    #_tcroff,a0             | value for pmove to TC (turn off MMU)
        movl    #CACHE_OFF,d0
        movc    d0,cacr                 | disable on-chip cache(s)
        movl    #_tcroff,a0             | value for pmove to TC (turn off MMU)
@@ -1969,13 +2399,20 @@ _doboot:
        jmp     a1@                     | goto REBOOT
 
        .data
        jmp     a1@                     | goto REBOOT
 
        .data
+       .globl  _machineid,_mmutype
+_machineid:
+       .long   1               | default to LUNA-I
+_mmutype:
+       .long   -1              | default to 68030 PMMU
        .globl  _protorp,_protott0,_protott1
 _protorp:
        .long   0,0             | prototype root pointer
 _protott0:
        .globl  _protorp,_protott0,_protott1
 _protorp:
        .long   0,0             | prototype root pointer
 _protott0:
-       .long   0x807F8543      | prototype tt0 register (for kernel)
+       .long   0x403f8543      | tt0 (for LUNA1 kernel 0x40000000-0x7fffffff)
 _protott1:
 _protott1:
-       .long   0               | prototype tt0 register (for user)
+       .long   0x807F8543      | tt1 (for LUNA1 kernel 0x80000000-0xffffffff)
+_mapping_tc:
+       .long   0
        .globl  _cold
 _cold:
        .long   1               | cold start flag
        .globl  _cold
 _cold:
        .long   1               | cold start flag
@@ -2001,6 +2438,9 @@ _clock_on:
        .globl  _dipswitch
 _dipswitch:
        .word   0               | dipsw(front panel) value
        .globl  _dipswitch
 _dipswitch:
        .word   0               | dipsw(front panel) value
+       .globl  _KernInter
+_KernInter:                    | Kernel InterFace Field
+       .space  KIFF_SIZE
 #ifdef DEBUG
        .globl  fulltflush, fullcflush
 fulltflush:
 #ifdef DEBUG
        .globl  fulltflush, fullcflush
 fulltflush:
@@ -2008,6 +2448,27 @@ fulltflush:
 fullcflush:
        .long   0
 #endif
 fullcflush:
        .long   0
 #endif
+#ifdef HPFPLIB
+/*
+ * Undefined symbols from hpux_float.o:
+ *
+ * kdb_printf: A kernel debugger print routine, we just use printf instead.
+ * processor:  HP-UX equiv. of machineid, set to 3 if it is a 68040.
+ * u:          Ye ole u-area.  The code wants to grab the first longword
+ *             indirect off of that and clear the 0x40000 bit there.
+ *             Oddly enough this was incorrect even in HP-UX!
+ * runrun:     Old name for want_resched.
+ */
+       .globl  _kdb_printf,_processor,_u,_runrun
+_kdb_printf:
+       .long   _printf
+_processor:
+       .long   0
+_u:
+       .long   .+4
+       .long   0
+       .set    _runrun,_want_resched
+#endif
 /* interrupt counters */
        .globl  _intrcnt,_eintrcnt,_intrnames,_eintrnames
 _intrnames:
 /* interrupt counters */
        .globl  _intrcnt,_eintrcnt,_intrnames,_eintrnames
 _intrnames:
Continuous source code history from original PDP-7 UNIX to FreeBSD 2, the first fully unencumbered FreeBSD release.