1 /* SPDX-License-Identifier: GPL-2.0-only */ !! 1 /* SPDX-License-Identifier: GPL-2.0-or-later >> 2 ** -*- mode: asm -*- >> 3 ** >> 4 ** head.S -- This file contains the initial boot code for the >> 5 ** Linux/68k kernel. >> 6 ** >> 7 ** Copyright 1993 by Hamish Macdonald >> 8 ** >> 9 ** 68040 fixes by Michael Rausch >> 10 ** 68060 fixes by Roman Hodek >> 11 ** MMU cleanup by Randy Thelen >> 12 ** Final MMU cleanup by Roman Zippel >> 13 ** >> 14 ** Atari support by Andreas Schwab, using ideas of Robert de Vries >> 15 ** and Bjoern Brauel >> 16 ** VME Support by Richard Hirst >> 17 ** >> 18 ** 94/11/14 Andreas Schwab: put kernel at PAGESIZE >> 19 ** 94/11/18 Andreas Schwab: remove identity mapping of STRAM for Atari >> 20 ** ++ Bjoern & Roman: ATARI-68040 support for the Medusa >> 21 ** 95/11/18 Richard Hirst: Added MVME166 support >> 22 ** 96/04/26 Guenther Kelleter: fixed identity mapping for Falcon with >> 23 ** Magnum- and FX-alternate ram >> 24 ** 98/04/25 Phil Blundell: added HP300 support >> 25 ** 1998/08/30 David Kilzer: Added support for font_desc structures >> 26 ** for linux-2.1.115 >> 27 ** 1999/02/11 Richard Zidlicky: added Q40 support (initial version 99/01/01) >> 28 ** 2004/05/13 Kars de Jong: Finalised HP300 support >> 29 */ >> 30 2 /* 31 /* 3 * ARC CPU startup Code !! 32 * Linux startup code. >> 33 * >> 34 * At this point, the boot loader has: >> 35 * Disabled interrupts >> 36 * Disabled caches >> 37 * Put us in supervisor state. >> 38 * >> 39 * The kernel setup code takes the following steps: >> 40 * . Raise interrupt level >> 41 * . Set up initial kernel memory mapping. >> 42 * . This sets up a mapping of the 4M of memory the kernel is located in. >> 43 * . It also does a mapping of any initial machine specific areas. >> 44 * . Enable the MMU >> 45 * . Enable cache memories >> 46 * . Jump to kernel startup >> 47 * >> 48 * Much of the file restructuring was to accomplish: >> 49 * 1) Remove register dependency through-out the file. >> 50 * 2) Increase use of subroutines to perform functions >> 51 * 3) Increase readability of the code >> 52 * >> 53 * Of course, readability is a subjective issue, so it will never be >> 54 * argued that that goal was accomplished. It was merely a goal. >> 55 * A key way to help make code more readable is to give good >> 56 * documentation. So, the first thing you will find is exhaustive >> 57 * write-ups on the structure of the file, and the features of the >> 58 * functional subroutines. >> 59 * >> 60 * General Structure: >> 61 * ------------------ >> 62 * Without a doubt the single largest chunk of head.S is spent >> 63 * mapping the kernel and I/O physical space into the logical range >> 64 * for the kernel. >> 65 * There are new subroutines and data structures to make MMU >> 66 * support cleaner and easier to understand. >> 67 * First, you will find a routine call "mmu_map" which maps >> 68 * a logical to a physical region for some length given a cache >> 69 * type on behalf of the caller. This routine makes writing the >> 70 * actual per-machine specific code very simple. >> 71 * A central part of the code, but not a subroutine in itself, >> 72 * is the mmu_init code which is broken down into mapping the kernel >> 73 * (the same for all machines) and mapping machine-specific I/O >> 74 * regions. >> 75 * Also, there will be a description of engaging the MMU and >> 76 * caches. >> 77 * You will notice that there is a chunk of code which >> 78 * can emit the entire MMU mapping of the machine. This is present >> 79 * only in debug modes and can be very helpful. >> 80 * Further, there is a new console driver in head.S that is >> 81 * also only engaged in debug mode. Currently, it's only supported >> 82 * on the Macintosh class of machines. However, it is hoped that >> 83 * others will plug-in support for specific machines. >> 84 * >> 85 * ###################################################################### >> 86 * >> 87 * mmu_map >> 88 * ------- >> 89 * mmu_map was written for two key reasons. First, it was clear >> 90 * that it was very difficult to read the previous code for mapping >> 91 * regions of memory. Second, the Macintosh required such extensive >> 92 * memory allocations that it didn't make sense to propagate the >> 93 * existing code any further. >> 94 * mmu_map requires some parameters: >> 95 * >> 96 * mmu_map (logical, physical, length, cache_type) >> 97 * >> 98 * While this essentially describes the function in the abstract, you'll >> 99 * find more indepth description of other parameters at the implementation site. >> 100 * >> 101 * mmu_get_root_table_entry >> 102 * ------------------------ >> 103 * mmu_get_ptr_table_entry >> 104 * ----------------------- >> 105 * mmu_get_page_table_entry >> 106 * ------------------------ >> 107 * >> 108 * These routines are used by other mmu routines to get a pointer into >> 109 * a table, if necessary a new table is allocated. These routines are working >> 110 * basically like pmd_alloc() and pte_alloc() in <asm/pgtable.h>. The root >> 111 * table needs of course only to be allocated once in mmu_get_root_table_entry, >> 112 * so that here also some mmu specific initialization is done. The second page >> 113 * at the start of the kernel (the first page is unmapped later) is used for >> 114 * the kernel_pg_dir. It must be at a position known at link time (as it's used >> 115 * to initialize the init task struct) and since it needs special cache >> 116 * settings, it's the easiest to use this page, the rest of the page is used >> 117 * for further pointer tables. >> 118 * mmu_get_page_table_entry allocates always a whole page for page tables, this >> 119 * means 1024 pages and so 4MB of memory can be mapped. It doesn't make sense >> 120 * to manage page tables in smaller pieces as nearly all mappings have that >> 121 * size. >> 122 * >> 123 * ###################################################################### >> 124 * >> 125 * >> 126 * ###################################################################### >> 127 * >> 128 * mmu_engage >> 129 * ---------- >> 130 * Thanks to a small helping routine enabling the mmu got quite simple >> 131 * and there is only one way left. mmu_engage makes a complete a new mapping >> 132 * that only includes the absolute necessary to be able to jump to the final >> 133 * position and to restore the original mapping. >> 134 * As this code doesn't need a transparent translation register anymore this >> 135 * means all registers are free to be used by machines that needs them for >> 136 * other purposes. >> 137 * >> 138 * ###################################################################### >> 139 * >> 140 * mmu_print >> 141 * --------- >> 142 * This algorithm will print out the page tables of the system as >> 143 * appropriate for an 030 or an 040. This is useful for debugging purposes >> 144 * and as such is enclosed in #ifdef MMU_PRINT/#endif clauses. >> 145 * >> 146 * ###################################################################### >> 147 * >> 148 * console_init >> 149 * ------------ >> 150 * The console is also able to be turned off. The console in head.S >> 151 * is specifically for debugging and can be very useful. It is surrounded by >> 152 * #ifdef / #endif clauses so it doesn't have to ship in known-good >> 153 * kernels. It's basic algorithm is to determine the size of the screen >> 154 * (in height/width and bit depth) and then use that information for >> 155 * displaying an 8x8 font or an 8x16 (widthxheight). I prefer the 8x8 for >> 156 * debugging so I can see more good data. But it was trivial to add support >> 157 * for both fonts, so I included it. >> 158 * Also, the algorithm for plotting pixels is abstracted so that in >> 159 * theory other platforms could add support for different kinds of frame >> 160 * buffers. This could be very useful. >> 161 * >> 162 * console_put_penguin >> 163 * ------------------- >> 164 * An important part of any Linux bring up is the penguin and there's >> 165 * nothing like getting the Penguin on the screen! This algorithm will work >> 166 * on any machine for which there is a console_plot_pixel. >> 167 * >> 168 * console_scroll >> 169 * -------------- >> 170 * My hope is that the scroll algorithm does the right thing on the >> 171 * various platforms, but it wouldn't be hard to add the test conditions >> 172 * and new code if it doesn't. >> 173 * >> 174 * console_putc >> 175 * ------------- >> 176 * >> 177 * ###################################################################### >> 178 * >> 179 * Register usage has greatly simplified within head.S. Every subroutine >> 180 * saves and restores all registers that it modifies (except it returns a >> 181 * value in there of course). So the only register that needs to be initialized >> 182 * is the stack pointer. >> 183 * All other init code and data is now placed in the init section, so it will >> 184 * be automatically freed at the end of the kernel initialization. >> 185 * >> 186 * ###################################################################### >> 187 * >> 188 * options >> 189 * ------- >> 190 * There are many options available in a build of this file. I've >> 191 * taken the time to describe them here to save you the time of searching >> 192 * for them and trying to understand what they mean. >> 193 * >> 194 * CONFIG_xxx: These are the obvious machine configuration defines created >> 195 * during configuration. These are defined in autoconf.h. >> 196 * >> 197 * CONSOLE_DEBUG: Only supports a Mac frame buffer but could easily be >> 198 * extended to support other platforms. >> 199 * >> 200 * TEST_MMU: This is a test harness for running on any given machine but >> 201 * getting an MMU dump for another class of machine. The classes of machines >> 202 * that can be tested are any of the makes (Atari, Amiga, Mac, VME, etc.) >> 203 * and any of the models (030, 040, 060, etc.). >> 204 * >> 205 * NOTE: TEST_MMU is NOT permanent! It is scheduled to be removed >> 206 * When head.S boots on Atari, Amiga, Macintosh, and VME >> 207 * machines. At that point the underlying logic will be >> 208 * believed to be solid enough to be trusted, and TEST_MMU >> 209 * can be dropped. Do note that that will clean up the >> 210 * head.S code significantly as large blocks of #if/#else >> 211 * clauses can be removed. >> 212 * >> 213 * MMU_NOCACHE_KERNEL: On the Macintosh platform there was an inquiry into >> 214 * determing why devices don't appear to work. A test case was to remove >> 215 * the cacheability of the kernel bits. >> 216 * >> 217 * MMU_PRINT: There is a routine built into head.S that can display the >> 218 * MMU data structures. It outputs its result through the serial_putc >> 219 * interface. So where ever that winds up driving data, that's where the >> 220 * mmu struct will appear. >> 221 * >> 222 * SERIAL_DEBUG: There are a series of putc() macro statements >> 223 * scattered through out the code to give progress of status to the >> 224 * person sitting at the console. This constant determines whether those >> 225 * are used. >> 226 * >> 227 * DEBUG: This is the standard DEBUG flag that can be set for building >> 228 * the kernel. It has the effect adding additional tests into >> 229 * the code. >> 230 * >> 231 * FONT_6x11: >> 232 * FONT_8x8: >> 233 * FONT_8x16: >> 234 * In theory these could be determined at run time or handed >> 235 * over by the booter. But, let's be real, it's a fine hard >> 236 * coded value. (But, you will notice the code is run-time >> 237 * flexible!) A pointer to the font's struct font_desc >> 238 * is kept locally in Lconsole_font. It is used to determine >> 239 * font size information dynamically. 4 * 240 * 5 * Copyright (C) 2004, 2007-2010, 2011-2012 Sy !! 241 * Atari constants: >> 242 * USE_PRINTER: Use the printer port for serial debug. >> 243 * USE_SCC_B: Use the SCC port A (Serial2) for serial debug. >> 244 * USE_SCC_A: Use the SCC port B (Modem2) for serial debug. >> 245 * USE_MFP: Use the ST-MFP port (Modem1) for serial debug. 6 * 246 * 7 * Vineetg: Dec 2007 !! 247 * Macintosh constants: 8 * -Check if we are running on Simulator or o !! 248 * MAC_USE_SCC_A: Use SCC port A (modem) for serial debug. 9 * to skip certain things during boot on !! 249 * MAC_USE_SCC_B: Use SCC port B (printer) for serial debug. 10 */ 250 */ 11 251 12 #include <linux/linkage.h> 252 #include <linux/linkage.h> 13 #include <asm/asm-offsets.h> !! 253 #include <linux/init.h> >> 254 #include <linux/pgtable.h> >> 255 #include <asm/bootinfo.h> >> 256 #include <asm/bootinfo-amiga.h> >> 257 #include <asm/bootinfo-atari.h> >> 258 #include <asm/bootinfo-hp300.h> >> 259 #include <asm/bootinfo-mac.h> >> 260 #include <asm/bootinfo-q40.h> >> 261 #include <asm/bootinfo-virt.h> >> 262 #include <asm/bootinfo-vme.h> >> 263 #include <asm/setup.h> 14 #include <asm/entry.h> 264 #include <asm/entry.h> 15 #include <asm/arcregs.h> !! 265 #include <asm/page.h> 16 #include <asm/cache.h> !! 266 #include <asm/asm-offsets.h> 17 #include <asm/dsp-impl.h> !! 267 #ifdef CONFIG_MAC 18 #include <asm/irqflags.h> !! 268 # include <asm/machw.h> 19 !! 269 #endif 20 .macro CPU_EARLY_SETUP !! 270 21 !! 271 #ifdef CONFIG_EARLY_PRINTK 22 ; Setting up Vectror Table (in case ex !! 272 # define SERIAL_DEBUG 23 sr @_int_vec_base_lds, [AUX_INTR_ !! 273 # if defined(CONFIG_MAC) && defined(CONFIG_FONT_SUPPORT) 24 !! 274 # define CONSOLE_DEBUG 25 ; Disable I-cache/D-cache if kernel so !! 275 # endif 26 lr r5, [ARC_REG_IC_BCR] !! 276 #endif 27 breq r5, 0, 1f ; I$ d !! 277 28 lr r5, [ARC_REG_IC_CTRL] !! 278 #undef MMU_PRINT 29 #ifdef CONFIG_ARC_HAS_ICACHE !! 279 #undef MMU_NOCACHE_KERNEL 30 bclr r5, r5, 0 ; 0 - !! 280 #undef DEBUG >> 281 >> 282 /* >> 283 * For the head.S console, there are three supported fonts, 6x11, 8x16 and 8x8. >> 284 * The 8x8 font is harder to read but fits more on the screen. >> 285 */ >> 286 #define FONT_8x8 /* default */ >> 287 /* #define FONT_8x16 */ /* 2nd choice */ >> 288 /* #define FONT_6x11 */ /* 3rd choice */ >> 289 >> 290 .globl kernel_pg_dir >> 291 .globl availmem >> 292 .globl m68k_init_mapped_size >> 293 .globl m68k_pgtable_cachemode >> 294 .globl m68k_supervisor_cachemode >> 295 #ifdef CONFIG_MVME16x >> 296 .globl mvme_bdid >> 297 #endif >> 298 #ifdef CONFIG_Q40 >> 299 .globl q40_mem_cptr >> 300 #endif >> 301 >> 302 CPUTYPE_040 = 1 /* indicates an 040 */ >> 303 CPUTYPE_060 = 2 /* indicates an 060 */ >> 304 CPUTYPE_0460 = 3 /* if either above are set, this is set */ >> 305 CPUTYPE_020 = 4 /* indicates an 020 */ >> 306 >> 307 /* Translation control register */ >> 308 TC_ENABLE = 0x8000 >> 309 TC_PAGE8K = 0x4000 >> 310 TC_PAGE4K = 0x0000 >> 311 >> 312 /* Transparent translation registers */ >> 313 TTR_ENABLE = 0x8000 /* enable transparent translation */ >> 314 TTR_ANYMODE = 0x4000 /* user and kernel mode access */ >> 315 TTR_KERNELMODE = 0x2000 /* only kernel mode access */ >> 316 TTR_USERMODE = 0x0000 /* only user mode access */ >> 317 TTR_CI = 0x0400 /* inhibit cache */ >> 318 TTR_RW = 0x0200 /* read/write mode */ >> 319 TTR_RWM = 0x0100 /* read/write mask */ >> 320 TTR_FCB2 = 0x0040 /* function code base bit 2 */ >> 321 TTR_FCB1 = 0x0020 /* function code base bit 1 */ >> 322 TTR_FCB0 = 0x0010 /* function code base bit 0 */ >> 323 TTR_FCM2 = 0x0004 /* function code mask bit 2 */ >> 324 TTR_FCM1 = 0x0002 /* function code mask bit 1 */ >> 325 TTR_FCM0 = 0x0001 /* function code mask bit 0 */ >> 326 >> 327 /* Cache Control registers */ >> 328 CC6_ENABLE_D = 0x80000000 /* enable data cache (680[46]0) */ >> 329 CC6_FREEZE_D = 0x40000000 /* freeze data cache (68060) */ >> 330 CC6_ENABLE_SB = 0x20000000 /* enable store buffer (68060) */ >> 331 CC6_PUSH_DPI = 0x10000000 /* disable CPUSH invalidation (68060) */ >> 332 CC6_HALF_D = 0x08000000 /* half-cache mode for data cache (68060) */ >> 333 CC6_ENABLE_B = 0x00800000 /* enable branch cache (68060) */ >> 334 CC6_CLRA_B = 0x00400000 /* clear all entries in branch cache (68060) */ >> 335 CC6_CLRU_B = 0x00200000 /* clear user entries in branch cache (68060) */ >> 336 CC6_ENABLE_I = 0x00008000 /* enable instruction cache (680[46]0) */ >> 337 CC6_FREEZE_I = 0x00004000 /* freeze instruction cache (68060) */ >> 338 CC6_HALF_I = 0x00002000 /* half-cache mode for instruction cache (68060) */ >> 339 CC3_ALLOC_WRITE = 0x00002000 /* write allocate mode(68030) */ >> 340 CC3_ENABLE_DB = 0x00001000 /* enable data burst (68030) */ >> 341 CC3_CLR_D = 0x00000800 /* clear data cache (68030) */ >> 342 CC3_CLRE_D = 0x00000400 /* clear entry in data cache (68030) */ >> 343 CC3_FREEZE_D = 0x00000200 /* freeze data cache (68030) */ >> 344 CC3_ENABLE_D = 0x00000100 /* enable data cache (68030) */ >> 345 CC3_ENABLE_IB = 0x00000010 /* enable instruction burst (68030) */ >> 346 CC3_CLR_I = 0x00000008 /* clear instruction cache (68030) */ >> 347 CC3_CLRE_I = 0x00000004 /* clear entry in instruction cache (68030) */ >> 348 CC3_FREEZE_I = 0x00000002 /* freeze instruction cache (68030) */ >> 349 CC3_ENABLE_I = 0x00000001 /* enable instruction cache (68030) */ >> 350 >> 351 /* Miscellaneous definitions */ >> 352 PAGESIZE = 4096 >> 353 PAGESHIFT = 12 >> 354 >> 355 ROOT_TABLE_SIZE = 128 >> 356 PTR_TABLE_SIZE = 128 >> 357 PAGE_TABLE_SIZE = 64 >> 358 ROOT_INDEX_SHIFT = 25 >> 359 PTR_INDEX_SHIFT = 18 >> 360 PAGE_INDEX_SHIFT = 12 >> 361 >> 362 #ifdef DEBUG >> 363 /* When debugging use readable names for labels */ >> 364 #ifdef __STDC__ >> 365 #define L(name) .head.S.##name >> 366 #else >> 367 #define L(name) .head.S./**/name >> 368 #endif 31 #else 369 #else 32 bset r5, r5, 0 ; I$ e !! 370 #ifdef __STDC__ >> 371 #define L(name) .L##name >> 372 #else >> 373 #define L(name) .L/**/name >> 374 #endif >> 375 #endif >> 376 >> 377 /* The __INITDATA stuff is a no-op when ftrace or kgdb are turned on */ >> 378 #ifndef __INITDATA >> 379 #define __INITDATA .data >> 380 #define __FINIT .previous >> 381 #endif >> 382 >> 383 /* Several macros to make the writing of subroutines easier: >> 384 * - func_start marks the beginning of the routine which setups the frame >> 385 * register and saves the registers, it also defines another macro >> 386 * to automatically restore the registers again. >> 387 * - func_return marks the end of the routine and simply calls the prepared >> 388 * macro to restore registers and jump back to the caller. >> 389 * - func_define generates another macro to automatically put arguments >> 390 * onto the stack call the subroutine and cleanup the stack again. >> 391 */ >> 392 >> 393 /* Within subroutines these macros can be used to access the arguments >> 394 * on the stack. With STACK some allocated memory on the stack can be >> 395 * accessed and ARG0 points to the return address (used by mmu_engage). >> 396 */ >> 397 #define STACK %a6@(stackstart) >> 398 #define ARG0 %a6@(4) >> 399 #define ARG1 %a6@(8) >> 400 #define ARG2 %a6@(12) >> 401 #define ARG3 %a6@(16) >> 402 #define ARG4 %a6@(20) >> 403 >> 404 .macro func_start name,saveregs,stack=0 >> 405 L(\name): >> 406 linkw %a6,#-\stack >> 407 moveml \saveregs,%sp@- >> 408 .set stackstart,-\stack >> 409 >> 410 .macro func_return_\name >> 411 moveml %sp@+,\saveregs >> 412 unlk %a6 >> 413 rts >> 414 .endm >> 415 .endm >> 416 >> 417 .macro func_return name >> 418 func_return_\name >> 419 .endm >> 420 >> 421 .macro func_call name >> 422 jbsr L(\name) >> 423 .endm >> 424 >> 425 .macro move_stack nr,arg1,arg2,arg3,arg4 >> 426 .if \nr >> 427 move_stack "(\nr-1)",\arg2,\arg3,\arg4 >> 428 movel \arg1,%sp@- >> 429 .endif >> 430 .endm >> 431 >> 432 .macro func_define name,nr=0 >> 433 .macro \name arg1,arg2,arg3,arg4 >> 434 move_stack \nr,\arg1,\arg2,\arg3,\arg4 >> 435 func_call \name >> 436 .if \nr >> 437 lea %sp@(\nr*4),%sp >> 438 .endif >> 439 .endm >> 440 .endm >> 441 >> 442 func_define mmu_map,4 >> 443 func_define mmu_map_tt,4 >> 444 func_define mmu_fixup_page_mmu_cache,1 >> 445 func_define mmu_temp_map,2 >> 446 func_define mmu_engage >> 447 func_define mmu_get_root_table_entry,1 >> 448 func_define mmu_get_ptr_table_entry,2 >> 449 func_define mmu_get_page_table_entry,2 >> 450 func_define mmu_print >> 451 func_define get_new_page >> 452 #if defined(CONFIG_HP300) || defined(CONFIG_APOLLO) >> 453 func_define set_leds 33 #endif 454 #endif 34 sr r5, [ARC_REG_IC_CTRL] << 35 455 >> 456 .macro mmu_map_eq arg1,arg2,arg3 >> 457 mmu_map \arg1,\arg1,\arg2,\arg3 >> 458 .endm >> 459 >> 460 .macro get_bi_record record >> 461 pea \record >> 462 func_call get_bi_record >> 463 addql #4,%sp >> 464 .endm >> 465 >> 466 func_define serial_putc,1 >> 467 func_define console_putc,1 >> 468 >> 469 func_define console_init >> 470 func_define console_put_penguin >> 471 func_define console_plot_pixel,3 >> 472 func_define console_scroll >> 473 >> 474 .macro putc ch >> 475 #if defined(CONSOLE_DEBUG) || defined(SERIAL_DEBUG) >> 476 pea \ch >> 477 #endif >> 478 #ifdef CONSOLE_DEBUG >> 479 func_call console_putc >> 480 #endif >> 481 #ifdef SERIAL_DEBUG >> 482 func_call serial_putc >> 483 #endif >> 484 #if defined(CONSOLE_DEBUG) || defined(SERIAL_DEBUG) >> 485 addql #4,%sp >> 486 #endif >> 487 .endm >> 488 >> 489 .macro dputc ch >> 490 #ifdef DEBUG >> 491 putc \ch >> 492 #endif >> 493 .endm >> 494 >> 495 func_define putn,1 >> 496 >> 497 .macro dputn nr >> 498 #ifdef DEBUG >> 499 putn \nr >> 500 #endif >> 501 .endm >> 502 >> 503 .macro puts string >> 504 #if defined(CONSOLE_DEBUG) || defined(SERIAL_DEBUG) >> 505 __INITDATA >> 506 .Lstr\@: >> 507 .string "\string" >> 508 __FINIT >> 509 pea %pc@(.Lstr\@) >> 510 func_call puts >> 511 addql #4,%sp >> 512 #endif >> 513 .endm >> 514 >> 515 .macro dputs string >> 516 #ifdef DEBUG >> 517 puts "\string" >> 518 #endif >> 519 .endm >> 520 >> 521 #define is_not_amiga(lab) cmpl &MACH_AMIGA,%pc@(m68k_machtype); jne lab >> 522 #define is_not_atari(lab) cmpl &MACH_ATARI,%pc@(m68k_machtype); jne lab >> 523 #define is_not_mac(lab) cmpl &MACH_MAC,%pc@(m68k_machtype); jne lab >> 524 #define is_not_mvme147(lab) cmpl &MACH_MVME147,%pc@(m68k_machtype); jne lab >> 525 #define is_not_mvme16x(lab) cmpl &MACH_MVME16x,%pc@(m68k_machtype); jne lab >> 526 #define is_not_bvme6000(lab) cmpl &MACH_BVME6000,%pc@(m68k_machtype); jne lab >> 527 #define is_mvme147(lab) cmpl &MACH_MVME147,%pc@(m68k_machtype); jeq lab >> 528 #define is_mvme16x(lab) cmpl &MACH_MVME16x,%pc@(m68k_machtype); jeq lab >> 529 #define is_bvme6000(lab) cmpl &MACH_BVME6000,%pc@(m68k_machtype); jeq lab >> 530 #define is_not_hp300(lab) cmpl &MACH_HP300,%pc@(m68k_machtype); jne lab >> 531 #define is_not_apollo(lab) cmpl &MACH_APOLLO,%pc@(m68k_machtype); jne lab >> 532 #define is_not_q40(lab) cmpl &MACH_Q40,%pc@(m68k_machtype); jne lab >> 533 #define is_not_sun3x(lab) cmpl &MACH_SUN3X,%pc@(m68k_machtype); jne lab >> 534 #define is_not_virt(lab) cmpl &MACH_VIRT,%pc@(m68k_machtype); jne lab >> 535 >> 536 #define hasnt_leds(lab) cmpl &MACH_HP300,%pc@(m68k_machtype); \ >> 537 jeq 42f; \ >> 538 cmpl &MACH_APOLLO,%pc@(m68k_machtype); \ >> 539 jne lab ;\ >> 540 42:\ >> 541 >> 542 #define is_040_or_060(lab) btst &CPUTYPE_0460,%pc@(L(cputype)+3); jne lab >> 543 #define is_not_040_or_060(lab) btst &CPUTYPE_0460,%pc@(L(cputype)+3); jeq lab >> 544 #define is_040(lab) btst &CPUTYPE_040,%pc@(L(cputype)+3); jne lab >> 545 #define is_060(lab) btst &CPUTYPE_060,%pc@(L(cputype)+3); jne lab >> 546 #define is_not_060(lab) btst &CPUTYPE_060,%pc@(L(cputype)+3); jeq lab >> 547 #define is_020(lab) btst &CPUTYPE_020,%pc@(L(cputype)+3); jne lab >> 548 #define is_not_020(lab) btst &CPUTYPE_020,%pc@(L(cputype)+3); jeq lab >> 549 >> 550 /* On the HP300 we use the on-board LEDs for debug output before >> 551 the console is running. Writing a 1 bit turns the corresponding LED >> 552 _off_ - on the 340 bit 7 is towards the back panel of the machine. */ >> 553 .macro leds mask >> 554 #if defined(CONFIG_HP300) || defined(CONFIG_APOLLO) >> 555 hasnt_leds(.Lled\@) >> 556 pea \mask >> 557 func_call set_leds >> 558 addql #4,%sp >> 559 .Lled\@: >> 560 #endif >> 561 .endm >> 562 >> 563 __HEAD >> 564 ENTRY(_stext) >> 565 /* >> 566 * Version numbers of the bootinfo interface >> 567 * The area from _stext to _start will later be used as kernel pointer table >> 568 */ >> 569 bras 1f /* Jump over bootinfo version numbers */ >> 570 >> 571 .long BOOTINFOV_MAGIC >> 572 .long MACH_AMIGA, AMIGA_BOOTI_VERSION >> 573 .long MACH_ATARI, ATARI_BOOTI_VERSION >> 574 .long MACH_MVME147, MVME147_BOOTI_VERSION >> 575 .long MACH_MVME16x, MVME16x_BOOTI_VERSION >> 576 .long MACH_BVME6000, BVME6000_BOOTI_VERSION >> 577 .long MACH_MAC, MAC_BOOTI_VERSION >> 578 .long MACH_Q40, Q40_BOOTI_VERSION >> 579 .long MACH_HP300, HP300_BOOTI_VERSION >> 580 .long 0 >> 581 1: jra __start >> 582 >> 583 .equ kernel_pg_dir,_stext >> 584 >> 585 .equ .,_stext+PAGESIZE >> 586 >> 587 ENTRY(_start) >> 588 jra __start >> 589 __INIT >> 590 ENTRY(__start) >> 591 /* >> 592 * Setup initial stack pointer >> 593 */ >> 594 lea %pc@(_stext),%sp >> 595 >> 596 /* >> 597 * Record the CPU and machine type. >> 598 */ >> 599 get_bi_record BI_MACHTYPE >> 600 lea %pc@(m68k_machtype),%a1 >> 601 movel %a0@,%a1@ >> 602 >> 603 get_bi_record BI_FPUTYPE >> 604 lea %pc@(m68k_fputype),%a1 >> 605 movel %a0@,%a1@ >> 606 >> 607 get_bi_record BI_MMUTYPE >> 608 lea %pc@(m68k_mmutype),%a1 >> 609 movel %a0@,%a1@ >> 610 >> 611 get_bi_record BI_CPUTYPE >> 612 lea %pc@(m68k_cputype),%a1 >> 613 movel %a0@,%a1@ >> 614 >> 615 leds 0x1 >> 616 >> 617 #ifdef CONFIG_MAC >> 618 /* >> 619 * For Macintosh, we need to determine the display parameters early (at least >> 620 * while debugging it). >> 621 */ >> 622 >> 623 is_not_mac(L(test_notmac)) >> 624 >> 625 get_bi_record BI_MAC_VADDR >> 626 lea %pc@(L(mac_videobase)),%a1 >> 627 movel %a0@,%a1@ >> 628 >> 629 get_bi_record BI_MAC_VDEPTH >> 630 lea %pc@(L(mac_videodepth)),%a1 >> 631 movel %a0@,%a1@ >> 632 >> 633 get_bi_record BI_MAC_VDIM >> 634 lea %pc@(L(mac_dimensions)),%a1 >> 635 movel %a0@,%a1@ >> 636 >> 637 get_bi_record BI_MAC_VROW >> 638 lea %pc@(L(mac_rowbytes)),%a1 >> 639 movel %a0@,%a1@ >> 640 >> 641 get_bi_record BI_MAC_SCCBASE >> 642 lea %pc@(L(mac_sccbase)),%a1 >> 643 movel %a0@,%a1@ >> 644 >> 645 L(test_notmac): >> 646 #endif /* CONFIG_MAC */ >> 647 >> 648 #ifdef CONFIG_VIRT >> 649 is_not_virt(L(test_notvirt)) >> 650 >> 651 get_bi_record BI_VIRT_GF_TTY_BASE >> 652 lea %pc@(L(virt_gf_tty_base)),%a1 >> 653 movel %a0@,%a1@ >> 654 L(test_notvirt): >> 655 #endif /* CONFIG_VIRT */ >> 656 >> 657 /* >> 658 * There are ultimately two pieces of information we want for all kinds of >> 659 * processors CpuType and CacheBits. The CPUTYPE was passed in from booter >> 660 * and is converted here from a booter type definition to a separate bit >> 661 * number which allows for the standard is_0x0 macro tests. >> 662 */ >> 663 movel %pc@(m68k_cputype),%d0 >> 664 /* >> 665 * Assume it's an 030 >> 666 */ >> 667 clrl %d1 >> 668 >> 669 /* >> 670 * Test the BootInfo cputype for 060 >> 671 */ >> 672 btst #CPUB_68060,%d0 >> 673 jeq 1f >> 674 bset #CPUTYPE_060,%d1 >> 675 bset #CPUTYPE_0460,%d1 >> 676 jra 3f 36 1: 677 1: 37 lr r5, [ARC_REG_DC_BCR] !! 678 /* 38 breq r5, 0, 1f ; D$ d !! 679 * Test the BootInfo cputype for 040 39 lr r5, [ARC_REG_DC_CTRL] !! 680 */ 40 bclr r5, r5, 6 ; Inva !! 681 btst #CPUB_68040,%d0 41 #ifdef CONFIG_ARC_HAS_DCACHE !! 682 jeq 2f 42 bclr r5, r5, 0 ; Enab !! 683 bset #CPUTYPE_040,%d1 43 #else !! 684 bset #CPUTYPE_0460,%d1 44 bset r5, r5, 0 ; Disa !! 685 jra 3f >> 686 2: >> 687 /* >> 688 * Test the BootInfo cputype for 020 >> 689 */ >> 690 btst #CPUB_68020,%d0 >> 691 jeq 3f >> 692 bset #CPUTYPE_020,%d1 >> 693 jra 3f >> 694 3: >> 695 /* >> 696 * Record the cpu type >> 697 */ >> 698 lea %pc@(L(cputype)),%a0 >> 699 movel %d1,%a0@ >> 700 >> 701 /* >> 702 * NOTE: >> 703 * >> 704 * Now the macros are valid: >> 705 * is_040_or_060 >> 706 * is_not_040_or_060 >> 707 * is_040 >> 708 * is_060 >> 709 * is_not_060 >> 710 */ >> 711 >> 712 /* >> 713 * Determine the cache mode for pages holding MMU tables >> 714 * and for supervisor mode, unused for '020 and '030 >> 715 */ >> 716 clrl %d0 >> 717 clrl %d1 >> 718 >> 719 is_not_040_or_060(L(save_cachetype)) >> 720 >> 721 /* >> 722 * '040 or '060 >> 723 * d1 := cacheable write-through >> 724 * NOTE: The 68040 manual strongly recommends non-cached for MMU tables, >> 725 * but we have been using write-through since at least 2.0.29 so I >> 726 * guess it is OK. >> 727 */ >> 728 #ifdef CONFIG_060_WRITETHROUGH >> 729 /* >> 730 * If this is a 68060 board using drivers with cache coherency >> 731 * problems, then supervisor memory accesses need to be write-through >> 732 * also; otherwise, we want copyback. >> 733 */ >> 734 >> 735 is_not_060(1f) >> 736 movel #_PAGE_CACHE040W,%d0 >> 737 jra L(save_cachetype) >> 738 #endif /* CONFIG_060_WRITETHROUGH */ >> 739 1: >> 740 movew #_PAGE_CACHE040,%d0 >> 741 >> 742 movel #_PAGE_CACHE040W,%d1 >> 743 >> 744 L(save_cachetype): >> 745 /* Save cache mode for supervisor mode and page tables >> 746 */ >> 747 lea %pc@(m68k_supervisor_cachemode),%a0 >> 748 movel %d0,%a0@ >> 749 lea %pc@(m68k_pgtable_cachemode),%a0 >> 750 movel %d1,%a0@ >> 751 >> 752 /* >> 753 * raise interrupt level >> 754 */ >> 755 movew #0x2700,%sr >> 756 >> 757 /* >> 758 If running on an Atari, determine the I/O base of the >> 759 serial port and test if we are running on a Medusa or Hades. >> 760 This test is necessary here, because on the Hades the serial >> 761 port is only accessible in the high I/O memory area. >> 762 >> 763 The test whether it is a Medusa is done by writing to the byte at >> 764 phys. 0x0. This should result in a bus error on all other machines. >> 765 >> 766 ...should, but doesn't. The Afterburner040 for the Falcon has the >> 767 same behaviour (0x0..0x7 are no ROM shadow). So we have to do >> 768 another test to distinguish Medusa and AB040. This is a >> 769 read attempt for 0x00ff82fe phys. that should bus error on a Falcon >> 770 (+AB040), but is in the range where the Medusa always asserts DTACK. >> 771 >> 772 The test for the Hades is done by reading address 0xb0000000. This >> 773 should give a bus error on the Medusa. >> 774 */ >> 775 >> 776 #ifdef CONFIG_ATARI >> 777 is_not_atari(L(notypetest)) >> 778 >> 779 /* get special machine type (Medusa/Hades/AB40) */ >> 780 moveq #0,%d3 /* default if tag doesn't exist */ >> 781 get_bi_record BI_ATARI_MCH_TYPE >> 782 tstl %d0 >> 783 jbmi 1f >> 784 movel %a0@,%d3 >> 785 lea %pc@(atari_mch_type),%a0 >> 786 movel %d3,%a0@ >> 787 1: >> 788 /* On the Hades, the iobase must be set up before opening the >> 789 * serial port. There are no I/O regs at 0x00ffxxxx at all. */ >> 790 moveq #0,%d0 >> 791 cmpl #ATARI_MACH_HADES,%d3 >> 792 jbne 1f >> 793 movel #0xff000000,%d0 /* Hades I/O base addr: 0xff000000 */ >> 794 1: lea %pc@(L(iobase)),%a0 >> 795 movel %d0,%a0@ >> 796 >> 797 L(notypetest): 45 #endif 798 #endif 46 sr r5, [ARC_REG_DC_CTRL] << 47 799 >> 800 #ifdef CONFIG_VME >> 801 is_mvme147(L(getvmetype)) >> 802 is_bvme6000(L(getvmetype)) >> 803 is_not_mvme16x(L(gvtdone)) >> 804 >> 805 /* See if the loader has specified the BI_VME_TYPE tag. Recent >> 806 * versions of VMELILO and TFTPLILO do this. We have to do this >> 807 * early so we know how to handle console output. If the tag >> 808 * doesn't exist then we use the Bug for output on MVME16x. >> 809 */ >> 810 L(getvmetype): >> 811 get_bi_record BI_VME_TYPE >> 812 tstl %d0 >> 813 jbmi 1f >> 814 movel %a0@,%d3 >> 815 lea %pc@(vme_brdtype),%a0 >> 816 movel %d3,%a0@ 48 1: 817 1: >> 818 #ifdef CONFIG_MVME16x >> 819 is_not_mvme16x(L(gvtdone)) 49 820 50 #ifdef CONFIG_ISA_ARCV2 !! 821 /* Need to get the BRD_ID info to differentiate between 162, 167, 51 ; Unaligned access is disabled at rese !! 822 * etc. This is available as a BI_VME_BRDINFO tag with later 52 ; gcc 7.3.1 (ARC GNU 2018.03) onwards !! 823 * versions of VMELILO and TFTPLILO, otherwise we call the Bug. 53 ; by default !! 824 */ 54 lr r5, [status32] !! 825 get_bi_record BI_VME_BRDINFO 55 #ifdef CONFIG_ARC_USE_UNALIGNED_MEM_ACCESS !! 826 tstl %d0 56 bset r5, r5, STATUS_AD_BIT !! 827 jpl 1f 57 #else !! 828 58 ; Although disabled at reset, bootload !! 829 /* Get pointer to board ID data from Bug */ 59 bclr r5, r5, STATUS_AD_BIT !! 830 movel %d2,%sp@- >> 831 trap #15 >> 832 .word 0x70 /* trap 0x70 - .BRD_ID */ >> 833 movel %sp@+,%a0 >> 834 1: >> 835 lea %pc@(mvme_bdid),%a1 >> 836 /* Structure is 32 bytes long */ >> 837 movel %a0@+,%a1@+ >> 838 movel %a0@+,%a1@+ >> 839 movel %a0@+,%a1@+ >> 840 movel %a0@+,%a1@+ >> 841 movel %a0@+,%a1@+ >> 842 movel %a0@+,%a1@+ >> 843 movel %a0@+,%a1@+ >> 844 movel %a0@+,%a1@+ >> 845 #endif >> 846 >> 847 L(gvtdone): >> 848 >> 849 #endif >> 850 >> 851 #ifdef CONFIG_HP300 >> 852 is_not_hp300(L(nothp)) >> 853 >> 854 /* Get the address of the UART for serial debugging */ >> 855 get_bi_record BI_HP300_UART_ADDR >> 856 tstl %d0 >> 857 jbmi 1f >> 858 movel %a0@,%d3 >> 859 lea %pc@(L(uartbase)),%a0 >> 860 movel %d3,%a0@ >> 861 get_bi_record BI_HP300_UART_SCODE >> 862 tstl %d0 >> 863 jbmi 1f >> 864 movel %a0@,%d3 >> 865 lea %pc@(L(uart_scode)),%a0 >> 866 movel %d3,%a0@ >> 867 1: >> 868 L(nothp): >> 869 #endif >> 870 >> 871 /* >> 872 * Initialize serial port >> 873 */ >> 874 jbsr L(serial_init) >> 875 >> 876 /* >> 877 * Initialize console >> 878 */ >> 879 #ifdef CONFIG_MAC >> 880 is_not_mac(L(nocon)) >> 881 # ifdef CONSOLE_DEBUG >> 882 console_init >> 883 # ifdef CONFIG_LOGO >> 884 console_put_penguin >> 885 # endif /* CONFIG_LOGO */ >> 886 # endif /* CONSOLE_DEBUG */ >> 887 L(nocon): >> 888 #endif /* CONFIG_MAC */ >> 889 >> 890 >> 891 putc '\n' >> 892 putc 'A' >> 893 leds 0x2 >> 894 dputn %pc@(L(cputype)) >> 895 dputn %pc@(m68k_supervisor_cachemode) >> 896 dputn %pc@(m68k_pgtable_cachemode) >> 897 dputc '\n' >> 898 >> 899 /* >> 900 * Save physical start address of kernel >> 901 */ >> 902 lea %pc@(L(phys_kernel_start)),%a0 >> 903 lea %pc@(_stext),%a1 >> 904 subl #_stext,%a1 >> 905 addl #PAGE_OFFSET,%a1 >> 906 movel %a1,%a0@ >> 907 >> 908 putc 'B' >> 909 >> 910 leds 0x4 >> 911 >> 912 /* >> 913 * mmu_init >> 914 * >> 915 * This block of code does what's necessary to map in the various kinds >> 916 * of machines for execution of Linux. >> 917 * First map the first 4, 8, or 16 MB of kernel code & data >> 918 */ >> 919 >> 920 get_bi_record BI_MEMCHUNK >> 921 movel %a0@(4),%d0 >> 922 movel #16*1024*1024,%d1 >> 923 cmpl %d0,%d1 >> 924 jls 1f >> 925 lsrl #1,%d1 >> 926 cmpl %d0,%d1 >> 927 jls 1f >> 928 lsrl #1,%d1 >> 929 1: >> 930 lea %pc@(m68k_init_mapped_size),%a0 >> 931 movel %d1,%a0@ >> 932 mmu_map #PAGE_OFFSET,%pc@(L(phys_kernel_start)),%d1,\ >> 933 %pc@(m68k_supervisor_cachemode) >> 934 >> 935 putc 'C' >> 936 >> 937 #ifdef CONFIG_AMIGA >> 938 >> 939 L(mmu_init_amiga): >> 940 >> 941 is_not_amiga(L(mmu_init_not_amiga)) >> 942 /* >> 943 * mmu_init_amiga >> 944 */ >> 945 >> 946 putc 'D' >> 947 >> 948 is_not_040_or_060(1f) >> 949 >> 950 /* >> 951 * 040: Map the 16Meg range physical 0x0 up to logical 0x8000.0000 >> 952 */ >> 953 mmu_map #0x80000000,#0,#0x01000000,#_PAGE_NOCACHE_S >> 954 /* >> 955 * Map the Zorro III I/O space with transparent translation >> 956 * for frame buffer memory etc. >> 957 */ >> 958 mmu_map_tt #1,#0x40000000,#0x20000000,#_PAGE_NOCACHE_S >> 959 >> 960 jbra L(mmu_init_done) >> 961 >> 962 1: >> 963 /* >> 964 * 030: Map the 32Meg range physical 0x0 up to logical 0x8000.0000 >> 965 */ >> 966 mmu_map #0x80000000,#0,#0x02000000,#_PAGE_NOCACHE030 >> 967 mmu_map_tt #1,#0x40000000,#0x20000000,#_PAGE_NOCACHE030 >> 968 >> 969 jbra L(mmu_init_done) >> 970 >> 971 L(mmu_init_not_amiga): >> 972 #endif >> 973 >> 974 #ifdef CONFIG_ATARI >> 975 >> 976 L(mmu_init_atari): >> 977 >> 978 is_not_atari(L(mmu_init_not_atari)) >> 979 >> 980 putc 'E' >> 981 >> 982 /* On the Atari, we map the I/O region (phys. 0x00ffxxxx) by mapping >> 983 the last 16 MB of virtual address space to the first 16 MB (i.e. >> 984 0xffxxxxxx -> 0x00xxxxxx). For this, an additional pointer table is >> 985 needed. I/O ranges are marked non-cachable. >> 986 >> 987 For the Medusa it is better to map the I/O region transparently >> 988 (i.e. 0xffxxxxxx -> 0xffxxxxxx), because some I/O registers are >> 989 accessible only in the high area. >> 990 >> 991 On the Hades all I/O registers are only accessible in the high >> 992 area. >> 993 */ >> 994 >> 995 /* I/O base addr for non-Medusa, non-Hades: 0x00000000 */ >> 996 moveq #0,%d0 >> 997 movel %pc@(atari_mch_type),%d3 >> 998 cmpl #ATARI_MACH_MEDUSA,%d3 >> 999 jbeq 2f >> 1000 cmpl #ATARI_MACH_HADES,%d3 >> 1001 jbne 1f >> 1002 2: movel #0xff000000,%d0 /* Medusa/Hades base addr: 0xff000000 */ >> 1003 1: movel %d0,%d3 >> 1004 >> 1005 is_040_or_060(L(spata68040)) >> 1006 >> 1007 /* Map everything non-cacheable, though not all parts really >> 1008 * need to disable caches (crucial only for 0xff8000..0xffffff >> 1009 * (standard I/O) and 0xf00000..0xf3ffff (IDE)). The remainder >> 1010 * isn't really used, except for sometimes peeking into the >> 1011 * ROMs (mirror at phys. 0x0), so caching isn't necessary for >> 1012 * this. */ >> 1013 mmu_map #0xff000000,%d3,#0x01000000,#_PAGE_NOCACHE030 >> 1014 >> 1015 jbra L(mmu_init_done) >> 1016 >> 1017 L(spata68040): >> 1018 >> 1019 mmu_map #0xff000000,%d3,#0x01000000,#_PAGE_NOCACHE_S >> 1020 >> 1021 jbra L(mmu_init_done) >> 1022 >> 1023 L(mmu_init_not_atari): >> 1024 #endif >> 1025 >> 1026 #ifdef CONFIG_Q40 >> 1027 is_not_q40(L(notq40)) >> 1028 /* >> 1029 * add transparent mapping for 0xff00 0000 - 0xffff ffff >> 1030 * non-cached serialized etc.. >> 1031 * this includes master chip, DAC, RTC and ISA ports >> 1032 * 0xfe000000-0xfeffffff is for screen and ROM >> 1033 */ >> 1034 >> 1035 putc 'Q' >> 1036 >> 1037 mmu_map_tt #0,#0xfe000000,#0x01000000,#_PAGE_CACHE040W >> 1038 mmu_map_tt #1,#0xff000000,#0x01000000,#_PAGE_NOCACHE_S >> 1039 >> 1040 jbra L(mmu_init_done) >> 1041 >> 1042 L(notq40): >> 1043 #endif >> 1044 >> 1045 #ifdef CONFIG_HP300 >> 1046 is_not_hp300(L(nothp300)) >> 1047 >> 1048 /* On the HP300, we map the ROM, INTIO and DIO regions (phys. 0x00xxxxxx) >> 1049 * by mapping 32MB (on 020/030) or 16 MB (on 040) from 0xf0xxxxxx -> 0x00xxxxxx). >> 1050 * The ROM mapping is needed because the LEDs are mapped there too. >> 1051 */ >> 1052 >> 1053 is_040(1f) >> 1054 >> 1055 /* >> 1056 * 030: Map the 32Meg range physical 0x0 up to logical 0xf000.0000 >> 1057 */ >> 1058 mmu_map #0xf0000000,#0,#0x02000000,#_PAGE_NOCACHE030 >> 1059 >> 1060 jbra L(mmu_init_done) >> 1061 >> 1062 1: >> 1063 /* >> 1064 * 040: Map the 16Meg range physical 0x0 up to logical 0xf000.0000 >> 1065 */ >> 1066 mmu_map #0xf0000000,#0,#0x01000000,#_PAGE_NOCACHE_S >> 1067 >> 1068 jbra L(mmu_init_done) >> 1069 >> 1070 L(nothp300): >> 1071 #endif /* CONFIG_HP300 */ >> 1072 >> 1073 #ifdef CONFIG_MVME147 >> 1074 >> 1075 is_not_mvme147(L(not147)) >> 1076 >> 1077 /* >> 1078 * On MVME147 we have already created kernel page tables for >> 1079 * 4MB of RAM at address 0, so now need to do a transparent >> 1080 * mapping of the top of memory space. Make it 0.5GByte for now, >> 1081 * so we can access on-board i/o areas. >> 1082 */ >> 1083 >> 1084 mmu_map_tt #1,#0xe0000000,#0x20000000,#_PAGE_NOCACHE030 >> 1085 >> 1086 jbra L(mmu_init_done) >> 1087 >> 1088 L(not147): >> 1089 #endif /* CONFIG_MVME147 */ >> 1090 >> 1091 #ifdef CONFIG_MVME16x >> 1092 >> 1093 is_not_mvme16x(L(not16x)) >> 1094 >> 1095 /* >> 1096 * On MVME16x we have already created kernel page tables for >> 1097 * 4MB of RAM at address 0, so now need to do a transparent >> 1098 * mapping of the top of memory space. Make it 0.5GByte for now. >> 1099 * Supervisor only access, so transparent mapping doesn't >> 1100 * clash with User code virtual address space. >> 1101 * this covers IO devices, PROM and SRAM. The PROM and SRAM >> 1102 * mapping is needed to allow 167Bug to run. >> 1103 * IO is in the range 0xfff00000 to 0xfffeffff. >> 1104 * PROM is 0xff800000->0xffbfffff and SRAM is >> 1105 * 0xffe00000->0xffe1ffff. >> 1106 */ >> 1107 >> 1108 mmu_map_tt #1,#0xe0000000,#0x20000000,#_PAGE_NOCACHE_S >> 1109 >> 1110 jbra L(mmu_init_done) >> 1111 >> 1112 L(not16x): >> 1113 #endif /* CONFIG_MVME162 | CONFIG_MVME167 */ >> 1114 >> 1115 #ifdef CONFIG_BVME6000 >> 1116 >> 1117 is_not_bvme6000(L(not6000)) >> 1118 >> 1119 /* >> 1120 * On BVME6000 we have already created kernel page tables for >> 1121 * 4MB of RAM at address 0, so now need to do a transparent >> 1122 * mapping of the top of memory space. Make it 0.5GByte for now, >> 1123 * so we can access on-board i/o areas. >> 1124 * Supervisor only access, so transparent mapping doesn't >> 1125 * clash with User code virtual address space. >> 1126 */ >> 1127 >> 1128 mmu_map_tt #1,#0xe0000000,#0x20000000,#_PAGE_NOCACHE_S >> 1129 >> 1130 jbra L(mmu_init_done) >> 1131 >> 1132 L(not6000): >> 1133 #endif /* CONFIG_BVME6000 */ >> 1134 >> 1135 /* >> 1136 * mmu_init_mac >> 1137 * >> 1138 * The Macintosh mappings are less clear. >> 1139 * >> 1140 * Even as of this writing, it is unclear how the >> 1141 * Macintosh mappings will be done. However, as >> 1142 * the first author of this code I'm proposing the >> 1143 * following model: >> 1144 * >> 1145 * Map the kernel (that's already done), >> 1146 * Map the I/O (on most machines that's the >> 1147 * 0x5000.0000 ... 0x5300.0000 range, >> 1148 * Map the video frame buffer using as few pages >> 1149 * as absolutely (this requirement mostly stems from >> 1150 * the fact that when the frame buffer is at >> 1151 * 0x0000.0000 then we know there is valid RAM just >> 1152 * above the screen that we don't want to waste!). >> 1153 * >> 1154 * By the way, if the frame buffer is at 0x0000.0000 >> 1155 * then the Macintosh is known as an RBV based Mac. >> 1156 * >> 1157 * By the way 2, the code currently maps in a bunch of >> 1158 * regions. But I'd like to cut that out. (And move most >> 1159 * of the mappings up into the kernel proper ... or only >> 1160 * map what's necessary.) >> 1161 */ >> 1162 >> 1163 #ifdef CONFIG_MAC >> 1164 >> 1165 L(mmu_init_mac): >> 1166 >> 1167 is_not_mac(L(mmu_init_not_mac)) >> 1168 >> 1169 putc 'F' >> 1170 >> 1171 is_not_040_or_060(1f) >> 1172 >> 1173 moveq #_PAGE_NOCACHE_S,%d3 >> 1174 jbra 2f >> 1175 1: >> 1176 moveq #_PAGE_NOCACHE030,%d3 >> 1177 2: >> 1178 /* >> 1179 * Mac Note: screen address of logical 0xF000.0000 -> <screen physical> >> 1180 * we simply map the 4MB that contains the videomem >> 1181 */ >> 1182 >> 1183 movel #VIDEOMEMMASK,%d0 >> 1184 andl %pc@(L(mac_videobase)),%d0 >> 1185 >> 1186 mmu_map #VIDEOMEMBASE,%d0,#VIDEOMEMSIZE,%d3 >> 1187 /* ROM from 4000 0000 to 4200 0000 (only for mac_reset()) */ >> 1188 mmu_map_eq #0x40000000,#0x02000000,%d3 >> 1189 /* IO devices (incl. serial port) from 5000 0000 to 5300 0000 */ >> 1190 mmu_map_eq #0x50000000,#0x03000000,%d3 >> 1191 /* Nubus slot space (video at 0xF0000000, rom at 0xF0F80000) */ >> 1192 mmu_map_tt #1,#0xf8000000,#0x08000000,%d3 >> 1193 >> 1194 jbra L(mmu_init_done) >> 1195 >> 1196 L(mmu_init_not_mac): 60 #endif 1197 #endif 61 kflag r5 << 62 1198 63 #ifdef CONFIG_ARC_LPB_DISABLE !! 1199 #ifdef CONFIG_SUN3X 64 lr r5, [ARC_REG_LPB_BUILD] !! 1200 is_not_sun3x(L(notsun3x)) 65 breq r5, 0, 1f ; LPB !! 1201 66 mov r5, 1 !! 1202 /* oh, the pain.. We're gonna want the prom code after 67 sr r5, [ARC_REG_LPB_CTRL] !! 1203 * starting the MMU, so we copy the mappings, translating >> 1204 * from 8k -> 4k pages as we go. >> 1205 */ >> 1206 >> 1207 /* copy maps from 0xfee00000 to 0xff000000 */ >> 1208 movel #0xfee00000, %d0 >> 1209 moveq #ROOT_INDEX_SHIFT, %d1 >> 1210 lsrl %d1,%d0 >> 1211 mmu_get_root_table_entry %d0 >> 1212 >> 1213 movel #0xfee00000, %d0 >> 1214 moveq #PTR_INDEX_SHIFT, %d1 >> 1215 lsrl %d1,%d0 >> 1216 andl #PTR_TABLE_SIZE-1, %d0 >> 1217 mmu_get_ptr_table_entry %a0,%d0 >> 1218 >> 1219 movel #0xfee00000, %d0 >> 1220 moveq #PAGE_INDEX_SHIFT, %d1 >> 1221 lsrl %d1,%d0 >> 1222 andl #PAGE_TABLE_SIZE-1, %d0 >> 1223 mmu_get_page_table_entry %a0,%d0 >> 1224 >> 1225 /* this is where the prom page table lives */ >> 1226 movel 0xfefe00d4, %a1 >> 1227 movel %a1@, %a1 >> 1228 >> 1229 movel #((0x200000 >> 13)-1), %d1 >> 1230 68 1: 1231 1: 69 #endif /* CONFIG_ARC_LPB_DISABLE */ !! 1232 movel %a1@+, %d3 >> 1233 movel %d3,%a0@+ >> 1234 addl #0x1000,%d3 >> 1235 movel %d3,%a0@+ >> 1236 >> 1237 dbra %d1,1b >> 1238 >> 1239 /* setup tt1 for I/O */ >> 1240 mmu_map_tt #1,#0x40000000,#0x40000000,#_PAGE_NOCACHE_S >> 1241 jbra L(mmu_init_done) >> 1242 >> 1243 L(notsun3x): >> 1244 #endif >> 1245 >> 1246 #ifdef CONFIG_VIRT >> 1247 is_not_virt(L(novirt)) >> 1248 mmu_map_tt #1,#0xFF000000,#0x01000000,#_PAGE_NOCACHE_S >> 1249 jbra L(mmu_init_done) >> 1250 L(novirt): >> 1251 #endif >> 1252 >> 1253 #ifdef CONFIG_APOLLO >> 1254 is_not_apollo(L(notapollo)) 70 1255 71 /* On HSDK, CCMs need to remapped supe !! 1256 putc 'P' 72 #ifdef CONFIG_ARC_SOC_HSDK !! 1257 mmu_map #0x80000000,#0,#0x02000000,#_PAGE_NOCACHE030 73 mov r6, 0x60000000 !! 1258 74 lr r5, [ARC_REG_ICCM_BUILD] !! 1259 L(notapollo): 75 breq r5, 0, 1f !! 1260 jbra L(mmu_init_done) 76 sr r6, [ARC_REG_AUX_ICCM] !! 1261 #endif >> 1262 >> 1263 L(mmu_init_done): >> 1264 >> 1265 putc 'G' >> 1266 leds 0x8 >> 1267 >> 1268 /* >> 1269 * mmu_fixup >> 1270 * >> 1271 * On the 040 class machines, all pages that are used for the >> 1272 * mmu have to be fixed up. According to Motorola, pages holding mmu >> 1273 * tables should be non-cacheable on a '040 and write-through on a >> 1274 * '060. But analysis of the reasons for this, and practical >> 1275 * experience, showed that write-through also works on a '040. >> 1276 * >> 1277 * Allocated memory so far goes from kernel_end to memory_start that >> 1278 * is used for all kind of tables, for that the cache attributes >> 1279 * are now fixed. >> 1280 */ >> 1281 L(mmu_fixup): >> 1282 >> 1283 is_not_040_or_060(L(mmu_fixup_done)) >> 1284 >> 1285 #ifdef MMU_NOCACHE_KERNEL >> 1286 jbra L(mmu_fixup_done) >> 1287 #endif >> 1288 >> 1289 /* first fix the page at the start of the kernel, that >> 1290 * contains also kernel_pg_dir. >> 1291 */ >> 1292 movel %pc@(L(phys_kernel_start)),%d0 >> 1293 subl #PAGE_OFFSET,%d0 >> 1294 lea %pc@(_stext),%a0 >> 1295 subl %d0,%a0 >> 1296 mmu_fixup_page_mmu_cache %a0 >> 1297 >> 1298 movel %pc@(L(kernel_end)),%a0 >> 1299 subl %d0,%a0 >> 1300 movel %pc@(L(memory_start)),%a1 >> 1301 subl %d0,%a1 >> 1302 bra 2f 77 1: 1303 1: 78 lr r5, [ARC_REG_DCCM_BUILD] !! 1304 mmu_fixup_page_mmu_cache %a0 79 breq r5, 0, 2f !! 1305 addw #PAGESIZE,%a0 80 sr r6, [ARC_REG_AUX_DCCM] << 81 2: 1306 2: 82 #endif /* CONFIG_ARC_SOC_HSDK */ !! 1307 cmpl %a0,%a1 >> 1308 jgt 1b 83 1309 84 #endif /* CONFIG_ISA_ARCV2 */ !! 1310 L(mmu_fixup_done): 85 1311 86 ; Config DSP_CTRL properly, so kernel !! 1312 #ifdef MMU_PRINT 87 ; multiply-accumulate, and divide oper !! 1313 mmu_print 88 DSP_EARLY_INIT !! 1314 #endif 89 .endm !! 1315 >> 1316 /* >> 1317 * mmu_engage >> 1318 * >> 1319 * This chunk of code performs the gruesome task of engaging the MMU. >> 1320 * The reason it's gruesome is because when the MMU becomes engaged it >> 1321 * maps logical addresses to physical addresses. The Program Counter >> 1322 * register is then passed through the MMU before the next instruction >> 1323 * is fetched (the instruction following the engage MMU instruction). >> 1324 * This may mean one of two things: >> 1325 * 1. The Program Counter falls within the logical address space of >> 1326 * the kernel of which there are two sub-possibilities: >> 1327 * A. The PC maps to the correct instruction (logical PC == physical >> 1328 * code location), or >> 1329 * B. The PC does not map through and the processor will read some >> 1330 * data (or instruction) which is not the logically next instr. >> 1331 * As you can imagine, A is good and B is bad. >> 1332 * Alternatively, >> 1333 * 2. The Program Counter does not map through the MMU. The processor >> 1334 * will take a Bus Error. >> 1335 * Clearly, 2 is bad. >> 1336 * It doesn't take a wiz kid to figure you want 1.A. >> 1337 * This code creates that possibility. >> 1338 * There are two possible 1.A. states (we now ignore the other above states): >> 1339 * A. The kernel is located at physical memory addressed the same as >> 1340 * the logical memory for the kernel, i.e., 0x01000. >> 1341 * B. The kernel is located some where else. e.g., 0x0400.0000 >> 1342 * >> 1343 * Under some conditions the Macintosh can look like A or B. >> 1344 * [A friend and I once noted that Apple hardware engineers should be >> 1345 * wacked twice each day: once when they show up at work (as in, Whack!, >> 1346 * "This is for the screwy hardware we know you're going to design today."), >> 1347 * and also at the end of the day (as in, Whack! "I don't know what >> 1348 * you designed today, but I'm sure it wasn't good."). -- rst] >> 1349 * >> 1350 * This code works on the following premise: >> 1351 * If the kernel start (%d5) is within the first 16 Meg of RAM, >> 1352 * then create a mapping for the kernel at logical 0x8000.0000 to >> 1353 * the physical location of the pc. And, create a transparent >> 1354 * translation register for the first 16 Meg. Then, after the MMU >> 1355 * is engaged, the PC can be moved up into the 0x8000.0000 range >> 1356 * and then the transparent translation can be turned off and then >> 1357 * the PC can jump to the correct logical location and it will be >> 1358 * home (finally). This is essentially the code that the Amiga used >> 1359 * to use. Now, it's generalized for all processors. Which means >> 1360 * that a fresh (but temporary) mapping has to be created. The mapping >> 1361 * is made in page 0 (an as of yet unused location -- except for the >> 1362 * stack!). This temporary mapping will only require 1 pointer table >> 1363 * and a single page table (it can map 256K). >> 1364 * >> 1365 * OK, alternatively, imagine that the Program Counter is not within >> 1366 * the first 16 Meg. Then, just use Transparent Translation registers >> 1367 * to do the right thing. >> 1368 * >> 1369 * Last, if _start is already at 0x01000, then there's nothing special >> 1370 * to do (in other words, in a degenerate case of the first case above, >> 1371 * do nothing). >> 1372 * >> 1373 * Let's do it. >> 1374 * >> 1375 * >> 1376 */ >> 1377 >> 1378 putc 'H' >> 1379 >> 1380 mmu_engage >> 1381 >> 1382 /* >> 1383 * After this point no new memory is allocated and >> 1384 * the start of available memory is stored in availmem. >> 1385 * (The bootmem allocator requires now the physical address.) >> 1386 */ >> 1387 >> 1388 movel L(memory_start),availmem >> 1389 >> 1390 #ifdef CONFIG_AMIGA >> 1391 is_not_amiga(1f) >> 1392 /* fixup the Amiga custom register location before printing */ >> 1393 clrl L(custom) >> 1394 1: >> 1395 #endif 90 1396 91 .section .init.text, "ax",@progbits !! 1397 #ifdef CONFIG_ATARI >> 1398 is_not_atari(1f) >> 1399 /* fixup the Atari iobase register location before printing */ >> 1400 movel #0xff000000,L(iobase) >> 1401 1: >> 1402 #endif >> 1403 >> 1404 #ifdef CONFIG_MAC >> 1405 is_not_mac(1f) >> 1406 movel #~VIDEOMEMMASK,%d0 >> 1407 andl L(mac_videobase),%d0 >> 1408 addl #VIDEOMEMBASE,%d0 >> 1409 movel %d0,L(mac_videobase) >> 1410 #ifdef CONSOLE_DEBUG >> 1411 movel %pc@(L(phys_kernel_start)),%d0 >> 1412 subl #PAGE_OFFSET,%d0 >> 1413 subl %d0,L(console_font) >> 1414 subl %d0,L(console_font_data) >> 1415 #endif >> 1416 orl #0x50000000,L(mac_sccbase) >> 1417 1: >> 1418 #endif >> 1419 >> 1420 #ifdef CONFIG_HP300 >> 1421 is_not_hp300(2f) >> 1422 /* >> 1423 * Fix up the iobase register to point to the new location of the LEDs. >> 1424 */ >> 1425 movel #0xf0000000,L(iobase) >> 1426 >> 1427 /* >> 1428 * Energise the FPU and caches. >> 1429 */ >> 1430 is_040(1f) >> 1431 movel #0x60,0xf05f400c >> 1432 jbra 2f >> 1433 >> 1434 /* >> 1435 * 040: slightly different, apparently. >> 1436 */ >> 1437 1: movew #0,0xf05f400e >> 1438 movew #0x64,0xf05f400e >> 1439 2: >> 1440 #endif >> 1441 >> 1442 #ifdef CONFIG_SUN3X >> 1443 is_not_sun3x(1f) >> 1444 >> 1445 /* enable copro */ >> 1446 oriw #0x4000,0x61000000 >> 1447 1: >> 1448 #endif >> 1449 >> 1450 #ifdef CONFIG_APOLLO >> 1451 is_not_apollo(1f) >> 1452 >> 1453 /* >> 1454 * Fix up the iobase before printing >> 1455 */ >> 1456 movel #0x80000000,L(iobase) >> 1457 1: >> 1458 #endif >> 1459 >> 1460 putc 'I' >> 1461 leds 0x10 >> 1462 >> 1463 /* >> 1464 * Enable caches >> 1465 */ >> 1466 >> 1467 is_not_040_or_060(L(cache_not_680460)) >> 1468 >> 1469 L(cache680460): >> 1470 .chip 68040 >> 1471 nop >> 1472 cpusha %bc >> 1473 nop >> 1474 >> 1475 is_060(L(cache68060)) >> 1476 >> 1477 movel #CC6_ENABLE_D+CC6_ENABLE_I,%d0 >> 1478 /* MMU stuff works in copyback mode now, so enable the cache */ >> 1479 movec %d0,%cacr >> 1480 jra L(cache_done) >> 1481 >> 1482 L(cache68060): >> 1483 movel #CC6_ENABLE_D+CC6_ENABLE_I+CC6_ENABLE_SB+CC6_PUSH_DPI+CC6_ENABLE_B+CC6_CLRA_B,%d0 >> 1484 /* MMU stuff works in copyback mode now, so enable the cache */ >> 1485 movec %d0,%cacr >> 1486 /* enable superscalar dispatch in PCR */ >> 1487 moveq #1,%d0 >> 1488 .chip 68060 >> 1489 movec %d0,%pcr >> 1490 >> 1491 jbra L(cache_done) >> 1492 L(cache_not_680460): >> 1493 L(cache68030): >> 1494 .chip 68030 >> 1495 movel #CC3_ENABLE_DB+CC3_CLR_D+CC3_ENABLE_D+CC3_ENABLE_IB+CC3_CLR_I+CC3_ENABLE_I,%d0 >> 1496 movec %d0,%cacr >> 1497 >> 1498 jra L(cache_done) >> 1499 .chip 68k >> 1500 L(cache_done): >> 1501 >> 1502 putc 'J' >> 1503 >> 1504 /* >> 1505 * Setup initial stack pointer >> 1506 */ >> 1507 lea init_task,%curptr >> 1508 lea init_thread_union+THREAD_SIZE,%sp >> 1509 >> 1510 putc 'K' >> 1511 >> 1512 subl %a6,%a6 /* clear a6 for gdb */ >> 1513 >> 1514 /* >> 1515 * The new 64bit printf support requires an early exception initialization. >> 1516 */ >> 1517 jbsr base_trap_init >> 1518 >> 1519 /* jump to the kernel start */ >> 1520 >> 1521 putc '\n' >> 1522 leds 0x55 >> 1523 >> 1524 jbsr start_kernel >> 1525 >> 1526 /* >> 1527 * Find a tag record in the bootinfo structure >> 1528 * The bootinfo structure is located right after the kernel >> 1529 * Returns: d0: size (-1 if not found) >> 1530 * a0: data pointer (end-of-records if not found) >> 1531 */ >> 1532 func_start get_bi_record,%d1 >> 1533 >> 1534 movel ARG1,%d0 >> 1535 lea %pc@(_end),%a0 >> 1536 1: tstw %a0@(BIR_TAG) >> 1537 jeq 3f >> 1538 cmpw %a0@(BIR_TAG),%d0 >> 1539 jeq 2f >> 1540 addw %a0@(BIR_SIZE),%a0 >> 1541 jra 1b >> 1542 2: moveq #0,%d0 >> 1543 movew %a0@(BIR_SIZE),%d0 >> 1544 lea %a0@(BIR_DATA),%a0 >> 1545 jra 4f >> 1546 3: moveq #-1,%d0 >> 1547 lea %a0@(BIR_SIZE),%a0 >> 1548 4: >> 1549 func_return get_bi_record >> 1550 >> 1551 >> 1552 /* >> 1553 * MMU Initialization Begins Here >> 1554 * >> 1555 * The structure of the MMU tables on the 68k machines >> 1556 * is thus: >> 1557 * Root Table >> 1558 * Logical addresses are translated through >> 1559 * a hierarchical translation mechanism where the high-order >> 1560 * seven bits of the logical address (LA) are used as an >> 1561 * index into the "root table." Each entry in the root >> 1562 * table has a bit which specifies if it's a valid pointer to a >> 1563 * pointer table. Each entry defines a 32Meg range of memory. >> 1564 * If an entry is invalid then that logical range of 32M is >> 1565 * invalid and references to that range of memory (when the MMU >> 1566 * is enabled) will fault. If the entry is valid, then it does >> 1567 * one of two things. On 040/060 class machines, it points to >> 1568 * a pointer table which then describes more finely the memory >> 1569 * within that 32M range. On 020/030 class machines, a technique >> 1570 * called "early terminating descriptors" are used. This technique >> 1571 * allows an entire 32Meg to be described by a single entry in the >> 1572 * root table. Thus, this entry in the root table, contains the >> 1573 * physical address of the memory or I/O at the logical address >> 1574 * which the entry represents and it also contains the necessary >> 1575 * cache bits for this region. >> 1576 * >> 1577 * Pointer Tables >> 1578 * Per the Root Table, there will be one or more >> 1579 * pointer tables. Each pointer table defines a 32M range. >> 1580 * Not all of the 32M range need be defined. Again, the next >> 1581 * seven bits of the logical address are used an index into >> 1582 * the pointer table to point to page tables (if the pointer >> 1583 * is valid). There will undoubtedly be more than one >> 1584 * pointer table for the kernel because each pointer table >> 1585 * defines a range of only 32M. Valid pointer table entries >> 1586 * point to page tables, or are early terminating entries >> 1587 * themselves. >> 1588 * >> 1589 * Page Tables >> 1590 * Per the Pointer Tables, each page table entry points >> 1591 * to the physical page in memory that supports the logical >> 1592 * address that translates to the particular index. >> 1593 * >> 1594 * In short, the Logical Address gets translated as follows: >> 1595 * bits 31..26 - index into the Root Table >> 1596 * bits 25..18 - index into the Pointer Table >> 1597 * bits 17..12 - index into the Page Table >> 1598 * bits 11..0 - offset into a particular 4K page >> 1599 * >> 1600 * The algorithms which follow do one thing: they abstract >> 1601 * the MMU hardware. For example, there are three kinds of >> 1602 * cache settings that are relevant. Either, memory is >> 1603 * being mapped in which case it is either Kernel Code (or >> 1604 * the RamDisk) or it is MMU data. On the 030, the MMU data >> 1605 * option also describes the kernel. Or, I/O is being mapped >> 1606 * in which case it has its own kind of cache bits. There >> 1607 * are constants which abstract these notions from the code that >> 1608 * actually makes the call to map some range of memory. >> 1609 * >> 1610 * >> 1611 * >> 1612 */ >> 1613 >> 1614 #ifdef MMU_PRINT >> 1615 /* >> 1616 * mmu_print >> 1617 * >> 1618 * This algorithm will print out the current MMU mappings. >> 1619 * >> 1620 * Input: >> 1621 * %a5 points to the root table. Everything else is calculated >> 1622 * from this. >> 1623 */ >> 1624 >> 1625 #define mmu_next_valid 0 >> 1626 #define mmu_start_logical 4 >> 1627 #define mmu_next_logical 8 >> 1628 #define mmu_start_physical 12 >> 1629 #define mmu_next_physical 16 >> 1630 >> 1631 #define MMU_PRINT_INVALID -1 >> 1632 #define MMU_PRINT_VALID 1 >> 1633 #define MMU_PRINT_UNINITED 0 >> 1634 >> 1635 #define putZc(z,n) jbne 1f; putc z; jbra 2f; 1: putc n; 2: >> 1636 >> 1637 func_start mmu_print,%a0-%a6/%d0-%d7 >> 1638 >> 1639 movel %pc@(L(kernel_pgdir_ptr)),%a5 >> 1640 lea %pc@(L(mmu_print_data)),%a0 >> 1641 movel #MMU_PRINT_UNINITED,%a0@(mmu_next_valid) >> 1642 >> 1643 is_not_040_or_060(mmu_030_print) >> 1644 >> 1645 mmu_040_print: >> 1646 puts "\nMMU040\n" >> 1647 puts "rp:" >> 1648 putn %a5 >> 1649 putc '\n' >> 1650 #if 0 >> 1651 /* >> 1652 * The following #if/#endif block is a tight algorithm for dumping the 040 >> 1653 * MMU Map in gory detail. It really isn't that practical unless the >> 1654 * MMU Map algorithm appears to go awry and you need to debug it at the >> 1655 * entry per entry level. >> 1656 */ >> 1657 movel #ROOT_TABLE_SIZE,%d5 >> 1658 #if 0 >> 1659 movel %a5@+,%d7 | Burn an entry to skip the kernel mappings, >> 1660 subql #1,%d5 | they (might) work >> 1661 #endif >> 1662 1: tstl %d5 >> 1663 jbeq mmu_print_done >> 1664 subq #1,%d5 >> 1665 movel %a5@+,%d7 >> 1666 btst #1,%d7 >> 1667 jbeq 1b >> 1668 >> 1669 2: putn %d7 >> 1670 andil #0xFFFFFE00,%d7 >> 1671 movel %d7,%a4 >> 1672 movel #PTR_TABLE_SIZE,%d4 >> 1673 putc ' ' >> 1674 3: tstl %d4 >> 1675 jbeq 11f >> 1676 subq #1,%d4 >> 1677 movel %a4@+,%d7 >> 1678 btst #1,%d7 >> 1679 jbeq 3b >> 1680 >> 1681 4: putn %d7 >> 1682 andil #0xFFFFFF00,%d7 >> 1683 movel %d7,%a3 >> 1684 movel #PAGE_TABLE_SIZE,%d3 >> 1685 5: movel #8,%d2 >> 1686 6: tstl %d3 >> 1687 jbeq 31f >> 1688 subq #1,%d3 >> 1689 movel %a3@+,%d6 >> 1690 btst #0,%d6 >> 1691 jbeq 6b >> 1692 7: tstl %d2 >> 1693 jbeq 8f >> 1694 subq #1,%d2 >> 1695 putc ' ' >> 1696 jbra 91f >> 1697 8: putc '\n' >> 1698 movel #8+1+8+1+1,%d2 >> 1699 9: putc ' ' >> 1700 dbra %d2,9b >> 1701 movel #7,%d2 >> 1702 91: putn %d6 >> 1703 jbra 6b >> 1704 >> 1705 31: putc '\n' >> 1706 movel #8+1,%d2 >> 1707 32: putc ' ' >> 1708 dbra %d2,32b >> 1709 jbra 3b >> 1710 >> 1711 11: putc '\n' >> 1712 jbra 1b >> 1713 #endif /* MMU 040 Dumping code that's gory and detailed */ >> 1714 >> 1715 lea %pc@(kernel_pg_dir),%a5 >> 1716 movel %a5,%a0 /* a0 has the address of the root table ptr */ >> 1717 movel #0x00000000,%a4 /* logical address */ >> 1718 moveql #0,%d0 >> 1719 40: >> 1720 /* Increment the logical address and preserve in d5 */ >> 1721 movel %a4,%d5 >> 1722 addil #PAGESIZE<<13,%d5 >> 1723 movel %a0@+,%d6 >> 1724 btst #1,%d6 >> 1725 jbne 41f >> 1726 jbsr mmu_print_tuple_invalidate >> 1727 jbra 48f >> 1728 41: >> 1729 movel #0,%d1 >> 1730 andil #0xfffffe00,%d6 >> 1731 movel %d6,%a1 >> 1732 42: >> 1733 movel %a4,%d5 >> 1734 addil #PAGESIZE<<6,%d5 >> 1735 movel %a1@+,%d6 >> 1736 btst #1,%d6 >> 1737 jbne 43f >> 1738 jbsr mmu_print_tuple_invalidate >> 1739 jbra 47f >> 1740 43: >> 1741 movel #0,%d2 >> 1742 andil #0xffffff00,%d6 >> 1743 movel %d6,%a2 >> 1744 44: >> 1745 movel %a4,%d5 >> 1746 addil #PAGESIZE,%d5 >> 1747 movel %a2@+,%d6 >> 1748 btst #0,%d6 >> 1749 jbne 45f >> 1750 jbsr mmu_print_tuple_invalidate >> 1751 jbra 46f >> 1752 45: >> 1753 moveml %d0-%d1,%sp@- >> 1754 movel %a4,%d0 >> 1755 movel %d6,%d1 >> 1756 andil #0xfffff4e0,%d1 >> 1757 lea %pc@(mmu_040_print_flags),%a6 >> 1758 jbsr mmu_print_tuple >> 1759 moveml %sp@+,%d0-%d1 >> 1760 46: >> 1761 movel %d5,%a4 >> 1762 addq #1,%d2 >> 1763 cmpib #64,%d2 >> 1764 jbne 44b >> 1765 47: >> 1766 movel %d5,%a4 >> 1767 addq #1,%d1 >> 1768 cmpib #128,%d1 >> 1769 jbne 42b >> 1770 48: >> 1771 movel %d5,%a4 /* move to the next logical address */ >> 1772 addq #1,%d0 >> 1773 cmpib #128,%d0 >> 1774 jbne 40b >> 1775 >> 1776 .chip 68040 >> 1777 movec %dtt1,%d0 >> 1778 movel %d0,%d1 >> 1779 andiw #0x8000,%d1 /* is it valid ? */ >> 1780 jbeq 1f /* No, bail out */ >> 1781 >> 1782 movel %d0,%d1 >> 1783 andil #0xff000000,%d1 /* Get the address */ >> 1784 putn %d1 >> 1785 puts "==" >> 1786 putn %d1 >> 1787 >> 1788 movel %d0,%d6 >> 1789 jbsr mmu_040_print_flags_tt >> 1790 1: >> 1791 movec %dtt0,%d0 >> 1792 movel %d0,%d1 >> 1793 andiw #0x8000,%d1 /* is it valid ? */ >> 1794 jbeq 1f /* No, bail out */ >> 1795 >> 1796 movel %d0,%d1 >> 1797 andil #0xff000000,%d1 /* Get the address */ >> 1798 putn %d1 >> 1799 puts "==" >> 1800 putn %d1 >> 1801 >> 1802 movel %d0,%d6 >> 1803 jbsr mmu_040_print_flags_tt >> 1804 1: >> 1805 .chip 68k >> 1806 >> 1807 jbra mmu_print_done >> 1808 >> 1809 mmu_040_print_flags: >> 1810 btstl #10,%d6 >> 1811 putZc(' ','G') /* global bit */ >> 1812 btstl #7,%d6 >> 1813 putZc(' ','S') /* supervisor bit */ >> 1814 mmu_040_print_flags_tt: >> 1815 btstl #6,%d6 >> 1816 jbne 3f >> 1817 putc 'C' >> 1818 btstl #5,%d6 >> 1819 putZc('w','c') /* write through or copy-back */ >> 1820 jbra 4f >> 1821 3: >> 1822 putc 'N' >> 1823 btstl #5,%d6 >> 1824 putZc('s',' ') /* serialized non-cacheable, or non-cacheable */ >> 1825 4: >> 1826 rts >> 1827 >> 1828 mmu_030_print_flags: >> 1829 btstl #6,%d6 >> 1830 putZc('C','I') /* write through or copy-back */ >> 1831 rts >> 1832 >> 1833 mmu_030_print: >> 1834 puts "\nMMU030\n" >> 1835 puts "\nrp:" >> 1836 putn %a5 >> 1837 putc '\n' >> 1838 movel %a5,%d0 >> 1839 andil #0xfffffff0,%d0 >> 1840 movel %d0,%a0 >> 1841 movel #0x00000000,%a4 /* logical address */ >> 1842 movel #0,%d0 >> 1843 30: >> 1844 movel %a4,%d5 >> 1845 addil #PAGESIZE<<13,%d5 >> 1846 movel %a0@+,%d6 >> 1847 btst #1,%d6 /* is it a table ptr? */ >> 1848 jbne 31f /* yes */ >> 1849 btst #0,%d6 /* is it early terminating? */ >> 1850 jbeq 1f /* no */ >> 1851 jbsr mmu_030_print_helper >> 1852 jbra 38f >> 1853 1: >> 1854 jbsr mmu_print_tuple_invalidate >> 1855 jbra 38f >> 1856 31: >> 1857 movel #0,%d1 >> 1858 andil #0xfffffff0,%d6 >> 1859 movel %d6,%a1 >> 1860 32: >> 1861 movel %a4,%d5 >> 1862 addil #PAGESIZE<<6,%d5 >> 1863 movel %a1@+,%d6 >> 1864 btst #1,%d6 /* is it a table ptr? */ >> 1865 jbne 33f /* yes */ >> 1866 btst #0,%d6 /* is it a page descriptor? */ >> 1867 jbeq 1f /* no */ >> 1868 jbsr mmu_030_print_helper >> 1869 jbra 37f >> 1870 1: >> 1871 jbsr mmu_print_tuple_invalidate >> 1872 jbra 37f >> 1873 33: >> 1874 movel #0,%d2 >> 1875 andil #0xfffffff0,%d6 >> 1876 movel %d6,%a2 >> 1877 34: >> 1878 movel %a4,%d5 >> 1879 addil #PAGESIZE,%d5 >> 1880 movel %a2@+,%d6 >> 1881 btst #0,%d6 >> 1882 jbne 35f >> 1883 jbsr mmu_print_tuple_invalidate >> 1884 jbra 36f >> 1885 35: >> 1886 jbsr mmu_030_print_helper >> 1887 36: >> 1888 movel %d5,%a4 >> 1889 addq #1,%d2 >> 1890 cmpib #64,%d2 >> 1891 jbne 34b >> 1892 37: >> 1893 movel %d5,%a4 >> 1894 addq #1,%d1 >> 1895 cmpib #128,%d1 >> 1896 jbne 32b >> 1897 38: >> 1898 movel %d5,%a4 /* move to the next logical address */ >> 1899 addq #1,%d0 >> 1900 cmpib #128,%d0 >> 1901 jbne 30b >> 1902 >> 1903 mmu_print_done: >> 1904 puts "\n" >> 1905 >> 1906 func_return mmu_print >> 1907 >> 1908 >> 1909 mmu_030_print_helper: >> 1910 moveml %d0-%d1,%sp@- >> 1911 movel %a4,%d0 >> 1912 movel %d6,%d1 >> 1913 lea %pc@(mmu_030_print_flags),%a6 >> 1914 jbsr mmu_print_tuple >> 1915 moveml %sp@+,%d0-%d1 >> 1916 rts >> 1917 >> 1918 mmu_print_tuple_invalidate: >> 1919 moveml %a0/%d7,%sp@- >> 1920 >> 1921 lea %pc@(L(mmu_print_data)),%a0 >> 1922 tstl %a0@(mmu_next_valid) >> 1923 jbmi mmu_print_tuple_invalidate_exit >> 1924 >> 1925 movel #MMU_PRINT_INVALID,%a0@(mmu_next_valid) >> 1926 >> 1927 putn %a4 >> 1928 >> 1929 puts "##\n" >> 1930 >> 1931 mmu_print_tuple_invalidate_exit: >> 1932 moveml %sp@+,%a0/%d7 >> 1933 rts >> 1934 >> 1935 >> 1936 mmu_print_tuple: >> 1937 moveml %d0-%d7/%a0,%sp@- >> 1938 >> 1939 lea %pc@(L(mmu_print_data)),%a0 >> 1940 >> 1941 tstl %a0@(mmu_next_valid) >> 1942 jble mmu_print_tuple_print >> 1943 >> 1944 cmpl %a0@(mmu_next_physical),%d1 >> 1945 jbeq mmu_print_tuple_increment >> 1946 >> 1947 mmu_print_tuple_print: >> 1948 putn %d0 >> 1949 puts "->" >> 1950 putn %d1 >> 1951 >> 1952 movel %d1,%d6 >> 1953 jbsr %a6@ >> 1954 >> 1955 mmu_print_tuple_record: >> 1956 movel #MMU_PRINT_VALID,%a0@(mmu_next_valid) >> 1957 >> 1958 movel %d1,%a0@(mmu_next_physical) >> 1959 >> 1960 mmu_print_tuple_increment: >> 1961 movel %d5,%d7 >> 1962 subl %a4,%d7 >> 1963 addl %d7,%a0@(mmu_next_physical) >> 1964 >> 1965 mmu_print_tuple_exit: >> 1966 moveml %sp@+,%d0-%d7/%a0 >> 1967 rts >> 1968 >> 1969 mmu_print_machine_cpu_types: >> 1970 puts "machine: " >> 1971 >> 1972 is_not_amiga(1f) >> 1973 puts "amiga" >> 1974 jbra 9f >> 1975 1: >> 1976 is_not_atari(2f) >> 1977 puts "atari" >> 1978 jbra 9f >> 1979 2: >> 1980 is_not_mac(3f) >> 1981 puts "macintosh" >> 1982 jbra 9f >> 1983 3: puts "unknown" >> 1984 9: putc '\n' >> 1985 >> 1986 puts "cputype: 0" >> 1987 is_not_060(1f) >> 1988 putc '6' >> 1989 jbra 9f >> 1990 1: >> 1991 is_not_040_or_060(2f) >> 1992 putc '4' >> 1993 jbra 9f >> 1994 2: putc '3' >> 1995 9: putc '0' >> 1996 putc '\n' >> 1997 >> 1998 rts >> 1999 #endif /* MMU_PRINT */ >> 2000 >> 2001 /* >> 2002 * mmu_map_tt >> 2003 * >> 2004 * This is a specific function which works on all 680x0 machines. >> 2005 * On 030, 040 & 060 it will attempt to use Transparent Translation >> 2006 * registers (tt1). >> 2007 * On 020 it will call the standard mmu_map which will use early >> 2008 * terminating descriptors. >> 2009 */ >> 2010 func_start mmu_map_tt,%d0/%d1/%a0,4 >> 2011 >> 2012 dputs "mmu_map_tt:" >> 2013 dputn ARG1 >> 2014 dputn ARG2 >> 2015 dputn ARG3 >> 2016 dputn ARG4 >> 2017 dputc '\n' >> 2018 >> 2019 is_020(L(do_map)) >> 2020 >> 2021 /* Extract the highest bit set >> 2022 */ >> 2023 bfffo ARG3{#0,#32},%d1 >> 2024 cmpw #8,%d1 >> 2025 jcc L(do_map) >> 2026 >> 2027 /* And get the mask >> 2028 */ >> 2029 moveq #-1,%d0 >> 2030 lsrl %d1,%d0 >> 2031 lsrl #1,%d0 >> 2032 >> 2033 /* Mask the address >> 2034 */ >> 2035 movel %d0,%d1 >> 2036 notl %d1 >> 2037 andl ARG2,%d1 >> 2038 >> 2039 /* Generate the upper 16bit of the tt register >> 2040 */ >> 2041 lsrl #8,%d0 >> 2042 orl %d0,%d1 >> 2043 clrw %d1 >> 2044 >> 2045 is_040_or_060(L(mmu_map_tt_040)) >> 2046 >> 2047 /* set 030 specific bits (read/write access for supervisor mode >> 2048 * (highest function code set, lower two bits masked)) >> 2049 */ >> 2050 orw #TTR_ENABLE+TTR_RWM+TTR_FCB2+TTR_FCM1+TTR_FCM0,%d1 >> 2051 movel ARG4,%d0 >> 2052 btst #6,%d0 >> 2053 jeq 1f >> 2054 orw #TTR_CI,%d1 >> 2055 >> 2056 1: lea STACK,%a0 >> 2057 dputn %d1 >> 2058 movel %d1,%a0@ >> 2059 .chip 68030 >> 2060 tstl ARG1 >> 2061 jne 1f >> 2062 pmove %a0@,%tt0 >> 2063 jra 2f >> 2064 1: pmove %a0@,%tt1 >> 2065 2: .chip 68k >> 2066 jra L(mmu_map_tt_done) >> 2067 >> 2068 /* set 040 specific bits >> 2069 */ >> 2070 L(mmu_map_tt_040): >> 2071 orw #TTR_ENABLE+TTR_KERNELMODE,%d1 >> 2072 orl ARG4,%d1 >> 2073 dputn %d1 >> 2074 >> 2075 .chip 68040 >> 2076 tstl ARG1 >> 2077 jne 1f >> 2078 movec %d1,%itt0 >> 2079 movec %d1,%dtt0 >> 2080 jra 2f >> 2081 1: movec %d1,%itt1 >> 2082 movec %d1,%dtt1 >> 2083 2: .chip 68k >> 2084 >> 2085 jra L(mmu_map_tt_done) >> 2086 >> 2087 L(do_map): >> 2088 mmu_map_eq ARG2,ARG3,ARG4 >> 2089 >> 2090 L(mmu_map_tt_done): >> 2091 >> 2092 func_return mmu_map_tt >> 2093 >> 2094 /* >> 2095 * mmu_map >> 2096 * >> 2097 * This routine will map a range of memory using a pointer >> 2098 * table and allocate the pages on the fly from the kernel. >> 2099 * The pointer table does not have to be already linked into >> 2100 * the root table, this routine will do that if necessary. >> 2101 * >> 2102 * NOTE >> 2103 * This routine will assert failure and use the serial_putc >> 2104 * routines in the case of a run-time error. For example, >> 2105 * if the address is already mapped. >> 2106 * >> 2107 * NOTE-2 >> 2108 * This routine will use early terminating descriptors >> 2109 * where possible for the 68020+68851 and 68030 type >> 2110 * processors. >> 2111 */ >> 2112 func_start mmu_map,%d0-%d4/%a0-%a4 >> 2113 >> 2114 dputs "\nmmu_map:" >> 2115 dputn ARG1 >> 2116 dputn ARG2 >> 2117 dputn ARG3 >> 2118 dputn ARG4 >> 2119 dputc '\n' >> 2120 >> 2121 /* Get logical address and round it down to 256KB >> 2122 */ >> 2123 movel ARG1,%d0 >> 2124 andl #-(PAGESIZE*PAGE_TABLE_SIZE),%d0 >> 2125 movel %d0,%a3 >> 2126 >> 2127 /* Get the end address >> 2128 */ >> 2129 movel ARG1,%a4 >> 2130 addl ARG3,%a4 >> 2131 subql #1,%a4 >> 2132 >> 2133 /* Get physical address and round it down to 256KB >> 2134 */ >> 2135 movel ARG2,%d0 >> 2136 andl #-(PAGESIZE*PAGE_TABLE_SIZE),%d0 >> 2137 movel %d0,%a2 >> 2138 >> 2139 /* Add page attributes to the physical address >> 2140 */ >> 2141 movel ARG4,%d0 >> 2142 orw #_PAGE_PRESENT+_PAGE_ACCESSED+_PAGE_DIRTY,%d0 >> 2143 addw %d0,%a2 >> 2144 >> 2145 dputn %a2 >> 2146 dputn %a3 >> 2147 dputn %a4 >> 2148 >> 2149 is_not_040_or_060(L(mmu_map_030)) >> 2150 >> 2151 addw #_PAGE_GLOBAL040,%a2 >> 2152 /* >> 2153 * MMU 040 & 060 Support >> 2154 * >> 2155 * The MMU usage for the 040 and 060 is different enough from >> 2156 * the 030 and 68851 that there is separate code. This comment >> 2157 * block describes the data structures and algorithms built by >> 2158 * this code. >> 2159 * >> 2160 * The 040 does not support early terminating descriptors, as >> 2161 * the 030 does. Therefore, a third level of table is needed >> 2162 * for the 040, and that would be the page table. In Linux, >> 2163 * page tables are allocated directly from the memory above the >> 2164 * kernel. >> 2165 * >> 2166 */ >> 2167 >> 2168 L(mmu_map_040): >> 2169 /* Calculate the offset into the root table >> 2170 */ >> 2171 movel %a3,%d0 >> 2172 moveq #ROOT_INDEX_SHIFT,%d1 >> 2173 lsrl %d1,%d0 >> 2174 mmu_get_root_table_entry %d0 >> 2175 >> 2176 /* Calculate the offset into the pointer table >> 2177 */ >> 2178 movel %a3,%d0 >> 2179 moveq #PTR_INDEX_SHIFT,%d1 >> 2180 lsrl %d1,%d0 >> 2181 andl #PTR_TABLE_SIZE-1,%d0 >> 2182 mmu_get_ptr_table_entry %a0,%d0 >> 2183 >> 2184 /* Calculate the offset into the page table >> 2185 */ >> 2186 movel %a3,%d0 >> 2187 moveq #PAGE_INDEX_SHIFT,%d1 >> 2188 lsrl %d1,%d0 >> 2189 andl #PAGE_TABLE_SIZE-1,%d0 >> 2190 mmu_get_page_table_entry %a0,%d0 >> 2191 >> 2192 /* The page table entry must not no be busy >> 2193 */ >> 2194 tstl %a0@ >> 2195 jne L(mmu_map_error) >> 2196 >> 2197 /* Do the mapping and advance the pointers >> 2198 */ >> 2199 movel %a2,%a0@ >> 2200 2: >> 2201 addw #PAGESIZE,%a2 >> 2202 addw #PAGESIZE,%a3 >> 2203 >> 2204 /* Ready with mapping? >> 2205 */ >> 2206 lea %a3@(-1),%a0 >> 2207 cmpl %a0,%a4 >> 2208 jhi L(mmu_map_040) >> 2209 jra L(mmu_map_done) >> 2210 >> 2211 L(mmu_map_030): >> 2212 /* Calculate the offset into the root table >> 2213 */ >> 2214 movel %a3,%d0 >> 2215 moveq #ROOT_INDEX_SHIFT,%d1 >> 2216 lsrl %d1,%d0 >> 2217 mmu_get_root_table_entry %d0 >> 2218 >> 2219 /* Check if logical address 32MB aligned, >> 2220 * so we can try to map it once >> 2221 */ >> 2222 movel %a3,%d0 >> 2223 andl #(PTR_TABLE_SIZE*PAGE_TABLE_SIZE*PAGESIZE-1)&(-ROOT_TABLE_SIZE),%d0 >> 2224 jne 1f >> 2225 >> 2226 /* Is there enough to map for 32MB at once >> 2227 */ >> 2228 lea %a3@(PTR_TABLE_SIZE*PAGE_TABLE_SIZE*PAGESIZE-1),%a1 >> 2229 cmpl %a1,%a4 >> 2230 jcs 1f >> 2231 >> 2232 addql #1,%a1 >> 2233 >> 2234 /* The root table entry must not no be busy >> 2235 */ >> 2236 tstl %a0@ >> 2237 jne L(mmu_map_error) >> 2238 >> 2239 /* Do the mapping and advance the pointers >> 2240 */ >> 2241 dputs "early term1" >> 2242 dputn %a2 >> 2243 dputn %a3 >> 2244 dputn %a1 >> 2245 dputc '\n' >> 2246 movel %a2,%a0@ >> 2247 >> 2248 movel %a1,%a3 >> 2249 lea %a2@(PTR_TABLE_SIZE*PAGE_TABLE_SIZE*PAGESIZE),%a2 >> 2250 jra L(mmu_mapnext_030) >> 2251 1: >> 2252 /* Calculate the offset into the pointer table >> 2253 */ >> 2254 movel %a3,%d0 >> 2255 moveq #PTR_INDEX_SHIFT,%d1 >> 2256 lsrl %d1,%d0 >> 2257 andl #PTR_TABLE_SIZE-1,%d0 >> 2258 mmu_get_ptr_table_entry %a0,%d0 >> 2259 >> 2260 /* The pointer table entry must not no be busy >> 2261 */ >> 2262 tstl %a0@ >> 2263 jne L(mmu_map_error) >> 2264 >> 2265 /* Do the mapping and advance the pointers >> 2266 */ >> 2267 dputs "early term2" >> 2268 dputn %a2 >> 2269 dputn %a3 >> 2270 dputc '\n' >> 2271 movel %a2,%a0@ >> 2272 >> 2273 addl #PAGE_TABLE_SIZE*PAGESIZE,%a2 >> 2274 addl #PAGE_TABLE_SIZE*PAGESIZE,%a3 >> 2275 >> 2276 L(mmu_mapnext_030): >> 2277 /* Ready with mapping? >> 2278 */ >> 2279 lea %a3@(-1),%a0 >> 2280 cmpl %a0,%a4 >> 2281 jhi L(mmu_map_030) >> 2282 jra L(mmu_map_done) >> 2283 >> 2284 L(mmu_map_error): >> 2285 >> 2286 dputs "mmu_map error:" >> 2287 dputn %a2 >> 2288 dputn %a3 >> 2289 dputc '\n' >> 2290 >> 2291 L(mmu_map_done): >> 2292 >> 2293 func_return mmu_map >> 2294 >> 2295 /* >> 2296 * mmu_fixup >> 2297 * >> 2298 * On the 040 class machines, all pages that are used for the >> 2299 * mmu have to be fixed up. >> 2300 */ >> 2301 >> 2302 func_start mmu_fixup_page_mmu_cache,%d0/%a0 >> 2303 >> 2304 dputs "mmu_fixup_page_mmu_cache" >> 2305 dputn ARG1 >> 2306 >> 2307 /* Calculate the offset into the root table >> 2308 */ >> 2309 movel ARG1,%d0 >> 2310 moveq #ROOT_INDEX_SHIFT,%d1 >> 2311 lsrl %d1,%d0 >> 2312 mmu_get_root_table_entry %d0 >> 2313 >> 2314 /* Calculate the offset into the pointer table >> 2315 */ >> 2316 movel ARG1,%d0 >> 2317 moveq #PTR_INDEX_SHIFT,%d1 >> 2318 lsrl %d1,%d0 >> 2319 andl #PTR_TABLE_SIZE-1,%d0 >> 2320 mmu_get_ptr_table_entry %a0,%d0 >> 2321 >> 2322 /* Calculate the offset into the page table >> 2323 */ >> 2324 movel ARG1,%d0 >> 2325 moveq #PAGE_INDEX_SHIFT,%d1 >> 2326 lsrl %d1,%d0 >> 2327 andl #PAGE_TABLE_SIZE-1,%d0 >> 2328 mmu_get_page_table_entry %a0,%d0 >> 2329 >> 2330 movel %a0@,%d0 >> 2331 andil #_CACHEMASK040,%d0 >> 2332 orl %pc@(m68k_pgtable_cachemode),%d0 >> 2333 movel %d0,%a0@ >> 2334 >> 2335 dputc '\n' >> 2336 >> 2337 func_return mmu_fixup_page_mmu_cache >> 2338 >> 2339 /* >> 2340 * mmu_temp_map >> 2341 * >> 2342 * create a temporary mapping to enable the mmu, >> 2343 * this we don't need any transparation translation tricks. >> 2344 */ >> 2345 >> 2346 func_start mmu_temp_map,%d0/%d1/%a0/%a1 >> 2347 >> 2348 dputs "mmu_temp_map" >> 2349 dputn ARG1 >> 2350 dputn ARG2 >> 2351 dputc '\n' >> 2352 >> 2353 lea %pc@(L(temp_mmap_mem)),%a1 >> 2354 >> 2355 /* Calculate the offset in the root table >> 2356 */ >> 2357 movel ARG2,%d0 >> 2358 moveq #ROOT_INDEX_SHIFT,%d1 >> 2359 lsrl %d1,%d0 >> 2360 mmu_get_root_table_entry %d0 >> 2361 >> 2362 /* Check if the table is temporary allocated, so we have to reuse it >> 2363 */ >> 2364 movel %a0@,%d0 >> 2365 cmpl %pc@(L(memory_start)),%d0 >> 2366 jcc 1f >> 2367 >> 2368 /* Temporary allocate a ptr table and insert it into the root table >> 2369 */ >> 2370 movel %a1@,%d0 >> 2371 addl #PTR_TABLE_SIZE*4,%a1@ >> 2372 orw #_PAGE_TABLE+_PAGE_ACCESSED,%d0 >> 2373 movel %d0,%a0@ >> 2374 dputs " (new)" >> 2375 1: >> 2376 dputn %d0 >> 2377 /* Mask the root table entry for the ptr table >> 2378 */ >> 2379 andw #-ROOT_TABLE_SIZE,%d0 >> 2380 movel %d0,%a0 >> 2381 >> 2382 /* Calculate the offset into the pointer table >> 2383 */ >> 2384 movel ARG2,%d0 >> 2385 moveq #PTR_INDEX_SHIFT,%d1 >> 2386 lsrl %d1,%d0 >> 2387 andl #PTR_TABLE_SIZE-1,%d0 >> 2388 lea %a0@(%d0*4),%a0 >> 2389 dputn %a0 >> 2390 >> 2391 /* Check if a temporary page table is already allocated >> 2392 */ >> 2393 movel %a0@,%d0 >> 2394 jne 1f >> 2395 >> 2396 /* Temporary allocate a page table and insert it into the ptr table >> 2397 */ >> 2398 movel %a1@,%d0 >> 2399 /* The 512 should be PAGE_TABLE_SIZE*4, but that violates the >> 2400 alignment restriction for pointer tables on the '0[46]0. */ >> 2401 addl #512,%a1@ >> 2402 orw #_PAGE_TABLE+_PAGE_ACCESSED,%d0 >> 2403 movel %d0,%a0@ >> 2404 dputs " (new)" >> 2405 1: >> 2406 dputn %d0 >> 2407 /* Mask the ptr table entry for the page table >> 2408 */ >> 2409 andw #-PTR_TABLE_SIZE,%d0 >> 2410 movel %d0,%a0 >> 2411 >> 2412 /* Calculate the offset into the page table >> 2413 */ >> 2414 movel ARG2,%d0 >> 2415 moveq #PAGE_INDEX_SHIFT,%d1 >> 2416 lsrl %d1,%d0 >> 2417 andl #PAGE_TABLE_SIZE-1,%d0 >> 2418 lea %a0@(%d0*4),%a0 >> 2419 dputn %a0 >> 2420 >> 2421 /* Insert the address into the page table >> 2422 */ >> 2423 movel ARG1,%d0 >> 2424 andw #-PAGESIZE,%d0 >> 2425 orw #_PAGE_PRESENT+_PAGE_ACCESSED+_PAGE_DIRTY,%d0 >> 2426 movel %d0,%a0@ >> 2427 dputn %d0 >> 2428 >> 2429 dputc '\n' >> 2430 >> 2431 func_return mmu_temp_map >> 2432 >> 2433 func_start mmu_engage,%d0-%d2/%a0-%a3 >> 2434 >> 2435 moveq #ROOT_TABLE_SIZE-1,%d0 >> 2436 /* Temporarily use a different root table. */ >> 2437 lea %pc@(L(kernel_pgdir_ptr)),%a0 >> 2438 movel %a0@,%a2 >> 2439 movel %pc@(L(memory_start)),%a1 >> 2440 movel %a1,%a0@ >> 2441 movel %a2,%a0 >> 2442 1: >> 2443 movel %a0@+,%a1@+ >> 2444 dbra %d0,1b >> 2445 >> 2446 lea %pc@(L(temp_mmap_mem)),%a0 >> 2447 movel %a1,%a0@ >> 2448 >> 2449 movew #PAGESIZE-1,%d0 >> 2450 1: >> 2451 clrl %a1@+ >> 2452 dbra %d0,1b >> 2453 >> 2454 lea %pc@(1b),%a0 >> 2455 movel #1b,%a1 >> 2456 /* Skip temp mappings if phys == virt */ >> 2457 cmpl %a0,%a1 >> 2458 jeq 1f >> 2459 >> 2460 mmu_temp_map %a0,%a0 >> 2461 mmu_temp_map %a0,%a1 >> 2462 >> 2463 addw #PAGESIZE,%a0 >> 2464 addw #PAGESIZE,%a1 >> 2465 mmu_temp_map %a0,%a0 >> 2466 mmu_temp_map %a0,%a1 >> 2467 1: >> 2468 movel %pc@(L(memory_start)),%a3 >> 2469 movel %pc@(L(phys_kernel_start)),%d2 >> 2470 >> 2471 is_not_040_or_060(L(mmu_engage_030)) >> 2472 >> 2473 L(mmu_engage_040): >> 2474 .chip 68040 >> 2475 nop >> 2476 cinva %bc >> 2477 nop >> 2478 pflusha >> 2479 nop >> 2480 movec %a3,%srp >> 2481 movel #TC_ENABLE+TC_PAGE4K,%d0 >> 2482 movec %d0,%tc /* enable the MMU */ >> 2483 jmp 1f:l >> 2484 1: nop >> 2485 movec %a2,%srp >> 2486 nop >> 2487 cinva %bc >> 2488 nop >> 2489 pflusha >> 2490 .chip 68k >> 2491 jra L(mmu_engage_cleanup) >> 2492 >> 2493 L(mmu_engage_030_temp): >> 2494 .space 12 >> 2495 L(mmu_engage_030): >> 2496 .chip 68030 >> 2497 lea %pc@(L(mmu_engage_030_temp)),%a0 >> 2498 movel #0x80000002,%a0@ >> 2499 movel %a3,%a0@(4) >> 2500 movel #0x0808,%d0 >> 2501 movec %d0,%cacr >> 2502 pmove %a0@,%srp >> 2503 pflusha >> 2504 /* >> 2505 * enable,super root enable,4096 byte pages,7 bit root index, >> 2506 * 7 bit pointer index, 6 bit page table index. >> 2507 */ >> 2508 movel #0x82c07760,%a0@(8) >> 2509 pmove %a0@(8),%tc /* enable the MMU */ >> 2510 jmp 1f:l >> 2511 1: movel %a2,%a0@(4) >> 2512 movel #0x0808,%d0 >> 2513 movec %d0,%cacr >> 2514 pmove %a0@,%srp >> 2515 pflusha >> 2516 .chip 68k >> 2517 >> 2518 L(mmu_engage_cleanup): >> 2519 subl #PAGE_OFFSET,%d2 >> 2520 subl %d2,%a2 >> 2521 movel %a2,L(kernel_pgdir_ptr) >> 2522 subl %d2,%fp >> 2523 subl %d2,%sp >> 2524 subl %d2,ARG0 >> 2525 >> 2526 func_return mmu_engage >> 2527 >> 2528 func_start mmu_get_root_table_entry,%d0/%a1 >> 2529 >> 2530 #if 0 >> 2531 dputs "mmu_get_root_table_entry:" >> 2532 dputn ARG1 >> 2533 dputs " =" >> 2534 #endif >> 2535 >> 2536 movel %pc@(L(kernel_pgdir_ptr)),%a0 >> 2537 tstl %a0 >> 2538 jne 2f >> 2539 >> 2540 dputs "\nmmu_init:" >> 2541 >> 2542 /* Find the start of free memory, get_bi_record does this for us, >> 2543 * as the bootinfo structure is located directly behind the kernel >> 2544 * we simply search for the last entry. >> 2545 */ >> 2546 get_bi_record BI_LAST >> 2547 addw #PAGESIZE-1,%a0 >> 2548 movel %a0,%d0 >> 2549 andw #-PAGESIZE,%d0 >> 2550 >> 2551 dputn %d0 >> 2552 >> 2553 lea %pc@(L(memory_start)),%a0 >> 2554 movel %d0,%a0@ >> 2555 lea %pc@(L(kernel_end)),%a0 >> 2556 movel %d0,%a0@ >> 2557 >> 2558 /* we have to return the first page at _stext since the init code >> 2559 * in mm/init.c simply expects kernel_pg_dir there, the rest of >> 2560 * page is used for further ptr tables in get_ptr_table. >> 2561 */ >> 2562 lea %pc@(_stext),%a0 >> 2563 lea %pc@(L(mmu_cached_pointer_tables)),%a1 >> 2564 movel %a0,%a1@ >> 2565 addl #ROOT_TABLE_SIZE*4,%a1@ >> 2566 >> 2567 lea %pc@(L(mmu_num_pointer_tables)),%a1 >> 2568 addql #1,%a1@ >> 2569 >> 2570 /* clear the page >> 2571 */ >> 2572 movel %a0,%a1 >> 2573 movew #PAGESIZE/4-1,%d0 >> 2574 1: >> 2575 clrl %a1@+ >> 2576 dbra %d0,1b >> 2577 >> 2578 lea %pc@(L(kernel_pgdir_ptr)),%a1 >> 2579 movel %a0,%a1@ >> 2580 >> 2581 dputn %a0 >> 2582 dputc '\n' >> 2583 2: >> 2584 movel ARG1,%d0 >> 2585 lea %a0@(%d0*4),%a0 >> 2586 >> 2587 #if 0 >> 2588 dputn %a0 >> 2589 dputc '\n' >> 2590 #endif >> 2591 >> 2592 func_return mmu_get_root_table_entry >> 2593 >> 2594 >> 2595 >> 2596 func_start mmu_get_ptr_table_entry,%d0/%a1 >> 2597 >> 2598 #if 0 >> 2599 dputs "mmu_get_ptr_table_entry:" >> 2600 dputn ARG1 >> 2601 dputn ARG2 >> 2602 dputs " =" >> 2603 #endif >> 2604 >> 2605 movel ARG1,%a0 >> 2606 movel %a0@,%d0 >> 2607 jne 2f >> 2608 >> 2609 /* Keep track of the number of pointer tables we use >> 2610 */ >> 2611 dputs "\nmmu_get_new_ptr_table:" >> 2612 lea %pc@(L(mmu_num_pointer_tables)),%a0 >> 2613 movel %a0@,%d0 >> 2614 addql #1,%a0@ >> 2615 >> 2616 /* See if there is a free pointer table in our cache of pointer tables >> 2617 */ >> 2618 lea %pc@(L(mmu_cached_pointer_tables)),%a1 >> 2619 andw #7,%d0 >> 2620 jne 1f >> 2621 >> 2622 /* Get a new pointer table page from above the kernel memory >> 2623 */ >> 2624 get_new_page >> 2625 movel %a0,%a1@ >> 2626 1: >> 2627 /* There is an unused pointer table in our cache... use it >> 2628 */ >> 2629 movel %a1@,%d0 >> 2630 addl #PTR_TABLE_SIZE*4,%a1@ >> 2631 >> 2632 dputn %d0 >> 2633 dputc '\n' >> 2634 >> 2635 /* Insert the new pointer table into the root table >> 2636 */ >> 2637 movel ARG1,%a0 >> 2638 orw #_PAGE_TABLE+_PAGE_ACCESSED,%d0 >> 2639 movel %d0,%a0@ >> 2640 2: >> 2641 /* Extract the pointer table entry >> 2642 */ >> 2643 andw #-PTR_TABLE_SIZE,%d0 >> 2644 movel %d0,%a0 >> 2645 movel ARG2,%d0 >> 2646 lea %a0@(%d0*4),%a0 >> 2647 >> 2648 #if 0 >> 2649 dputn %a0 >> 2650 dputc '\n' >> 2651 #endif 92 2652 93 ;--------------------------------------------- !! 2653 func_return mmu_get_ptr_table_entry 94 ; Default Reset Handler (jumped into from Rese << 95 ; - Don't clobber r0,r1,r2 as they might have << 96 ; - Platforms can override this weak version i << 97 ;--------------------------------------------- << 98 WEAK(res_service) << 99 j stext << 100 END(res_service) << 101 2654 102 ;--------------------------------------------- << 103 ; Kernel Entry point << 104 ;--------------------------------------------- << 105 ENTRY(stext) << 106 2655 107 CPU_EARLY_SETUP !! 2656 func_start mmu_get_page_table_entry,%d0/%a1 108 2657 109 #ifdef CONFIG_SMP !! 2658 #if 0 110 GET_CPU_ID r5 !! 2659 dputs "mmu_get_page_table_entry:" 111 cmp r5, 0 !! 2660 dputn ARG1 112 mov.nz r0, r5 !! 2661 dputn ARG2 113 bz .Lmaster_proceed !! 2662 dputs " =" >> 2663 #endif >> 2664 >> 2665 movel ARG1,%a0 >> 2666 movel %a0@,%d0 >> 2667 jne 2f >> 2668 >> 2669 /* If the page table entry doesn't exist, we allocate a complete new >> 2670 * page and use it as one continuous big page table which can cover >> 2671 * 4MB of memory, nearly almost all mappings have that alignment. >> 2672 */ >> 2673 get_new_page >> 2674 addw #_PAGE_TABLE+_PAGE_ACCESSED,%a0 >> 2675 >> 2676 /* align pointer table entry for a page of page tables >> 2677 */ >> 2678 movel ARG1,%d0 >> 2679 andw #-(PAGESIZE/PAGE_TABLE_SIZE),%d0 >> 2680 movel %d0,%a1 >> 2681 >> 2682 /* Insert the page tables into the pointer entries >> 2683 */ >> 2684 moveq #PAGESIZE/PAGE_TABLE_SIZE/4-1,%d0 >> 2685 1: >> 2686 movel %a0,%a1@+ >> 2687 lea %a0@(PAGE_TABLE_SIZE*4),%a0 >> 2688 dbra %d0,1b >> 2689 >> 2690 /* Now we can get the initialized pointer table entry >> 2691 */ >> 2692 movel ARG1,%a0 >> 2693 movel %a0@,%d0 >> 2694 2: >> 2695 /* Extract the page table entry >> 2696 */ >> 2697 andw #-PAGE_TABLE_SIZE,%d0 >> 2698 movel %d0,%a0 >> 2699 movel ARG2,%d0 >> 2700 lea %a0@(%d0*4),%a0 >> 2701 >> 2702 #if 0 >> 2703 dputn %a0 >> 2704 dputc '\n' >> 2705 #endif >> 2706 >> 2707 func_return mmu_get_page_table_entry >> 2708 >> 2709 /* >> 2710 * get_new_page >> 2711 * >> 2712 * Return a new page from the memory start and clear it. >> 2713 */ >> 2714 func_start get_new_page,%d0/%a1 >> 2715 >> 2716 dputs "\nget_new_page:" >> 2717 >> 2718 /* allocate the page and adjust memory_start >> 2719 */ >> 2720 lea %pc@(L(memory_start)),%a0 >> 2721 movel %a0@,%a1 >> 2722 addl #PAGESIZE,%a0@ >> 2723 >> 2724 /* clear the new page >> 2725 */ >> 2726 movel %a1,%a0 >> 2727 movew #PAGESIZE/4-1,%d0 >> 2728 1: >> 2729 clrl %a1@+ >> 2730 dbra %d0,1b >> 2731 >> 2732 dputn %a0 >> 2733 dputc '\n' >> 2734 >> 2735 func_return get_new_page >> 2736 >> 2737 >> 2738 >> 2739 /* >> 2740 * Debug output support >> 2741 * Atarians have a choice between the parallel port, the serial port >> 2742 * from the MFP or a serial port of the SCC >> 2743 */ >> 2744 >> 2745 #ifdef CONFIG_MAC >> 2746 /* You may define either or both of these. */ >> 2747 #define MAC_USE_SCC_A /* Modem port */ >> 2748 #define MAC_USE_SCC_B /* Printer port */ >> 2749 >> 2750 #if defined(MAC_USE_SCC_A) || defined(MAC_USE_SCC_B) >> 2751 /* Initialisation table for SCC with 3.6864 MHz PCLK */ >> 2752 L(scc_initable_mac): >> 2753 .byte 4,0x44 /* x16, 1 stopbit, no parity */ >> 2754 .byte 3,0xc0 /* receiver: 8 bpc */ >> 2755 .byte 5,0xe2 /* transmitter: 8 bpc, assert dtr/rts */ >> 2756 .byte 10,0 /* NRZ */ >> 2757 .byte 11,0x50 /* use baud rate generator */ >> 2758 .byte 12,1,13,0 /* 38400 baud */ >> 2759 .byte 14,1 /* Baud rate generator enable */ >> 2760 .byte 3,0xc1 /* enable receiver */ >> 2761 .byte 5,0xea /* enable transmitter */ >> 2762 .byte -1 >> 2763 .even >> 2764 #endif >> 2765 #endif /* CONFIG_MAC */ >> 2766 >> 2767 #ifdef CONFIG_ATARI >> 2768 /* #define USE_PRINTER */ >> 2769 /* #define USE_SCC_B */ >> 2770 /* #define USE_SCC_A */ >> 2771 #define USE_MFP >> 2772 >> 2773 #if defined(USE_SCC_A) || defined(USE_SCC_B) >> 2774 /* Initialisation table for SCC with 7.9872 MHz PCLK */ >> 2775 /* PCLK == 8.0539 gives baud == 9680.1 */ >> 2776 L(scc_initable_atari): >> 2777 .byte 4,0x44 /* x16, 1 stopbit, no parity */ >> 2778 .byte 3,0xc0 /* receiver: 8 bpc */ >> 2779 .byte 5,0xe2 /* transmitter: 8 bpc, assert dtr/rts */ >> 2780 .byte 10,0 /* NRZ */ >> 2781 .byte 11,0x50 /* use baud rate generator */ >> 2782 .byte 12,24,13,0 /* 9600 baud */ >> 2783 .byte 14,2,14,3 /* use master clock for BRG, enable */ >> 2784 .byte 3,0xc1 /* enable receiver */ >> 2785 .byte 5,0xea /* enable transmitter */ >> 2786 .byte -1 >> 2787 .even >> 2788 #endif >> 2789 >> 2790 #ifdef USE_PRINTER >> 2791 >> 2792 LPSG_SELECT = 0xff8800 >> 2793 LPSG_READ = 0xff8800 >> 2794 LPSG_WRITE = 0xff8802 >> 2795 LPSG_IO_A = 14 >> 2796 LPSG_IO_B = 15 >> 2797 LPSG_CONTROL = 7 >> 2798 LSTMFP_GPIP = 0xfffa01 >> 2799 LSTMFP_DDR = 0xfffa05 >> 2800 LSTMFP_IERB = 0xfffa09 >> 2801 >> 2802 #elif defined(USE_SCC_B) >> 2803 >> 2804 LSCC_CTRL = 0xff8c85 >> 2805 LSCC_DATA = 0xff8c87 >> 2806 >> 2807 #elif defined(USE_SCC_A) >> 2808 >> 2809 LSCC_CTRL = 0xff8c81 >> 2810 LSCC_DATA = 0xff8c83 >> 2811 >> 2812 #elif defined(USE_MFP) >> 2813 >> 2814 LMFP_UCR = 0xfffa29 >> 2815 LMFP_TDCDR = 0xfffa1d >> 2816 LMFP_TDDR = 0xfffa25 >> 2817 LMFP_TSR = 0xfffa2d >> 2818 LMFP_UDR = 0xfffa2f >> 2819 >> 2820 #endif >> 2821 #endif /* CONFIG_ATARI */ >> 2822 >> 2823 /* >> 2824 * Serial port output support. >> 2825 */ >> 2826 >> 2827 /* >> 2828 * Initialize serial port hardware >> 2829 */ >> 2830 func_start serial_init,%d0/%d1/%a0/%a1 >> 2831 /* >> 2832 * Some of the register usage that follows >> 2833 * CONFIG_AMIGA >> 2834 * a0 = pointer to boot info record >> 2835 * d0 = boot info offset >> 2836 * CONFIG_ATARI >> 2837 * a0 = address of SCC >> 2838 * a1 = Liobase address/address of scc_initable_atari >> 2839 * d0 = init data for serial port >> 2840 * CONFIG_MAC >> 2841 * a0 = address of SCC >> 2842 * a1 = address of scc_initable_mac >> 2843 * d0 = init data for serial port >> 2844 */ >> 2845 >> 2846 #ifdef CONFIG_AMIGA >> 2847 #define SERIAL_DTR 7 >> 2848 #define SERIAL_CNTRL CIABBASE+C_PRA >> 2849 >> 2850 is_not_amiga(1f) >> 2851 lea %pc@(L(custom)),%a0 >> 2852 movel #-ZTWOBASE,%a0@ >> 2853 bclr #SERIAL_DTR,SERIAL_CNTRL-ZTWOBASE >> 2854 get_bi_record BI_AMIGA_SERPER >> 2855 movew %a0@,CUSTOMBASE+C_SERPER-ZTWOBASE >> 2856 | movew #61,CUSTOMBASE+C_SERPER-ZTWOBASE >> 2857 1: >> 2858 #endif >> 2859 >> 2860 #ifdef CONFIG_ATARI >> 2861 is_not_atari(4f) >> 2862 movel %pc@(L(iobase)),%a1 >> 2863 #if defined(USE_PRINTER) >> 2864 bclr #0,%a1@(LSTMFP_IERB) >> 2865 bclr #0,%a1@(LSTMFP_DDR) >> 2866 moveb #LPSG_CONTROL,%a1@(LPSG_SELECT) >> 2867 moveb #0xff,%a1@(LPSG_WRITE) >> 2868 moveb #LPSG_IO_B,%a1@(LPSG_SELECT) >> 2869 clrb %a1@(LPSG_WRITE) >> 2870 moveb #LPSG_IO_A,%a1@(LPSG_SELECT) >> 2871 moveb %a1@(LPSG_READ),%d0 >> 2872 bset #5,%d0 >> 2873 moveb %d0,%a1@(LPSG_WRITE) >> 2874 #elif defined(USE_SCC_A) || defined(USE_SCC_B) >> 2875 lea %a1@(LSCC_CTRL),%a0 >> 2876 /* Reset SCC register pointer */ >> 2877 moveb %a0@,%d0 >> 2878 /* Reset SCC device: write register pointer then register value */ >> 2879 moveb #9,%a0@ >> 2880 moveb #0xc0,%a0@ >> 2881 /* Wait for 5 PCLK cycles, which is about 63 CPU cycles */ >> 2882 /* 5 / 7.9872 MHz = approx. 0.63 us = 63 / 100 MHz */ >> 2883 movel #32,%d0 >> 2884 2: >> 2885 subq #1,%d0 >> 2886 jne 2b >> 2887 /* Initialize channel */ >> 2888 lea %pc@(L(scc_initable_atari)),%a1 >> 2889 2: moveb %a1@+,%d0 >> 2890 jmi 3f >> 2891 moveb %d0,%a0@ >> 2892 moveb %a1@+,%a0@ >> 2893 jra 2b >> 2894 3: clrb %a0@ >> 2895 #elif defined(USE_MFP) >> 2896 bclr #1,%a1@(LMFP_TSR) >> 2897 moveb #0x88,%a1@(LMFP_UCR) >> 2898 andb #0x70,%a1@(LMFP_TDCDR) >> 2899 moveb #2,%a1@(LMFP_TDDR) >> 2900 orb #1,%a1@(LMFP_TDCDR) >> 2901 bset #1,%a1@(LMFP_TSR) >> 2902 #endif >> 2903 jra L(serial_init_done) >> 2904 4: >> 2905 #endif >> 2906 >> 2907 #ifdef CONFIG_MAC >> 2908 is_not_mac(L(serial_init_not_mac)) >> 2909 #if defined(MAC_USE_SCC_A) || defined(MAC_USE_SCC_B) >> 2910 #define mac_scc_cha_b_ctrl_offset 0x0 >> 2911 #define mac_scc_cha_a_ctrl_offset 0x2 >> 2912 #define mac_scc_cha_b_data_offset 0x4 >> 2913 #define mac_scc_cha_a_data_offset 0x6 >> 2914 movel %pc@(L(mac_sccbase)),%a0 >> 2915 /* Reset SCC register pointer */ >> 2916 moveb %a0@(mac_scc_cha_a_ctrl_offset),%d0 >> 2917 /* Reset SCC device: write register pointer then register value */ >> 2918 moveb #9,%a0@(mac_scc_cha_a_ctrl_offset) >> 2919 moveb #0xc0,%a0@(mac_scc_cha_a_ctrl_offset) >> 2920 /* Wait for 5 PCLK cycles, which is about 68 CPU cycles */ >> 2921 /* 5 / 3.6864 MHz = approx. 1.36 us = 68 / 50 MHz */ >> 2922 movel #35,%d0 >> 2923 5: >> 2924 subq #1,%d0 >> 2925 jne 5b >> 2926 #endif >> 2927 #ifdef MAC_USE_SCC_A >> 2928 /* Initialize channel A */ >> 2929 lea %pc@(L(scc_initable_mac)),%a1 >> 2930 5: moveb %a1@+,%d0 >> 2931 jmi 6f >> 2932 moveb %d0,%a0@(mac_scc_cha_a_ctrl_offset) >> 2933 moveb %a1@+,%a0@(mac_scc_cha_a_ctrl_offset) >> 2934 jra 5b >> 2935 6: >> 2936 #endif /* MAC_USE_SCC_A */ >> 2937 #ifdef MAC_USE_SCC_B >> 2938 /* Initialize channel B */ >> 2939 lea %pc@(L(scc_initable_mac)),%a1 >> 2940 7: moveb %a1@+,%d0 >> 2941 jmi 8f >> 2942 moveb %d0,%a0@(mac_scc_cha_b_ctrl_offset) >> 2943 moveb %a1@+,%a0@(mac_scc_cha_b_ctrl_offset) >> 2944 jra 7b >> 2945 8: >> 2946 #endif /* MAC_USE_SCC_B */ >> 2947 jra L(serial_init_done) >> 2948 L(serial_init_not_mac): >> 2949 #endif /* CONFIG_MAC */ >> 2950 >> 2951 #ifdef CONFIG_Q40 >> 2952 is_not_q40(2f) >> 2953 /* debug output goes into SRAM, so we don't do it unless requested >> 2954 - check for '%LX$' signature in SRAM */ >> 2955 lea %pc@(q40_mem_cptr),%a1 >> 2956 move.l #0xff020010,%a1@ /* must be inited - also used by debug=mem */ >> 2957 move.l #0xff020000,%a1 >> 2958 cmp.b #'%',%a1@ >> 2959 bne 2f /*nodbg*/ >> 2960 addq.w #4,%a1 >> 2961 cmp.b #'L',%a1@ >> 2962 bne 2f /*nodbg*/ >> 2963 addq.w #4,%a1 >> 2964 cmp.b #'X',%a1@ >> 2965 bne 2f /*nodbg*/ >> 2966 addq.w #4,%a1 >> 2967 cmp.b #'$',%a1@ >> 2968 bne 2f /*nodbg*/ >> 2969 /* signature OK */ >> 2970 lea %pc@(L(q40_do_debug)),%a1 >> 2971 tas %a1@ >> 2972 /*nodbg: q40_do_debug is 0 by default*/ >> 2973 2: >> 2974 #endif >> 2975 >> 2976 #ifdef CONFIG_MVME16x >> 2977 is_not_mvme16x(L(serial_init_not_mvme16x)) >> 2978 moveb #0x10,M167_PCSCCMICR >> 2979 moveb #0x10,M167_PCSCCTICR >> 2980 moveb #0x10,M167_PCSCCRICR >> 2981 jra L(serial_init_done) >> 2982 L(serial_init_not_mvme16x): >> 2983 #endif >> 2984 >> 2985 #ifdef CONFIG_APOLLO >> 2986 /* We count on the PROM initializing SIO1 */ >> 2987 #endif >> 2988 >> 2989 #ifdef CONFIG_HP300 >> 2990 /* We count on the boot loader initialising the UART */ >> 2991 #endif >> 2992 >> 2993 L(serial_init_done): >> 2994 func_return serial_init >> 2995 >> 2996 /* >> 2997 * Output character on serial port. >> 2998 */ >> 2999 func_start serial_putc,%d0/%d1/%a0/%a1 >> 3000 >> 3001 movel ARG1,%d0 >> 3002 cmpib #'\n',%d0 >> 3003 jbne 1f >> 3004 >> 3005 /* A little safe recursion is good for the soul */ >> 3006 serial_putc #'\r' >> 3007 1: >> 3008 >> 3009 #ifdef CONFIG_AMIGA >> 3010 is_not_amiga(2f) >> 3011 andw #0x00ff,%d0 >> 3012 oriw #0x0100,%d0 >> 3013 movel %pc@(L(custom)),%a0 >> 3014 movew %d0,%a0@(CUSTOMBASE+C_SERDAT) >> 3015 1: movew %a0@(CUSTOMBASE+C_SERDATR),%d0 >> 3016 andw #0x2000,%d0 >> 3017 jeq 1b >> 3018 jra L(serial_putc_done) >> 3019 2: >> 3020 #endif >> 3021 >> 3022 #ifdef CONFIG_MAC >> 3023 is_not_mac(5f) >> 3024 #if defined(MAC_USE_SCC_A) || defined(MAC_USE_SCC_B) >> 3025 movel %pc@(L(mac_sccbase)),%a1 >> 3026 #endif >> 3027 #ifdef MAC_USE_SCC_A >> 3028 3: btst #2,%a1@(mac_scc_cha_a_ctrl_offset) >> 3029 jeq 3b >> 3030 moveb %d0,%a1@(mac_scc_cha_a_data_offset) >> 3031 #endif /* MAC_USE_SCC_A */ >> 3032 #ifdef MAC_USE_SCC_B >> 3033 4: btst #2,%a1@(mac_scc_cha_b_ctrl_offset) >> 3034 jeq 4b >> 3035 moveb %d0,%a1@(mac_scc_cha_b_data_offset) >> 3036 #endif /* MAC_USE_SCC_B */ >> 3037 jra L(serial_putc_done) >> 3038 5: >> 3039 #endif /* CONFIG_MAC */ >> 3040 >> 3041 #ifdef CONFIG_ATARI >> 3042 is_not_atari(4f) >> 3043 movel %pc@(L(iobase)),%a1 >> 3044 #if defined(USE_PRINTER) >> 3045 3: btst #0,%a1@(LSTMFP_GPIP) >> 3046 jne 3b >> 3047 moveb #LPSG_IO_B,%a1@(LPSG_SELECT) >> 3048 moveb %d0,%a1@(LPSG_WRITE) >> 3049 moveb #LPSG_IO_A,%a1@(LPSG_SELECT) >> 3050 moveb %a1@(LPSG_READ),%d0 >> 3051 bclr #5,%d0 >> 3052 moveb %d0,%a1@(LPSG_WRITE) >> 3053 nop >> 3054 nop >> 3055 bset #5,%d0 >> 3056 moveb %d0,%a1@(LPSG_WRITE) >> 3057 #elif defined(USE_SCC_A) || defined(USE_SCC_B) >> 3058 3: btst #2,%a1@(LSCC_CTRL) >> 3059 jeq 3b >> 3060 moveb %d0,%a1@(LSCC_DATA) >> 3061 #elif defined(USE_MFP) >> 3062 3: btst #7,%a1@(LMFP_TSR) >> 3063 jeq 3b >> 3064 moveb %d0,%a1@(LMFP_UDR) >> 3065 #endif >> 3066 jra L(serial_putc_done) >> 3067 4: >> 3068 #endif /* CONFIG_ATARI */ >> 3069 >> 3070 #ifdef CONFIG_MVME147 >> 3071 is_not_mvme147(2f) >> 3072 1: btst #2,M147_SCC_CTRL_A >> 3073 jeq 1b >> 3074 moveb %d0,M147_SCC_DATA_A >> 3075 jbra L(serial_putc_done) >> 3076 2: >> 3077 #endif >> 3078 >> 3079 #ifdef CONFIG_MVME16x >> 3080 is_not_mvme16x(2f) >> 3081 /* >> 3082 * If the loader gave us a board type then we can use that to >> 3083 * select an appropriate output routine; otherwise we just use >> 3084 * the Bug code. If we have to use the Bug that means the Bug >> 3085 * workspace has to be valid, which means the Bug has to use >> 3086 * the SRAM, which is non-standard. >> 3087 */ >> 3088 moveml %d0-%d7/%a2-%a6,%sp@- >> 3089 movel vme_brdtype,%d1 >> 3090 jeq 1f | No tag - use the Bug >> 3091 cmpi #VME_TYPE_MVME162,%d1 >> 3092 jeq 6f >> 3093 cmpi #VME_TYPE_MVME172,%d1 >> 3094 jne 5f >> 3095 /* 162/172; it's an SCC */ >> 3096 6: btst #2,M162_SCC_CTRL_A >> 3097 nop >> 3098 nop >> 3099 nop >> 3100 jeq 6b >> 3101 moveb #8,M162_SCC_CTRL_A >> 3102 nop >> 3103 nop >> 3104 nop >> 3105 moveb %d0,M162_SCC_CTRL_A >> 3106 jra 3f >> 3107 5: >> 3108 /* 166/167/177; it's a CD2401 */ >> 3109 moveb #0,M167_CYCAR >> 3110 moveb M167_CYIER,%d2 >> 3111 moveb #0x02,M167_CYIER >> 3112 7: >> 3113 btst #5,M167_PCSCCTICR >> 3114 jeq 7b >> 3115 moveb M167_PCTPIACKR,%d1 >> 3116 moveb M167_CYLICR,%d1 >> 3117 jeq 8f >> 3118 moveb #0x08,M167_CYTEOIR >> 3119 jra 7b >> 3120 8: >> 3121 moveb %d0,M167_CYTDR >> 3122 moveb #0,M167_CYTEOIR >> 3123 moveb %d2,M167_CYIER >> 3124 jra 3f >> 3125 1: >> 3126 moveb %d0,%sp@- >> 3127 trap #15 >> 3128 .word 0x0020 /* TRAP 0x020 */ >> 3129 3: >> 3130 moveml %sp@+,%d0-%d7/%a2-%a6 >> 3131 jbra L(serial_putc_done) >> 3132 2: >> 3133 #endif /* CONFIG_MVME16x */ >> 3134 >> 3135 #ifdef CONFIG_BVME6000 >> 3136 is_not_bvme6000(2f) >> 3137 /* >> 3138 * The BVME6000 machine has a serial port ... >> 3139 */ >> 3140 1: btst #2,BVME_SCC_CTRL_A >> 3141 jeq 1b >> 3142 moveb %d0,BVME_SCC_DATA_A >> 3143 jbra L(serial_putc_done) >> 3144 2: >> 3145 #endif 114 3146 115 ; Non-Masters wait for Master to boot !! 3147 #ifdef CONFIG_SUN3X 116 ; when they resume, tail-call to entry !! 3148 is_not_sun3x(2f) 117 mov blink, @first_lines_of_seconda !! 3149 movel %d0,-(%sp) 118 j arc_platform_smp_wait_to_boot !! 3150 movel 0xFEFE0018,%a1 >> 3151 jbsr (%a1) >> 3152 addq #4,%sp >> 3153 jbra L(serial_putc_done) >> 3154 2: >> 3155 #endif 119 3156 120 .Lmaster_proceed: !! 3157 #ifdef CONFIG_Q40 >> 3158 is_not_q40(2f) >> 3159 tst.l %pc@(L(q40_do_debug)) /* only debug if requested */ >> 3160 beq 2f >> 3161 lea %pc@(q40_mem_cptr),%a1 >> 3162 move.l %a1@,%a0 >> 3163 move.b %d0,%a0@ >> 3164 addq.l #4,%a0 >> 3165 move.l %a0,%a1@ >> 3166 jbra L(serial_putc_done) >> 3167 2: 121 #endif 3168 #endif 122 3169 123 ; Clear BSS before updating any global !! 3170 #ifdef CONFIG_APOLLO 124 ; XXX: use ZOL here !! 3171 is_not_apollo(2f) 125 mov r5, __bss_start !! 3172 movl %pc@(L(iobase)),%a1 126 sub r6, __bss_stop, r5 !! 3173 moveb %d0,%a1@(LTHRB0) 127 lsr.f lp_count, r6, 2 !! 3174 1: moveb %a1@(LSRB0),%d0 128 lpnz 1f !! 3175 andb #0x4,%d0 129 st.ab 0, [r5, 4] !! 3176 beq 1b >> 3177 jbra L(serial_putc_done) >> 3178 2: >> 3179 #endif >> 3180 >> 3181 #ifdef CONFIG_HP300 >> 3182 is_not_hp300(3f) >> 3183 movl %pc@(L(iobase)),%a1 >> 3184 addl %pc@(L(uartbase)),%a1 >> 3185 movel %pc@(L(uart_scode)),%d1 /* Check the scode */ >> 3186 jmi 3f /* Unset? Exit */ >> 3187 cmpi #256,%d1 /* APCI scode? */ >> 3188 jeq 2f >> 3189 1: moveb %a1@(DCALSR),%d1 /* Output to DCA */ >> 3190 andb #0x20,%d1 >> 3191 beq 1b >> 3192 moveb %d0,%a1@(DCADATA) >> 3193 jbra L(serial_putc_done) >> 3194 2: moveb %a1@(APCILSR),%d1 /* Output to APCI */ >> 3195 andb #0x20,%d1 >> 3196 beq 2b >> 3197 moveb %d0,%a1@(APCIDATA) >> 3198 jbra L(serial_putc_done) >> 3199 3: >> 3200 #endif >> 3201 >> 3202 #ifdef CONFIG_VIRT >> 3203 is_not_virt(1f) >> 3204 >> 3205 movel L(virt_gf_tty_base),%a1 >> 3206 movel %d0,%a1@(GF_PUT_CHAR) 130 1: 3207 1: >> 3208 #endif 131 3209 132 ; Uboot - kernel ABI !! 3210 L(serial_putc_done): 133 ; r0 = [0] No uboot interaction, [1 !! 3211 func_return serial_putc 134 ; r1 = magic number (always zero as << 135 ; r2 = pointer to uboot provided cm << 136 ; These are handled later in handle_ub << 137 st r0, [@uboot_tag] << 138 st r1, [@uboot_magic] << 139 st r2, [@uboot_arg] << 140 3212 141 ; setup "current" tsk and optionally c !! 3213 /* 142 mov r9, @init_task !! 3214 * Output a string. 143 SET_CURR_TASK_ON_CPU r9, r0 ; r9 = !! 3215 */ >> 3216 func_start puts,%d0/%a0 144 3217 145 ; setup stack (fp, sp) !! 3218 movel ARG1,%a0 146 mov fp, 0 !! 3219 jra 2f >> 3220 1: >> 3221 #ifdef CONSOLE_DEBUG >> 3222 console_putc %d0 >> 3223 #endif >> 3224 #ifdef SERIAL_DEBUG >> 3225 serial_putc %d0 >> 3226 #endif >> 3227 2: moveb %a0@+,%d0 >> 3228 jne 1b >> 3229 >> 3230 func_return puts 147 3231 148 ; tsk->thread_info is really a PAGE, w !! 3232 /* 149 GET_TSK_STACK_BASE r9, sp ; r9 = !! 3233 * Output number in hex notation. >> 3234 */ 150 3235 151 j start_kernel ; "C" entry po !! 3236 func_start putn,%d0-%d2 152 END(stext) << 153 3237 154 #ifdef CONFIG_SMP !! 3238 putc ' ' 155 ;--------------------------------------------- << 156 ; First lines of code run by secondary bef << 157 ;--------------------------------------------- << 158 .section .text, "ax",@progbits << 159 ENTRY(first_lines_of_secondary) << 160 3239 161 ; setup per-cpu idle task as "current" !! 3240 movel ARG1,%d0 162 ld r0, [@secondary_idle_tsk] !! 3241 moveq #7,%d1 163 SET_CURR_TASK_ON_CPU r0, r1 !! 3242 1: roll #4,%d0 >> 3243 move %d0,%d2 >> 3244 andb #0x0f,%d2 >> 3245 addb #'0',%d2 >> 3246 cmpb #'9',%d2 >> 3247 jls 2f >> 3248 addb #'A'-('9'+1),%d2 >> 3249 2: >> 3250 #ifdef CONSOLE_DEBUG >> 3251 console_putc %d2 >> 3252 #endif >> 3253 #ifdef SERIAL_DEBUG >> 3254 serial_putc %d2 >> 3255 #endif >> 3256 dbra %d1,1b 164 3257 165 ; setup stack (fp, sp) !! 3258 func_return putn 166 mov fp, 0 << 167 3259 168 ; set its stack base to tsk->thread_in !! 3260 #ifdef CONFIG_EARLY_PRINTK 169 GET_TSK_STACK_BASE r0, sp !! 3261 /* >> 3262 * This routine takes its parameters on the stack. It then >> 3263 * turns around and calls the internal routines. This routine >> 3264 * is used by the boot console. >> 3265 * >> 3266 * The calling parameters are: >> 3267 * void debug_cons_nputs(const char *str, unsigned length) >> 3268 * >> 3269 * This routine does NOT understand variable arguments only >> 3270 * simple strings! >> 3271 */ >> 3272 ENTRY(debug_cons_nputs) >> 3273 moveml %d0/%d1/%a0,%sp@- >> 3274 movew %sr,%sp@- >> 3275 ori #0x0700,%sr >> 3276 movel %sp@(18),%a0 /* fetch parameter */ >> 3277 movel %sp@(22),%d1 /* fetch parameter */ >> 3278 jra 2f >> 3279 1: >> 3280 #ifdef CONSOLE_DEBUG >> 3281 console_putc %d0 >> 3282 #endif >> 3283 #ifdef SERIAL_DEBUG >> 3284 serial_putc %d0 >> 3285 #endif >> 3286 subq #1,%d1 >> 3287 2: jeq 3f >> 3288 moveb %a0@+,%d0 >> 3289 jne 1b >> 3290 3: >> 3291 movew %sp@+,%sr >> 3292 moveml %sp@+,%d0/%d1/%a0 >> 3293 rts >> 3294 #endif /* CONFIG_EARLY_PRINTK */ >> 3295 >> 3296 #if defined(CONFIG_HP300) || defined(CONFIG_APOLLO) >> 3297 func_start set_leds,%d0/%a0 >> 3298 movel ARG1,%d0 >> 3299 #ifdef CONFIG_HP300 >> 3300 is_not_hp300(1f) >> 3301 movel %pc@(L(iobase)),%a0 >> 3302 moveb %d0,%a0@(0x1ffff) >> 3303 jra 2f >> 3304 #endif >> 3305 1: >> 3306 #ifdef CONFIG_APOLLO >> 3307 movel %pc@(L(iobase)),%a0 >> 3308 lsll #8,%d0 >> 3309 eorw #0xff00,%d0 >> 3310 moveb %d0,%a0@(LCPUCTRL) >> 3311 #endif >> 3312 2: >> 3313 func_return set_leds >> 3314 #endif 170 3315 171 j start_kernel_secondary !! 3316 #ifdef CONSOLE_DEBUG 172 END(first_lines_of_secondary) !! 3317 /* >> 3318 * For continuity, see the data alignment >> 3319 * to which this structure is tied. >> 3320 */ >> 3321 #define Lconsole_struct_cur_column 0 >> 3322 #define Lconsole_struct_cur_row 4 >> 3323 #define Lconsole_struct_num_columns 8 >> 3324 #define Lconsole_struct_num_rows 12 >> 3325 #define Lconsole_struct_left_edge 16 >> 3326 >> 3327 func_start console_init,%a0-%a4/%d0-%d7 >> 3328 /* >> 3329 * Some of the register usage that follows >> 3330 * a0 = pointer to boot_info >> 3331 * a1 = pointer to screen >> 3332 * a2 = pointer to console_globals >> 3333 * d3 = pixel width of screen >> 3334 * d4 = pixel height of screen >> 3335 * (d3,d4) ~= (x,y) of a point just below >> 3336 * and to the right of the screen >> 3337 * NOT on the screen! >> 3338 * d5 = number of bytes per scan line >> 3339 * d6 = number of bytes on the entire screen >> 3340 */ >> 3341 >> 3342 lea %pc@(L(console_globals)),%a2 >> 3343 movel %pc@(L(mac_videobase)),%a1 >> 3344 movel %pc@(L(mac_rowbytes)),%d5 >> 3345 movel %pc@(L(mac_dimensions)),%d3 /* -> low byte */ >> 3346 movel %d3,%d4 >> 3347 swap %d4 /* -> high byte */ >> 3348 andl #0xffff,%d3 /* d3 = screen width in pixels */ >> 3349 andl #0xffff,%d4 /* d4 = screen height in pixels */ >> 3350 >> 3351 movel %d5,%d6 >> 3352 | subl #20,%d6 >> 3353 mulul %d4,%d6 /* scan line bytes x num scan lines */ >> 3354 divul #8,%d6 /* we'll clear 8 bytes at a time */ >> 3355 moveq #-1,%d0 /* Mac_black */ >> 3356 subq #1,%d6 >> 3357 >> 3358 L(console_clear_loop): >> 3359 movel %d0,%a1@+ >> 3360 movel %d0,%a1@+ >> 3361 dbra %d6,L(console_clear_loop) >> 3362 >> 3363 /* Calculate font size */ >> 3364 >> 3365 #if defined(FONT_8x8) && defined(CONFIG_FONT_8x8) >> 3366 lea %pc@(font_vga_8x8),%a0 >> 3367 #elif defined(FONT_8x16) && defined(CONFIG_FONT_8x16) >> 3368 lea %pc@(font_vga_8x16),%a0 >> 3369 #elif defined(FONT_6x11) && defined(CONFIG_FONT_6x11) >> 3370 lea %pc@(font_vga_6x11),%a0 >> 3371 #elif defined(CONFIG_FONT_8x8) /* default */ >> 3372 lea %pc@(font_vga_8x8),%a0 >> 3373 #else /* no compiled-in font */ >> 3374 lea 0,%a0 173 #endif 3375 #endif >> 3376 >> 3377 /* >> 3378 * At this point we make a shift in register usage >> 3379 * a1 = address of console_font pointer >> 3380 */ >> 3381 lea %pc@(L(console_font)),%a1 >> 3382 movel %a0,%a1@ /* store pointer to struct fbcon_font_desc in console_font */ >> 3383 tstl %a0 >> 3384 jeq 1f >> 3385 lea %pc@(L(console_font_data)),%a4 >> 3386 movel %a0@(FONT_DESC_DATA),%d0 >> 3387 subl #L(console_font),%a1 >> 3388 addl %a1,%d0 >> 3389 movel %d0,%a4@ >> 3390 >> 3391 /* >> 3392 * Calculate global maxs >> 3393 * Note - we can use either an >> 3394 * 8 x 16 or 8 x 8 character font >> 3395 * 6 x 11 also supported >> 3396 */ >> 3397 /* ASSERT: a0 = contents of Lconsole_font */ >> 3398 movel %d3,%d0 /* screen width in pixels */ >> 3399 divul %a0@(FONT_DESC_WIDTH),%d0 /* d0 = max num chars per row */ >> 3400 >> 3401 movel %d4,%d1 /* screen height in pixels */ >> 3402 divul %a0@(FONT_DESC_HEIGHT),%d1 /* d1 = max num rows */ >> 3403 >> 3404 movel %d0,%a2@(Lconsole_struct_num_columns) >> 3405 movel %d1,%a2@(Lconsole_struct_num_rows) >> 3406 >> 3407 /* >> 3408 * Clear the current row and column >> 3409 */ >> 3410 clrl %a2@(Lconsole_struct_cur_column) >> 3411 clrl %a2@(Lconsole_struct_cur_row) >> 3412 clrl %a2@(Lconsole_struct_left_edge) >> 3413 >> 3414 /* >> 3415 * Initialization is complete >> 3416 */ >> 3417 1: >> 3418 func_return console_init >> 3419 >> 3420 #ifdef CONFIG_LOGO >> 3421 func_start console_put_penguin,%a0-%a1/%d0-%d7 >> 3422 /* >> 3423 * Get 'that_penguin' onto the screen in the upper right corner >> 3424 * penguin is 64 x 74 pixels, align against right edge of screen >> 3425 */ >> 3426 lea %pc@(L(mac_dimensions)),%a0 >> 3427 movel %a0@,%d0 >> 3428 andil #0xffff,%d0 >> 3429 subil #64,%d0 /* snug up against the right edge */ >> 3430 clrl %d1 /* start at the top */ >> 3431 movel #73,%d7 >> 3432 lea %pc@(L(that_penguin)),%a1 >> 3433 L(console_penguin_row): >> 3434 movel #31,%d6 >> 3435 L(console_penguin_pixel_pair): >> 3436 moveb %a1@,%d2 >> 3437 lsrb #4,%d2 >> 3438 console_plot_pixel %d0,%d1,%d2 >> 3439 addq #1,%d0 >> 3440 moveb %a1@+,%d2 >> 3441 console_plot_pixel %d0,%d1,%d2 >> 3442 addq #1,%d0 >> 3443 dbra %d6,L(console_penguin_pixel_pair) >> 3444 >> 3445 subil #64,%d0 >> 3446 addq #1,%d1 >> 3447 dbra %d7,L(console_penguin_row) >> 3448 >> 3449 func_return console_put_penguin >> 3450 >> 3451 /* include penguin bitmap */ >> 3452 L(that_penguin): >> 3453 #include "../mac/mac_penguin.S" >> 3454 #endif >> 3455 >> 3456 /* >> 3457 * Calculate source and destination addresses >> 3458 * output a1 = dest >> 3459 * a2 = source >> 3460 */ >> 3461 >> 3462 func_start console_scroll,%a0-%a4/%d0-%d7 >> 3463 lea %pc@(L(mac_videobase)),%a0 >> 3464 movel %a0@,%a1 >> 3465 movel %a1,%a2 >> 3466 lea %pc@(L(mac_rowbytes)),%a0 >> 3467 movel %a0@,%d5 >> 3468 movel %pc@(L(console_font)),%a0 >> 3469 tstl %a0 >> 3470 jeq 1f >> 3471 mulul %a0@(FONT_DESC_HEIGHT),%d5 /* account for # scan lines per character */ >> 3472 addal %d5,%a2 >> 3473 >> 3474 /* >> 3475 * Get dimensions >> 3476 */ >> 3477 lea %pc@(L(mac_dimensions)),%a0 >> 3478 movel %a0@,%d3 >> 3479 movel %d3,%d4 >> 3480 swap %d4 >> 3481 andl #0xffff,%d3 /* d3 = screen width in pixels */ >> 3482 andl #0xffff,%d4 /* d4 = screen height in pixels */ >> 3483 >> 3484 /* >> 3485 * Calculate number of bytes to move >> 3486 */ >> 3487 lea %pc@(L(mac_rowbytes)),%a0 >> 3488 movel %a0@,%d6 >> 3489 movel %pc@(L(console_font)),%a0 >> 3490 subl %a0@(FONT_DESC_HEIGHT),%d4 /* we're not scrolling the top row! */ >> 3491 mulul %d4,%d6 /* scan line bytes x num scan lines */ >> 3492 divul #32,%d6 /* we'll move 8 longs at a time */ >> 3493 subq #1,%d6 >> 3494 >> 3495 L(console_scroll_loop): >> 3496 movel %a2@+,%a1@+ >> 3497 movel %a2@+,%a1@+ >> 3498 movel %a2@+,%a1@+ >> 3499 movel %a2@+,%a1@+ >> 3500 movel %a2@+,%a1@+ >> 3501 movel %a2@+,%a1@+ >> 3502 movel %a2@+,%a1@+ >> 3503 movel %a2@+,%a1@+ >> 3504 dbra %d6,L(console_scroll_loop) >> 3505 >> 3506 lea %pc@(L(mac_rowbytes)),%a0 >> 3507 movel %a0@,%d6 >> 3508 movel %pc@(L(console_font)),%a0 >> 3509 mulul %a0@(FONT_DESC_HEIGHT),%d6 /* scan line bytes x font height */ >> 3510 divul #32,%d6 /* we'll move 8 words at a time */ >> 3511 subq #1,%d6 >> 3512 >> 3513 moveq #-1,%d0 >> 3514 L(console_scroll_clear_loop): >> 3515 movel %d0,%a1@+ >> 3516 movel %d0,%a1@+ >> 3517 movel %d0,%a1@+ >> 3518 movel %d0,%a1@+ >> 3519 movel %d0,%a1@+ >> 3520 movel %d0,%a1@+ >> 3521 movel %d0,%a1@+ >> 3522 movel %d0,%a1@+ >> 3523 dbra %d6,L(console_scroll_clear_loop) >> 3524 >> 3525 1: >> 3526 func_return console_scroll >> 3527 >> 3528 >> 3529 func_start console_putc,%a0/%a1/%d0-%d7 >> 3530 >> 3531 is_not_mac(L(console_exit)) >> 3532 tstl %pc@(L(console_font)) >> 3533 jeq L(console_exit) >> 3534 >> 3535 /* Output character in d7 on console. >> 3536 */ >> 3537 movel ARG1,%d7 >> 3538 cmpib #'\n',%d7 >> 3539 jbne 1f >> 3540 >> 3541 /* A little safe recursion is good for the soul */ >> 3542 console_putc #'\r' >> 3543 1: >> 3544 lea %pc@(L(console_globals)),%a0 >> 3545 >> 3546 cmpib #10,%d7 >> 3547 jne L(console_not_lf) >> 3548 movel %a0@(Lconsole_struct_cur_row),%d0 >> 3549 addil #1,%d0 >> 3550 movel %d0,%a0@(Lconsole_struct_cur_row) >> 3551 movel %a0@(Lconsole_struct_num_rows),%d1 >> 3552 cmpl %d1,%d0 >> 3553 jcs 1f >> 3554 subil #1,%d0 >> 3555 movel %d0,%a0@(Lconsole_struct_cur_row) >> 3556 console_scroll >> 3557 1: >> 3558 jra L(console_exit) >> 3559 >> 3560 L(console_not_lf): >> 3561 cmpib #13,%d7 >> 3562 jne L(console_not_cr) >> 3563 clrl %a0@(Lconsole_struct_cur_column) >> 3564 jra L(console_exit) >> 3565 >> 3566 L(console_not_cr): >> 3567 cmpib #1,%d7 >> 3568 jne L(console_not_home) >> 3569 clrl %a0@(Lconsole_struct_cur_row) >> 3570 clrl %a0@(Lconsole_struct_cur_column) >> 3571 jra L(console_exit) >> 3572 >> 3573 /* >> 3574 * At this point we know that the %d7 character is going to be >> 3575 * rendered on the screen. Register usage is - >> 3576 * a0 = pointer to console globals >> 3577 * a1 = font data >> 3578 * d0 = cursor column >> 3579 * d1 = cursor row to draw the character >> 3580 * d7 = character number >> 3581 */ >> 3582 L(console_not_home): >> 3583 movel %a0@(Lconsole_struct_cur_column),%d0 >> 3584 addql #1,%a0@(Lconsole_struct_cur_column) >> 3585 movel %a0@(Lconsole_struct_num_columns),%d1 >> 3586 cmpl %d1,%d0 >> 3587 jcs 1f >> 3588 console_putc #'\n' /* recursion is OK! */ >> 3589 1: >> 3590 movel %a0@(Lconsole_struct_cur_row),%d1 >> 3591 >> 3592 /* >> 3593 * At this point we make a shift in register usage >> 3594 * a0 = address of pointer to font data (fbcon_font_desc) >> 3595 */ >> 3596 movel %pc@(L(console_font)),%a0 >> 3597 movel %pc@(L(console_font_data)),%a1 /* Load fbcon_font_desc.data into a1 */ >> 3598 andl #0x000000ff,%d7 >> 3599 /* ASSERT: a0 = contents of Lconsole_font */ >> 3600 mulul %a0@(FONT_DESC_HEIGHT),%d7 /* d7 = index into font data */ >> 3601 addl %d7,%a1 /* a1 = points to char image */ >> 3602 >> 3603 /* >> 3604 * At this point we make a shift in register usage >> 3605 * d0 = pixel coordinate, x >> 3606 * d1 = pixel coordinate, y >> 3607 * d2 = (bit 0) 1/0 for white/black (!) pixel on screen >> 3608 * d3 = font scan line data (8 pixels) >> 3609 * d6 = count down for the font's pixel width (8) >> 3610 * d7 = count down for the font's pixel count in height >> 3611 */ >> 3612 /* ASSERT: a0 = contents of Lconsole_font */ >> 3613 mulul %a0@(FONT_DESC_WIDTH),%d0 >> 3614 mulul %a0@(FONT_DESC_HEIGHT),%d1 >> 3615 movel %a0@(FONT_DESC_HEIGHT),%d7 /* Load fbcon_font_desc.height into d7 */ >> 3616 subq #1,%d7 >> 3617 L(console_read_char_scanline): >> 3618 moveb %a1@+,%d3 >> 3619 >> 3620 /* ASSERT: a0 = contents of Lconsole_font */ >> 3621 movel %a0@(FONT_DESC_WIDTH),%d6 /* Load fbcon_font_desc.width into d6 */ >> 3622 subql #1,%d6 >> 3623 >> 3624 L(console_do_font_scanline): >> 3625 lslb #1,%d3 >> 3626 scsb %d2 /* convert 1 bit into a byte */ >> 3627 console_plot_pixel %d0,%d1,%d2 >> 3628 addq #1,%d0 >> 3629 dbra %d6,L(console_do_font_scanline) >> 3630 >> 3631 /* ASSERT: a0 = contents of Lconsole_font */ >> 3632 subl %a0@(FONT_DESC_WIDTH),%d0 >> 3633 addq #1,%d1 >> 3634 dbra %d7,L(console_read_char_scanline) >> 3635 >> 3636 L(console_exit): >> 3637 func_return console_putc >> 3638 >> 3639 /* >> 3640 * Input: >> 3641 * d0 = x coordinate >> 3642 * d1 = y coordinate >> 3643 * d2 = (bit 0) 1/0 for white/black (!) >> 3644 * All registers are preserved >> 3645 */ >> 3646 func_start console_plot_pixel,%a0-%a1/%d0-%d4 >> 3647 >> 3648 movel %pc@(L(mac_videobase)),%a1 >> 3649 movel %pc@(L(mac_videodepth)),%d3 >> 3650 movel ARG1,%d0 >> 3651 movel ARG2,%d1 >> 3652 mulul %pc@(L(mac_rowbytes)),%d1 >> 3653 movel ARG3,%d2 >> 3654 >> 3655 /* >> 3656 * Register usage: >> 3657 * d0 = x coord becomes byte offset into frame buffer >> 3658 * d1 = y coord >> 3659 * d2 = black or white (0/1) >> 3660 * d3 = video depth >> 3661 * d4 = temp of x (d0) for many bit depths >> 3662 */ >> 3663 L(test_1bit): >> 3664 cmpb #1,%d3 >> 3665 jbne L(test_2bit) >> 3666 movel %d0,%d4 /* we need the low order 3 bits! */ >> 3667 divul #8,%d0 >> 3668 addal %d0,%a1 >> 3669 addal %d1,%a1 >> 3670 andb #7,%d4 >> 3671 eorb #7,%d4 /* reverse the x-coordinate w/ screen-bit # */ >> 3672 andb #1,%d2 >> 3673 jbne L(white_1) >> 3674 bsetb %d4,%a1@ >> 3675 jbra L(console_plot_pixel_exit) >> 3676 L(white_1): >> 3677 bclrb %d4,%a1@ >> 3678 jbra L(console_plot_pixel_exit) >> 3679 >> 3680 L(test_2bit): >> 3681 cmpb #2,%d3 >> 3682 jbne L(test_4bit) >> 3683 movel %d0,%d4 /* we need the low order 2 bits! */ >> 3684 divul #4,%d0 >> 3685 addal %d0,%a1 >> 3686 addal %d1,%a1 >> 3687 andb #3,%d4 >> 3688 eorb #3,%d4 /* reverse the x-coordinate w/ screen-bit # */ >> 3689 lsll #1,%d4 /* ! */ >> 3690 andb #1,%d2 >> 3691 jbne L(white_2) >> 3692 bsetb %d4,%a1@ >> 3693 addq #1,%d4 >> 3694 bsetb %d4,%a1@ >> 3695 jbra L(console_plot_pixel_exit) >> 3696 L(white_2): >> 3697 bclrb %d4,%a1@ >> 3698 addq #1,%d4 >> 3699 bclrb %d4,%a1@ >> 3700 jbra L(console_plot_pixel_exit) >> 3701 >> 3702 L(test_4bit): >> 3703 cmpb #4,%d3 >> 3704 jbne L(test_8bit) >> 3705 movel %d0,%d4 /* we need the low order bit! */ >> 3706 divul #2,%d0 >> 3707 addal %d0,%a1 >> 3708 addal %d1,%a1 >> 3709 andb #1,%d4 >> 3710 eorb #1,%d4 >> 3711 lsll #2,%d4 /* ! */ >> 3712 andb #1,%d2 >> 3713 jbne L(white_4) >> 3714 bsetb %d4,%a1@ >> 3715 addq #1,%d4 >> 3716 bsetb %d4,%a1@ >> 3717 addq #1,%d4 >> 3718 bsetb %d4,%a1@ >> 3719 addq #1,%d4 >> 3720 bsetb %d4,%a1@ >> 3721 jbra L(console_plot_pixel_exit) >> 3722 L(white_4): >> 3723 bclrb %d4,%a1@ >> 3724 addq #1,%d4 >> 3725 bclrb %d4,%a1@ >> 3726 addq #1,%d4 >> 3727 bclrb %d4,%a1@ >> 3728 addq #1,%d4 >> 3729 bclrb %d4,%a1@ >> 3730 jbra L(console_plot_pixel_exit) >> 3731 >> 3732 L(test_8bit): >> 3733 cmpb #8,%d3 >> 3734 jbne L(test_16bit) >> 3735 addal %d0,%a1 >> 3736 addal %d1,%a1 >> 3737 andb #1,%d2 >> 3738 jbne L(white_8) >> 3739 moveb #0xff,%a1@ >> 3740 jbra L(console_plot_pixel_exit) >> 3741 L(white_8): >> 3742 clrb %a1@ >> 3743 jbra L(console_plot_pixel_exit) >> 3744 >> 3745 L(test_16bit): >> 3746 cmpb #16,%d3 >> 3747 jbne L(console_plot_pixel_exit) >> 3748 addal %d0,%a1 >> 3749 addal %d0,%a1 >> 3750 addal %d1,%a1 >> 3751 andb #1,%d2 >> 3752 jbne L(white_16) >> 3753 clrw %a1@ >> 3754 jbra L(console_plot_pixel_exit) >> 3755 L(white_16): >> 3756 movew #0x0fff,%a1@ >> 3757 jbra L(console_plot_pixel_exit) >> 3758 >> 3759 L(console_plot_pixel_exit): >> 3760 func_return console_plot_pixel >> 3761 #endif /* CONSOLE_DEBUG */ >> 3762 >> 3763 >> 3764 __INITDATA >> 3765 .align 4 >> 3766 >> 3767 m68k_init_mapped_size: >> 3768 .long 0 >> 3769 >> 3770 #if defined(CONFIG_ATARI) || defined(CONFIG_AMIGA) || \ >> 3771 defined(CONFIG_HP300) || defined(CONFIG_APOLLO) >> 3772 L(custom): >> 3773 L(iobase): >> 3774 .long 0 >> 3775 #endif >> 3776 >> 3777 #ifdef CONSOLE_DEBUG >> 3778 L(console_globals): >> 3779 .long 0 /* cursor column */ >> 3780 .long 0 /* cursor row */ >> 3781 .long 0 /* max num columns */ >> 3782 .long 0 /* max num rows */ >> 3783 .long 0 /* left edge */ >> 3784 L(console_font): >> 3785 .long 0 /* pointer to console font (struct font_desc) */ >> 3786 L(console_font_data): >> 3787 .long 0 /* pointer to console font data */ >> 3788 #endif /* CONSOLE_DEBUG */ >> 3789 >> 3790 #if defined(MMU_PRINT) >> 3791 L(mmu_print_data): >> 3792 .long 0 /* valid flag */ >> 3793 .long 0 /* start logical */ >> 3794 .long 0 /* next logical */ >> 3795 .long 0 /* start physical */ >> 3796 .long 0 /* next physical */ >> 3797 #endif /* MMU_PRINT */ >> 3798 >> 3799 L(cputype): >> 3800 .long 0 >> 3801 L(mmu_cached_pointer_tables): >> 3802 .long 0 >> 3803 L(mmu_num_pointer_tables): >> 3804 .long 0 >> 3805 L(phys_kernel_start): >> 3806 .long 0 >> 3807 L(kernel_end): >> 3808 .long 0 >> 3809 L(memory_start): >> 3810 .long 0 >> 3811 L(kernel_pgdir_ptr): >> 3812 .long 0 >> 3813 L(temp_mmap_mem): >> 3814 .long 0 >> 3815 >> 3816 #if defined (CONFIG_MVME147) >> 3817 M147_SCC_CTRL_A = 0xfffe3002 >> 3818 M147_SCC_DATA_A = 0xfffe3003 >> 3819 #endif >> 3820 >> 3821 #if defined (CONFIG_MVME16x) >> 3822 M162_SCC_CTRL_A = 0xfff45005 >> 3823 M167_CYCAR = 0xfff450ee >> 3824 M167_CYIER = 0xfff45011 >> 3825 M167_CYLICR = 0xfff45026 >> 3826 M167_CYTEOIR = 0xfff45085 >> 3827 M167_CYTDR = 0xfff450f8 >> 3828 M167_PCSCCMICR = 0xfff4201d >> 3829 M167_PCSCCTICR = 0xfff4201e >> 3830 M167_PCSCCRICR = 0xfff4201f >> 3831 M167_PCTPIACKR = 0xfff42025 >> 3832 #endif >> 3833 >> 3834 #if defined (CONFIG_BVME6000) >> 3835 BVME_SCC_CTRL_A = 0xffb0000b >> 3836 BVME_SCC_DATA_A = 0xffb0000f >> 3837 #endif >> 3838 >> 3839 #if defined(CONFIG_MAC) >> 3840 L(mac_videobase): >> 3841 .long 0 >> 3842 L(mac_videodepth): >> 3843 .long 0 >> 3844 L(mac_dimensions): >> 3845 .long 0 >> 3846 L(mac_rowbytes): >> 3847 .long 0 >> 3848 L(mac_sccbase): >> 3849 .long 0 >> 3850 #endif /* CONFIG_MAC */ >> 3851 >> 3852 #if defined (CONFIG_APOLLO) >> 3853 LSRB0 = 0x10412 >> 3854 LTHRB0 = 0x10416 >> 3855 LCPUCTRL = 0x10100 >> 3856 #endif >> 3857 >> 3858 #if defined(CONFIG_HP300) >> 3859 DCADATA = 0x11 >> 3860 DCALSR = 0x1b >> 3861 APCIDATA = 0x00 >> 3862 APCILSR = 0x14 >> 3863 L(uartbase): >> 3864 .long 0 >> 3865 L(uart_scode): >> 3866 .long -1 >> 3867 #endif >> 3868 >> 3869 __FINIT >> 3870 .data >> 3871 .align 4 >> 3872 >> 3873 availmem: >> 3874 .long 0 >> 3875 m68k_pgtable_cachemode: >> 3876 .long 0 >> 3877 m68k_supervisor_cachemode: >> 3878 .long 0 >> 3879 #if defined(CONFIG_MVME16x) >> 3880 mvme_bdid: >> 3881 .long 0,0,0,0,0,0,0,0 >> 3882 #endif >> 3883 #if defined(CONFIG_Q40) >> 3884 q40_mem_cptr: >> 3885 .long 0 >> 3886 L(q40_do_debug): >> 3887 .long 0 >> 3888 #endif >> 3889 >> 3890 #if defined(CONFIG_VIRT) >> 3891 GF_PUT_CHAR = 0x00 >> 3892 L(virt_gf_tty_base): >> 3893 .long 0 >> 3894 #endif /* CONFIG_VIRT */
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.