3868 lines
88 KiB
ArmAsm
3868 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
|