 f1a1b63529
			
		
	
	
	f1a1b63529
	
	
	
		
			
			My enhancement to store the initial mapping size for later reuse in commit
486df8bc46 ("m68k: Increase initial mapping
to 8 or 16 MiB if possible") broke booting on machines where RAM doesn't
start at address zero.
Use pc-relative addressing to fix this.
Reported-by: Andreas Schwab <schwab@linux-m68k.org>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
Tested-by: Andreas Schwab <schwab@linux-m68k.org>
		
	
			
		
			
				
	
	
		
			3867 lines
		
	
	
	
		
			88 KiB
			
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			3867 lines
		
	
	
	
		
			88 KiB
			
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| /* -*- mode: asm -*-
 | |
| **
 | |
| ** head.S -- This file contains the initial boot code for the
 | |
| **	     Linux/68k kernel.
 | |
| **
 | |
| ** Copyright 1993 by Hamish Macdonald
 | |
| **
 | |
| ** 68040 fixes by Michael Rausch
 | |
| ** 68060 fixes by Roman Hodek
 | |
| ** MMU cleanup by Randy Thelen
 | |
| ** Final MMU cleanup by Roman Zippel
 | |
| **
 | |
| ** Atari support by Andreas Schwab, using ideas of Robert de Vries
 | |
| ** and Bjoern Brauel
 | |
| ** VME Support by Richard Hirst
 | |
| **
 | |
| ** 94/11/14 Andreas Schwab: put kernel at PAGESIZE
 | |
| ** 94/11/18 Andreas Schwab: remove identity mapping of STRAM for Atari
 | |
| ** ++ Bjoern & Roman: ATARI-68040 support for the Medusa
 | |
| ** 95/11/18 Richard Hirst: Added MVME166 support
 | |
| ** 96/04/26 Guenther Kelleter: fixed identity mapping for Falcon with
 | |
| **			      Magnum- and FX-alternate ram
 | |
| ** 98/04/25 Phil Blundell: added HP300 support
 | |
| ** 1998/08/30 David Kilzer: Added support for font_desc structures
 | |
| **            for linux-2.1.115
 | |
| ** 1999/02/11  Richard Zidlicky: added Q40 support (initial version 99/01/01)
 | |
| ** 2004/05/13 Kars de Jong: Finalised HP300 support
 | |
| **
 | |
| ** This file is subject to the terms and conditions of the GNU General Public
 | |
| ** License. See the file README.legal in the main directory of this archive
 | |
| ** for more details.
 | |
| **
 | |
| */
 | |
| 
 | |
| /*
 | |
|  * Linux startup code.
 | |
|  *
 | |
|  * At this point, the boot loader has:
 | |
|  * Disabled interrupts
 | |
|  * Disabled caches
 | |
|  * Put us in supervisor state.
 | |
|  *
 | |
|  * The kernel setup code takes the following steps:
 | |
|  * .  Raise interrupt level
 | |
|  * .  Set up initial kernel memory mapping.
 | |
|  *    .  This sets up a mapping of the 4M of memory the kernel is located in.
 | |
|  *    .  It also does a mapping of any initial machine specific areas.
 | |
|  * .  Enable the MMU
 | |
|  * .  Enable cache memories
 | |
|  * .  Jump to kernel startup
 | |
|  *
 | |
|  * Much of the file restructuring was to accomplish:
 | |
|  * 1) Remove register dependency through-out the file.
 | |
|  * 2) Increase use of subroutines to perform functions
 | |
|  * 3) Increase readability of the code
 | |
|  *
 | |
|  * Of course, readability is a subjective issue, so it will never be
 | |
|  * argued that that goal was accomplished.  It was merely a goal.
 | |
|  * A key way to help make code more readable is to give good
 | |
|  * documentation.  So, the first thing you will find is exaustive
 | |
|  * write-ups on the structure of the file, and the features of the
 | |
|  * functional subroutines.
 | |
|  *
 | |
|  * General Structure:
 | |
|  * ------------------
 | |
|  *	Without a doubt the single largest chunk of head.S is spent
 | |
|  * mapping the kernel and I/O physical space into the logical range
 | |
|  * for the kernel.
 | |
|  *	There are new subroutines and data structures to make MMU
 | |
|  * support cleaner and easier to understand.
 | |
|  *	First, you will find a routine call "mmu_map" which maps
 | |
|  * a logical to a physical region for some length given a cache
 | |
|  * type on behalf of the caller.  This routine makes writing the
 | |
|  * actual per-machine specific code very simple.
 | |
|  *	A central part of the code, but not a subroutine in itself,
 | |
|  * is the mmu_init code which is broken down into mapping the kernel
 | |
|  * (the same for all machines) and mapping machine-specific I/O
 | |
|  * regions.
 | |
|  *	Also, there will be a description of engaging the MMU and
 | |
|  * caches.
 | |
|  *	You will notice that there is a chunk of code which
 | |
|  * can emit the entire MMU mapping of the machine.  This is present
 | |
|  * only in debug modes and can be very helpful.
 | |
|  *	Further, there is a new console driver in head.S that is
 | |
|  * also only engaged in debug mode.  Currently, it's only supported
 | |
|  * on the Macintosh class of machines.  However, it is hoped that
 | |
|  * others will plug-in support for specific machines.
 | |
|  *
 | |
|  * ######################################################################
 | |
|  *
 | |
|  * mmu_map
 | |
|  * -------
 | |
|  *	mmu_map was written for two key reasons.  First, it was clear
 | |
|  * that it was very difficult to read the previous code for mapping
 | |
|  * regions of memory.  Second, the Macintosh required such extensive
 | |
|  * memory allocations that it didn't make sense to propagate the
 | |
|  * existing code any further.
 | |
|  *	mmu_map requires some parameters:
 | |
|  *
 | |
|  *	mmu_map (logical, physical, length, cache_type)
 | |
|  *
 | |
|  *	While this essentially describes the function in the abstract, you'll
 | |
|  * find more indepth description of other parameters at the implementation site.
 | |
|  *
 | |
|  * mmu_get_root_table_entry
 | |
|  * ------------------------
 | |
|  * mmu_get_ptr_table_entry
 | |
|  * -----------------------
 | |
|  * mmu_get_page_table_entry
 | |
|  * ------------------------
 | |
|  *
 | |
|  *	These routines are used by other mmu routines to get a pointer into
 | |
|  * a table, if necessary a new table is allocated. These routines are working
 | |
|  * basically like pmd_alloc() and pte_alloc() in <asm/pgtable.h>. The root
 | |
|  * table needs of course only to be allocated once in mmu_get_root_table_entry,
 | |
|  * so that here also some mmu specific initialization is done. The second page
 | |
|  * at the start of the kernel (the first page is unmapped later) is used for
 | |
|  * the kernel_pg_dir. It must be at a position known at link time (as it's used
 | |
|  * to initialize the init task struct) and since it needs special cache
 | |
|  * settings, it's the easiest to use this page, the rest of the page is used
 | |
|  * for further pointer tables.
 | |
|  * mmu_get_page_table_entry allocates always a whole page for page tables, this
 | |
|  * means 1024 pages and so 4MB of memory can be mapped. It doesn't make sense
 | |
|  * to manage page tables in smaller pieces as nearly all mappings have that
 | |
|  * size.
 | |
|  *
 | |
|  * ######################################################################
 | |
|  *
 | |
|  *
 | |
|  * ######################################################################
 | |
|  *
 | |
|  * mmu_engage
 | |
|  * ----------
 | |
|  *	Thanks to a small helping routine enabling the mmu got quite simple
 | |
|  * and there is only one way left. mmu_engage makes a complete a new mapping
 | |
|  * that only includes the absolute necessary to be able to jump to the final
 | |
|  * position and to restore the original mapping.
 | |
|  * As this code doesn't need a transparent translation register anymore this
 | |
|  * means all registers are free to be used by machines that needs them for
 | |
|  * other purposes.
 | |
|  *
 | |
|  * ######################################################################
 | |
|  *
 | |
|  * mmu_print
 | |
|  * ---------
 | |
|  *	This algorithm will print out the page tables of the system as
 | |
|  * appropriate for an 030 or an 040.  This is useful for debugging purposes
 | |
|  * and as such is enclosed in #ifdef MMU_PRINT/#endif clauses.
 | |
|  *
 | |
|  * ######################################################################
 | |
|  *
 | |
|  * console_init
 | |
|  * ------------
 | |
|  *	The console is also able to be turned off.  The console in head.S
 | |
|  * is specifically for debugging and can be very useful.  It is surrounded by
 | |
|  * #ifdef / #endif clauses so it doesn't have to ship in known-good
 | |
|  * kernels.  It's basic algorithm is to determine the size of the screen
 | |
|  * (in height/width and bit depth) and then use that information for
 | |
|  * displaying an 8x8 font or an 8x16 (widthxheight).  I prefer the 8x8 for
 | |
|  * debugging so I can see more good data.  But it was trivial to add support
 | |
|  * for both fonts, so I included it.
 | |
|  *	Also, the algorithm for plotting pixels is abstracted so that in
 | |
|  * theory other platforms could add support for different kinds of frame
 | |
|  * buffers.  This could be very useful.
 | |
|  *
 | |
|  * console_put_penguin
 | |
|  * -------------------
 | |
|  *	An important part of any Linux bring up is the penguin and there's
 | |
|  * nothing like getting the Penguin on the screen!  This algorithm will work
 | |
|  * on any machine for which there is a console_plot_pixel.
 | |
|  *
 | |
|  * console_scroll
 | |
|  * --------------
 | |
|  *	My hope is that the scroll algorithm does the right thing on the
 | |
|  * various platforms, but it wouldn't be hard to add the test conditions
 | |
|  * and new code if it doesn't.
 | |
|  *
 | |
|  * console_putc
 | |
|  * -------------
 | |
|  *
 | |
|  * ######################################################################
 | |
|  *
 | |
|  *	Register usage has greatly simplified within head.S. Every subroutine
 | |
|  * saves and restores all registers that it modifies (except it returns a
 | |
|  * value in there of course). So the only register that needs to be initialized
 | |
|  * is the stack pointer.
 | |
|  * All other init code and data is now placed in the init section, so it will
 | |
|  * be automatically freed at the end of the kernel initialization.
 | |
|  *
 | |
|  * ######################################################################
 | |
|  *
 | |
|  * options
 | |
|  * -------
 | |
|  *	There are many options available in a build of this file.  I've
 | |
|  * taken the time to describe them here to save you the time of searching
 | |
|  * for them and trying to understand what they mean.
 | |
|  *
 | |
|  * CONFIG_xxx:	These are the obvious machine configuration defines created
 | |
|  * during configuration.  These are defined in autoconf.h.
 | |
|  *
 | |
|  * CONSOLE_DEBUG:  Only supports a Mac frame buffer but could easily be
 | |
|  * extended to support other platforms.
 | |
|  *
 | |
|  * TEST_MMU:	This is a test harness for running on any given machine but
 | |
|  * getting an MMU dump for another class of machine.  The classes of machines
 | |
|  * that can be tested are any of the makes (Atari, Amiga, Mac, VME, etc.)
 | |
|  * and any of the models (030, 040, 060, etc.).
 | |
|  *
 | |
|  *	NOTE:	TEST_MMU is NOT permanent!  It is scheduled to be removed
 | |
|  *		When head.S boots on Atari, Amiga, Macintosh, and VME
 | |
|  *		machines.  At that point the underlying logic will be
 | |
|  *		believed to be solid enough to be trusted, and TEST_MMU
 | |
|  *		can be dropped.  Do note that that will clean up the
 | |
|  *		head.S code significantly as large blocks of #if/#else
 | |
|  *		clauses can be removed.
 | |
|  *
 | |
|  * MMU_NOCACHE_KERNEL:	On the Macintosh platform there was an inquiry into
 | |
|  * determing why devices don't appear to work.  A test case was to remove
 | |
|  * the cacheability of the kernel bits.
 | |
|  *
 | |
|  * MMU_PRINT:	There is a routine built into head.S that can display the
 | |
|  * MMU data structures.  It outputs its result through the serial_putc
 | |
|  * interface.  So where ever that winds up driving data, that's where the
 | |
|  * mmu struct will appear.
 | |
|  *
 | |
|  * SERIAL_DEBUG:	There are a series of putc() macro statements
 | |
|  * scattered through out the code to give progress of status to the
 | |
|  * person sitting at the console.  This constant determines whether those
 | |
|  * are used.
 | |
|  *
 | |
|  * DEBUG:	This is the standard DEBUG flag that can be set for building
 | |
|  *		the kernel.  It has the effect adding additional tests into
 | |
|  *		the code.
 | |
|  *
 | |
|  * FONT_6x11:
 | |
|  * FONT_8x8:
 | |
|  * FONT_8x16:
 | |
|  *		In theory these could be determined at run time or handed
 | |
|  *		over by the booter.  But, let's be real, it's a fine hard
 | |
|  *		coded value.  (But, you will notice the code is run-time
 | |
|  *		flexible!)  A pointer to the font's struct font_desc
 | |
|  *		is kept locally in Lconsole_font.  It is used to determine
 | |
|  *		font size information dynamically.
 | |
|  *
 | |
|  * Atari constants:
 | |
|  * USE_PRINTER:	Use the printer port for serial debug.
 | |
|  * USE_SCC_B:	Use the SCC port A (Serial2) for serial debug.
 | |
|  * USE_SCC_A:	Use the SCC port B (Modem2) for serial debug.
 | |
|  * USE_MFP:	Use the ST-MFP port (Modem1) for serial debug.
 | |
|  *
 | |
|  * Macintosh constants:
 | |
|  * MAC_USE_SCC_A: Use SCC port A (modem) for serial debug.
 | |
|  * MAC_USE_SCC_B: Use SCC port B (printer) for serial debug.
 | |
|  */
 | |
| 
 | |
| #include <linux/linkage.h>
 | |
| #include <linux/init.h>
 | |
| #include <asm/bootinfo.h>
 | |
| #include <asm/bootinfo-amiga.h>
 | |
| #include <asm/bootinfo-atari.h>
 | |
| #include <asm/bootinfo-hp300.h>
 | |
| #include <asm/bootinfo-mac.h>
 | |
| #include <asm/bootinfo-q40.h>
 | |
| #include <asm/bootinfo-vme.h>
 | |
| #include <asm/setup.h>
 | |
| #include <asm/entry.h>
 | |
| #include <asm/pgtable.h>
 | |
| #include <asm/page.h>
 | |
| #include <asm/asm-offsets.h>
 | |
| #ifdef CONFIG_MAC
 | |
| #  include <asm/machw.h>
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_EARLY_PRINTK
 | |
| #  define SERIAL_DEBUG
 | |
| #  if defined(CONFIG_MAC) && defined(CONFIG_FONT_SUPPORT)
 | |
| #    define CONSOLE_DEBUG
 | |
| #  endif
 | |
| #endif
 | |
| 
 | |
| #undef MMU_PRINT
 | |
| #undef MMU_NOCACHE_KERNEL
 | |
| #undef DEBUG
 | |
| 
 | |
| /*
 | |
|  * For the head.S console, there are three supported fonts, 6x11, 8x16 and 8x8.
 | |
|  * The 8x8 font is harder to read but fits more on the screen.
 | |
|  */
 | |
| #define FONT_8x8	/* default */
 | |
| /* #define FONT_8x16 */	/* 2nd choice */
 | |
| /* #define FONT_6x11 */	/* 3rd choice */
 | |
| 
 | |
| .globl kernel_pg_dir
 | |
| .globl availmem
 | |
| .globl m68k_init_mapped_size
 | |
| .globl m68k_pgtable_cachemode
 | |
| .globl m68k_supervisor_cachemode
 | |
| #ifdef CONFIG_MVME16x
 | |
| .globl mvme_bdid
 | |
| #endif
 | |
| #ifdef CONFIG_Q40
 | |
| .globl q40_mem_cptr
 | |
| #endif
 | |
| 
 | |
| CPUTYPE_040	= 1	/* indicates an 040 */
 | |
| CPUTYPE_060	= 2	/* indicates an 060 */
 | |
| CPUTYPE_0460	= 3	/* if either above are set, this is set */
 | |
| CPUTYPE_020	= 4	/* indicates an 020 */
 | |
| 
 | |
| /* Translation control register */
 | |
| TC_ENABLE = 0x8000
 | |
| TC_PAGE8K = 0x4000
 | |
| TC_PAGE4K = 0x0000
 | |
| 
 | |
| /* Transparent translation registers */
 | |
| TTR_ENABLE	= 0x8000	/* enable transparent translation */
 | |
| TTR_ANYMODE	= 0x4000	/* user and kernel mode access */
 | |
| TTR_KERNELMODE	= 0x2000	/* only kernel mode access */
 | |
| TTR_USERMODE	= 0x0000	/* only user mode access */
 | |
| TTR_CI		= 0x0400	/* inhibit cache */
 | |
| TTR_RW		= 0x0200	/* read/write mode */
 | |
| TTR_RWM		= 0x0100	/* read/write mask */
 | |
| TTR_FCB2	= 0x0040	/* function code base bit 2 */
 | |
| TTR_FCB1	= 0x0020	/* function code base bit 1 */
 | |
| TTR_FCB0	= 0x0010	/* function code base bit 0 */
 | |
| TTR_FCM2	= 0x0004	/* function code mask bit 2 */
 | |
| TTR_FCM1	= 0x0002	/* function code mask bit 1 */
 | |
| TTR_FCM0	= 0x0001	/* function code mask bit 0 */
 | |
| 
 | |
| /* Cache Control registers */
 | |
| CC6_ENABLE_D	= 0x80000000	/* enable data cache (680[46]0) */
 | |
| CC6_FREEZE_D	= 0x40000000	/* freeze data cache (68060) */
 | |
| CC6_ENABLE_SB	= 0x20000000	/* enable store buffer (68060) */
 | |
| CC6_PUSH_DPI	= 0x10000000	/* disable CPUSH invalidation (68060) */
 | |
| CC6_HALF_D	= 0x08000000	/* half-cache mode for data cache (68060) */
 | |
| CC6_ENABLE_B	= 0x00800000	/* enable branch cache (68060) */
 | |
| CC6_CLRA_B	= 0x00400000	/* clear all entries in branch cache (68060) */
 | |
| CC6_CLRU_B	= 0x00200000	/* clear user entries in branch cache (68060) */
 | |
| CC6_ENABLE_I	= 0x00008000	/* enable instruction cache (680[46]0) */
 | |
| CC6_FREEZE_I	= 0x00004000	/* freeze instruction cache (68060) */
 | |
| CC6_HALF_I	= 0x00002000	/* half-cache mode for instruction cache (68060) */
 | |
| CC3_ALLOC_WRITE	= 0x00002000	/* write allocate mode(68030) */
 | |
| CC3_ENABLE_DB	= 0x00001000	/* enable data burst (68030) */
 | |
| CC3_CLR_D	= 0x00000800	/* clear data cache (68030) */
 | |
| CC3_CLRE_D	= 0x00000400	/* clear entry in data cache (68030) */
 | |
| CC3_FREEZE_D	= 0x00000200	/* freeze data cache (68030) */
 | |
| CC3_ENABLE_D	= 0x00000100	/* enable data cache (68030) */
 | |
| CC3_ENABLE_IB	= 0x00000010	/* enable instruction burst (68030) */
 | |
| CC3_CLR_I	= 0x00000008	/* clear instruction cache (68030) */
 | |
| CC3_CLRE_I	= 0x00000004	/* clear entry in instruction cache (68030) */
 | |
| CC3_FREEZE_I	= 0x00000002	/* freeze instruction cache (68030) */
 | |
| CC3_ENABLE_I	= 0x00000001	/* enable instruction cache (68030) */
 | |
| 
 | |
| /* Miscellaneous definitions */
 | |
| PAGESIZE	= 4096
 | |
| PAGESHIFT	= 12
 | |
| 
 | |
| ROOT_TABLE_SIZE	= 128
 | |
| PTR_TABLE_SIZE	= 128
 | |
| PAGE_TABLE_SIZE	= 64
 | |
| ROOT_INDEX_SHIFT = 25
 | |
| PTR_INDEX_SHIFT  = 18
 | |
| PAGE_INDEX_SHIFT = 12
 | |
| 
 | |
| #ifdef DEBUG
 | |
| /* When debugging use readable names for labels */
 | |
| #ifdef __STDC__
 | |
| #define L(name) .head.S.##name
 | |
| #else
 | |
| #define L(name) .head.S./**/name
 | |
| #endif
 | |
| #else
 | |
| #ifdef __STDC__
 | |
| #define L(name) .L##name
 | |
| #else
 | |
| #define L(name) .L/**/name
 | |
| #endif
 | |
| #endif
 | |
| 
 | |
| /* The __INITDATA stuff is a no-op when ftrace or kgdb are turned on */
 | |
| #ifndef __INITDATA
 | |
| #define __INITDATA	.data
 | |
| #define __FINIT		.previous
 | |
| #endif
 | |
| 
 | |
| /* Several macros to make the writing of subroutines easier:
 | |
|  * - func_start marks the beginning of the routine which setups the frame
 | |
|  *   register and saves the registers, it also defines another macro
 | |
|  *   to automatically restore the registers again.
 | |
|  * - func_return marks the end of the routine and simply calls the prepared
 | |
|  *   macro to restore registers and jump back to the caller.
 | |
|  * - func_define generates another macro to automatically put arguments
 | |
|  *   onto the stack call the subroutine and cleanup the stack again.
 | |
|  */
 | |
| 
 | |
| /* Within subroutines these macros can be used to access the arguments
 | |
|  * on the stack. With STACK some allocated memory on the stack can be
 | |
|  * accessed and ARG0 points to the return address (used by mmu_engage).
 | |
|  */
 | |
| #define	STACK	%a6@(stackstart)
 | |
| #define ARG0	%a6@(4)
 | |
| #define ARG1	%a6@(8)
 | |
| #define ARG2	%a6@(12)
 | |
| #define ARG3	%a6@(16)
 | |
| #define ARG4	%a6@(20)
 | |
| 
 | |
| .macro	func_start	name,saveregs,stack=0
 | |
| L(\name):
 | |
| 	linkw	%a6,#-\stack
 | |
| 	moveml	\saveregs,%sp@-
 | |
| .set	stackstart,-\stack
 | |
| 
 | |
| .macro	func_return_\name
 | |
| 	moveml	%sp@+,\saveregs
 | |
| 	unlk	%a6
 | |
| 	rts
 | |
| .endm
 | |
| .endm
 | |
| 
 | |
| .macro	func_return	name
 | |
| 	func_return_\name
 | |
| .endm
 | |
| 
 | |
| .macro	func_call	name
 | |
| 	jbsr	L(\name)
 | |
| .endm
 | |
| 
 | |
| .macro	move_stack	nr,arg1,arg2,arg3,arg4
 | |
| .if	\nr
 | |
| 	move_stack	"(\nr-1)",\arg2,\arg3,\arg4
 | |
| 	movel	\arg1,%sp@-
 | |
| .endif
 | |
| .endm
 | |
| 
 | |
| .macro	func_define	name,nr=0
 | |
| .macro	\name	arg1,arg2,arg3,arg4
 | |
| 	move_stack	\nr,\arg1,\arg2,\arg3,\arg4
 | |
| 	func_call	\name
 | |
| .if	\nr
 | |
| 	lea	%sp@(\nr*4),%sp
 | |
| .endif
 | |
| .endm
 | |
| .endm
 | |
| 
 | |
| func_define	mmu_map,4
 | |
| func_define	mmu_map_tt,4
 | |
| func_define	mmu_fixup_page_mmu_cache,1
 | |
| func_define	mmu_temp_map,2
 | |
| func_define	mmu_engage
 | |
| func_define	mmu_get_root_table_entry,1
 | |
| func_define	mmu_get_ptr_table_entry,2
 | |
| func_define	mmu_get_page_table_entry,2
 | |
| func_define	mmu_print
 | |
| func_define	get_new_page
 | |
| #if defined(CONFIG_HP300) || defined(CONFIG_APOLLO)
 | |
| func_define	set_leds
 | |
| #endif
 | |
| 
 | |
| .macro	mmu_map_eq	arg1,arg2,arg3
 | |
| 	mmu_map	\arg1,\arg1,\arg2,\arg3
 | |
| .endm
 | |
| 
 | |
| .macro	get_bi_record	record
 | |
| 	pea	\record
 | |
| 	func_call	get_bi_record
 | |
| 	addql	#4,%sp
 | |
| .endm
 | |
| 
 | |
| func_define	serial_putc,1
 | |
| func_define	console_putc,1
 | |
| 
 | |
| func_define	console_init
 | |
| func_define	console_put_penguin
 | |
| func_define	console_plot_pixel,3
 | |
| func_define	console_scroll
 | |
| 
 | |
| .macro	putc	ch
 | |
| #if defined(CONSOLE_DEBUG) || defined(SERIAL_DEBUG)
 | |
| 	pea	\ch
 | |
| #endif
 | |
| #ifdef CONSOLE_DEBUG
 | |
| 	func_call	console_putc
 | |
| #endif
 | |
| #ifdef SERIAL_DEBUG
 | |
| 	func_call	serial_putc
 | |
| #endif
 | |
| #if defined(CONSOLE_DEBUG) || defined(SERIAL_DEBUG)
 | |
| 	addql	#4,%sp
 | |
| #endif
 | |
| .endm
 | |
| 
 | |
| .macro	dputc	ch
 | |
| #ifdef DEBUG
 | |
| 	putc	\ch
 | |
| #endif
 | |
| .endm
 | |
| 
 | |
| func_define	putn,1
 | |
| 
 | |
| .macro	dputn	nr
 | |
| #ifdef DEBUG
 | |
| 	putn	\nr
 | |
| #endif
 | |
| .endm
 | |
| 
 | |
| .macro	puts		string
 | |
| #if defined(CONSOLE_DEBUG) || defined(SERIAL_DEBUG)
 | |
| 	__INITDATA
 | |
| .Lstr\@:
 | |
| 	.string	"\string"
 | |
| 	__FINIT
 | |
| 	pea	%pc@(.Lstr\@)
 | |
| 	func_call	puts
 | |
| 	addql	#4,%sp
 | |
| #endif
 | |
| .endm
 | |
| 
 | |
| .macro	dputs	string
 | |
| #ifdef DEBUG
 | |
| 	puts	"\string"
 | |
| #endif
 | |
| .endm
 | |
| 
 | |
| #define is_not_amiga(lab) cmpl &MACH_AMIGA,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_atari(lab) cmpl &MACH_ATARI,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_mac(lab) cmpl &MACH_MAC,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_mvme147(lab) cmpl &MACH_MVME147,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_mvme16x(lab) cmpl &MACH_MVME16x,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_bvme6000(lab) cmpl &MACH_BVME6000,%pc@(m68k_machtype); jne lab
 | |
| #define is_mvme147(lab) cmpl &MACH_MVME147,%pc@(m68k_machtype); jeq lab
 | |
| #define is_mvme16x(lab) cmpl &MACH_MVME16x,%pc@(m68k_machtype); jeq lab
 | |
| #define is_bvme6000(lab) cmpl &MACH_BVME6000,%pc@(m68k_machtype); jeq lab
 | |
| #define is_not_hp300(lab) cmpl &MACH_HP300,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_apollo(lab) cmpl &MACH_APOLLO,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_q40(lab) cmpl &MACH_Q40,%pc@(m68k_machtype); jne lab
 | |
| #define is_not_sun3x(lab) cmpl &MACH_SUN3X,%pc@(m68k_machtype); jne lab
 | |
| 
 | |
| #define hasnt_leds(lab) cmpl &MACH_HP300,%pc@(m68k_machtype); \
 | |
| 			jeq 42f; \
 | |
| 			cmpl &MACH_APOLLO,%pc@(m68k_machtype); \
 | |
| 			jne lab ;\
 | |
| 		42:\
 | |
| 
 | |
| #define is_040_or_060(lab)	btst &CPUTYPE_0460,%pc@(L(cputype)+3); jne lab
 | |
| #define is_not_040_or_060(lab)	btst &CPUTYPE_0460,%pc@(L(cputype)+3); jeq lab
 | |
| #define is_040(lab)		btst &CPUTYPE_040,%pc@(L(cputype)+3); jne lab
 | |
| #define is_060(lab)		btst &CPUTYPE_060,%pc@(L(cputype)+3); jne lab
 | |
| #define is_not_060(lab)		btst &CPUTYPE_060,%pc@(L(cputype)+3); jeq lab
 | |
| #define is_020(lab)		btst &CPUTYPE_020,%pc@(L(cputype)+3); jne lab
 | |
| #define is_not_020(lab)		btst &CPUTYPE_020,%pc@(L(cputype)+3); jeq lab
 | |
| 
 | |
| /* On the HP300 we use the on-board LEDs for debug output before
 | |
|    the console is running.  Writing a 1 bit turns the corresponding LED
 | |
|    _off_ - on the 340 bit 7 is towards the back panel of the machine.  */
 | |
| .macro	leds	mask
 | |
| #if defined(CONFIG_HP300) || defined(CONFIG_APOLLO)
 | |
| 	hasnt_leds(.Lled\@)
 | |
| 	pea	\mask
 | |
| 	func_call	set_leds
 | |
| 	addql	#4,%sp
 | |
| .Lled\@:
 | |
| #endif
 | |
| .endm
 | |
| 
 | |
| __HEAD
 | |
| ENTRY(_stext)
 | |
| /*
 | |
|  * Version numbers of the bootinfo interface
 | |
|  * The area from _stext to _start will later be used as kernel pointer table
 | |
|  */
 | |
| 	bras	1f	/* Jump over bootinfo version numbers */
 | |
| 
 | |
| 	.long	BOOTINFOV_MAGIC
 | |
| 	.long	MACH_AMIGA, AMIGA_BOOTI_VERSION
 | |
| 	.long	MACH_ATARI, ATARI_BOOTI_VERSION
 | |
| 	.long	MACH_MVME147, MVME147_BOOTI_VERSION
 | |
| 	.long	MACH_MVME16x, MVME16x_BOOTI_VERSION
 | |
| 	.long	MACH_BVME6000, BVME6000_BOOTI_VERSION
 | |
| 	.long	MACH_MAC, MAC_BOOTI_VERSION
 | |
| 	.long	MACH_Q40, Q40_BOOTI_VERSION
 | |
| 	.long	MACH_HP300, HP300_BOOTI_VERSION
 | |
| 	.long	0
 | |
| 1:	jra	__start
 | |
| 
 | |
| .equ	kernel_pg_dir,_stext
 | |
| 
 | |
| .equ	.,_stext+PAGESIZE
 | |
| 
 | |
| ENTRY(_start)
 | |
| 	jra	__start
 | |
| __INIT
 | |
| ENTRY(__start)
 | |
| /*
 | |
|  * Setup initial stack pointer
 | |
|  */
 | |
| 	lea	%pc@(_stext),%sp
 | |
| 
 | |
| /*
 | |
|  * Record the CPU and machine type.
 | |
|  */
 | |
| 	get_bi_record	BI_MACHTYPE
 | |
| 	lea	%pc@(m68k_machtype),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	get_bi_record	BI_FPUTYPE
 | |
| 	lea	%pc@(m68k_fputype),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	get_bi_record	BI_MMUTYPE
 | |
| 	lea	%pc@(m68k_mmutype),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	get_bi_record	BI_CPUTYPE
 | |
| 	lea	%pc@(m68k_cputype),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	leds	0x1
 | |
| 
 | |
| #ifdef CONFIG_MAC
 | |
| /*
 | |
|  * For Macintosh, we need to determine the display parameters early (at least
 | |
|  * while debugging it).
 | |
|  */
 | |
| 
 | |
| 	is_not_mac(L(test_notmac))
 | |
| 
 | |
| 	get_bi_record	BI_MAC_VADDR
 | |
| 	lea	%pc@(L(mac_videobase)),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	get_bi_record	BI_MAC_VDEPTH
 | |
| 	lea	%pc@(L(mac_videodepth)),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	get_bi_record	BI_MAC_VDIM
 | |
| 	lea	%pc@(L(mac_dimensions)),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	get_bi_record	BI_MAC_VROW
 | |
| 	lea	%pc@(L(mac_rowbytes)),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| 	get_bi_record	BI_MAC_SCCBASE
 | |
| 	lea	%pc@(L(mac_sccbase)),%a1
 | |
| 	movel	%a0@,%a1@
 | |
| 
 | |
| L(test_notmac):
 | |
| #endif /* CONFIG_MAC */
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * There are ultimately two pieces of information we want for all kinds of
 | |
|  * processors CpuType and CacheBits.  The CPUTYPE was passed in from booter
 | |
|  * and is converted here from a booter type definition to a separate bit
 | |
|  * number which allows for the standard is_0x0 macro tests.
 | |
|  */
 | |
| 	movel	%pc@(m68k_cputype),%d0
 | |
| 	/*
 | |
| 	 * Assume it's an 030
 | |
| 	 */
 | |
| 	clrl	%d1
 | |
| 
 | |
| 	/*
 | |
| 	 * Test the BootInfo cputype for 060
 | |
| 	 */
 | |
| 	btst	#CPUB_68060,%d0
 | |
| 	jeq	1f
 | |
| 	bset	#CPUTYPE_060,%d1
 | |
| 	bset	#CPUTYPE_0460,%d1
 | |
| 	jra	3f
 | |
| 1:
 | |
| 	/*
 | |
| 	 * Test the BootInfo cputype for 040
 | |
| 	 */
 | |
| 	btst	#CPUB_68040,%d0
 | |
| 	jeq	2f
 | |
| 	bset	#CPUTYPE_040,%d1
 | |
| 	bset	#CPUTYPE_0460,%d1
 | |
| 	jra	3f
 | |
| 2:
 | |
| 	/*
 | |
| 	 * Test the BootInfo cputype for 020
 | |
| 	 */
 | |
| 	btst	#CPUB_68020,%d0
 | |
| 	jeq	3f
 | |
| 	bset	#CPUTYPE_020,%d1
 | |
| 	jra	3f
 | |
| 3:
 | |
| 	/*
 | |
| 	 * Record the cpu type
 | |
| 	 */
 | |
| 	lea	%pc@(L(cputype)),%a0
 | |
| 	movel	%d1,%a0@
 | |
| 
 | |
| 	/*
 | |
| 	 * NOTE:
 | |
| 	 *
 | |
| 	 * Now the macros are valid:
 | |
| 	 *	is_040_or_060
 | |
| 	 *	is_not_040_or_060
 | |
| 	 *	is_040
 | |
| 	 *	is_060
 | |
| 	 *	is_not_060
 | |
| 	 */
 | |
| 
 | |
| 	/*
 | |
| 	 * Determine the cache mode for pages holding MMU tables
 | |
| 	 * and for supervisor mode, unused for '020 and '030
 | |
| 	 */
 | |
| 	clrl	%d0
 | |
| 	clrl	%d1
 | |
| 
 | |
| 	is_not_040_or_060(L(save_cachetype))
 | |
| 
 | |
| 	/*
 | |
| 	 * '040 or '060
 | |
| 	 * d1 := cacheable write-through
 | |
| 	 * NOTE: The 68040 manual strongly recommends non-cached for MMU tables,
 | |
| 	 * but we have been using write-through since at least 2.0.29 so I
 | |
| 	 * guess it is OK.
 | |
| 	 */
 | |
| #ifdef CONFIG_060_WRITETHROUGH
 | |
| 	/*
 | |
| 	 * If this is a 68060 board using drivers with cache coherency
 | |
| 	 * problems, then supervisor memory accesses need to be write-through
 | |
| 	 * also; otherwise, we want copyback.
 | |
| 	 */
 | |
| 
 | |
| 	is_not_060(1f)
 | |
| 	movel	#_PAGE_CACHE040W,%d0
 | |
| 	jra	L(save_cachetype)
 | |
| #endif /* CONFIG_060_WRITETHROUGH */
 | |
| 1:
 | |
| 	movew	#_PAGE_CACHE040,%d0
 | |
| 
 | |
| 	movel	#_PAGE_CACHE040W,%d1
 | |
| 
 | |
| L(save_cachetype):
 | |
| 	/* Save cache mode for supervisor mode and page tables
 | |
| 	 */
 | |
| 	lea	%pc@(m68k_supervisor_cachemode),%a0
 | |
| 	movel	%d0,%a0@
 | |
| 	lea	%pc@(m68k_pgtable_cachemode),%a0
 | |
| 	movel	%d1,%a0@
 | |
| 
 | |
| /*
 | |
|  * raise interrupt level
 | |
|  */
 | |
| 	movew	#0x2700,%sr
 | |
| 
 | |
| /*
 | |
|    If running on an Atari, determine the I/O base of the
 | |
|    serial port and test if we are running on a Medusa or Hades.
 | |
|    This test is necessary here, because on the Hades the serial
 | |
|    port is only accessible in the high I/O memory area.
 | |
| 
 | |
|    The test whether it is a Medusa is done by writing to the byte at
 | |
|    phys. 0x0. This should result in a bus error on all other machines.
 | |
| 
 | |
|    ...should, but doesn't. The Afterburner040 for the Falcon has the
 | |
|    same behaviour (0x0..0x7 are no ROM shadow). So we have to do
 | |
|    another test to distinguish Medusa and AB040. This is a
 | |
|    read attempt for 0x00ff82fe phys. that should bus error on a Falcon
 | |
|    (+AB040), but is in the range where the Medusa always asserts DTACK.
 | |
| 
 | |
|    The test for the Hades is done by reading address 0xb0000000. This
 | |
|    should give a bus error on the Medusa.
 | |
|  */
 | |
| 
 | |
| #ifdef CONFIG_ATARI
 | |
| 	is_not_atari(L(notypetest))
 | |
| 
 | |
| 	/* get special machine type (Medusa/Hades/AB40) */
 | |
| 	moveq	#0,%d3 /* default if tag doesn't exist */
 | |
| 	get_bi_record	BI_ATARI_MCH_TYPE
 | |
| 	tstl	%d0
 | |
| 	jbmi	1f
 | |
| 	movel	%a0@,%d3
 | |
| 	lea	%pc@(atari_mch_type),%a0
 | |
| 	movel	%d3,%a0@
 | |
| 1:
 | |
| 	/* On the Hades, the iobase must be set up before opening the
 | |
| 	 * serial port. There are no I/O regs at 0x00ffxxxx at all. */
 | |
| 	moveq	#0,%d0
 | |
| 	cmpl	#ATARI_MACH_HADES,%d3
 | |
| 	jbne	1f
 | |
| 	movel	#0xff000000,%d0		/* Hades I/O base addr: 0xff000000 */
 | |
| 1:	lea     %pc@(L(iobase)),%a0
 | |
| 	movel   %d0,%a0@
 | |
| 
 | |
| L(notypetest):
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_VME
 | |
| 	is_mvme147(L(getvmetype))
 | |
| 	is_bvme6000(L(getvmetype))
 | |
| 	is_not_mvme16x(L(gvtdone))
 | |
| 
 | |
| 	/* See if the loader has specified the BI_VME_TYPE tag.  Recent
 | |
| 	 * versions of VMELILO and TFTPLILO do this.  We have to do this
 | |
| 	 * early so we know how to handle console output.  If the tag
 | |
| 	 * doesn't exist then we use the Bug for output on MVME16x.
 | |
| 	 */
 | |
| L(getvmetype):
 | |
| 	get_bi_record	BI_VME_TYPE
 | |
| 	tstl	%d0
 | |
| 	jbmi	1f
 | |
| 	movel	%a0@,%d3
 | |
| 	lea	%pc@(vme_brdtype),%a0
 | |
| 	movel	%d3,%a0@
 | |
| 1:
 | |
| #ifdef CONFIG_MVME16x
 | |
| 	is_not_mvme16x(L(gvtdone))
 | |
| 
 | |
| 	/* Need to get the BRD_ID info to differentiate between 162, 167,
 | |
| 	 * etc.  This is available as a BI_VME_BRDINFO tag with later
 | |
| 	 * versions of VMELILO and TFTPLILO, otherwise we call the Bug.
 | |
| 	 */
 | |
| 	get_bi_record	BI_VME_BRDINFO
 | |
| 	tstl	%d0
 | |
| 	jpl	1f
 | |
| 
 | |
| 	/* Get pointer to board ID data from Bug */
 | |
| 	movel	%d2,%sp@-
 | |
| 	trap	#15
 | |
| 	.word	0x70		/* trap 0x70 - .BRD_ID */
 | |
| 	movel	%sp@+,%a0
 | |
| 1:
 | |
| 	lea	%pc@(mvme_bdid),%a1
 | |
| 	/* Structure is 32 bytes long */
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	movel	%a0@+,%a1@+
 | |
| #endif
 | |
| 
 | |
| L(gvtdone):
 | |
| 
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_HP300
 | |
| 	is_not_hp300(L(nothp))
 | |
| 
 | |
| 	/* Get the address of the UART for serial debugging */
 | |
| 	get_bi_record	BI_HP300_UART_ADDR
 | |
| 	tstl	%d0
 | |
| 	jbmi	1f
 | |
| 	movel	%a0@,%d3
 | |
| 	lea	%pc@(L(uartbase)),%a0
 | |
| 	movel	%d3,%a0@
 | |
| 	get_bi_record	BI_HP300_UART_SCODE
 | |
| 	tstl	%d0
 | |
| 	jbmi	1f
 | |
| 	movel	%a0@,%d3
 | |
| 	lea	%pc@(L(uart_scode)),%a0
 | |
| 	movel	%d3,%a0@
 | |
| 1:
 | |
| L(nothp):
 | |
| #endif
 | |
| 
 | |
| /*
 | |
|  * Initialize serial port
 | |
|  */
 | |
| 	jbsr	L(serial_init)
 | |
| 
 | |
| /*
 | |
|  * Initialize console
 | |
|  */
 | |
| #ifdef CONFIG_MAC
 | |
| 	is_not_mac(L(nocon))
 | |
| #  ifdef CONSOLE_DEBUG
 | |
| 	console_init
 | |
| #    ifdef CONFIG_LOGO
 | |
| 	console_put_penguin
 | |
| #    endif /* CONFIG_LOGO */
 | |
| #  endif /* CONSOLE_DEBUG */
 | |
| L(nocon):
 | |
| #endif /* CONFIG_MAC */
 | |
| 
 | |
| 
 | |
| 	putc	'\n'
 | |
| 	putc	'A'
 | |
| 	leds	0x2
 | |
| 	dputn	%pc@(L(cputype))
 | |
| 	dputn	%pc@(m68k_supervisor_cachemode)
 | |
| 	dputn	%pc@(m68k_pgtable_cachemode)
 | |
| 	dputc	'\n'
 | |
| 
 | |
| /*
 | |
|  * Save physical start address of kernel
 | |
|  */
 | |
| 	lea	%pc@(L(phys_kernel_start)),%a0
 | |
| 	lea	%pc@(_stext),%a1
 | |
| 	subl	#_stext,%a1
 | |
| 	addl	#PAGE_OFFSET,%a1
 | |
| 	movel	%a1,%a0@
 | |
| 
 | |
| 	putc	'B'
 | |
| 
 | |
| 	leds	0x4
 | |
| 
 | |
| /*
 | |
|  *	mmu_init
 | |
|  *
 | |
|  *	This block of code does what's necessary to map in the various kinds
 | |
|  *	of machines for execution of Linux.
 | |
|  *	First map the first 4, 8, or 16 MB of kernel code & data
 | |
|  */
 | |
| 
 | |
| 	get_bi_record BI_MEMCHUNK
 | |
| 	movel	%a0@(4),%d0
 | |
| 	movel	#16*1024*1024,%d1
 | |
| 	cmpl	%d0,%d1
 | |
| 	jls	1f
 | |
| 	lsrl	#1,%d1
 | |
| 	cmpl	%d0,%d1
 | |
| 	jls	1f
 | |
| 	lsrl	#1,%d1
 | |
| 1:
 | |
| 	lea	%pc@(m68k_init_mapped_size),%a0
 | |
| 	movel	%d1,%a0@
 | |
| 	mmu_map	#PAGE_OFFSET,%pc@(L(phys_kernel_start)),%d1,\
 | |
| 		%pc@(m68k_supervisor_cachemode)
 | |
| 
 | |
| 	putc	'C'
 | |
| 
 | |
| #ifdef CONFIG_AMIGA
 | |
| 
 | |
| L(mmu_init_amiga):
 | |
| 
 | |
| 	is_not_amiga(L(mmu_init_not_amiga))
 | |
| /*
 | |
|  * mmu_init_amiga
 | |
|  */
 | |
| 
 | |
| 	putc	'D'
 | |
| 
 | |
| 	is_not_040_or_060(1f)
 | |
| 
 | |
| 	/*
 | |
| 	 * 040: Map the 16Meg range physical 0x0 up to logical 0x8000.0000
 | |
| 	 */
 | |
| 	mmu_map		#0x80000000,#0,#0x01000000,#_PAGE_NOCACHE_S
 | |
| 	/*
 | |
| 	 * Map the Zorro III I/O space with transparent translation
 | |
| 	 * for frame buffer memory etc.
 | |
| 	 */
 | |
| 	mmu_map_tt	#1,#0x40000000,#0x20000000,#_PAGE_NOCACHE_S
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| 1:
 | |
| 	/*
 | |
| 	 * 030:	Map the 32Meg range physical 0x0 up to logical 0x8000.0000
 | |
| 	 */
 | |
| 	mmu_map		#0x80000000,#0,#0x02000000,#_PAGE_NOCACHE030
 | |
| 	mmu_map_tt	#1,#0x40000000,#0x20000000,#_PAGE_NOCACHE030
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(mmu_init_not_amiga):
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_ATARI
 | |
| 
 | |
| L(mmu_init_atari):
 | |
| 
 | |
| 	is_not_atari(L(mmu_init_not_atari))
 | |
| 
 | |
| 	putc	'E'
 | |
| 
 | |
| /* On the Atari, we map the I/O region (phys. 0x00ffxxxx) by mapping
 | |
|    the last 16 MB of virtual address space to the first 16 MB (i.e.
 | |
|    0xffxxxxxx -> 0x00xxxxxx). For this, an additional pointer table is
 | |
|    needed. I/O ranges are marked non-cachable.
 | |
| 
 | |
|    For the Medusa it is better to map the I/O region transparently
 | |
|    (i.e. 0xffxxxxxx -> 0xffxxxxxx), because some I/O registers are
 | |
|    accessible only in the high area.
 | |
| 
 | |
|    On the Hades all I/O registers are only accessible in the high
 | |
|    area.
 | |
| */
 | |
| 
 | |
| 	/* I/O base addr for non-Medusa, non-Hades: 0x00000000 */
 | |
| 	moveq	#0,%d0
 | |
| 	movel	%pc@(atari_mch_type),%d3
 | |
| 	cmpl	#ATARI_MACH_MEDUSA,%d3
 | |
| 	jbeq	2f
 | |
| 	cmpl	#ATARI_MACH_HADES,%d3
 | |
| 	jbne	1f
 | |
| 2:	movel	#0xff000000,%d0 /* Medusa/Hades base addr: 0xff000000 */
 | |
| 1:	movel	%d0,%d3
 | |
| 
 | |
| 	is_040_or_060(L(spata68040))
 | |
| 
 | |
| 	/* Map everything non-cacheable, though not all parts really
 | |
| 	 * need to disable caches (crucial only for 0xff8000..0xffffff
 | |
| 	 * (standard I/O) and 0xf00000..0xf3ffff (IDE)). The remainder
 | |
| 	 * isn't really used, except for sometimes peeking into the
 | |
| 	 * ROMs (mirror at phys. 0x0), so caching isn't necessary for
 | |
| 	 * this. */
 | |
| 	mmu_map	#0xff000000,%d3,#0x01000000,#_PAGE_NOCACHE030
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(spata68040):
 | |
| 
 | |
| 	mmu_map	#0xff000000,%d3,#0x01000000,#_PAGE_NOCACHE_S
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(mmu_init_not_atari):
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_Q40
 | |
| 	is_not_q40(L(notq40))
 | |
| 	/*
 | |
| 	 * add transparent mapping for 0xff00 0000 - 0xffff ffff
 | |
| 	 * non-cached serialized etc..
 | |
| 	 * this includes master chip, DAC, RTC and ISA ports
 | |
| 	 * 0xfe000000-0xfeffffff is for screen and ROM
 | |
| 	 */
 | |
| 
 | |
| 	putc    'Q'
 | |
| 
 | |
| 	mmu_map_tt	#0,#0xfe000000,#0x01000000,#_PAGE_CACHE040W
 | |
| 	mmu_map_tt	#1,#0xff000000,#0x01000000,#_PAGE_NOCACHE_S
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(notq40):
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_HP300
 | |
| 	is_not_hp300(L(nothp300))
 | |
| 
 | |
| 	/* On the HP300, we map the ROM, INTIO and DIO regions (phys. 0x00xxxxxx)
 | |
| 	 * by mapping 32MB (on 020/030) or 16 MB (on 040) from 0xf0xxxxxx -> 0x00xxxxxx).
 | |
| 	 * The ROM mapping is needed because the LEDs are mapped there too.
 | |
| 	 */
 | |
| 
 | |
| 	is_040(1f)
 | |
| 
 | |
| 	/*
 | |
| 	 * 030: Map the 32Meg range physical 0x0 up to logical 0xf000.0000
 | |
| 	 */
 | |
| 	mmu_map	#0xf0000000,#0,#0x02000000,#_PAGE_NOCACHE030
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| 1:
 | |
| 	/*
 | |
| 	 * 040: Map the 16Meg range physical 0x0 up to logical 0xf000.0000
 | |
| 	 */
 | |
| 	mmu_map #0xf0000000,#0,#0x01000000,#_PAGE_NOCACHE_S
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(nothp300):
 | |
| #endif /* CONFIG_HP300 */
 | |
| 
 | |
| #ifdef CONFIG_MVME147
 | |
| 
 | |
| 	is_not_mvme147(L(not147))
 | |
| 
 | |
| 	/*
 | |
| 	 * On MVME147 we have already created kernel page tables for
 | |
| 	 * 4MB of RAM at address 0, so now need to do a transparent
 | |
| 	 * mapping of the top of memory space.  Make it 0.5GByte for now,
 | |
| 	 * so we can access on-board i/o areas.
 | |
| 	 */
 | |
| 
 | |
| 	mmu_map_tt	#1,#0xe0000000,#0x20000000,#_PAGE_NOCACHE030
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(not147):
 | |
| #endif /* CONFIG_MVME147 */
 | |
| 
 | |
| #ifdef CONFIG_MVME16x
 | |
| 
 | |
| 	is_not_mvme16x(L(not16x))
 | |
| 
 | |
| 	/*
 | |
| 	 * On MVME16x we have already created kernel page tables for
 | |
| 	 * 4MB of RAM at address 0, so now need to do a transparent
 | |
| 	 * mapping of the top of memory space.  Make it 0.5GByte for now.
 | |
| 	 * Supervisor only access, so transparent mapping doesn't
 | |
| 	 * clash with User code virtual address space.
 | |
| 	 * this covers IO devices, PROM and SRAM.  The PROM and SRAM
 | |
| 	 * mapping is needed to allow 167Bug to run.
 | |
| 	 * IO is in the range 0xfff00000 to 0xfffeffff.
 | |
| 	 * PROM is 0xff800000->0xffbfffff and SRAM is
 | |
| 	 * 0xffe00000->0xffe1ffff.
 | |
| 	 */
 | |
| 
 | |
| 	mmu_map_tt	#1,#0xe0000000,#0x20000000,#_PAGE_NOCACHE_S
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(not16x):
 | |
| #endif	/* CONFIG_MVME162 | CONFIG_MVME167 */
 | |
| 
 | |
| #ifdef CONFIG_BVME6000
 | |
| 
 | |
| 	is_not_bvme6000(L(not6000))
 | |
| 
 | |
| 	/*
 | |
| 	 * On BVME6000 we have already created kernel page tables for
 | |
| 	 * 4MB of RAM at address 0, so now need to do a transparent
 | |
| 	 * mapping of the top of memory space.  Make it 0.5GByte for now,
 | |
| 	 * so we can access on-board i/o areas.
 | |
| 	 * Supervisor only access, so transparent mapping doesn't
 | |
| 	 * clash with User code virtual address space.
 | |
| 	 */
 | |
| 
 | |
| 	mmu_map_tt	#1,#0xe0000000,#0x20000000,#_PAGE_NOCACHE_S
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(not6000):
 | |
| #endif /* CONFIG_BVME6000 */
 | |
| 
 | |
| /*
 | |
|  * mmu_init_mac
 | |
|  *
 | |
|  * The Macintosh mappings are less clear.
 | |
|  *
 | |
|  * Even as of this writing, it is unclear how the
 | |
|  * Macintosh mappings will be done.  However, as
 | |
|  * the first author of this code I'm proposing the
 | |
|  * following model:
 | |
|  *
 | |
|  * Map the kernel (that's already done),
 | |
|  * Map the I/O (on most machines that's the
 | |
|  * 0x5000.0000 ... 0x5300.0000 range,
 | |
|  * Map the video frame buffer using as few pages
 | |
|  * as absolutely (this requirement mostly stems from
 | |
|  * the fact that when the frame buffer is at
 | |
|  * 0x0000.0000 then we know there is valid RAM just
 | |
|  * above the screen that we don't want to waste!).
 | |
|  *
 | |
|  * By the way, if the frame buffer is at 0x0000.0000
 | |
|  * then the Macintosh is known as an RBV based Mac.
 | |
|  *
 | |
|  * By the way 2, the code currently maps in a bunch of
 | |
|  * regions.  But I'd like to cut that out.  (And move most
 | |
|  * of the mappings up into the kernel proper ... or only
 | |
|  * map what's necessary.)
 | |
|  */
 | |
| 
 | |
| #ifdef CONFIG_MAC
 | |
| 
 | |
| L(mmu_init_mac):
 | |
| 
 | |
| 	is_not_mac(L(mmu_init_not_mac))
 | |
| 
 | |
| 	putc	'F'
 | |
| 
 | |
| 	is_not_040_or_060(1f)
 | |
| 
 | |
| 	moveq	#_PAGE_NOCACHE_S,%d3
 | |
| 	jbra	2f
 | |
| 1:
 | |
| 	moveq	#_PAGE_NOCACHE030,%d3
 | |
| 2:
 | |
| 	/*
 | |
| 	 * Mac Note: screen address of logical 0xF000.0000 -> <screen physical>
 | |
| 	 *	     we simply map the 4MB that contains the videomem
 | |
| 	 */
 | |
| 
 | |
| 	movel	#VIDEOMEMMASK,%d0
 | |
| 	andl	%pc@(L(mac_videobase)),%d0
 | |
| 
 | |
| 	mmu_map		#VIDEOMEMBASE,%d0,#VIDEOMEMSIZE,%d3
 | |
| 	/* ROM from 4000 0000 to 4200 0000 (only for mac_reset()) */
 | |
| 	mmu_map_eq	#0x40000000,#0x02000000,%d3
 | |
| 	/* IO devices (incl. serial port) from 5000 0000 to 5300 0000 */
 | |
| 	mmu_map_eq	#0x50000000,#0x03000000,%d3
 | |
| 	/* Nubus slot space (video at 0xF0000000, rom at 0xF0F80000) */
 | |
| 	mmu_map_tt	#1,#0xf8000000,#0x08000000,%d3
 | |
| 
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(mmu_init_not_mac):
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_SUN3X
 | |
| 	is_not_sun3x(L(notsun3x))
 | |
| 
 | |
| 	/* oh, the pain..  We're gonna want the prom code after
 | |
| 	 * starting the MMU, so we copy the mappings, translating
 | |
| 	 * from 8k -> 4k pages as we go.
 | |
| 	 */
 | |
| 
 | |
| 	/* copy maps from 0xfee00000 to 0xff000000 */
 | |
| 	movel	#0xfee00000, %d0
 | |
| 	moveq	#ROOT_INDEX_SHIFT, %d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	mmu_get_root_table_entry	%d0
 | |
| 
 | |
| 	movel	#0xfee00000, %d0
 | |
| 	moveq	#PTR_INDEX_SHIFT, %d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PTR_TABLE_SIZE-1, %d0
 | |
| 	mmu_get_ptr_table_entry		%a0,%d0
 | |
| 
 | |
| 	movel	#0xfee00000, %d0
 | |
| 	moveq	#PAGE_INDEX_SHIFT, %d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PAGE_TABLE_SIZE-1, %d0
 | |
| 	mmu_get_page_table_entry	%a0,%d0
 | |
| 
 | |
| 	/* this is where the prom page table lives */
 | |
| 	movel	0xfefe00d4, %a1
 | |
| 	movel	%a1@, %a1
 | |
| 
 | |
| 	movel	#((0x200000 >> 13)-1), %d1
 | |
| 
 | |
| 1:
 | |
| 	movel	%a1@+, %d3
 | |
| 	movel	%d3,%a0@+
 | |
| 	addl	#0x1000,%d3
 | |
| 	movel	%d3,%a0@+
 | |
| 
 | |
| 	dbra	%d1,1b
 | |
| 
 | |
| 	/* setup tt1 for I/O */
 | |
| 	mmu_map_tt	#1,#0x40000000,#0x40000000,#_PAGE_NOCACHE_S
 | |
| 	jbra	L(mmu_init_done)
 | |
| 
 | |
| L(notsun3x):
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_APOLLO
 | |
| 	is_not_apollo(L(notapollo))
 | |
| 
 | |
| 	putc	'P'
 | |
| 	mmu_map         #0x80000000,#0,#0x02000000,#_PAGE_NOCACHE030
 | |
| 
 | |
| L(notapollo):
 | |
| 	jbra	L(mmu_init_done)
 | |
| #endif
 | |
| 
 | |
| L(mmu_init_done):
 | |
| 
 | |
| 	putc	'G'
 | |
| 	leds	0x8
 | |
| 
 | |
| /*
 | |
|  * mmu_fixup
 | |
|  *
 | |
|  * On the 040 class machines, all pages that are used for the
 | |
|  * mmu have to be fixed up. According to Motorola, pages holding mmu
 | |
|  * tables should be non-cacheable on a '040 and write-through on a
 | |
|  * '060. But analysis of the reasons for this, and practical
 | |
|  * experience, showed that write-through also works on a '040.
 | |
|  *
 | |
|  * Allocated memory so far goes from kernel_end to memory_start that
 | |
|  * is used for all kind of tables, for that the cache attributes
 | |
|  * are now fixed.
 | |
|  */
 | |
| L(mmu_fixup):
 | |
| 
 | |
| 	is_not_040_or_060(L(mmu_fixup_done))
 | |
| 
 | |
| #ifdef MMU_NOCACHE_KERNEL
 | |
| 	jbra	L(mmu_fixup_done)
 | |
| #endif
 | |
| 
 | |
| 	/* first fix the page at the start of the kernel, that
 | |
| 	 * contains also kernel_pg_dir.
 | |
| 	 */
 | |
| 	movel	%pc@(L(phys_kernel_start)),%d0
 | |
| 	subl	#PAGE_OFFSET,%d0
 | |
| 	lea	%pc@(_stext),%a0
 | |
| 	subl	%d0,%a0
 | |
| 	mmu_fixup_page_mmu_cache	%a0
 | |
| 
 | |
| 	movel	%pc@(L(kernel_end)),%a0
 | |
| 	subl	%d0,%a0
 | |
| 	movel	%pc@(L(memory_start)),%a1
 | |
| 	subl	%d0,%a1
 | |
| 	bra	2f
 | |
| 1:
 | |
| 	mmu_fixup_page_mmu_cache	%a0
 | |
| 	addw	#PAGESIZE,%a0
 | |
| 2:
 | |
| 	cmpl	%a0,%a1
 | |
| 	jgt	1b
 | |
| 
 | |
| L(mmu_fixup_done):
 | |
| 
 | |
| #ifdef MMU_PRINT
 | |
| 	mmu_print
 | |
| #endif
 | |
| 
 | |
| /*
 | |
|  * mmu_engage
 | |
|  *
 | |
|  * This chunk of code performs the gruesome task of engaging the MMU.
 | |
|  * The reason its gruesome is because when the MMU becomes engaged it
 | |
|  * maps logical addresses to physical addresses.  The Program Counter
 | |
|  * register is then passed through the MMU before the next instruction
 | |
|  * is fetched (the instruction following the engage MMU instruction).
 | |
|  * This may mean one of two things:
 | |
|  * 1. The Program Counter falls within the logical address space of
 | |
|  *    the kernel of which there are two sub-possibilities:
 | |
|  *    A. The PC maps to the correct instruction (logical PC == physical
 | |
|  *       code location), or
 | |
|  *    B. The PC does not map through and the processor will read some
 | |
|  *       data (or instruction) which is not the logically next instr.
 | |
|  *    As you can imagine, A is good and B is bad.
 | |
|  * Alternatively,
 | |
|  * 2. The Program Counter does not map through the MMU.  The processor
 | |
|  *    will take a Bus Error.
 | |
|  * Clearly, 2 is bad.
 | |
|  * It doesn't take a wiz kid to figure you want 1.A.
 | |
|  * This code creates that possibility.
 | |
|  * There are two possible 1.A. states (we now ignore the other above states):
 | |
|  * A. The kernel is located at physical memory addressed the same as
 | |
|  *    the logical memory for the kernel, i.e., 0x01000.
 | |
|  * B. The kernel is located some where else.  e.g., 0x0400.0000
 | |
|  *
 | |
|  *    Under some conditions the Macintosh can look like A or B.
 | |
|  * [A friend and I once noted that Apple hardware engineers should be
 | |
|  * wacked twice each day: once when they show up at work (as in, Whack!,
 | |
|  * "This is for the screwy hardware we know you're going to design today."),
 | |
|  * and also at the end of the day (as in, Whack! "I don't know what
 | |
|  * you designed today, but I'm sure it wasn't good."). -- rst]
 | |
|  *
 | |
|  * This code works on the following premise:
 | |
|  * If the kernel start (%d5) is within the first 16 Meg of RAM,
 | |
|  * then create a mapping for the kernel at logical 0x8000.0000 to
 | |
|  * the physical location of the pc.  And, create a transparent
 | |
|  * translation register for the first 16 Meg.  Then, after the MMU
 | |
|  * is engaged, the PC can be moved up into the 0x8000.0000 range
 | |
|  * and then the transparent translation can be turned off and then
 | |
|  * the PC can jump to the correct logical location and it will be
 | |
|  * home (finally).  This is essentially the code that the Amiga used
 | |
|  * to use.  Now, it's generalized for all processors.  Which means
 | |
|  * that a fresh (but temporary) mapping has to be created.  The mapping
 | |
|  * is made in page 0 (an as of yet unused location -- except for the
 | |
|  * stack!).  This temporary mapping will only require 1 pointer table
 | |
|  * and a single page table (it can map 256K).
 | |
|  *
 | |
|  * OK, alternatively, imagine that the Program Counter is not within
 | |
|  * the first 16 Meg.  Then, just use Transparent Translation registers
 | |
|  * to do the right thing.
 | |
|  *
 | |
|  * Last, if _start is already at 0x01000, then there's nothing special
 | |
|  * to do (in other words, in a degenerate case of the first case above,
 | |
|  * do nothing).
 | |
|  *
 | |
|  * Let's do it.
 | |
|  *
 | |
|  *
 | |
|  */
 | |
| 
 | |
| 	putc	'H'
 | |
| 
 | |
| 	mmu_engage
 | |
| 
 | |
| /*
 | |
|  * After this point no new memory is allocated and
 | |
|  * the start of available memory is stored in availmem.
 | |
|  * (The bootmem allocator requires now the physicall address.)
 | |
|  */
 | |
| 
 | |
| 	movel	L(memory_start),availmem
 | |
| 
 | |
| #ifdef CONFIG_AMIGA
 | |
| 	is_not_amiga(1f)
 | |
| 	/* fixup the Amiga custom register location before printing */
 | |
| 	clrl	L(custom)
 | |
| 1:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_ATARI
 | |
| 	is_not_atari(1f)
 | |
| 	/* fixup the Atari iobase register location before printing */
 | |
| 	movel	#0xff000000,L(iobase)
 | |
| 1:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_MAC
 | |
| 	is_not_mac(1f)
 | |
| 	movel	#~VIDEOMEMMASK,%d0
 | |
| 	andl	L(mac_videobase),%d0
 | |
| 	addl	#VIDEOMEMBASE,%d0
 | |
| 	movel	%d0,L(mac_videobase)
 | |
| #ifdef CONSOLE_DEBUG
 | |
| 	movel	%pc@(L(phys_kernel_start)),%d0
 | |
| 	subl	#PAGE_OFFSET,%d0
 | |
| 	subl	%d0,L(console_font)
 | |
| 	subl	%d0,L(console_font_data)
 | |
| #endif
 | |
| 	orl	#0x50000000,L(mac_sccbase)
 | |
| 1:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_HP300
 | |
| 	is_not_hp300(2f)
 | |
| 	/*
 | |
| 	 * Fix up the iobase register to point to the new location of the LEDs.
 | |
| 	 */
 | |
| 	movel	#0xf0000000,L(iobase)
 | |
| 
 | |
| 	/*
 | |
| 	 * Energise the FPU and caches.
 | |
| 	 */
 | |
| 	is_040(1f)
 | |
| 	movel	#0x60,0xf05f400c
 | |
| 	jbra	2f
 | |
| 
 | |
| 	/*
 | |
| 	 * 040: slightly different, apparently.
 | |
| 	 */
 | |
| 1:	movew	#0,0xf05f400e
 | |
| 	movew	#0x64,0xf05f400e
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_SUN3X
 | |
| 	is_not_sun3x(1f)
 | |
| 
 | |
| 	/* enable copro */
 | |
| 	oriw	#0x4000,0x61000000
 | |
| 1:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_APOLLO
 | |
| 	is_not_apollo(1f)
 | |
| 
 | |
| 	/*
 | |
| 	 * Fix up the iobase before printing
 | |
| 	 */
 | |
| 	movel	#0x80000000,L(iobase)
 | |
| 1:
 | |
| #endif
 | |
| 
 | |
| 	putc	'I'
 | |
| 	leds	0x10
 | |
| 
 | |
| /*
 | |
|  * Enable caches
 | |
|  */
 | |
| 
 | |
| 	is_not_040_or_060(L(cache_not_680460))
 | |
| 
 | |
| L(cache680460):
 | |
| 	.chip	68040
 | |
| 	nop
 | |
| 	cpusha	%bc
 | |
| 	nop
 | |
| 
 | |
| 	is_060(L(cache68060))
 | |
| 
 | |
| 	movel	#CC6_ENABLE_D+CC6_ENABLE_I,%d0
 | |
| 	/* MMU stuff works in copyback mode now, so enable the cache */
 | |
| 	movec	%d0,%cacr
 | |
| 	jra	L(cache_done)
 | |
| 
 | |
| L(cache68060):
 | |
| 	movel	#CC6_ENABLE_D+CC6_ENABLE_I+CC6_ENABLE_SB+CC6_PUSH_DPI+CC6_ENABLE_B+CC6_CLRA_B,%d0
 | |
| 	/* MMU stuff works in copyback mode now, so enable the cache */
 | |
| 	movec	%d0,%cacr
 | |
| 	/* enable superscalar dispatch in PCR */
 | |
| 	moveq	#1,%d0
 | |
| 	.chip	68060
 | |
| 	movec	%d0,%pcr
 | |
| 
 | |
| 	jbra	L(cache_done)
 | |
| L(cache_not_680460):
 | |
| L(cache68030):
 | |
| 	.chip	68030
 | |
| 	movel	#CC3_ENABLE_DB+CC3_CLR_D+CC3_ENABLE_D+CC3_ENABLE_IB+CC3_CLR_I+CC3_ENABLE_I,%d0
 | |
| 	movec	%d0,%cacr
 | |
| 
 | |
| 	jra	L(cache_done)
 | |
| 	.chip	68k
 | |
| L(cache_done):
 | |
| 
 | |
| 	putc	'J'
 | |
| 
 | |
| /*
 | |
|  * Setup initial stack pointer
 | |
|  */
 | |
| 	lea	init_task,%curptr
 | |
| 	lea	init_thread_union+THREAD_SIZE,%sp
 | |
| 
 | |
| 	putc	'K'
 | |
| 
 | |
| 	subl	%a6,%a6		/* clear a6 for gdb */
 | |
| 
 | |
| /*
 | |
|  * The new 64bit printf support requires an early exception initialization.
 | |
|  */
 | |
| 	jbsr	base_trap_init
 | |
| 
 | |
| /* jump to the kernel start */
 | |
| 
 | |
| 	putc	'\n'
 | |
| 	leds	0x55
 | |
| 
 | |
| 	jbsr	start_kernel
 | |
| 
 | |
| /*
 | |
|  * Find a tag record in the bootinfo structure
 | |
|  * The bootinfo structure is located right after the kernel
 | |
|  * Returns: d0: size (-1 if not found)
 | |
|  *          a0: data pointer (end-of-records if not found)
 | |
|  */
 | |
| func_start	get_bi_record,%d1
 | |
| 
 | |
| 	movel	ARG1,%d0
 | |
| 	lea	%pc@(_end),%a0
 | |
| 1:	tstw	%a0@(BIR_TAG)
 | |
| 	jeq	3f
 | |
| 	cmpw	%a0@(BIR_TAG),%d0
 | |
| 	jeq	2f
 | |
| 	addw	%a0@(BIR_SIZE),%a0
 | |
| 	jra	1b
 | |
| 2:	moveq	#0,%d0
 | |
| 	movew	%a0@(BIR_SIZE),%d0
 | |
| 	lea	%a0@(BIR_DATA),%a0
 | |
| 	jra	4f
 | |
| 3:	moveq	#-1,%d0
 | |
| 	lea	%a0@(BIR_SIZE),%a0
 | |
| 4:
 | |
| func_return	get_bi_record
 | |
| 
 | |
| 
 | |
| /*
 | |
|  *	MMU Initialization Begins Here
 | |
|  *
 | |
|  *	The structure of the MMU tables on the 68k machines
 | |
|  *	is thus:
 | |
|  *	Root Table
 | |
|  *		Logical addresses are translated through
 | |
|  *	a hierarchical translation mechanism where the high-order
 | |
|  *	seven bits of the logical address (LA) are used as an
 | |
|  *	index into the "root table."  Each entry in the root
 | |
|  *	table has a bit which specifies if it's a valid pointer to a
 | |
|  *	pointer table.  Each entry defines a 32KMeg range of memory.
 | |
|  *	If an entry is invalid then that logical range of 32M is
 | |
|  *	invalid and references to that range of memory (when the MMU
 | |
|  *	is enabled) will fault.  If the entry is valid, then it does
 | |
|  *	one of two things.  On 040/060 class machines, it points to
 | |
|  *	a pointer table which then describes more finely the memory
 | |
|  *	within that 32M range.  On 020/030 class machines, a technique
 | |
|  *	called "early terminating descriptors" are used.  This technique
 | |
|  *	allows an entire 32Meg to be described by a single entry in the
 | |
|  *	root table.  Thus, this entry in the root table, contains the
 | |
|  *	physical address of the memory or I/O at the logical address
 | |
|  *	which the entry represents and it also contains the necessary
 | |
|  *	cache bits for this region.
 | |
|  *
 | |
|  *	Pointer Tables
 | |
|  *		Per the Root Table, there will be one or more
 | |
|  *	pointer tables.  Each pointer table defines a 32M range.
 | |
|  *	Not all of the 32M range need be defined.  Again, the next
 | |
|  *	seven bits of the logical address are used an index into
 | |
|  *	the pointer table to point to page tables (if the pointer
 | |
|  *	is valid).  There will undoubtedly be more than one
 | |
|  *	pointer table for the kernel because each pointer table
 | |
|  *	defines a range of only 32M.  Valid pointer table entries
 | |
|  *	point to page tables, or are early terminating entries
 | |
|  *	themselves.
 | |
|  *
 | |
|  *	Page Tables
 | |
|  *		Per the Pointer Tables, each page table entry points
 | |
|  *	to the physical page in memory that supports the logical
 | |
|  *	address that translates to the particular index.
 | |
|  *
 | |
|  *	In short, the Logical Address gets translated as follows:
 | |
|  *		bits 31..26 - index into the Root Table
 | |
|  *		bits 25..18 - index into the Pointer Table
 | |
|  *		bits 17..12 - index into the Page Table
 | |
|  *		bits 11..0  - offset into a particular 4K page
 | |
|  *
 | |
|  *	The algorithms which follows do one thing: they abstract
 | |
|  *	the MMU hardware.  For example, there are three kinds of
 | |
|  *	cache settings that are relevant.  Either, memory is
 | |
|  *	being mapped in which case it is either Kernel Code (or
 | |
|  *	the RamDisk) or it is MMU data.  On the 030, the MMU data
 | |
|  *	option also describes the kernel.  Or, I/O is being mapped
 | |
|  *	in which case it has its own kind of cache bits.  There
 | |
|  *	are constants which abstract these notions from the code that
 | |
|  *	actually makes the call to map some range of memory.
 | |
|  *
 | |
|  *
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #ifdef MMU_PRINT
 | |
| /*
 | |
|  *	mmu_print
 | |
|  *
 | |
|  *	This algorithm will print out the current MMU mappings.
 | |
|  *
 | |
|  *	Input:
 | |
|  *		%a5 points to the root table.  Everything else is calculated
 | |
|  *			from this.
 | |
|  */
 | |
| 
 | |
| #define mmu_next_valid		0
 | |
| #define mmu_start_logical	4
 | |
| #define mmu_next_logical	8
 | |
| #define mmu_start_physical	12
 | |
| #define mmu_next_physical	16
 | |
| 
 | |
| #define MMU_PRINT_INVALID		-1
 | |
| #define MMU_PRINT_VALID			1
 | |
| #define MMU_PRINT_UNINITED		0
 | |
| 
 | |
| #define putZc(z,n)		jbne 1f; putc z; jbra 2f; 1: putc n; 2:
 | |
| 
 | |
| func_start	mmu_print,%a0-%a6/%d0-%d7
 | |
| 
 | |
| 	movel	%pc@(L(kernel_pgdir_ptr)),%a5
 | |
| 	lea	%pc@(L(mmu_print_data)),%a0
 | |
| 	movel	#MMU_PRINT_UNINITED,%a0@(mmu_next_valid)
 | |
| 
 | |
| 	is_not_040_or_060(mmu_030_print)
 | |
| 
 | |
| mmu_040_print:
 | |
| 	puts	"\nMMU040\n"
 | |
| 	puts	"rp:"
 | |
| 	putn	%a5
 | |
| 	putc	'\n'
 | |
| #if 0
 | |
| 	/*
 | |
| 	 * The following #if/#endif block is a tight algorithm for dumping the 040
 | |
| 	 * MMU Map in gory detail.  It really isn't that practical unless the
 | |
| 	 * MMU Map algorithm appears to go awry and you need to debug it at the
 | |
| 	 * entry per entry level.
 | |
| 	 */
 | |
| 	movel	#ROOT_TABLE_SIZE,%d5
 | |
| #if 0
 | |
| 	movel	%a5@+,%d7		| Burn an entry to skip the kernel mappings,
 | |
| 	subql	#1,%d5			| they (might) work
 | |
| #endif
 | |
| 1:	tstl	%d5
 | |
| 	jbeq	mmu_print_done
 | |
| 	subq	#1,%d5
 | |
| 	movel	%a5@+,%d7
 | |
| 	btst	#1,%d7
 | |
| 	jbeq	1b
 | |
| 
 | |
| 2:	putn	%d7
 | |
| 	andil	#0xFFFFFE00,%d7
 | |
| 	movel	%d7,%a4
 | |
| 	movel	#PTR_TABLE_SIZE,%d4
 | |
| 	putc	' '
 | |
| 3:	tstl	%d4
 | |
| 	jbeq	11f
 | |
| 	subq	#1,%d4
 | |
| 	movel	%a4@+,%d7
 | |
| 	btst	#1,%d7
 | |
| 	jbeq	3b
 | |
| 
 | |
| 4:	putn	%d7
 | |
| 	andil	#0xFFFFFF00,%d7
 | |
| 	movel	%d7,%a3
 | |
| 	movel	#PAGE_TABLE_SIZE,%d3
 | |
| 5:	movel	#8,%d2
 | |
| 6:	tstl	%d3
 | |
| 	jbeq	31f
 | |
| 	subq	#1,%d3
 | |
| 	movel	%a3@+,%d6
 | |
| 	btst	#0,%d6
 | |
| 	jbeq	6b
 | |
| 7:	tstl	%d2
 | |
| 	jbeq	8f
 | |
| 	subq	#1,%d2
 | |
| 	putc	' '
 | |
| 	jbra	91f
 | |
| 8:	putc	'\n'
 | |
| 	movel	#8+1+8+1+1,%d2
 | |
| 9:	putc	' '
 | |
| 	dbra	%d2,9b
 | |
| 	movel	#7,%d2
 | |
| 91:	putn	%d6
 | |
| 	jbra	6b
 | |
| 
 | |
| 31:	putc	'\n'
 | |
| 	movel	#8+1,%d2
 | |
| 32:	putc	' '
 | |
| 	dbra	%d2,32b
 | |
| 	jbra	3b
 | |
| 
 | |
| 11:	putc	'\n'
 | |
| 	jbra	1b
 | |
| #endif /* MMU 040 Dumping code that's gory and detailed */
 | |
| 
 | |
| 	lea	%pc@(kernel_pg_dir),%a5
 | |
| 	movel	%a5,%a0			/* a0 has the address of the root table ptr */
 | |
| 	movel	#0x00000000,%a4		/* logical address */
 | |
| 	moveql	#0,%d0
 | |
| 40:
 | |
| 	/* Increment the logical address and preserve in d5 */
 | |
| 	movel	%a4,%d5
 | |
| 	addil	#PAGESIZE<<13,%d5
 | |
| 	movel	%a0@+,%d6
 | |
| 	btst	#1,%d6
 | |
| 	jbne	41f
 | |
| 	jbsr	mmu_print_tuple_invalidate
 | |
| 	jbra	48f
 | |
| 41:
 | |
| 	movel	#0,%d1
 | |
| 	andil	#0xfffffe00,%d6
 | |
| 	movel	%d6,%a1
 | |
| 42:
 | |
| 	movel	%a4,%d5
 | |
| 	addil	#PAGESIZE<<6,%d5
 | |
| 	movel	%a1@+,%d6
 | |
| 	btst	#1,%d6
 | |
| 	jbne	43f
 | |
| 	jbsr	mmu_print_tuple_invalidate
 | |
| 	jbra	47f
 | |
| 43:
 | |
| 	movel	#0,%d2
 | |
| 	andil	#0xffffff00,%d6
 | |
| 	movel	%d6,%a2
 | |
| 44:
 | |
| 	movel	%a4,%d5
 | |
| 	addil	#PAGESIZE,%d5
 | |
| 	movel	%a2@+,%d6
 | |
| 	btst	#0,%d6
 | |
| 	jbne	45f
 | |
| 	jbsr	mmu_print_tuple_invalidate
 | |
| 	jbra	46f
 | |
| 45:
 | |
| 	moveml	%d0-%d1,%sp@-
 | |
| 	movel	%a4,%d0
 | |
| 	movel	%d6,%d1
 | |
| 	andil	#0xfffff4e0,%d1
 | |
| 	lea	%pc@(mmu_040_print_flags),%a6
 | |
| 	jbsr	mmu_print_tuple
 | |
| 	moveml	%sp@+,%d0-%d1
 | |
| 46:
 | |
| 	movel	%d5,%a4
 | |
| 	addq	#1,%d2
 | |
| 	cmpib	#64,%d2
 | |
| 	jbne	44b
 | |
| 47:
 | |
| 	movel	%d5,%a4
 | |
| 	addq	#1,%d1
 | |
| 	cmpib	#128,%d1
 | |
| 	jbne	42b
 | |
| 48:
 | |
| 	movel	%d5,%a4			/* move to the next logical address */
 | |
| 	addq	#1,%d0
 | |
| 	cmpib	#128,%d0
 | |
| 	jbne	40b
 | |
| 
 | |
| 	.chip	68040
 | |
| 	movec	%dtt1,%d0
 | |
| 	movel	%d0,%d1
 | |
| 	andiw	#0x8000,%d1		/* is it valid ? */
 | |
| 	jbeq	1f			/* No, bail out */
 | |
| 
 | |
| 	movel	%d0,%d1
 | |
| 	andil	#0xff000000,%d1		/* Get the address */
 | |
| 	putn	%d1
 | |
| 	puts	"=="
 | |
| 	putn	%d1
 | |
| 
 | |
| 	movel	%d0,%d6
 | |
| 	jbsr	mmu_040_print_flags_tt
 | |
| 1:
 | |
| 	movec	%dtt0,%d0
 | |
| 	movel	%d0,%d1
 | |
| 	andiw	#0x8000,%d1		/* is it valid ? */
 | |
| 	jbeq	1f			/* No, bail out */
 | |
| 
 | |
| 	movel	%d0,%d1
 | |
| 	andil	#0xff000000,%d1		/* Get the address */
 | |
| 	putn	%d1
 | |
| 	puts	"=="
 | |
| 	putn	%d1
 | |
| 
 | |
| 	movel	%d0,%d6
 | |
| 	jbsr	mmu_040_print_flags_tt
 | |
| 1:
 | |
| 	.chip	68k
 | |
| 
 | |
| 	jbra	mmu_print_done
 | |
| 
 | |
| mmu_040_print_flags:
 | |
| 	btstl	#10,%d6
 | |
| 	putZc(' ','G')	/* global bit */
 | |
| 	btstl	#7,%d6
 | |
| 	putZc(' ','S')	/* supervisor bit */
 | |
| mmu_040_print_flags_tt:
 | |
| 	btstl	#6,%d6
 | |
| 	jbne	3f
 | |
| 	putc	'C'
 | |
| 	btstl	#5,%d6
 | |
| 	putZc('w','c')	/* write through or copy-back */
 | |
| 	jbra	4f
 | |
| 3:
 | |
| 	putc	'N'
 | |
| 	btstl	#5,%d6
 | |
| 	putZc('s',' ')	/* serialized non-cacheable, or non-cacheable */
 | |
| 4:
 | |
| 	rts
 | |
| 
 | |
| mmu_030_print_flags:
 | |
| 	btstl	#6,%d6
 | |
| 	putZc('C','I')	/* write through or copy-back */
 | |
| 	rts
 | |
| 
 | |
| mmu_030_print:
 | |
| 	puts	"\nMMU030\n"
 | |
| 	puts	"\nrp:"
 | |
| 	putn	%a5
 | |
| 	putc	'\n'
 | |
| 	movel	%a5,%d0
 | |
| 	andil	#0xfffffff0,%d0
 | |
| 	movel	%d0,%a0
 | |
| 	movel	#0x00000000,%a4		/* logical address */
 | |
| 	movel	#0,%d0
 | |
| 30:
 | |
| 	movel	%a4,%d5
 | |
| 	addil	#PAGESIZE<<13,%d5
 | |
| 	movel	%a0@+,%d6
 | |
| 	btst	#1,%d6			/* is it a table ptr? */
 | |
| 	jbne	31f			/* yes */
 | |
| 	btst	#0,%d6			/* is it early terminating? */
 | |
| 	jbeq	1f			/* no */
 | |
| 	jbsr	mmu_030_print_helper
 | |
| 	jbra	38f
 | |
| 1:
 | |
| 	jbsr	mmu_print_tuple_invalidate
 | |
| 	jbra	38f
 | |
| 31:
 | |
| 	movel	#0,%d1
 | |
| 	andil	#0xfffffff0,%d6
 | |
| 	movel	%d6,%a1
 | |
| 32:
 | |
| 	movel	%a4,%d5
 | |
| 	addil	#PAGESIZE<<6,%d5
 | |
| 	movel	%a1@+,%d6
 | |
| 	btst	#1,%d6			/* is it a table ptr? */
 | |
| 	jbne	33f			/* yes */
 | |
| 	btst	#0,%d6			/* is it a page descriptor? */
 | |
| 	jbeq	1f			/* no */
 | |
| 	jbsr	mmu_030_print_helper
 | |
| 	jbra	37f
 | |
| 1:
 | |
| 	jbsr	mmu_print_tuple_invalidate
 | |
| 	jbra	37f
 | |
| 33:
 | |
| 	movel	#0,%d2
 | |
| 	andil	#0xfffffff0,%d6
 | |
| 	movel	%d6,%a2
 | |
| 34:
 | |
| 	movel	%a4,%d5
 | |
| 	addil	#PAGESIZE,%d5
 | |
| 	movel	%a2@+,%d6
 | |
| 	btst	#0,%d6
 | |
| 	jbne	35f
 | |
| 	jbsr	mmu_print_tuple_invalidate
 | |
| 	jbra	36f
 | |
| 35:
 | |
| 	jbsr	mmu_030_print_helper
 | |
| 36:
 | |
| 	movel	%d5,%a4
 | |
| 	addq	#1,%d2
 | |
| 	cmpib	#64,%d2
 | |
| 	jbne	34b
 | |
| 37:
 | |
| 	movel	%d5,%a4
 | |
| 	addq	#1,%d1
 | |
| 	cmpib	#128,%d1
 | |
| 	jbne	32b
 | |
| 38:
 | |
| 	movel	%d5,%a4			/* move to the next logical address */
 | |
| 	addq	#1,%d0
 | |
| 	cmpib	#128,%d0
 | |
| 	jbne	30b
 | |
| 
 | |
| mmu_print_done:
 | |
| 	puts	"\n"
 | |
| 
 | |
| func_return	mmu_print
 | |
| 
 | |
| 
 | |
| mmu_030_print_helper:
 | |
| 	moveml	%d0-%d1,%sp@-
 | |
| 	movel	%a4,%d0
 | |
| 	movel	%d6,%d1
 | |
| 	lea	%pc@(mmu_030_print_flags),%a6
 | |
| 	jbsr	mmu_print_tuple
 | |
| 	moveml	%sp@+,%d0-%d1
 | |
| 	rts
 | |
| 
 | |
| mmu_print_tuple_invalidate:
 | |
| 	moveml	%a0/%d7,%sp@-
 | |
| 
 | |
| 	lea	%pc@(L(mmu_print_data)),%a0
 | |
| 	tstl	%a0@(mmu_next_valid)
 | |
| 	jbmi	mmu_print_tuple_invalidate_exit
 | |
| 
 | |
| 	movel	#MMU_PRINT_INVALID,%a0@(mmu_next_valid)
 | |
| 
 | |
| 	putn	%a4
 | |
| 
 | |
| 	puts	"##\n"
 | |
| 
 | |
| mmu_print_tuple_invalidate_exit:
 | |
| 	moveml	%sp@+,%a0/%d7
 | |
| 	rts
 | |
| 
 | |
| 
 | |
| mmu_print_tuple:
 | |
| 	moveml	%d0-%d7/%a0,%sp@-
 | |
| 
 | |
| 	lea	%pc@(L(mmu_print_data)),%a0
 | |
| 
 | |
| 	tstl	%a0@(mmu_next_valid)
 | |
| 	jble	mmu_print_tuple_print
 | |
| 
 | |
| 	cmpl	%a0@(mmu_next_physical),%d1
 | |
| 	jbeq	mmu_print_tuple_increment
 | |
| 
 | |
| mmu_print_tuple_print:
 | |
| 	putn	%d0
 | |
| 	puts	"->"
 | |
| 	putn	%d1
 | |
| 
 | |
| 	movel	%d1,%d6
 | |
| 	jbsr	%a6@
 | |
| 
 | |
| mmu_print_tuple_record:
 | |
| 	movel	#MMU_PRINT_VALID,%a0@(mmu_next_valid)
 | |
| 
 | |
| 	movel	%d1,%a0@(mmu_next_physical)
 | |
| 
 | |
| mmu_print_tuple_increment:
 | |
| 	movel	%d5,%d7
 | |
| 	subl	%a4,%d7
 | |
| 	addl	%d7,%a0@(mmu_next_physical)
 | |
| 
 | |
| mmu_print_tuple_exit:
 | |
| 	moveml	%sp@+,%d0-%d7/%a0
 | |
| 	rts
 | |
| 
 | |
| mmu_print_machine_cpu_types:
 | |
| 	puts	"machine: "
 | |
| 
 | |
| 	is_not_amiga(1f)
 | |
| 	puts	"amiga"
 | |
| 	jbra	9f
 | |
| 1:
 | |
| 	is_not_atari(2f)
 | |
| 	puts	"atari"
 | |
| 	jbra	9f
 | |
| 2:
 | |
| 	is_not_mac(3f)
 | |
| 	puts	"macintosh"
 | |
| 	jbra	9f
 | |
| 3:	puts	"unknown"
 | |
| 9:	putc	'\n'
 | |
| 
 | |
| 	puts	"cputype: 0"
 | |
| 	is_not_060(1f)
 | |
| 	putc	'6'
 | |
| 	jbra	9f
 | |
| 1:
 | |
| 	is_not_040_or_060(2f)
 | |
| 	putc	'4'
 | |
| 	jbra	9f
 | |
| 2:	putc	'3'
 | |
| 9:	putc	'0'
 | |
| 	putc	'\n'
 | |
| 
 | |
| 	rts
 | |
| #endif /* MMU_PRINT */
 | |
| 
 | |
| /*
 | |
|  * mmu_map_tt
 | |
|  *
 | |
|  * This is a specific function which works on all 680x0 machines.
 | |
|  * On 030, 040 & 060 it will attempt to use Transparent Translation
 | |
|  * registers (tt1).
 | |
|  * On 020 it will call the standard mmu_map which will use early
 | |
|  * terminating descriptors.
 | |
|  */
 | |
| func_start	mmu_map_tt,%d0/%d1/%a0,4
 | |
| 
 | |
| 	dputs	"mmu_map_tt:"
 | |
| 	dputn	ARG1
 | |
| 	dputn	ARG2
 | |
| 	dputn	ARG3
 | |
| 	dputn	ARG4
 | |
| 	dputc	'\n'
 | |
| 
 | |
| 	is_020(L(do_map))
 | |
| 
 | |
| 	/* Extract the highest bit set
 | |
| 	 */
 | |
| 	bfffo	ARG3{#0,#32},%d1
 | |
| 	cmpw	#8,%d1
 | |
| 	jcc	L(do_map)
 | |
| 
 | |
| 	/* And get the mask
 | |
| 	 */
 | |
| 	moveq	#-1,%d0
 | |
| 	lsrl	%d1,%d0
 | |
| 	lsrl	#1,%d0
 | |
| 
 | |
| 	/* Mask the address
 | |
| 	 */
 | |
| 	movel	%d0,%d1
 | |
| 	notl	%d1
 | |
| 	andl	ARG2,%d1
 | |
| 
 | |
| 	/* Generate the upper 16bit of the tt register
 | |
| 	 */
 | |
| 	lsrl	#8,%d0
 | |
| 	orl	%d0,%d1
 | |
| 	clrw	%d1
 | |
| 
 | |
| 	is_040_or_060(L(mmu_map_tt_040))
 | |
| 
 | |
| 	/* set 030 specific bits (read/write access for supervisor mode
 | |
| 	 * (highest function code set, lower two bits masked))
 | |
| 	 */
 | |
| 	orw	#TTR_ENABLE+TTR_RWM+TTR_FCB2+TTR_FCM1+TTR_FCM0,%d1
 | |
| 	movel	ARG4,%d0
 | |
| 	btst	#6,%d0
 | |
| 	jeq	1f
 | |
| 	orw	#TTR_CI,%d1
 | |
| 
 | |
| 1:	lea	STACK,%a0
 | |
| 	dputn	%d1
 | |
| 	movel	%d1,%a0@
 | |
| 	.chip	68030
 | |
| 	tstl	ARG1
 | |
| 	jne	1f
 | |
| 	pmove	%a0@,%tt0
 | |
| 	jra	2f
 | |
| 1:	pmove	%a0@,%tt1
 | |
| 2:	.chip	68k
 | |
| 	jra	L(mmu_map_tt_done)
 | |
| 
 | |
| 	/* set 040 specific bits
 | |
| 	 */
 | |
| L(mmu_map_tt_040):
 | |
| 	orw	#TTR_ENABLE+TTR_KERNELMODE,%d1
 | |
| 	orl	ARG4,%d1
 | |
| 	dputn	%d1
 | |
| 
 | |
| 	.chip	68040
 | |
| 	tstl	ARG1
 | |
| 	jne	1f
 | |
| 	movec	%d1,%itt0
 | |
| 	movec	%d1,%dtt0
 | |
| 	jra	2f
 | |
| 1:	movec	%d1,%itt1
 | |
| 	movec	%d1,%dtt1
 | |
| 2:	.chip	68k
 | |
| 
 | |
| 	jra	L(mmu_map_tt_done)
 | |
| 
 | |
| L(do_map):
 | |
| 	mmu_map_eq	ARG2,ARG3,ARG4
 | |
| 
 | |
| L(mmu_map_tt_done):
 | |
| 
 | |
| func_return	mmu_map_tt
 | |
| 
 | |
| /*
 | |
|  *	mmu_map
 | |
|  *
 | |
|  *	This routine will map a range of memory using a pointer
 | |
|  *	table and allocating the pages on the fly from the kernel.
 | |
|  *	The pointer table does not have to be already linked into
 | |
|  *	the root table, this routine will do that if necessary.
 | |
|  *
 | |
|  *	NOTE
 | |
|  *	This routine will assert failure and use the serial_putc
 | |
|  *	routines in the case of a run-time error.  For example,
 | |
|  *	if the address is already mapped.
 | |
|  *
 | |
|  *	NOTE-2
 | |
|  *	This routine will use early terminating descriptors
 | |
|  *	where possible for the 68020+68851 and 68030 type
 | |
|  *	processors.
 | |
|  */
 | |
| func_start	mmu_map,%d0-%d4/%a0-%a4
 | |
| 
 | |
| 	dputs	"\nmmu_map:"
 | |
| 	dputn	ARG1
 | |
| 	dputn	ARG2
 | |
| 	dputn	ARG3
 | |
| 	dputn	ARG4
 | |
| 	dputc	'\n'
 | |
| 
 | |
| 	/* Get logical address and round it down to 256KB
 | |
| 	 */
 | |
| 	movel	ARG1,%d0
 | |
| 	andl	#-(PAGESIZE*PAGE_TABLE_SIZE),%d0
 | |
| 	movel	%d0,%a3
 | |
| 
 | |
| 	/* Get the end address
 | |
| 	 */
 | |
| 	movel	ARG1,%a4
 | |
| 	addl	ARG3,%a4
 | |
| 	subql	#1,%a4
 | |
| 
 | |
| 	/* Get physical address and round it down to 256KB
 | |
| 	 */
 | |
| 	movel	ARG2,%d0
 | |
| 	andl	#-(PAGESIZE*PAGE_TABLE_SIZE),%d0
 | |
| 	movel	%d0,%a2
 | |
| 
 | |
| 	/* Add page attributes to the physical address
 | |
| 	 */
 | |
| 	movel	ARG4,%d0
 | |
| 	orw	#_PAGE_PRESENT+_PAGE_ACCESSED+_PAGE_DIRTY,%d0
 | |
| 	addw	%d0,%a2
 | |
| 
 | |
| 	dputn	%a2
 | |
| 	dputn	%a3
 | |
| 	dputn	%a4
 | |
| 
 | |
| 	is_not_040_or_060(L(mmu_map_030))
 | |
| 
 | |
| 	addw	#_PAGE_GLOBAL040,%a2
 | |
| /*
 | |
|  *	MMU 040 & 060 Support
 | |
|  *
 | |
|  *	The MMU usage for the 040 and 060 is different enough from
 | |
|  *	the 030 and 68851 that there is separate code.  This comment
 | |
|  *	block describes the data structures and algorithms built by
 | |
|  *	this code.
 | |
|  *
 | |
|  *	The 040 does not support early terminating descriptors, as
 | |
|  *	the 030 does.  Therefore, a third level of table is needed
 | |
|  *	for the 040, and that would be the page table.  In Linux,
 | |
|  *	page tables are allocated directly from the memory above the
 | |
|  *	kernel.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| L(mmu_map_040):
 | |
| 	/* Calculate the offset into the root table
 | |
| 	 */
 | |
| 	movel	%a3,%d0
 | |
| 	moveq	#ROOT_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	mmu_get_root_table_entry	%d0
 | |
| 
 | |
| 	/* Calculate the offset into the pointer table
 | |
| 	 */
 | |
| 	movel	%a3,%d0
 | |
| 	moveq	#PTR_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PTR_TABLE_SIZE-1,%d0
 | |
| 	mmu_get_ptr_table_entry		%a0,%d0
 | |
| 
 | |
| 	/* Calculate the offset into the page table
 | |
| 	 */
 | |
| 	movel	%a3,%d0
 | |
| 	moveq	#PAGE_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PAGE_TABLE_SIZE-1,%d0
 | |
| 	mmu_get_page_table_entry	%a0,%d0
 | |
| 
 | |
| 	/* The page table entry must not no be busy
 | |
| 	 */
 | |
| 	tstl	%a0@
 | |
| 	jne	L(mmu_map_error)
 | |
| 
 | |
| 	/* Do the mapping and advance the pointers
 | |
| 	 */
 | |
| 	movel	%a2,%a0@
 | |
| 2:
 | |
| 	addw	#PAGESIZE,%a2
 | |
| 	addw	#PAGESIZE,%a3
 | |
| 
 | |
| 	/* Ready with mapping?
 | |
| 	 */
 | |
| 	lea	%a3@(-1),%a0
 | |
| 	cmpl	%a0,%a4
 | |
| 	jhi	L(mmu_map_040)
 | |
| 	jra	L(mmu_map_done)
 | |
| 
 | |
| L(mmu_map_030):
 | |
| 	/* Calculate the offset into the root table
 | |
| 	 */
 | |
| 	movel	%a3,%d0
 | |
| 	moveq	#ROOT_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	mmu_get_root_table_entry	%d0
 | |
| 
 | |
| 	/* Check if logical address 32MB aligned,
 | |
| 	 * so we can try to map it once
 | |
| 	 */
 | |
| 	movel	%a3,%d0
 | |
| 	andl	#(PTR_TABLE_SIZE*PAGE_TABLE_SIZE*PAGESIZE-1)&(-ROOT_TABLE_SIZE),%d0
 | |
| 	jne	1f
 | |
| 
 | |
| 	/* Is there enough to map for 32MB at once
 | |
| 	 */
 | |
| 	lea	%a3@(PTR_TABLE_SIZE*PAGE_TABLE_SIZE*PAGESIZE-1),%a1
 | |
| 	cmpl	%a1,%a4
 | |
| 	jcs	1f
 | |
| 
 | |
| 	addql	#1,%a1
 | |
| 
 | |
| 	/* The root table entry must not no be busy
 | |
| 	 */
 | |
| 	tstl	%a0@
 | |
| 	jne	L(mmu_map_error)
 | |
| 
 | |
| 	/* Do the mapping and advance the pointers
 | |
| 	 */
 | |
| 	dputs	"early term1"
 | |
| 	dputn	%a2
 | |
| 	dputn	%a3
 | |
| 	dputn	%a1
 | |
| 	dputc	'\n'
 | |
| 	movel	%a2,%a0@
 | |
| 
 | |
| 	movel	%a1,%a3
 | |
| 	lea	%a2@(PTR_TABLE_SIZE*PAGE_TABLE_SIZE*PAGESIZE),%a2
 | |
| 	jra	L(mmu_mapnext_030)
 | |
| 1:
 | |
| 	/* Calculate the offset into the pointer table
 | |
| 	 */
 | |
| 	movel	%a3,%d0
 | |
| 	moveq	#PTR_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PTR_TABLE_SIZE-1,%d0
 | |
| 	mmu_get_ptr_table_entry		%a0,%d0
 | |
| 
 | |
| 	/* The pointer table entry must not no be busy
 | |
| 	 */
 | |
| 	tstl	%a0@
 | |
| 	jne	L(mmu_map_error)
 | |
| 
 | |
| 	/* Do the mapping and advance the pointers
 | |
| 	 */
 | |
| 	dputs	"early term2"
 | |
| 	dputn	%a2
 | |
| 	dputn	%a3
 | |
| 	dputc	'\n'
 | |
| 	movel	%a2,%a0@
 | |
| 
 | |
| 	addl	#PAGE_TABLE_SIZE*PAGESIZE,%a2
 | |
| 	addl	#PAGE_TABLE_SIZE*PAGESIZE,%a3
 | |
| 
 | |
| L(mmu_mapnext_030):
 | |
| 	/* Ready with mapping?
 | |
| 	 */
 | |
| 	lea	%a3@(-1),%a0
 | |
| 	cmpl	%a0,%a4
 | |
| 	jhi	L(mmu_map_030)
 | |
| 	jra	L(mmu_map_done)
 | |
| 
 | |
| L(mmu_map_error):
 | |
| 
 | |
| 	dputs	"mmu_map error:"
 | |
| 	dputn	%a2
 | |
| 	dputn	%a3
 | |
| 	dputc	'\n'
 | |
| 
 | |
| L(mmu_map_done):
 | |
| 
 | |
| func_return	mmu_map
 | |
| 
 | |
| /*
 | |
|  *	mmu_fixup
 | |
|  *
 | |
|  *	On the 040 class machines, all pages that are used for the
 | |
|  *	mmu have to be fixed up.
 | |
|  */
 | |
| 
 | |
| func_start	mmu_fixup_page_mmu_cache,%d0/%a0
 | |
| 
 | |
| 	dputs	"mmu_fixup_page_mmu_cache"
 | |
| 	dputn	ARG1
 | |
| 
 | |
| 	/* Calculate the offset into the root table
 | |
| 	 */
 | |
| 	movel	ARG1,%d0
 | |
| 	moveq	#ROOT_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	mmu_get_root_table_entry	%d0
 | |
| 
 | |
| 	/* Calculate the offset into the pointer table
 | |
| 	 */
 | |
| 	movel	ARG1,%d0
 | |
| 	moveq	#PTR_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PTR_TABLE_SIZE-1,%d0
 | |
| 	mmu_get_ptr_table_entry		%a0,%d0
 | |
| 
 | |
| 	/* Calculate the offset into the page table
 | |
| 	 */
 | |
| 	movel	ARG1,%d0
 | |
| 	moveq	#PAGE_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PAGE_TABLE_SIZE-1,%d0
 | |
| 	mmu_get_page_table_entry	%a0,%d0
 | |
| 
 | |
| 	movel	%a0@,%d0
 | |
| 	andil	#_CACHEMASK040,%d0
 | |
| 	orl	%pc@(m68k_pgtable_cachemode),%d0
 | |
| 	movel	%d0,%a0@
 | |
| 
 | |
| 	dputc	'\n'
 | |
| 
 | |
| func_return	mmu_fixup_page_mmu_cache
 | |
| 
 | |
| /*
 | |
|  *	mmu_temp_map
 | |
|  *
 | |
|  *	create a temporary mapping to enable the mmu,
 | |
|  *	this we don't need any transparation translation tricks.
 | |
|  */
 | |
| 
 | |
| func_start	mmu_temp_map,%d0/%d1/%a0/%a1
 | |
| 
 | |
| 	dputs	"mmu_temp_map"
 | |
| 	dputn	ARG1
 | |
| 	dputn	ARG2
 | |
| 	dputc	'\n'
 | |
| 
 | |
| 	lea	%pc@(L(temp_mmap_mem)),%a1
 | |
| 
 | |
| 	/* Calculate the offset in the root table
 | |
| 	 */
 | |
| 	movel	ARG2,%d0
 | |
| 	moveq	#ROOT_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	mmu_get_root_table_entry	%d0
 | |
| 
 | |
| 	/* Check if the table is temporary allocated, so we have to reuse it
 | |
| 	 */
 | |
| 	movel	%a0@,%d0
 | |
| 	cmpl	%pc@(L(memory_start)),%d0
 | |
| 	jcc	1f
 | |
| 
 | |
| 	/* Temporary allocate a ptr table and insert it into the root table
 | |
| 	 */
 | |
| 	movel	%a1@,%d0
 | |
| 	addl	#PTR_TABLE_SIZE*4,%a1@
 | |
| 	orw	#_PAGE_TABLE+_PAGE_ACCESSED,%d0
 | |
| 	movel	%d0,%a0@
 | |
| 	dputs	" (new)"
 | |
| 1:
 | |
| 	dputn	%d0
 | |
| 	/* Mask the root table entry for the ptr table
 | |
| 	 */
 | |
| 	andw	#-ROOT_TABLE_SIZE,%d0
 | |
| 	movel	%d0,%a0
 | |
| 
 | |
| 	/* Calculate the offset into the pointer table
 | |
| 	 */
 | |
| 	movel	ARG2,%d0
 | |
| 	moveq	#PTR_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PTR_TABLE_SIZE-1,%d0
 | |
| 	lea	%a0@(%d0*4),%a0
 | |
| 	dputn	%a0
 | |
| 
 | |
| 	/* Check if a temporary page table is already allocated
 | |
| 	 */
 | |
| 	movel	%a0@,%d0
 | |
| 	jne	1f
 | |
| 
 | |
| 	/* Temporary allocate a page table and insert it into the ptr table
 | |
| 	 */
 | |
| 	movel	%a1@,%d0
 | |
| 	/* The 512 should be PAGE_TABLE_SIZE*4, but that violates the
 | |
| 	   alignment restriction for pointer tables on the '0[46]0.  */
 | |
| 	addl	#512,%a1@
 | |
| 	orw	#_PAGE_TABLE+_PAGE_ACCESSED,%d0
 | |
| 	movel	%d0,%a0@
 | |
| 	dputs	" (new)"
 | |
| 1:
 | |
| 	dputn	%d0
 | |
| 	/* Mask the ptr table entry for the page table
 | |
| 	 */
 | |
| 	andw	#-PTR_TABLE_SIZE,%d0
 | |
| 	movel	%d0,%a0
 | |
| 
 | |
| 	/* Calculate the offset into the page table
 | |
| 	 */
 | |
| 	movel	ARG2,%d0
 | |
| 	moveq	#PAGE_INDEX_SHIFT,%d1
 | |
| 	lsrl	%d1,%d0
 | |
| 	andl	#PAGE_TABLE_SIZE-1,%d0
 | |
| 	lea	%a0@(%d0*4),%a0
 | |
| 	dputn	%a0
 | |
| 
 | |
| 	/* Insert the address into the page table
 | |
| 	 */
 | |
| 	movel	ARG1,%d0
 | |
| 	andw	#-PAGESIZE,%d0
 | |
| 	orw	#_PAGE_PRESENT+_PAGE_ACCESSED+_PAGE_DIRTY,%d0
 | |
| 	movel	%d0,%a0@
 | |
| 	dputn	%d0
 | |
| 
 | |
| 	dputc	'\n'
 | |
| 
 | |
| func_return	mmu_temp_map
 | |
| 
 | |
| func_start	mmu_engage,%d0-%d2/%a0-%a3
 | |
| 
 | |
| 	moveq	#ROOT_TABLE_SIZE-1,%d0
 | |
| 	/* Temporarily use a different root table.  */
 | |
| 	lea	%pc@(L(kernel_pgdir_ptr)),%a0
 | |
| 	movel	%a0@,%a2
 | |
| 	movel	%pc@(L(memory_start)),%a1
 | |
| 	movel	%a1,%a0@
 | |
| 	movel	%a2,%a0
 | |
| 1:
 | |
| 	movel	%a0@+,%a1@+
 | |
| 	dbra	%d0,1b
 | |
| 
 | |
| 	lea	%pc@(L(temp_mmap_mem)),%a0
 | |
| 	movel	%a1,%a0@
 | |
| 
 | |
| 	movew	#PAGESIZE-1,%d0
 | |
| 1:
 | |
| 	clrl	%a1@+
 | |
| 	dbra	%d0,1b
 | |
| 
 | |
| 	lea	%pc@(1b),%a0
 | |
| 	movel	#1b,%a1
 | |
| 	/* Skip temp mappings if phys == virt */
 | |
| 	cmpl	%a0,%a1
 | |
| 	jeq	1f
 | |
| 
 | |
| 	mmu_temp_map	%a0,%a0
 | |
| 	mmu_temp_map	%a0,%a1
 | |
| 
 | |
| 	addw	#PAGESIZE,%a0
 | |
| 	addw	#PAGESIZE,%a1
 | |
| 	mmu_temp_map	%a0,%a0
 | |
| 	mmu_temp_map	%a0,%a1
 | |
| 1:
 | |
| 	movel	%pc@(L(memory_start)),%a3
 | |
| 	movel	%pc@(L(phys_kernel_start)),%d2
 | |
| 
 | |
| 	is_not_040_or_060(L(mmu_engage_030))
 | |
| 
 | |
| L(mmu_engage_040):
 | |
| 	.chip	68040
 | |
| 	nop
 | |
| 	cinva	%bc
 | |
| 	nop
 | |
| 	pflusha
 | |
| 	nop
 | |
| 	movec	%a3,%srp
 | |
| 	movel	#TC_ENABLE+TC_PAGE4K,%d0
 | |
| 	movec	%d0,%tc		/* enable the MMU */
 | |
| 	jmp	1f:l
 | |
| 1:	nop
 | |
| 	movec	%a2,%srp
 | |
| 	nop
 | |
| 	cinva	%bc
 | |
| 	nop
 | |
| 	pflusha
 | |
| 	.chip	68k
 | |
| 	jra	L(mmu_engage_cleanup)
 | |
| 
 | |
| L(mmu_engage_030_temp):
 | |
| 	.space	12
 | |
| L(mmu_engage_030):
 | |
| 	.chip	68030
 | |
| 	lea	%pc@(L(mmu_engage_030_temp)),%a0
 | |
| 	movel	#0x80000002,%a0@
 | |
| 	movel	%a3,%a0@(4)
 | |
| 	movel	#0x0808,%d0
 | |
| 	movec	%d0,%cacr
 | |
| 	pmove	%a0@,%srp
 | |
| 	pflusha
 | |
| 	/*
 | |
| 	 * enable,super root enable,4096 byte pages,7 bit root index,
 | |
| 	 * 7 bit pointer index, 6 bit page table index.
 | |
| 	 */
 | |
| 	movel	#0x82c07760,%a0@(8)
 | |
| 	pmove	%a0@(8),%tc	/* enable the MMU */
 | |
| 	jmp	1f:l
 | |
| 1:	movel	%a2,%a0@(4)
 | |
| 	movel	#0x0808,%d0
 | |
| 	movec	%d0,%cacr
 | |
| 	pmove	%a0@,%srp
 | |
| 	pflusha
 | |
| 	.chip	68k
 | |
| 
 | |
| L(mmu_engage_cleanup):
 | |
| 	subl	#PAGE_OFFSET,%d2
 | |
| 	subl	%d2,%a2
 | |
| 	movel	%a2,L(kernel_pgdir_ptr)
 | |
| 	subl	%d2,%fp
 | |
| 	subl	%d2,%sp
 | |
| 	subl	%d2,ARG0
 | |
| 
 | |
| func_return	mmu_engage
 | |
| 
 | |
| func_start	mmu_get_root_table_entry,%d0/%a1
 | |
| 
 | |
| #if 0
 | |
| 	dputs	"mmu_get_root_table_entry:"
 | |
| 	dputn	ARG1
 | |
| 	dputs	" ="
 | |
| #endif
 | |
| 
 | |
| 	movel	%pc@(L(kernel_pgdir_ptr)),%a0
 | |
| 	tstl	%a0
 | |
| 	jne	2f
 | |
| 
 | |
| 	dputs	"\nmmu_init:"
 | |
| 
 | |
| 	/* Find the start of free memory, get_bi_record does this for us,
 | |
| 	 * as the bootinfo structure is located directly behind the kernel
 | |
| 	 * and and we simply search for the last entry.
 | |
| 	 */
 | |
| 	get_bi_record	BI_LAST
 | |
| 	addw	#PAGESIZE-1,%a0
 | |
| 	movel	%a0,%d0
 | |
| 	andw	#-PAGESIZE,%d0
 | |
| 
 | |
| 	dputn	%d0
 | |
| 
 | |
| 	lea	%pc@(L(memory_start)),%a0
 | |
| 	movel	%d0,%a0@
 | |
| 	lea	%pc@(L(kernel_end)),%a0
 | |
| 	movel	%d0,%a0@
 | |
| 
 | |
| 	/* we have to return the first page at _stext since the init code
 | |
| 	 * in mm/init.c simply expects kernel_pg_dir there, the rest of
 | |
| 	 * page is used for further ptr tables in get_ptr_table.
 | |
| 	 */
 | |
| 	lea	%pc@(_stext),%a0
 | |
| 	lea	%pc@(L(mmu_cached_pointer_tables)),%a1
 | |
| 	movel	%a0,%a1@
 | |
| 	addl	#ROOT_TABLE_SIZE*4,%a1@
 | |
| 
 | |
| 	lea	%pc@(L(mmu_num_pointer_tables)),%a1
 | |
| 	addql	#1,%a1@
 | |
| 
 | |
| 	/* clear the page
 | |
| 	 */
 | |
| 	movel	%a0,%a1
 | |
| 	movew	#PAGESIZE/4-1,%d0
 | |
| 1:
 | |
| 	clrl	%a1@+
 | |
| 	dbra	%d0,1b
 | |
| 
 | |
| 	lea	%pc@(L(kernel_pgdir_ptr)),%a1
 | |
| 	movel	%a0,%a1@
 | |
| 
 | |
| 	dputn	%a0
 | |
| 	dputc	'\n'
 | |
| 2:
 | |
| 	movel	ARG1,%d0
 | |
| 	lea	%a0@(%d0*4),%a0
 | |
| 
 | |
| #if 0
 | |
| 	dputn	%a0
 | |
| 	dputc	'\n'
 | |
| #endif
 | |
| 
 | |
| func_return	mmu_get_root_table_entry
 | |
| 
 | |
| 
 | |
| 
 | |
| func_start	mmu_get_ptr_table_entry,%d0/%a1
 | |
| 
 | |
| #if 0
 | |
| 	dputs	"mmu_get_ptr_table_entry:"
 | |
| 	dputn	ARG1
 | |
| 	dputn	ARG2
 | |
| 	dputs	" ="
 | |
| #endif
 | |
| 
 | |
| 	movel	ARG1,%a0
 | |
| 	movel	%a0@,%d0
 | |
| 	jne	2f
 | |
| 
 | |
| 	/* Keep track of the number of pointer tables we use
 | |
| 	 */
 | |
| 	dputs	"\nmmu_get_new_ptr_table:"
 | |
| 	lea	%pc@(L(mmu_num_pointer_tables)),%a0
 | |
| 	movel	%a0@,%d0
 | |
| 	addql	#1,%a0@
 | |
| 
 | |
| 	/* See if there is a free pointer table in our cache of pointer tables
 | |
| 	 */
 | |
| 	lea	%pc@(L(mmu_cached_pointer_tables)),%a1
 | |
| 	andw	#7,%d0
 | |
| 	jne	1f
 | |
| 
 | |
| 	/* Get a new pointer table page from above the kernel memory
 | |
| 	 */
 | |
| 	get_new_page
 | |
| 	movel	%a0,%a1@
 | |
| 1:
 | |
| 	/* There is an unused pointer table in our cache... use it
 | |
| 	 */
 | |
| 	movel	%a1@,%d0
 | |
| 	addl	#PTR_TABLE_SIZE*4,%a1@
 | |
| 
 | |
| 	dputn	%d0
 | |
| 	dputc	'\n'
 | |
| 
 | |
| 	/* Insert the new pointer table into the root table
 | |
| 	 */
 | |
| 	movel	ARG1,%a0
 | |
| 	orw	#_PAGE_TABLE+_PAGE_ACCESSED,%d0
 | |
| 	movel	%d0,%a0@
 | |
| 2:
 | |
| 	/* Extract the pointer table entry
 | |
| 	 */
 | |
| 	andw	#-PTR_TABLE_SIZE,%d0
 | |
| 	movel	%d0,%a0
 | |
| 	movel	ARG2,%d0
 | |
| 	lea	%a0@(%d0*4),%a0
 | |
| 
 | |
| #if 0
 | |
| 	dputn	%a0
 | |
| 	dputc	'\n'
 | |
| #endif
 | |
| 
 | |
| func_return	mmu_get_ptr_table_entry
 | |
| 
 | |
| 
 | |
| func_start	mmu_get_page_table_entry,%d0/%a1
 | |
| 
 | |
| #if 0
 | |
| 	dputs	"mmu_get_page_table_entry:"
 | |
| 	dputn	ARG1
 | |
| 	dputn	ARG2
 | |
| 	dputs	" ="
 | |
| #endif
 | |
| 
 | |
| 	movel	ARG1,%a0
 | |
| 	movel	%a0@,%d0
 | |
| 	jne	2f
 | |
| 
 | |
| 	/* If the page table entry doesn't exist, we allocate a complete new
 | |
| 	 * page and use it as one continues big page table which can cover
 | |
| 	 * 4MB of memory, nearly almost all mappings have that alignment.
 | |
| 	 */
 | |
| 	get_new_page
 | |
| 	addw	#_PAGE_TABLE+_PAGE_ACCESSED,%a0
 | |
| 
 | |
| 	/* align pointer table entry for a page of page tables
 | |
| 	 */
 | |
| 	movel	ARG1,%d0
 | |
| 	andw	#-(PAGESIZE/PAGE_TABLE_SIZE),%d0
 | |
| 	movel	%d0,%a1
 | |
| 
 | |
| 	/* Insert the page tables into the pointer entries
 | |
| 	 */
 | |
| 	moveq	#PAGESIZE/PAGE_TABLE_SIZE/4-1,%d0
 | |
| 1:
 | |
| 	movel	%a0,%a1@+
 | |
| 	lea	%a0@(PAGE_TABLE_SIZE*4),%a0
 | |
| 	dbra	%d0,1b
 | |
| 
 | |
| 	/* Now we can get the initialized pointer table entry
 | |
| 	 */
 | |
| 	movel	ARG1,%a0
 | |
| 	movel	%a0@,%d0
 | |
| 2:
 | |
| 	/* Extract the page table entry
 | |
| 	 */
 | |
| 	andw	#-PAGE_TABLE_SIZE,%d0
 | |
| 	movel	%d0,%a0
 | |
| 	movel	ARG2,%d0
 | |
| 	lea	%a0@(%d0*4),%a0
 | |
| 
 | |
| #if 0
 | |
| 	dputn	%a0
 | |
| 	dputc	'\n'
 | |
| #endif
 | |
| 
 | |
| func_return	mmu_get_page_table_entry
 | |
| 
 | |
| /*
 | |
|  *	get_new_page
 | |
|  *
 | |
|  *	Return a new page from the memory start and clear it.
 | |
|  */
 | |
| func_start	get_new_page,%d0/%a1
 | |
| 
 | |
| 	dputs	"\nget_new_page:"
 | |
| 
 | |
| 	/* allocate the page and adjust memory_start
 | |
| 	 */
 | |
| 	lea	%pc@(L(memory_start)),%a0
 | |
| 	movel	%a0@,%a1
 | |
| 	addl	#PAGESIZE,%a0@
 | |
| 
 | |
| 	/* clear the new page
 | |
| 	 */
 | |
| 	movel	%a1,%a0
 | |
| 	movew	#PAGESIZE/4-1,%d0
 | |
| 1:
 | |
| 	clrl	%a1@+
 | |
| 	dbra	%d0,1b
 | |
| 
 | |
| 	dputn	%a0
 | |
| 	dputc	'\n'
 | |
| 
 | |
| func_return	get_new_page
 | |
| 
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * Debug output support
 | |
|  * Atarians have a choice between the parallel port, the serial port
 | |
|  * from the MFP or a serial port of the SCC
 | |
|  */
 | |
| 
 | |
| #ifdef CONFIG_MAC
 | |
| /* You may define either or both of these. */
 | |
| #define MAC_USE_SCC_A /* Modem port */
 | |
| #define MAC_USE_SCC_B /* Printer port */
 | |
| 
 | |
| #if defined(MAC_USE_SCC_A) || defined(MAC_USE_SCC_B)
 | |
| /* Initialisation table for SCC with 3.6864 MHz PCLK */
 | |
| L(scc_initable_mac):
 | |
| 	.byte	4,0x44		/* x16, 1 stopbit, no parity */
 | |
| 	.byte	3,0xc0		/* receiver: 8 bpc */
 | |
| 	.byte	5,0xe2		/* transmitter: 8 bpc, assert dtr/rts */
 | |
| 	.byte	10,0		/* NRZ */
 | |
| 	.byte	11,0x50		/* use baud rate generator */
 | |
| 	.byte	12,1,13,0	/* 38400 baud */
 | |
| 	.byte	14,1		/* Baud rate generator enable */
 | |
| 	.byte	3,0xc1		/* enable receiver */
 | |
| 	.byte	5,0xea		/* enable transmitter */
 | |
| 	.byte	-1
 | |
| 	.even
 | |
| #endif
 | |
| #endif /* CONFIG_MAC */
 | |
| 
 | |
| #ifdef CONFIG_ATARI
 | |
| /* #define USE_PRINTER */
 | |
| /* #define USE_SCC_B */
 | |
| /* #define USE_SCC_A */
 | |
| #define USE_MFP
 | |
| 
 | |
| #if defined(USE_SCC_A) || defined(USE_SCC_B)
 | |
| /* Initialisation table for SCC with 7.9872 MHz PCLK */
 | |
| /* PCLK == 8.0539 gives baud == 9680.1 */
 | |
| L(scc_initable_atari):
 | |
| 	.byte	4,0x44		/* x16, 1 stopbit, no parity */
 | |
| 	.byte	3,0xc0		/* receiver: 8 bpc */
 | |
| 	.byte	5,0xe2		/* transmitter: 8 bpc, assert dtr/rts */
 | |
| 	.byte	10,0		/* NRZ */
 | |
| 	.byte	11,0x50		/* use baud rate generator */
 | |
| 	.byte	12,24,13,0	/* 9600 baud */
 | |
| 	.byte	14,2,14,3	/* use master clock for BRG, enable */
 | |
| 	.byte	3,0xc1		/* enable receiver */
 | |
| 	.byte	5,0xea		/* enable transmitter */
 | |
| 	.byte	-1
 | |
| 	.even
 | |
| #endif
 | |
| 
 | |
| #ifdef USE_PRINTER
 | |
| 
 | |
| LPSG_SELECT	= 0xff8800
 | |
| LPSG_READ	= 0xff8800
 | |
| LPSG_WRITE	= 0xff8802
 | |
| LPSG_IO_A	= 14
 | |
| LPSG_IO_B	= 15
 | |
| LPSG_CONTROL	= 7
 | |
| LSTMFP_GPIP	= 0xfffa01
 | |
| LSTMFP_DDR	= 0xfffa05
 | |
| LSTMFP_IERB	= 0xfffa09
 | |
| 
 | |
| #elif defined(USE_SCC_B)
 | |
| 
 | |
| LSCC_CTRL	= 0xff8c85
 | |
| LSCC_DATA	= 0xff8c87
 | |
| 
 | |
| #elif defined(USE_SCC_A)
 | |
| 
 | |
| LSCC_CTRL	= 0xff8c81
 | |
| LSCC_DATA	= 0xff8c83
 | |
| 
 | |
| #elif defined(USE_MFP)
 | |
| 
 | |
| LMFP_UCR     = 0xfffa29
 | |
| LMFP_TDCDR   = 0xfffa1d
 | |
| LMFP_TDDR    = 0xfffa25
 | |
| LMFP_TSR     = 0xfffa2d
 | |
| LMFP_UDR     = 0xfffa2f
 | |
| 
 | |
| #endif
 | |
| #endif	/* CONFIG_ATARI */
 | |
| 
 | |
| /*
 | |
|  * Serial port output support.
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * Initialize serial port hardware
 | |
|  */
 | |
| func_start	serial_init,%d0/%d1/%a0/%a1
 | |
| 	/*
 | |
| 	 *	Some of the register usage that follows
 | |
| 	 *	CONFIG_AMIGA
 | |
| 	 *		a0 = pointer to boot info record
 | |
| 	 *		d0 = boot info offset
 | |
| 	 *	CONFIG_ATARI
 | |
| 	 *		a0 = address of SCC
 | |
| 	 *		a1 = Liobase address/address of scc_initable_atari
 | |
| 	 *		d0 = init data for serial port
 | |
| 	 *	CONFIG_MAC
 | |
| 	 *		a0 = address of SCC
 | |
| 	 *		a1 = address of scc_initable_mac
 | |
| 	 *		d0 = init data for serial port
 | |
| 	 */
 | |
| 
 | |
| #ifdef CONFIG_AMIGA
 | |
| #define SERIAL_DTR	7
 | |
| #define SERIAL_CNTRL	CIABBASE+C_PRA
 | |
| 
 | |
| 	is_not_amiga(1f)
 | |
| 	lea	%pc@(L(custom)),%a0
 | |
| 	movel	#-ZTWOBASE,%a0@
 | |
| 	bclr	#SERIAL_DTR,SERIAL_CNTRL-ZTWOBASE
 | |
| 	get_bi_record	BI_AMIGA_SERPER
 | |
| 	movew	%a0@,CUSTOMBASE+C_SERPER-ZTWOBASE
 | |
| |	movew	#61,CUSTOMBASE+C_SERPER-ZTWOBASE
 | |
| 1:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_ATARI
 | |
| 	is_not_atari(4f)
 | |
| 	movel	%pc@(L(iobase)),%a1
 | |
| #if defined(USE_PRINTER)
 | |
| 	bclr	#0,%a1@(LSTMFP_IERB)
 | |
| 	bclr	#0,%a1@(LSTMFP_DDR)
 | |
| 	moveb	#LPSG_CONTROL,%a1@(LPSG_SELECT)
 | |
| 	moveb	#0xff,%a1@(LPSG_WRITE)
 | |
| 	moveb	#LPSG_IO_B,%a1@(LPSG_SELECT)
 | |
| 	clrb	%a1@(LPSG_WRITE)
 | |
| 	moveb	#LPSG_IO_A,%a1@(LPSG_SELECT)
 | |
| 	moveb	%a1@(LPSG_READ),%d0
 | |
| 	bset	#5,%d0
 | |
| 	moveb	%d0,%a1@(LPSG_WRITE)
 | |
| #elif defined(USE_SCC_A) || defined(USE_SCC_B)
 | |
| 	lea	%a1@(LSCC_CTRL),%a0
 | |
| 	/* Reset SCC register pointer */
 | |
| 	moveb	%a0@,%d0
 | |
| 	/* Reset SCC device: write register pointer then register value */
 | |
| 	moveb	#9,%a0@
 | |
| 	moveb	#0xc0,%a0@
 | |
| 	/* Wait for 5 PCLK cycles, which is about 63 CPU cycles */
 | |
| 	/* 5 / 7.9872 MHz = approx. 0.63 us = 63 / 100 MHz */
 | |
| 	movel	#32,%d0
 | |
| 2:
 | |
| 	subq	#1,%d0
 | |
| 	jne	2b
 | |
| 	/* Initialize channel */
 | |
| 	lea	%pc@(L(scc_initable_atari)),%a1
 | |
| 2:	moveb	%a1@+,%d0
 | |
| 	jmi	3f
 | |
| 	moveb	%d0,%a0@
 | |
| 	moveb	%a1@+,%a0@
 | |
| 	jra	2b
 | |
| 3:	clrb	%a0@
 | |
| #elif defined(USE_MFP)
 | |
| 	bclr	#1,%a1@(LMFP_TSR)
 | |
| 	moveb   #0x88,%a1@(LMFP_UCR)
 | |
| 	andb	#0x70,%a1@(LMFP_TDCDR)
 | |
| 	moveb   #2,%a1@(LMFP_TDDR)
 | |
| 	orb	#1,%a1@(LMFP_TDCDR)
 | |
| 	bset	#1,%a1@(LMFP_TSR)
 | |
| #endif
 | |
| 	jra	L(serial_init_done)
 | |
| 4:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_MAC
 | |
| 	is_not_mac(L(serial_init_not_mac))
 | |
| #if defined(MAC_USE_SCC_A) || defined(MAC_USE_SCC_B)
 | |
| #define mac_scc_cha_b_ctrl_offset	0x0
 | |
| #define mac_scc_cha_a_ctrl_offset	0x2
 | |
| #define mac_scc_cha_b_data_offset	0x4
 | |
| #define mac_scc_cha_a_data_offset	0x6
 | |
| 	movel	%pc@(L(mac_sccbase)),%a0
 | |
| 	/* Reset SCC register pointer */
 | |
| 	moveb	%a0@(mac_scc_cha_a_ctrl_offset),%d0
 | |
| 	/* Reset SCC device: write register pointer then register value */
 | |
| 	moveb	#9,%a0@(mac_scc_cha_a_ctrl_offset)
 | |
| 	moveb	#0xc0,%a0@(mac_scc_cha_a_ctrl_offset)
 | |
| 	/* Wait for 5 PCLK cycles, which is about 68 CPU cycles */
 | |
| 	/* 5 / 3.6864 MHz = approx. 1.36 us = 68 / 50 MHz */
 | |
| 	movel	#35,%d0
 | |
| 5:
 | |
| 	subq	#1,%d0
 | |
| 	jne	5b
 | |
| #endif
 | |
| #ifdef MAC_USE_SCC_A
 | |
| 	/* Initialize channel A */
 | |
| 	lea	%pc@(L(scc_initable_mac)),%a1
 | |
| 5:	moveb	%a1@+,%d0
 | |
| 	jmi	6f
 | |
| 	moveb	%d0,%a0@(mac_scc_cha_a_ctrl_offset)
 | |
| 	moveb	%a1@+,%a0@(mac_scc_cha_a_ctrl_offset)
 | |
| 	jra	5b
 | |
| 6:
 | |
| #endif	/* MAC_USE_SCC_A */
 | |
| #ifdef MAC_USE_SCC_B
 | |
| 	/* Initialize channel B */
 | |
| 	lea	%pc@(L(scc_initable_mac)),%a1
 | |
| 7:	moveb	%a1@+,%d0
 | |
| 	jmi	8f
 | |
| 	moveb	%d0,%a0@(mac_scc_cha_b_ctrl_offset)
 | |
| 	moveb	%a1@+,%a0@(mac_scc_cha_b_ctrl_offset)
 | |
| 	jra	7b
 | |
| 8:
 | |
| #endif	/* MAC_USE_SCC_B */
 | |
| 	jra	L(serial_init_done)
 | |
| L(serial_init_not_mac):
 | |
| #endif	/* CONFIG_MAC */
 | |
| 
 | |
| #ifdef CONFIG_Q40
 | |
| 	is_not_q40(2f)
 | |
| /* debug output goes into SRAM, so we don't do it unless requested
 | |
|    - check for '%LX$' signature in SRAM   */
 | |
| 	lea	%pc@(q40_mem_cptr),%a1
 | |
| 	move.l	#0xff020010,%a1@  /* must be inited - also used by debug=mem */
 | |
| 	move.l	#0xff020000,%a1
 | |
| 	cmp.b	#'%',%a1@
 | |
| 	bne	2f	/*nodbg*/
 | |
| 	addq.w	#4,%a1
 | |
| 	cmp.b	#'L',%a1@
 | |
| 	bne	2f	/*nodbg*/
 | |
| 	addq.w	#4,%a1
 | |
| 	cmp.b	#'X',%a1@
 | |
| 	bne	2f	/*nodbg*/
 | |
| 	addq.w	#4,%a1
 | |
| 	cmp.b	#'$',%a1@
 | |
| 	bne	2f	/*nodbg*/
 | |
| 	/* signature OK */
 | |
| 	lea	%pc@(L(q40_do_debug)),%a1
 | |
| 	tas	%a1@
 | |
| /*nodbg: q40_do_debug is 0 by default*/
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_MVME16x
 | |
| 	is_not_mvme16x(L(serial_init_not_mvme16x))
 | |
| 	moveb	#0x10,M167_PCSCCMICR
 | |
| 	moveb	#0x10,M167_PCSCCTICR
 | |
| 	moveb	#0x10,M167_PCSCCRICR
 | |
| 	jra	L(serial_init_done)
 | |
| L(serial_init_not_mvme16x):
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_APOLLO
 | |
| /* We count on the PROM initializing SIO1 */
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_HP300
 | |
| /* We count on the boot loader initialising the UART */
 | |
| #endif
 | |
| 
 | |
| L(serial_init_done):
 | |
| func_return	serial_init
 | |
| 
 | |
| /*
 | |
|  * Output character on serial port.
 | |
|  */
 | |
| func_start	serial_putc,%d0/%d1/%a0/%a1
 | |
| 
 | |
| 	movel	ARG1,%d0
 | |
| 	cmpib	#'\n',%d0
 | |
| 	jbne	1f
 | |
| 
 | |
| 	/* A little safe recursion is good for the soul */
 | |
| 	serial_putc	#'\r'
 | |
| 1:
 | |
| 
 | |
| #ifdef CONFIG_AMIGA
 | |
| 	is_not_amiga(2f)
 | |
| 	andw	#0x00ff,%d0
 | |
| 	oriw	#0x0100,%d0
 | |
| 	movel	%pc@(L(custom)),%a0
 | |
| 	movew	%d0,%a0@(CUSTOMBASE+C_SERDAT)
 | |
| 1:	movew	%a0@(CUSTOMBASE+C_SERDATR),%d0
 | |
| 	andw	#0x2000,%d0
 | |
| 	jeq	1b
 | |
| 	jra	L(serial_putc_done)
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_MAC
 | |
| 	is_not_mac(5f)
 | |
| #if defined(MAC_USE_SCC_A) || defined(MAC_USE_SCC_B)
 | |
| 	movel	%pc@(L(mac_sccbase)),%a1
 | |
| #endif
 | |
| #ifdef MAC_USE_SCC_A
 | |
| 3:	btst	#2,%a1@(mac_scc_cha_a_ctrl_offset)
 | |
| 	jeq	3b
 | |
| 	moveb	%d0,%a1@(mac_scc_cha_a_data_offset)
 | |
| #endif	/* MAC_USE_SCC_A */
 | |
| #ifdef MAC_USE_SCC_B
 | |
| 4:	btst	#2,%a1@(mac_scc_cha_b_ctrl_offset)
 | |
| 	jeq	4b
 | |
| 	moveb	%d0,%a1@(mac_scc_cha_b_data_offset)
 | |
| #endif	/* MAC_USE_SCC_B */
 | |
| 	jra	L(serial_putc_done)
 | |
| 5:
 | |
| #endif	/* CONFIG_MAC */
 | |
| 
 | |
| #ifdef CONFIG_ATARI
 | |
| 	is_not_atari(4f)
 | |
| 	movel	%pc@(L(iobase)),%a1
 | |
| #if defined(USE_PRINTER)
 | |
| 3:	btst	#0,%a1@(LSTMFP_GPIP)
 | |
| 	jne	3b
 | |
| 	moveb	#LPSG_IO_B,%a1@(LPSG_SELECT)
 | |
| 	moveb	%d0,%a1@(LPSG_WRITE)
 | |
| 	moveb	#LPSG_IO_A,%a1@(LPSG_SELECT)
 | |
| 	moveb	%a1@(LPSG_READ),%d0
 | |
| 	bclr	#5,%d0
 | |
| 	moveb	%d0,%a1@(LPSG_WRITE)
 | |
| 	nop
 | |
| 	nop
 | |
| 	bset	#5,%d0
 | |
| 	moveb	%d0,%a1@(LPSG_WRITE)
 | |
| #elif defined(USE_SCC_A) || defined(USE_SCC_B)
 | |
| 3:	btst	#2,%a1@(LSCC_CTRL)
 | |
| 	jeq	3b
 | |
| 	moveb	%d0,%a1@(LSCC_DATA)
 | |
| #elif defined(USE_MFP)
 | |
| 3:	btst	#7,%a1@(LMFP_TSR)
 | |
| 	jeq	3b
 | |
| 	moveb	%d0,%a1@(LMFP_UDR)
 | |
| #endif
 | |
| 	jra	L(serial_putc_done)
 | |
| 4:
 | |
| #endif	/* CONFIG_ATARI */
 | |
| 
 | |
| #ifdef CONFIG_MVME147
 | |
| 	is_not_mvme147(2f)
 | |
| 1:	btst	#2,M147_SCC_CTRL_A
 | |
| 	jeq	1b
 | |
| 	moveb	%d0,M147_SCC_DATA_A
 | |
| 	jbra	L(serial_putc_done)
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_MVME16x
 | |
| 	is_not_mvme16x(2f)
 | |
| 	/*
 | |
| 	 * If the loader gave us a board type then we can use that to
 | |
| 	 * select an appropriate output routine; otherwise we just use
 | |
| 	 * the Bug code.  If we have to use the Bug that means the Bug
 | |
| 	 * workspace has to be valid, which means the Bug has to use
 | |
| 	 * the SRAM, which is non-standard.
 | |
| 	 */
 | |
| 	moveml	%d0-%d7/%a2-%a6,%sp@-
 | |
| 	movel	vme_brdtype,%d1
 | |
| 	jeq	1f			| No tag - use the Bug
 | |
| 	cmpi	#VME_TYPE_MVME162,%d1
 | |
| 	jeq	6f
 | |
| 	cmpi	#VME_TYPE_MVME172,%d1
 | |
| 	jne	5f
 | |
| 	/* 162/172; it's an SCC */
 | |
| 6:	btst	#2,M162_SCC_CTRL_A
 | |
| 	nop
 | |
| 	nop
 | |
| 	nop
 | |
| 	jeq	6b
 | |
| 	moveb	#8,M162_SCC_CTRL_A
 | |
| 	nop
 | |
| 	nop
 | |
| 	nop
 | |
| 	moveb	%d0,M162_SCC_CTRL_A
 | |
| 	jra	3f
 | |
| 5:
 | |
| 	/* 166/167/177; it's a CD2401 */
 | |
| 	moveb	#0,M167_CYCAR
 | |
| 	moveb	M167_CYIER,%d2
 | |
| 	moveb	#0x02,M167_CYIER
 | |
| 7:
 | |
| 	btst	#5,M167_PCSCCTICR
 | |
| 	jeq	7b
 | |
| 	moveb	M167_PCTPIACKR,%d1
 | |
| 	moveb	M167_CYLICR,%d1
 | |
| 	jeq	8f
 | |
| 	moveb	#0x08,M167_CYTEOIR
 | |
| 	jra	7b
 | |
| 8:
 | |
| 	moveb	%d0,M167_CYTDR
 | |
| 	moveb	#0,M167_CYTEOIR
 | |
| 	moveb	%d2,M167_CYIER
 | |
| 	jra	3f
 | |
| 1:
 | |
| 	moveb	%d0,%sp@-
 | |
| 	trap	#15
 | |
| 	.word	0x0020	/* TRAP 0x020 */
 | |
| 3:
 | |
| 	moveml	%sp@+,%d0-%d7/%a2-%a6
 | |
| 	jbra	L(serial_putc_done)
 | |
| 2:
 | |
| #endif /* CONFIG_MVME16x */
 | |
| 
 | |
| #ifdef CONFIG_BVME6000
 | |
| 	is_not_bvme6000(2f)
 | |
| 	/*
 | |
| 	 * The BVME6000 machine has a serial port ...
 | |
| 	 */
 | |
| 1:	btst	#2,BVME_SCC_CTRL_A
 | |
| 	jeq	1b
 | |
| 	moveb	%d0,BVME_SCC_DATA_A
 | |
| 	jbra	L(serial_putc_done)
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_SUN3X
 | |
| 	is_not_sun3x(2f)
 | |
| 	movel	%d0,-(%sp)
 | |
| 	movel	0xFEFE0018,%a1
 | |
| 	jbsr	(%a1)
 | |
| 	addq	#4,%sp
 | |
| 	jbra	L(serial_putc_done)
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_Q40
 | |
| 	is_not_q40(2f)
 | |
| 	tst.l	%pc@(L(q40_do_debug))	/* only debug if requested */
 | |
| 	beq	2f
 | |
| 	lea	%pc@(q40_mem_cptr),%a1
 | |
| 	move.l	%a1@,%a0
 | |
| 	move.b	%d0,%a0@
 | |
| 	addq.l	#4,%a0
 | |
| 	move.l	%a0,%a1@
 | |
| 	jbra    L(serial_putc_done)
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_APOLLO
 | |
| 	is_not_apollo(2f)
 | |
| 	movl    %pc@(L(iobase)),%a1
 | |
| 	moveb	%d0,%a1@(LTHRB0)
 | |
| 1:      moveb   %a1@(LSRB0),%d0
 | |
| 	andb	#0x4,%d0
 | |
| 	beq	1b
 | |
| 	jbra	L(serial_putc_done)
 | |
| 2:
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_HP300
 | |
| 	is_not_hp300(3f)
 | |
| 	movl    %pc@(L(iobase)),%a1
 | |
| 	addl	%pc@(L(uartbase)),%a1
 | |
| 	movel	%pc@(L(uart_scode)),%d1	/* Check the scode */
 | |
| 	jmi	3f			/* Unset? Exit */
 | |
| 	cmpi	#256,%d1		/* APCI scode? */
 | |
| 	jeq	2f
 | |
| 1:      moveb   %a1@(DCALSR),%d1	/* Output to DCA */
 | |
| 	andb	#0x20,%d1
 | |
| 	beq	1b
 | |
| 	moveb	%d0,%a1@(DCADATA)
 | |
| 	jbra	L(serial_putc_done)
 | |
| 2:	moveb	%a1@(APCILSR),%d1	/* Output to APCI */
 | |
| 	andb	#0x20,%d1
 | |
| 	beq	2b
 | |
| 	moveb	%d0,%a1@(APCIDATA)
 | |
| 	jbra	L(serial_putc_done)
 | |
| 3:
 | |
| #endif
 | |
| 
 | |
| L(serial_putc_done):
 | |
| func_return	serial_putc
 | |
| 
 | |
| /*
 | |
|  * Output a string.
 | |
|  */
 | |
| func_start	puts,%d0/%a0
 | |
| 
 | |
| 	movel	ARG1,%a0
 | |
| 	jra	2f
 | |
| 1:
 | |
| #ifdef CONSOLE_DEBUG
 | |
| 	console_putc	%d0
 | |
| #endif
 | |
| #ifdef SERIAL_DEBUG
 | |
| 	serial_putc	%d0
 | |
| #endif
 | |
| 2:	moveb	%a0@+,%d0
 | |
| 	jne	1b
 | |
| 
 | |
| func_return	puts
 | |
| 
 | |
| /*
 | |
|  * Output number in hex notation.
 | |
|  */
 | |
| 
 | |
| func_start	putn,%d0-%d2
 | |
| 
 | |
| 	putc	' '
 | |
| 
 | |
| 	movel	ARG1,%d0
 | |
| 	moveq	#7,%d1
 | |
| 1:	roll	#4,%d0
 | |
| 	move	%d0,%d2
 | |
| 	andb	#0x0f,%d2
 | |
| 	addb	#'0',%d2
 | |
| 	cmpb	#'9',%d2
 | |
| 	jls	2f
 | |
| 	addb	#'A'-('9'+1),%d2
 | |
| 2:
 | |
| #ifdef CONSOLE_DEBUG
 | |
| 	console_putc	%d2
 | |
| #endif
 | |
| #ifdef SERIAL_DEBUG
 | |
| 	serial_putc	%d2
 | |
| #endif
 | |
| 	dbra	%d1,1b
 | |
| 
 | |
| func_return	putn
 | |
| 
 | |
| #ifdef CONFIG_EARLY_PRINTK
 | |
| /*
 | |
|  *	This routine takes its parameters on the stack.  It then
 | |
|  *	turns around and calls the internal routines.  This routine
 | |
|  *	is used by the boot console.
 | |
|  *
 | |
|  *	The calling parameters are:
 | |
|  *		void debug_cons_nputs(const char *str, unsigned length)
 | |
|  *
 | |
|  *	This routine does NOT understand variable arguments only
 | |
|  *	simple strings!
 | |
|  */
 | |
| ENTRY(debug_cons_nputs)
 | |
| 	moveml	%d0/%d1/%a0,%sp@-
 | |
| 	movew	%sr,%sp@-
 | |
| 	ori	#0x0700,%sr
 | |
| 	movel	%sp@(18),%a0		/* fetch parameter */
 | |
| 	movel	%sp@(22),%d1		/* fetch parameter */
 | |
| 	jra	2f
 | |
| 1:
 | |
| #ifdef CONSOLE_DEBUG
 | |
| 	console_putc	%d0
 | |
| #endif
 | |
| #ifdef SERIAL_DEBUG
 | |
| 	serial_putc	%d0
 | |
| #endif
 | |
| 	subq	#1,%d1
 | |
| 2:	jeq	3f
 | |
| 	moveb	%a0@+,%d0
 | |
| 	jne	1b
 | |
| 3:
 | |
| 	movew	%sp@+,%sr
 | |
| 	moveml	%sp@+,%d0/%d1/%a0
 | |
| 	rts
 | |
| #endif /* CONFIG_EARLY_PRINTK */
 | |
| 
 | |
| #if defined(CONFIG_HP300) || defined(CONFIG_APOLLO)
 | |
| func_start	set_leds,%d0/%a0
 | |
| 	movel	ARG1,%d0
 | |
| #ifdef CONFIG_HP300
 | |
| 	is_not_hp300(1f)
 | |
| 	movel	%pc@(L(iobase)),%a0
 | |
| 	moveb	%d0,%a0@(0x1ffff)
 | |
| 	jra	2f
 | |
| #endif
 | |
| 1:
 | |
| #ifdef CONFIG_APOLLO
 | |
| 	movel   %pc@(L(iobase)),%a0
 | |
| 	lsll    #8,%d0
 | |
| 	eorw    #0xff00,%d0
 | |
| 	moveb	%d0,%a0@(LCPUCTRL)
 | |
| #endif
 | |
| 2:
 | |
| func_return	set_leds
 | |
| #endif
 | |
| 
 | |
| #ifdef CONSOLE_DEBUG
 | |
| /*
 | |
|  *	For continuity, see the data alignment
 | |
|  *	to which this structure is tied.
 | |
|  */
 | |
| #define Lconsole_struct_cur_column	0
 | |
| #define Lconsole_struct_cur_row		4
 | |
| #define Lconsole_struct_num_columns	8
 | |
| #define Lconsole_struct_num_rows	12
 | |
| #define Lconsole_struct_left_edge	16
 | |
| 
 | |
| func_start	console_init,%a0-%a4/%d0-%d7
 | |
| 	/*
 | |
| 	 *	Some of the register usage that follows
 | |
| 	 *		a0 = pointer to boot_info
 | |
| 	 *		a1 = pointer to screen
 | |
| 	 *		a2 = pointer to console_globals
 | |
| 	 *		d3 = pixel width of screen
 | |
| 	 *		d4 = pixel height of screen
 | |
| 	 *		(d3,d4) ~= (x,y) of a point just below
 | |
| 	 *			and to the right of the screen
 | |
| 	 *			NOT on the screen!
 | |
| 	 *		d5 = number of bytes per scan line
 | |
| 	 *		d6 = number of bytes on the entire screen
 | |
| 	 */
 | |
| 
 | |
| 	lea	%pc@(L(console_globals)),%a2
 | |
| 	movel	%pc@(L(mac_videobase)),%a1
 | |
| 	movel	%pc@(L(mac_rowbytes)),%d5
 | |
| 	movel	%pc@(L(mac_dimensions)),%d3	/* -> low byte */
 | |
| 	movel	%d3,%d4
 | |
| 	swap	%d4		/* -> high byte */
 | |
| 	andl	#0xffff,%d3	/* d3 = screen width in pixels */
 | |
| 	andl	#0xffff,%d4	/* d4 = screen height in pixels */
 | |
| 
 | |
| 	movel	%d5,%d6
 | |
| |	subl	#20,%d6
 | |
| 	mulul	%d4,%d6		/* scan line bytes x num scan lines */
 | |
| 	divul	#8,%d6		/* we'll clear 8 bytes at a time */
 | |
| 	moveq	#-1,%d0		/* Mac_black */
 | |
| 	subq	#1,%d6
 | |
| 
 | |
| L(console_clear_loop):
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	dbra	%d6,L(console_clear_loop)
 | |
| 
 | |
| 	/* Calculate font size */
 | |
| 
 | |
| #if   defined(FONT_8x8) && defined(CONFIG_FONT_8x8)
 | |
| 	lea	%pc@(font_vga_8x8),%a0
 | |
| #elif defined(FONT_8x16) && defined(CONFIG_FONT_8x16)
 | |
| 	lea	%pc@(font_vga_8x16),%a0
 | |
| #elif defined(FONT_6x11) && defined(CONFIG_FONT_6x11)
 | |
| 	lea	%pc@(font_vga_6x11),%a0
 | |
| #elif defined(CONFIG_FONT_8x8) /* default */
 | |
| 	lea	%pc@(font_vga_8x8),%a0
 | |
| #else /* no compiled-in font */
 | |
| 	lea	0,%a0
 | |
| #endif
 | |
| 
 | |
| 	/*
 | |
| 	 *	At this point we make a shift in register usage
 | |
| 	 *	a1 = address of console_font pointer
 | |
| 	 */
 | |
| 	lea	%pc@(L(console_font)),%a1
 | |
| 	movel	%a0,%a1@	/* store pointer to struct fbcon_font_desc in console_font */
 | |
| 	tstl	%a0
 | |
| 	jeq	1f
 | |
| 	lea	%pc@(L(console_font_data)),%a4
 | |
| 	movel	%a0@(FONT_DESC_DATA),%d0
 | |
| 	subl	#L(console_font),%a1
 | |
| 	addl	%a1,%d0
 | |
| 	movel	%d0,%a4@
 | |
| 
 | |
| 	/*
 | |
| 	 *	Calculate global maxs
 | |
| 	 *	Note - we can use either an
 | |
| 	 *	8 x 16 or 8 x 8 character font
 | |
| 	 *	6 x 11 also supported
 | |
| 	 */
 | |
| 		/* ASSERT: a0 = contents of Lconsole_font */
 | |
| 	movel	%d3,%d0				/* screen width in pixels */
 | |
| 	divul	%a0@(FONT_DESC_WIDTH),%d0	/* d0 = max num chars per row */
 | |
| 
 | |
| 	movel	%d4,%d1				/* screen height in pixels */
 | |
| 	divul	%a0@(FONT_DESC_HEIGHT),%d1	/* d1 = max num rows */
 | |
| 
 | |
| 	movel	%d0,%a2@(Lconsole_struct_num_columns)
 | |
| 	movel	%d1,%a2@(Lconsole_struct_num_rows)
 | |
| 
 | |
| 	/*
 | |
| 	 *	Clear the current row and column
 | |
| 	 */
 | |
| 	clrl	%a2@(Lconsole_struct_cur_column)
 | |
| 	clrl	%a2@(Lconsole_struct_cur_row)
 | |
| 	clrl	%a2@(Lconsole_struct_left_edge)
 | |
| 
 | |
| 	/*
 | |
| 	 * Initialization is complete
 | |
| 	 */
 | |
| 1:
 | |
| func_return	console_init
 | |
| 
 | |
| #ifdef CONFIG_LOGO
 | |
| func_start	console_put_penguin,%a0-%a1/%d0-%d7
 | |
| 	/*
 | |
| 	 *	Get 'that_penguin' onto the screen in the upper right corner
 | |
| 	 *	penguin is 64 x 74 pixels, align against right edge of screen
 | |
| 	 */
 | |
| 	lea	%pc@(L(mac_dimensions)),%a0
 | |
| 	movel	%a0@,%d0
 | |
| 	andil	#0xffff,%d0
 | |
| 	subil	#64,%d0		/* snug up against the right edge */
 | |
| 	clrl	%d1		/* start at the top */
 | |
| 	movel	#73,%d7
 | |
| 	lea	%pc@(L(that_penguin)),%a1
 | |
| L(console_penguin_row):
 | |
| 	movel	#31,%d6
 | |
| L(console_penguin_pixel_pair):
 | |
| 	moveb	%a1@,%d2
 | |
| 	lsrb	#4,%d2
 | |
| 	console_plot_pixel %d0,%d1,%d2
 | |
| 	addq	#1,%d0
 | |
| 	moveb	%a1@+,%d2
 | |
| 	console_plot_pixel %d0,%d1,%d2
 | |
| 	addq	#1,%d0
 | |
| 	dbra	%d6,L(console_penguin_pixel_pair)
 | |
| 
 | |
| 	subil	#64,%d0
 | |
| 	addq	#1,%d1
 | |
| 	dbra	%d7,L(console_penguin_row)
 | |
| 
 | |
| func_return	console_put_penguin
 | |
| 
 | |
| /* include penguin bitmap */
 | |
| L(that_penguin):
 | |
| #include "../mac/mac_penguin.S"
 | |
| #endif
 | |
| 
 | |
| 	/*
 | |
| 	 * Calculate source and destination addresses
 | |
| 	 *	output	a1 = dest
 | |
| 	 *		a2 = source
 | |
| 	 */
 | |
| 
 | |
| func_start	console_scroll,%a0-%a4/%d0-%d7
 | |
| 	lea	%pc@(L(mac_videobase)),%a0
 | |
| 	movel	%a0@,%a1
 | |
| 	movel	%a1,%a2
 | |
| 	lea	%pc@(L(mac_rowbytes)),%a0
 | |
| 	movel	%a0@,%d5
 | |
| 	movel	%pc@(L(console_font)),%a0
 | |
| 	tstl	%a0
 | |
| 	jeq	1f
 | |
| 	mulul	%a0@(FONT_DESC_HEIGHT),%d5	/* account for # scan lines per character */
 | |
| 	addal	%d5,%a2
 | |
| 
 | |
| 	/*
 | |
| 	 * Get dimensions
 | |
| 	 */
 | |
| 	lea	%pc@(L(mac_dimensions)),%a0
 | |
| 	movel	%a0@,%d3
 | |
| 	movel	%d3,%d4
 | |
| 	swap	%d4
 | |
| 	andl	#0xffff,%d3	/* d3 = screen width in pixels */
 | |
| 	andl	#0xffff,%d4	/* d4 = screen height in pixels */
 | |
| 
 | |
| 	/*
 | |
| 	 * Calculate number of bytes to move
 | |
| 	 */
 | |
| 	lea	%pc@(L(mac_rowbytes)),%a0
 | |
| 	movel	%a0@,%d6
 | |
| 	movel	%pc@(L(console_font)),%a0
 | |
| 	subl	%a0@(FONT_DESC_HEIGHT),%d4	/* we're not scrolling the top row! */
 | |
| 	mulul	%d4,%d6		/* scan line bytes x num scan lines */
 | |
| 	divul	#32,%d6		/* we'll move 8 longs at a time */
 | |
| 	subq	#1,%d6
 | |
| 
 | |
| L(console_scroll_loop):
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	movel	%a2@+,%a1@+
 | |
| 	dbra	%d6,L(console_scroll_loop)
 | |
| 
 | |
| 	lea	%pc@(L(mac_rowbytes)),%a0
 | |
| 	movel	%a0@,%d6
 | |
| 	movel	%pc@(L(console_font)),%a0
 | |
| 	mulul	%a0@(FONT_DESC_HEIGHT),%d6	/* scan line bytes x font height */
 | |
| 	divul	#32,%d6			/* we'll move 8 words at a time */
 | |
| 	subq	#1,%d6
 | |
| 
 | |
| 	moveq	#-1,%d0
 | |
| L(console_scroll_clear_loop):
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	movel	%d0,%a1@+
 | |
| 	dbra	%d6,L(console_scroll_clear_loop)
 | |
| 
 | |
| 1:
 | |
| func_return	console_scroll
 | |
| 
 | |
| 
 | |
| func_start	console_putc,%a0/%a1/%d0-%d7
 | |
| 
 | |
| 	is_not_mac(L(console_exit))
 | |
| 	tstl	%pc@(L(console_font))
 | |
| 	jeq	L(console_exit)
 | |
| 
 | |
| 	/* Output character in d7 on console.
 | |
| 	 */
 | |
| 	movel	ARG1,%d7
 | |
| 	cmpib	#'\n',%d7
 | |
| 	jbne	1f
 | |
| 
 | |
| 	/* A little safe recursion is good for the soul */
 | |
| 	console_putc	#'\r'
 | |
| 1:
 | |
| 	lea	%pc@(L(console_globals)),%a0
 | |
| 
 | |
| 	cmpib	#10,%d7
 | |
| 	jne	L(console_not_lf)
 | |
| 	movel	%a0@(Lconsole_struct_cur_row),%d0
 | |
| 	addil	#1,%d0
 | |
| 	movel	%d0,%a0@(Lconsole_struct_cur_row)
 | |
| 	movel	%a0@(Lconsole_struct_num_rows),%d1
 | |
| 	cmpl	%d1,%d0
 | |
| 	jcs	1f
 | |
| 	subil	#1,%d0
 | |
| 	movel	%d0,%a0@(Lconsole_struct_cur_row)
 | |
| 	console_scroll
 | |
| 1:
 | |
| 	jra	L(console_exit)
 | |
| 
 | |
| L(console_not_lf):
 | |
| 	cmpib	#13,%d7
 | |
| 	jne	L(console_not_cr)
 | |
| 	clrl	%a0@(Lconsole_struct_cur_column)
 | |
| 	jra	L(console_exit)
 | |
| 
 | |
| L(console_not_cr):
 | |
| 	cmpib	#1,%d7
 | |
| 	jne	L(console_not_home)
 | |
| 	clrl	%a0@(Lconsole_struct_cur_row)
 | |
| 	clrl	%a0@(Lconsole_struct_cur_column)
 | |
| 	jra	L(console_exit)
 | |
| 
 | |
| /*
 | |
|  *	At this point we know that the %d7 character is going to be
 | |
|  *	rendered on the screen.  Register usage is -
 | |
|  *		a0 = pointer to console globals
 | |
|  *		a1 = font data
 | |
|  *		d0 = cursor column
 | |
|  *		d1 = cursor row to draw the character
 | |
|  *		d7 = character number
 | |
|  */
 | |
| L(console_not_home):
 | |
| 	movel	%a0@(Lconsole_struct_cur_column),%d0
 | |
| 	addql	#1,%a0@(Lconsole_struct_cur_column)
 | |
| 	movel	%a0@(Lconsole_struct_num_columns),%d1
 | |
| 	cmpl	%d1,%d0
 | |
| 	jcs	1f
 | |
| 	console_putc	#'\n'	/* recursion is OK! */
 | |
| 1:
 | |
| 	movel	%a0@(Lconsole_struct_cur_row),%d1
 | |
| 
 | |
| 	/*
 | |
| 	 *	At this point we make a shift in register usage
 | |
| 	 *	a0 = address of pointer to font data (fbcon_font_desc)
 | |
| 	 */
 | |
| 	movel	%pc@(L(console_font)),%a0
 | |
| 	movel	%pc@(L(console_font_data)),%a1	/* Load fbcon_font_desc.data into a1 */
 | |
| 	andl	#0x000000ff,%d7
 | |
| 		/* ASSERT: a0 = contents of Lconsole_font */
 | |
| 	mulul	%a0@(FONT_DESC_HEIGHT),%d7	/* d7 = index into font data */
 | |
| 	addl	%d7,%a1			/* a1 = points to char image */
 | |
| 
 | |
| 	/*
 | |
| 	 *	At this point we make a shift in register usage
 | |
| 	 *	d0 = pixel coordinate, x
 | |
| 	 *	d1 = pixel coordinate, y
 | |
| 	 *	d2 = (bit 0) 1/0 for white/black (!) pixel on screen
 | |
| 	 *	d3 = font scan line data (8 pixels)
 | |
| 	 *	d6 = count down for the font's pixel width (8)
 | |
| 	 *	d7 = count down for the font's pixel count in height
 | |
| 	 */
 | |
| 		/* ASSERT: a0 = contents of Lconsole_font */
 | |
| 	mulul	%a0@(FONT_DESC_WIDTH),%d0
 | |
| 	mulul	%a0@(FONT_DESC_HEIGHT),%d1
 | |
| 	movel	%a0@(FONT_DESC_HEIGHT),%d7	/* Load fbcon_font_desc.height into d7 */
 | |
| 	subq	#1,%d7
 | |
| L(console_read_char_scanline):
 | |
| 	moveb	%a1@+,%d3
 | |
| 
 | |
| 		/* ASSERT: a0 = contents of Lconsole_font */
 | |
| 	movel	%a0@(FONT_DESC_WIDTH),%d6	/* Load fbcon_font_desc.width into d6 */
 | |
| 	subql	#1,%d6
 | |
| 
 | |
| L(console_do_font_scanline):
 | |
| 	lslb	#1,%d3
 | |
| 	scsb	%d2		/* convert 1 bit into a byte */
 | |
| 	console_plot_pixel %d0,%d1,%d2
 | |
| 	addq	#1,%d0
 | |
| 	dbra	%d6,L(console_do_font_scanline)
 | |
| 
 | |
| 		/* ASSERT: a0 = contents of Lconsole_font */
 | |
| 	subl	%a0@(FONT_DESC_WIDTH),%d0
 | |
| 	addq	#1,%d1
 | |
| 	dbra	%d7,L(console_read_char_scanline)
 | |
| 
 | |
| L(console_exit):
 | |
| func_return	console_putc
 | |
| 
 | |
| 	/*
 | |
| 	 *	Input:
 | |
| 	 *		d0 = x coordinate
 | |
| 	 *		d1 = y coordinate
 | |
| 	 *		d2 = (bit 0) 1/0 for white/black (!)
 | |
| 	 *	All registers are preserved
 | |
| 	 */
 | |
| func_start	console_plot_pixel,%a0-%a1/%d0-%d4
 | |
| 
 | |
| 	movel	%pc@(L(mac_videobase)),%a1
 | |
| 	movel	%pc@(L(mac_videodepth)),%d3
 | |
| 	movel	ARG1,%d0
 | |
| 	movel	ARG2,%d1
 | |
| 	mulul	%pc@(L(mac_rowbytes)),%d1
 | |
| 	movel	ARG3,%d2
 | |
| 
 | |
| 	/*
 | |
| 	 *	Register usage:
 | |
| 	 *		d0 = x coord becomes byte offset into frame buffer
 | |
| 	 *		d1 = y coord
 | |
| 	 *		d2 = black or white (0/1)
 | |
| 	 *		d3 = video depth
 | |
| 	 *		d4 = temp of x (d0) for many bit depths
 | |
| 	 */
 | |
| L(test_1bit):
 | |
| 	cmpb	#1,%d3
 | |
| 	jbne	L(test_2bit)
 | |
| 	movel	%d0,%d4		/* we need the low order 3 bits! */
 | |
| 	divul	#8,%d0
 | |
| 	addal	%d0,%a1
 | |
| 	addal	%d1,%a1
 | |
| 	andb	#7,%d4
 | |
| 	eorb	#7,%d4		/* reverse the x-coordinate w/ screen-bit # */
 | |
| 	andb	#1,%d2
 | |
| 	jbne	L(white_1)
 | |
| 	bsetb	%d4,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| L(white_1):
 | |
| 	bclrb	%d4,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| 
 | |
| L(test_2bit):
 | |
| 	cmpb	#2,%d3
 | |
| 	jbne	L(test_4bit)
 | |
| 	movel	%d0,%d4		/* we need the low order 2 bits! */
 | |
| 	divul	#4,%d0
 | |
| 	addal	%d0,%a1
 | |
| 	addal	%d1,%a1
 | |
| 	andb	#3,%d4
 | |
| 	eorb	#3,%d4		/* reverse the x-coordinate w/ screen-bit # */
 | |
| 	lsll	#1,%d4		/* ! */
 | |
| 	andb	#1,%d2
 | |
| 	jbne	L(white_2)
 | |
| 	bsetb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bsetb	%d4,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| L(white_2):
 | |
| 	bclrb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bclrb	%d4,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| 
 | |
| L(test_4bit):
 | |
| 	cmpb	#4,%d3
 | |
| 	jbne	L(test_8bit)
 | |
| 	movel	%d0,%d4		/* we need the low order bit! */
 | |
| 	divul	#2,%d0
 | |
| 	addal	%d0,%a1
 | |
| 	addal	%d1,%a1
 | |
| 	andb	#1,%d4
 | |
| 	eorb	#1,%d4
 | |
| 	lsll	#2,%d4		/* ! */
 | |
| 	andb	#1,%d2
 | |
| 	jbne	L(white_4)
 | |
| 	bsetb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bsetb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bsetb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bsetb	%d4,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| L(white_4):
 | |
| 	bclrb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bclrb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bclrb	%d4,%a1@
 | |
| 	addq	#1,%d4
 | |
| 	bclrb	%d4,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| 
 | |
| L(test_8bit):
 | |
| 	cmpb	#8,%d3
 | |
| 	jbne	L(test_16bit)
 | |
| 	addal	%d0,%a1
 | |
| 	addal	%d1,%a1
 | |
| 	andb	#1,%d2
 | |
| 	jbne	L(white_8)
 | |
| 	moveb	#0xff,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| L(white_8):
 | |
| 	clrb	%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| 
 | |
| L(test_16bit):
 | |
| 	cmpb	#16,%d3
 | |
| 	jbne	L(console_plot_pixel_exit)
 | |
| 	addal	%d0,%a1
 | |
| 	addal	%d0,%a1
 | |
| 	addal	%d1,%a1
 | |
| 	andb	#1,%d2
 | |
| 	jbne	L(white_16)
 | |
| 	clrw	%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| L(white_16):
 | |
| 	movew	#0x0fff,%a1@
 | |
| 	jbra	L(console_plot_pixel_exit)
 | |
| 
 | |
| L(console_plot_pixel_exit):
 | |
| func_return	console_plot_pixel
 | |
| #endif /* CONSOLE_DEBUG */
 | |
| 
 | |
| 
 | |
| __INITDATA
 | |
| 	.align	4
 | |
| 
 | |
| m68k_init_mapped_size:
 | |
| 	.long	0
 | |
| 
 | |
| #if defined(CONFIG_ATARI) || defined(CONFIG_AMIGA) || \
 | |
|     defined(CONFIG_HP300) || defined(CONFIG_APOLLO)
 | |
| L(custom):
 | |
| L(iobase):
 | |
| 	.long 0
 | |
| #endif
 | |
| 
 | |
| #ifdef CONSOLE_DEBUG
 | |
| L(console_globals):
 | |
| 	.long	0		/* cursor column */
 | |
| 	.long	0		/* cursor row */
 | |
| 	.long	0		/* max num columns */
 | |
| 	.long	0		/* max num rows */
 | |
| 	.long	0		/* left edge */
 | |
| L(console_font):
 | |
| 	.long	0		/* pointer to console font (struct font_desc) */
 | |
| L(console_font_data):
 | |
| 	.long	0		/* pointer to console font data */
 | |
| #endif /* CONSOLE_DEBUG */
 | |
| 
 | |
| #if defined(MMU_PRINT)
 | |
| L(mmu_print_data):
 | |
| 	.long	0		/* valid flag */
 | |
| 	.long	0		/* start logical */
 | |
| 	.long	0		/* next logical */
 | |
| 	.long	0		/* start physical */
 | |
| 	.long	0		/* next physical */
 | |
| #endif /* MMU_PRINT */
 | |
| 
 | |
| L(cputype):
 | |
| 	.long	0
 | |
| L(mmu_cached_pointer_tables):
 | |
| 	.long	0
 | |
| L(mmu_num_pointer_tables):
 | |
| 	.long	0
 | |
| L(phys_kernel_start):
 | |
| 	.long	0
 | |
| L(kernel_end):
 | |
| 	.long	0
 | |
| L(memory_start):
 | |
| 	.long	0
 | |
| L(kernel_pgdir_ptr):
 | |
| 	.long	0
 | |
| L(temp_mmap_mem):
 | |
| 	.long	0
 | |
| 
 | |
| #if defined (CONFIG_MVME147)
 | |
| M147_SCC_CTRL_A = 0xfffe3002
 | |
| M147_SCC_DATA_A = 0xfffe3003
 | |
| #endif
 | |
| 
 | |
| #if defined (CONFIG_MVME16x)
 | |
| M162_SCC_CTRL_A = 0xfff45005
 | |
| M167_CYCAR = 0xfff450ee
 | |
| M167_CYIER = 0xfff45011
 | |
| M167_CYLICR = 0xfff45026
 | |
| M167_CYTEOIR = 0xfff45085
 | |
| M167_CYTDR = 0xfff450f8
 | |
| M167_PCSCCMICR = 0xfff4201d
 | |
| M167_PCSCCTICR = 0xfff4201e
 | |
| M167_PCSCCRICR = 0xfff4201f
 | |
| M167_PCTPIACKR = 0xfff42025
 | |
| #endif
 | |
| 
 | |
| #if defined (CONFIG_BVME6000)
 | |
| BVME_SCC_CTRL_A	= 0xffb0000b
 | |
| BVME_SCC_DATA_A	= 0xffb0000f
 | |
| #endif
 | |
| 
 | |
| #if defined(CONFIG_MAC)
 | |
| L(mac_videobase):
 | |
| 	.long	0
 | |
| L(mac_videodepth):
 | |
| 	.long	0
 | |
| L(mac_dimensions):
 | |
| 	.long	0
 | |
| L(mac_rowbytes):
 | |
| 	.long	0
 | |
| L(mac_sccbase):
 | |
| 	.long	0
 | |
| #endif /* CONFIG_MAC */
 | |
| 
 | |
| #if defined (CONFIG_APOLLO)
 | |
| LSRB0        = 0x10412
 | |
| LTHRB0       = 0x10416
 | |
| LCPUCTRL     = 0x10100
 | |
| #endif
 | |
| 
 | |
| #if defined(CONFIG_HP300)
 | |
| DCADATA	     = 0x11
 | |
| DCALSR	     = 0x1b
 | |
| APCIDATA     = 0x00
 | |
| APCILSR      = 0x14
 | |
| L(uartbase):
 | |
| 	.long	0
 | |
| L(uart_scode):
 | |
| 	.long	-1
 | |
| #endif
 | |
| 
 | |
| __FINIT
 | |
| 	.data
 | |
| 	.align	4
 | |
| 
 | |
| availmem:
 | |
| 	.long	0
 | |
| m68k_pgtable_cachemode:
 | |
| 	.long	0
 | |
| m68k_supervisor_cachemode:
 | |
| 	.long	0
 | |
| #if defined(CONFIG_MVME16x)
 | |
| mvme_bdid:
 | |
| 	.long	0,0,0,0,0,0,0,0
 | |
| #endif
 | |
| #if defined(CONFIG_Q40)
 | |
| q40_mem_cptr:
 | |
| 	.long	0
 | |
| L(q40_do_debug):
 | |
| 	.long	0
 | |
| #endif
 |