Home | History | Annotate | Line # | Download | only in integrator
integrator_machdep.c revision 1.8
      1 /*	$NetBSD: integrator_machdep.c,v 1.8 2002/01/30 04:00:47 thorpej Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2001 ARM Ltd
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. The name of the company may not be used to endorse or promote
     16  *    products derived from this software without specific prior written
     17  *    permission.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
     20  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     21  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     22  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
     23  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     24  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     25  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  * SUCH DAMAGE.
     30  *
     31  * Copyright (c) 1997,1998 Mark Brinicombe.
     32  * Copyright (c) 1997,1998 Causality Limited.
     33  * All rights reserved.
     34  *
     35  * Redistribution and use in source and binary forms, with or without
     36  * modification, are permitted provided that the following conditions
     37  * are met:
     38  * 1. Redistributions of source code must retain the above copyright
     39  *    notice, this list of conditions and the following disclaimer.
     40  * 2. Redistributions in binary form must reproduce the above copyright
     41  *    notice, this list of conditions and the following disclaimer in the
     42  *    documentation and/or other materials provided with the distribution.
     43  * 3. All advertising materials mentioning features or use of this software
     44  *    must display the following acknowledgement:
     45  *	This product includes software developed by Mark Brinicombe
     46  *	for the NetBSD Project.
     47  * 4. The name of the company nor the name of the author may be used to
     48  *    endorse or promote products derived from this software without specific
     49  *    prior written permission.
     50  *
     51  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
     52  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     53  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     54  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
     55  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     56  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     57  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     58  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     59  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     60  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     61  * SUCH DAMAGE.
     62  *
     63  * Machine dependant functions for kernel setup for integrator board
     64  *
     65  * Created      : 24/11/97
     66  */
     67 
     68 #include "opt_ddb.h"
     69 #include "opt_pmap_debug.h"
     70 
     71 #include <sys/param.h>
     72 #include <sys/device.h>
     73 #include <sys/systm.h>
     74 #include <sys/kernel.h>
     75 #include <sys/exec.h>
     76 #include <sys/proc.h>
     77 #include <sys/msgbuf.h>
     78 #include <sys/reboot.h>
     79 #include <sys/termios.h>
     80 
     81 #include <dev/cons.h>
     82 
     83 #include <machine/db_machdep.h>
     84 #include <ddb/db_sym.h>
     85 #include <ddb/db_extern.h>
     86 
     87 #include <machine/bootconfig.h>
     88 #include <machine/bus.h>
     89 #include <machine/cpu.h>
     90 #include <machine/frame.h>
     91 #include <machine/intr.h>
     92 #include <evbarm/ifpga/irqhandler.h>	/* XXX XXX XXX */
     93 #include <arm/undefined.h>
     94 
     95 #include <evbarm/integrator/integrator_boot.h>
     96 
     97 #include "opt_ipkdb.h"
     98 #include "pci.h"
     99 
    100 void ifpga_reset(void) __attribute__((noreturn));
    101 /*
    102  * Address to call from cpu_reset() to reset the machine.
    103  * This is machine architecture dependant as it varies depending
    104  * on where the ROM appears when you turn the MMU off.
    105  */
    106 
    107 u_int cpu_reset_address = (u_int) ifpga_reset;
    108 
    109 /* Define various stack sizes in pages */
    110 #define IRQ_STACK_SIZE	1
    111 #define ABT_STACK_SIZE	1
    112 #ifdef IPKDB
    113 #define UND_STACK_SIZE	2
    114 #else
    115 #define UND_STACK_SIZE	1
    116 #endif
    117 
    118 struct intbootinfo intbootinfo;
    119 BootConfig bootconfig;		/* Boot config storage */
    120 static char bootargs[MAX_BOOT_STRING + 1];
    121 char *boot_args = NULL;
    122 char *boot_file = NULL;
    123 
    124 vm_offset_t physical_start;
    125 vm_offset_t physical_freestart;
    126 vm_offset_t physical_freeend;
    127 vm_offset_t physical_end;
    128 u_int free_pages;
    129 vm_offset_t pagetables_start;
    130 int physmem = 0;
    131 
    132 /*int debug_flags;*/
    133 #ifndef PMAP_STATIC_L1S
    134 int max_processes = 64;			/* Default number */
    135 #endif	/* !PMAP_STATIC_L1S */
    136 
    137 /* Physical and virtual addresses for some global pages */
    138 pv_addr_t systempage;
    139 pv_addr_t irqstack;
    140 pv_addr_t undstack;
    141 pv_addr_t abtstack;
    142 pv_addr_t kernelstack;
    143 
    144 vm_offset_t msgbufphys;
    145 
    146 extern u_int data_abort_handler_address;
    147 extern u_int prefetch_abort_handler_address;
    148 extern u_int undefined_handler_address;
    149 
    150 #ifdef PMAP_DEBUG
    151 extern int pmap_debug_level;
    152 #endif
    153 
    154 #define KERNEL_PT_SYS		0	/* Page table for mapping proc0 zero page */
    155 #define KERNEL_PT_KERNEL	1	/* Page table for mapping kernel */
    156 #define KERNEL_PT_VMDATA	2	/* Page tables for mapping kernel VM */
    157 #define	KERNEL_PT_VMDATA_NUM	(KERNEL_VM_SIZE >> (PDSHIFT + 2))
    158 #define NUM_KERNEL_PTS		(KERNEL_PT_VMDATA + KERNEL_PT_VMDATA_NUM)
    159 
    160 pt_entry_t kernel_pt_table[NUM_KERNEL_PTS];
    161 
    162 struct user *proc0paddr;
    163 
    164 /* Prototypes */
    165 
    166 void consinit		__P((void));
    167 
    168 void map_section	__P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa,
    169 			     int cacheable));
    170 void map_pagetable	__P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
    171 void map_entry		__P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
    172 void map_entry_nc	__P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
    173 void map_entry_ro	__P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
    174 vm_size_t map_chunk	__P((vm_offset_t pd, vm_offset_t pt, vm_offset_t va,
    175 			     vm_offset_t pa, vm_size_t size, u_int acc,
    176 			     u_int flg));
    177 
    178 void process_kernel_args	__P((char *));
    179 void data_abort_handler		__P((trapframe_t *frame));
    180 void prefetch_abort_handler	__P((trapframe_t *frame));
    181 void undefinedinstruction_bounce	__P((trapframe_t *frame));
    182 extern void configure		__P((void));
    183 extern void parse_mi_bootargs	__P((char *args));
    184 extern void dumpsys		__P((void));
    185 
    186 /* A load of console goo. */
    187 #include "vga.h"
    188 #if (NVGA > 0)
    189 #include <dev/ic/mc6845reg.h>
    190 #include <dev/ic/pcdisplayvar.h>
    191 #include <dev/ic/vgareg.h>
    192 #include <dev/ic/vgavar.h>
    193 #endif
    194 
    195 #include "pckbc.h"
    196 #if (NPCKBC > 0)
    197 #include <dev/ic/i8042reg.h>
    198 #include <dev/ic/pckbcvar.h>
    199 #endif
    200 
    201 #include "com.h"
    202 #if (NCOM > 0)
    203 #include <dev/ic/comreg.h>
    204 #include <dev/ic/comvar.h>
    205 #ifndef CONCOMADDR
    206 #define CONCOMADDR 0x3f8
    207 #endif
    208 #endif
    209 
    210 #define CONSPEED B115200
    211 #ifndef CONSPEED
    212 #define CONSPEED B9600	/* TTYDEF_SPEED */
    213 #endif
    214 #ifndef CONMODE
    215 #define CONMODE ((TTYDEF_CFLAG & ~(CSIZE | CSTOPB | PARENB)) | CS8) /* 8N1 */
    216 #endif
    217 
    218 int comcnspeed = CONSPEED;
    219 int comcnmode = CONMODE;
    220 
    221 #include "plcom.h"
    222 #if (NPLCOM > 0)
    223 #include <evbarm/dev/plcomreg.h>
    224 #include <evbarm/dev/plcomvar.h>
    225 
    226 #include <evbarm/ifpga/ifpgamem.h>
    227 #include <evbarm/ifpga/ifpgareg.h>
    228 #include <evbarm/ifpga/ifpgavar.h>
    229 #endif
    230 
    231 #ifndef CONSDEVNAME
    232 #define CONSDEVNAME "plcom"
    233 #endif
    234 
    235 #ifndef PLCONSPEED
    236 #define PLCONSPEED B38400
    237 #endif
    238 #ifndef PLCONMODE
    239 #define PLCONMODE ((TTYDEF_CFLAG & ~(CSIZE | CSTOPB | PARENB)) | CS8) /* 8N1 */
    240 #endif
    241 #ifndef PLCOMCNUNIT
    242 #define PLCOMCNUNIT -1
    243 #endif
    244 
    245 int plcomcnspeed = PLCONSPEED;
    246 int plcomcnmode = PLCONMODE;
    247 
    248 #if 0
    249 extern struct consdev kcomcons;
    250 static void kcomcnputc(dev_t, int);
    251 #endif
    252 
    253 /*
    254  * void cpu_reboot(int howto, char *bootstr)
    255  *
    256  * Reboots the system
    257  *
    258  * Deal with any syncing, unmounting, dumping and shutdown hooks,
    259  * then reset the CPU.
    260  */
    261 
    262 void
    263 cpu_reboot(howto, bootstr)
    264 	int howto;
    265 	char *bootstr;
    266 {
    267 #ifdef DIAGNOSTIC
    268 	/* info */
    269 	printf("boot: howto=%08x curproc=%p\n", howto, curproc);
    270 #endif
    271 
    272 	/*
    273 	 * If we are still cold then hit the air brakes
    274 	 * and crash to earth fast
    275 	 */
    276 	if (cold) {
    277 		doshutdownhooks();
    278 		printf("The operating system has halted.\n");
    279 		printf("Please press any key to reboot.\n\n");
    280 		cngetc();
    281 		printf("rebooting...\n");
    282 		ifpga_reset();
    283 		/*NOTREACHED*/
    284 	}
    285 
    286 	/* Disable console buffering */
    287 /*	cnpollc(1);*/
    288 
    289 	/*
    290 	 * If RB_NOSYNC was not specified sync the discs.
    291 	 * Note: Unless cold is set to 1 here, syslogd will die during the unmount.
    292 	 * It looks like syslogd is getting woken up only to find that it cannot
    293 	 * page part of the binary in as the filesystem has been unmounted.
    294 	 */
    295 	if (!(howto & RB_NOSYNC))
    296 		bootsync();
    297 
    298 	/* Say NO to interrupts */
    299 	splhigh();
    300 
    301 	/* Do a dump if requested. */
    302 	if ((howto & (RB_DUMP | RB_HALT)) == RB_DUMP)
    303 		dumpsys();
    304 
    305 	/* Run any shutdown hooks */
    306 	doshutdownhooks();
    307 
    308 	/* Make sure IRQ's are disabled */
    309 	IRQdisable;
    310 
    311 	if (howto & RB_HALT) {
    312 		printf("The operating system has halted.\n");
    313 		printf("Please press any key to reboot.\n\n");
    314 		cngetc();
    315 	}
    316 
    317 	printf("rebooting...\n");
    318 	ifpga_reset();
    319 	/*NOTREACHED*/
    320 }
    321 
    322 /*
    323  * Mapping table for core kernel memory. This memory is mapped at init
    324  * time with section mappings.
    325  */
    326 struct l1_sec_map {
    327 	vm_offset_t	va;
    328 	vm_offset_t	pa;
    329 	vm_size_t	size;
    330 	int		flags;
    331 } l1_sec_table[] = {
    332 #if NPLCOM > 0 && defined(PLCONSOLE)
    333 	{ UART0_BOOT_BASE, IFPGA_IO_BASE + IFPGA_UART0, 1024 * 1024, 0},
    334 	{ UART1_BOOT_BASE, IFPGA_IO_BASE + IFPGA_UART1, 1024 * 1024, 0},
    335 #endif
    336 #if NPCI > 0
    337 	{ IFPGA_PCI_IO_VBASE, IFPGA_PCI_IO_BASE, IFPGA_PCI_IO_VSIZE, 0},
    338 	{ IFPGA_PCI_CONF_VBASE, IFPGA_PCI_CONF_BASE, IFPGA_PCI_CONF_VSIZE, 0},
    339 #endif
    340 
    341 	{ 0, 0, 0, 0 }
    342 };
    343 
    344 /*
    345  * u_int initarm(struct ebsaboot *bootinfo)
    346  *
    347  * Initial entry point on startup. This gets called before main() is
    348  * entered.
    349  * It should be responsible for setting up everything that must be
    350  * in place when main is called.
    351  * This includes
    352  *   Taking a copy of the boot configuration structure.
    353  *   Initialising the physical console so characters can be printed.
    354  *   Setting up page tables for the kernel
    355  *   Relocating the kernel to the bottom of physical memory
    356  */
    357 
    358 u_int
    359 initarm(bootinfo)
    360 	struct intbootinfo *bootinfo;
    361 {
    362 	int loop;
    363 	int loop1;
    364 	u_int l1pagetable;
    365 	u_int l2pagetable;
    366 	extern char page0[], page0_end[];
    367 	extern int etext asm ("_etext");
    368 	extern int end asm ("_end");
    369 	pv_addr_t kernel_l1pt;
    370 	pv_addr_t kernel_ptpt;
    371 #if NPLCOM > 0 && defined(PLCONSOLE)
    372 	static struct bus_space plcom_bus_space;
    373 #endif
    374 
    375 
    376 #if 0
    377 	cn_tab = &kcomcons;
    378 #endif
    379 	/*
    380 	 * Heads up ... Setup the CPU / MMU / TLB functions
    381 	 */
    382 	if (set_cpufuncs())
    383 		panic("cpu not recognized!");
    384 
    385 	/*    - intbootinfo.bt_memstart) / NBPG */;
    386 
    387 #if NPLCOM > 0 && defined(PLCONSOLE)
    388 	/*
    389 	 * Initialise the diagnostic serial console
    390 	 * This allows a means of generating output during initarm().
    391 	 * Once all the memory map changes are complete we can call consinit()
    392 	 * and not have to worry about things moving.
    393 	 */
    394 
    395 	if (PLCOMCNUNIT == 0) {
    396 		ifpga_create_io_bs_tag(&plcom_bus_space, (void*)0xfd600000);
    397 		plcomcnattach(&plcom_bus_space, 0, plcomcnspeed,
    398 		    IFPGA_UART_CLK, plcomcnmode, PLCOMCNUNIT);
    399 	} else if (PLCOMCNUNIT == 1) {
    400 		ifpga_create_io_bs_tag(&plcom_bus_space, (void*)0xfd700000);
    401 		plcomcnattach(&plcom_bus_space, 0, plcomcnspeed,
    402 		    IFPGA_UART_CLK, plcomcnmode, PLCOMCNUNIT);
    403 	}
    404 #endif
    405 
    406 	/* Talk to the user */
    407 	printf("\nNetBSD/integrator booting ...\n");
    408 
    409 #if 0
    410 	if (intbootinfo.bt_magic != BT_MAGIC_NUMBER_EBSA
    411 	    && intbootinfo.bt_magic != BT_MAGIC_NUMBER_CATS)
    412 		panic("Incompatible magic number passed in boot args\n");
    413 #endif
    414 
    415 /*	{
    416 	int loop;
    417 	for (loop = 0; loop < 8; ++loop) {
    418 		printf("%08x\n", *(((int *)bootinfo)+loop));
    419 	}
    420 	}*/
    421 
    422 	/*
    423 	 * Ok we have the following memory map
    424 	 *
    425 	 * virtual address == physical address apart from the areas:
    426 	 * 0x00000000 -> 0x000fffff which is mapped to
    427 	 * top 1MB of physical memory
    428 	 * 0x00100000 -> 0x0fffffff which is mapped to
    429 	 * physical addresses 0x00100000 -> 0x0fffffff
    430 	 * 0x10000000 -> 0x1fffffff which is mapped to
    431 	 * physical addresses 0x00000000 -> 0x0fffffff
    432 	 * 0x20000000 -> 0xefffffff which is mapped to
    433 	 * physical addresses 0x20000000 -> 0xefffffff
    434 	 * 0xf0000000 -> 0xf03fffff which is mapped to
    435 	 * physical addresses 0x00000000 -> 0x003fffff
    436 	 *
    437 	 * This means that the kernel is mapped suitably for continuing
    438 	 * execution, all I/O is mapped 1:1 virtual to physical and
    439 	 * physical memory is accessible.
    440 	 *
    441 	 * The initarm() has the responsibility for creating the kernel
    442 	 * page tables.
    443 	 * It must also set up various memory pointers that are used
    444 	 * by pmap etc.
    445 	 */
    446 
    447 	/*
    448 	 * Examine the boot args string for options we need to know about
    449 	 * now.
    450 	 */
    451 #if 0
    452 	process_kernel_args((char *)intbootinfo.bt_args);
    453 #endif
    454 
    455 	printf("initarm: Configuring system ...\n");
    456 
    457 	/*
    458 	 * Set up the variables that define the availablilty of
    459 	 * physical memory
    460 	 */
    461 	physical_start = 0 /*intbootinfo.bt_memstart*/;
    462 	physical_freestart = physical_start;
    463 
    464 #if 0
    465 	physical_end = /*intbootinfo.bt_memend*/ /*intbootinfo.bi_nrpages * NBPG */ 32*1024*1024;
    466 #else
    467 	{
    468 		volatile unsigned long *cm_sdram
    469 		    = (volatile unsigned long *)0x10000020;
    470 
    471 		switch ((*cm_sdram >> 2) & 0x7)
    472 		{
    473 		case 0:
    474 			physical_end = 16 * 1024 * 1024;
    475 			break;
    476 		case 1:
    477 			physical_end = 32 * 1024 * 1024;
    478 			break;
    479 		case 2:
    480 			physical_end = 64 * 1024 * 1024;
    481 			break;
    482 		case 3:
    483 			physical_end = 128 * 1024 * 1024;
    484 			break;
    485 		case 4:
    486 			physical_end = 256 * 1024 * 1024;
    487 			break;
    488 		default:
    489 			printf("CM_SDRAM retuns unknown value, using 16M\n");
    490 			physical_end = 16 * 1024 * 1024;
    491 			break;
    492 		}
    493 	}
    494 #endif
    495 
    496 	physical_freeend = physical_end;
    497 	free_pages = (physical_end - physical_start) / NBPG;
    498 
    499 	/* Set up the bootconfig structure for the benefit of pmap.c */
    500 	bootconfig.dramblocks = 1;
    501 	bootconfig.dram[0].address = physical_start;
    502 	bootconfig.dram[0].pages = free_pages;
    503 
    504 	physmem = (physical_end - physical_start) / NBPG;
    505 
    506 	/* Tell the user about the memory */
    507 	printf("physmemory: %d pages at 0x%08lx -> 0x%08lx\n", physmem,
    508 	    physical_start, physical_end - 1);
    509 
    510 	/*
    511 	 * Ok the kernel occupies the bottom of physical memory.
    512 	 * The first free page after the kernel can be found in
    513 	 * intbootinfo->bt_memavail
    514 	 * We now need to allocate some fixed page tables to get the kernel
    515 	 * going.
    516 	 * We allocate one page directory and a number page tables and store
    517 	 * the physical addresses in the kernel_pt_table array.
    518 	 *
    519 	 * Ok the next bit of physical allocation may look complex but it is
    520 	 * simple really. I have done it like this so that no memory gets
    521 	 * wasted during the allocation of various pages and tables that are
    522 	 * all different sizes.
    523 	 * The start addresses will be page aligned.
    524 	 * We allocate the kernel page directory on the first free 16KB boundry
    525 	 * we find.
    526 	 * We allocate the kernel page tables on the first 4KB boundry we find.
    527 	 * Since we allocate at least 3 L2 pagetables we know that we must
    528 	 * encounter at least one 16KB aligned address.
    529 	 */
    530 
    531 #ifdef VERBOSE_INIT_ARM
    532 	printf("Allocating page tables\n");
    533 #endif
    534 
    535 	/* Update the address of the first free 16KB chunk of physical memory */
    536         physical_freestart = ((uintptr_t) &end - KERNEL_TEXT_BASE + PGOFSET)
    537 	    & ~PGOFSET;
    538 #if 0
    539         physical_freestart += (kernexec->a_syms + sizeof(int)
    540 		    + *(u_int *)((int)end + kernexec->a_syms + sizeof(int))
    541 		    + (NBPG - 1)) & ~(NBPG - 1);
    542 #endif
    543 
    544 	free_pages -= (physical_freestart - physical_start) / NBPG;
    545 #ifdef VERBOSE_INIT_ARM
    546 	printf("freestart = %#lx, free_pages = %d (%#x)\n",
    547 	       physical_freestart, free_pages, free_pages);
    548 #endif
    549 
    550 	/* Define a macro to simplify memory allocation */
    551 #define	valloc_pages(var, np)			\
    552 	alloc_pages((var).pv_pa, (np));		\
    553 	(var).pv_va = KERNEL_TEXT_BASE + (var).pv_pa - physical_start;
    554 
    555 #define alloc_pages(var, np)			\
    556 	(var) = physical_freestart;		\
    557 	physical_freestart += ((np) * NBPG);	\
    558 	free_pages -= (np);			\
    559 	memset((char *)(var), 0, ((np) * NBPG));
    560 
    561 	loop1 = 0;
    562 	kernel_l1pt.pv_pa = 0;
    563 	for (loop = 0; loop <= NUM_KERNEL_PTS; ++loop) {
    564 		/* Are we 16KB aligned for an L1 ? */
    565 		if ((physical_freestart & (PD_SIZE - 1)) == 0
    566 		    && kernel_l1pt.pv_pa == 0) {
    567 			valloc_pages(kernel_l1pt, PD_SIZE / NBPG);
    568 		} else {
    569 			alloc_pages(kernel_pt_table[loop1], PT_SIZE / NBPG);
    570 			++loop1;
    571 		}
    572 	}
    573 
    574 	/* This should never be able to happen but better confirm that. */
    575 	if (!kernel_l1pt.pv_pa || (kernel_l1pt.pv_pa & (PD_SIZE-1)) != 0)
    576 		panic("initarm: Failed to align the kernel page directory\n");
    577 
    578 	/*
    579 	 * Allocate a page for the system page mapped to V0x00000000
    580 	 * This page will just contain the system vectors and can be
    581 	 * shared by all processes.
    582 	 */
    583 	alloc_pages(systempage.pv_pa, 1);
    584 
    585 	/* Allocate a page for the page table to map kernel page tables*/
    586 	valloc_pages(kernel_ptpt, PT_SIZE / NBPG);
    587 
    588 	/* Allocate stacks for all modes */
    589 	valloc_pages(irqstack, IRQ_STACK_SIZE);
    590 	valloc_pages(abtstack, ABT_STACK_SIZE);
    591 	valloc_pages(undstack, UND_STACK_SIZE);
    592 	valloc_pages(kernelstack, UPAGES);
    593 
    594 #ifdef VERBOSE_INIT_ARM
    595 	printf("IRQ stack: p0x%08lx v0x%08lx\n", irqstack.pv_pa, irqstack.pv_va);
    596 	printf("ABT stack: p0x%08lx v0x%08lx\n", abtstack.pv_pa, abtstack.pv_va);
    597 	printf("UND stack: p0x%08lx v0x%08lx\n", undstack.pv_pa, undstack.pv_va);
    598 	printf("SVC stack: p0x%08lx v0x%08lx\n", kernelstack.pv_pa, kernelstack.pv_va);
    599 #endif
    600 
    601 	alloc_pages(msgbufphys, round_page(MSGBUFSIZE) / NBPG);
    602 
    603 	/*
    604 	 * Ok we have allocated physical pages for the primary kernel
    605 	 * page tables
    606 	 */
    607 
    608 #ifdef VERBOSE_INIT_ARM
    609 	printf("Creating L1 page table at %#lx\n", kernel_l1pt.pv_pa);
    610 #endif
    611 
    612 	/*
    613 	 * Now we start consturction of the L1 page table
    614 	 * We start by mapping the L2 page tables into the L1.
    615 	 * This means that we can replace L1 mappings later on if necessary
    616 	 */
    617 	l1pagetable = kernel_l1pt.pv_pa;
    618 
    619 	/* Map the L2 pages tables in the L1 page table */
    620 	map_pagetable(l1pagetable, 0x00000000,
    621 	    kernel_pt_table[KERNEL_PT_SYS]);
    622 	map_pagetable(l1pagetable, KERNEL_BASE,
    623 	    kernel_pt_table[KERNEL_PT_KERNEL]);
    624 	for (loop = 0; loop < KERNEL_PT_VMDATA_NUM; ++loop)
    625 		map_pagetable(l1pagetable, KERNEL_VM_BASE + loop * 0x00400000,
    626 		    kernel_pt_table[KERNEL_PT_VMDATA + loop]);
    627 	map_pagetable(l1pagetable, PROCESS_PAGE_TBLS_BASE,
    628 	    kernel_ptpt.pv_pa);
    629 
    630 #ifdef VERBOSE_INIT_ARM
    631 	printf("Mapping kernel\n");
    632 #endif
    633 
    634 	/* Now we fill in the L2 pagetable for the kernel static code/data */
    635 	l2pagetable = kernel_pt_table[KERNEL_PT_KERNEL];
    636 
    637 	{
    638 		u_int logical;
    639 		size_t textsize = (uintptr_t) &etext - KERNEL_TEXT_BASE;
    640 		size_t totalsize = (uintptr_t) &end - KERNEL_TEXT_BASE;
    641 
    642 		/* Round down text size and round up total size
    643 		 */
    644 		textsize = textsize & ~PGOFSET;
    645 		totalsize = (totalsize + PGOFSET) & ~PGOFSET;
    646 		/* logical  = map_chunk(l1pagetable, l2pagetable, KERNEL_BASE,
    647 		    physical_start, KERNEL_TEXT_BASE - KERNEL_BASE,
    648 		    AP_KRW, PT_CACHEABLE); */
    649 		logical = map_chunk(l1pagetable, l2pagetable,
    650 		    KERNEL_TEXT_BASE, physical_start, textsize,
    651 		    AP_KRW, PT_CACHEABLE);
    652 		logical += map_chunk(l1pagetable, l2pagetable,
    653 		    KERNEL_TEXT_BASE + logical, physical_start + logical,
    654 		    totalsize - textsize, AP_KRW, PT_CACHEABLE);
    655 #if 0
    656 		logical += map_chunk(0, l2pagetable, KERNEL_BASE + logical,
    657 		    physical_start + logical, kernexec->a_syms + sizeof(int)
    658 		    + *(u_int *)((int)end + kernexec->a_syms + sizeof(int)),
    659 		    AP_KRW, PT_CACHEABLE);
    660 #endif
    661 	}
    662 
    663 #ifdef VERBOSE_INIT_ARM
    664 	printf("Constructing L2 page tables\n");
    665 #endif
    666 
    667 	/* Map the boot arguments page */
    668 #if 0
    669 	map_entry_ro(l2pagetable, intbootinfo.bt_vargp, intbootinfo.bt_pargp);
    670 #endif
    671 
    672 	/* Map the stack pages */
    673 	map_chunk(0, l2pagetable, irqstack.pv_va, irqstack.pv_pa,
    674 	    IRQ_STACK_SIZE * NBPG, AP_KRW, PT_CACHEABLE);
    675 	map_chunk(0, l2pagetable, abtstack.pv_va, abtstack.pv_pa,
    676 	    ABT_STACK_SIZE * NBPG, AP_KRW, PT_CACHEABLE);
    677 	map_chunk(0, l2pagetable, undstack.pv_va, undstack.pv_pa,
    678 	    UND_STACK_SIZE * NBPG, AP_KRW, PT_CACHEABLE);
    679 	map_chunk(0, l2pagetable, kernelstack.pv_va, kernelstack.pv_pa,
    680 	    UPAGES * NBPG, AP_KRW, PT_CACHEABLE);
    681 	map_chunk(0, l2pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
    682 	    PD_SIZE, AP_KRW, 0);
    683 
    684 	/* Map the page table that maps the kernel pages */
    685 	map_entry_nc(l2pagetable, kernel_ptpt.pv_pa, kernel_ptpt.pv_pa);
    686 
    687 	/*
    688 	 * Map entries in the page table used to map PTE's
    689 	 * Basically every kernel page table gets mapped here
    690 	 */
    691 	/* The -2 is slightly bogus, it should be -log2(sizeof(pt_entry_t)) */
    692 	l2pagetable = kernel_ptpt.pv_pa;
    693 	map_entry_nc(l2pagetable, (KERNEL_BASE >> (PGSHIFT-2)),
    694 	    kernel_pt_table[KERNEL_PT_KERNEL]);
    695 	map_entry_nc(l2pagetable, (PROCESS_PAGE_TBLS_BASE >> (PGSHIFT-2)),
    696 	    kernel_ptpt.pv_pa);
    697 	map_entry_nc(l2pagetable, (0x00000000 >> (PGSHIFT-2)),
    698 	    kernel_pt_table[KERNEL_PT_SYS]);
    699 	for (loop = 0; loop < KERNEL_PT_VMDATA_NUM; ++loop)
    700 		map_entry_nc(l2pagetable, ((KERNEL_VM_BASE +
    701 		    (loop * 0x00400000)) >> (PGSHIFT-2)),
    702 		    kernel_pt_table[KERNEL_PT_VMDATA + loop]);
    703 
    704 	/*
    705 	 * Map the system page in the kernel page table for the bottom 1Meg
    706 	 * of the virtual memory map.
    707 	 */
    708 	l2pagetable = kernel_pt_table[KERNEL_PT_SYS];
    709 #if 1
    710 	/* MULTI-ICE requires that page 0 is NC/NB so that it can download
    711 	   the cache-clean code there.  */
    712 	map_entry_nc(l2pagetable, 0x00000000, systempage.pv_pa);
    713 #else
    714 	map_entry_nc(l2pagetable, 0x00000000, systempage.pv_pa);
    715 #endif
    716 	/* Map the core memory needed before autoconfig */
    717 	loop = 0;
    718 	while (l1_sec_table[loop].size) {
    719 		vm_size_t sz;
    720 
    721 #ifdef VERBOSE_INIT_ARM
    722 		printf("%08lx -> %08lx @ %08lx\n", l1_sec_table[loop].pa,
    723 		    l1_sec_table[loop].pa + l1_sec_table[loop].size - 1,
    724 		    l1_sec_table[loop].va);
    725 #endif
    726 		for (sz = 0; sz < l1_sec_table[loop].size; sz += L1_SEC_SIZE)
    727 			map_section(l1pagetable, l1_sec_table[loop].va + sz,
    728 			    l1_sec_table[loop].pa + sz,
    729 			    l1_sec_table[loop].flags);
    730 		++loop;
    731 	}
    732 
    733 	/*
    734 	 * Now we have the real page tables in place so we can switch to them.
    735 	 * Once this is done we will be running with the REAL kernel page tables.
    736 	 */
    737 
    738 	/* Switch tables */
    739 #ifdef VERBOSE_INIT_ARM
    740 	printf("freestart = %#lx, free_pages = %d (%#x)\n",
    741 	       physical_freestart, free_pages, free_pages);
    742 	printf("switching to new L1 page table  @%#lx...", kernel_l1pt.pv_pa);
    743 #endif
    744 
    745 	setttb(kernel_l1pt.pv_pa);
    746 
    747 #ifdef VERBOSE_INIT_ARM
    748 	printf("done!\n");
    749 #endif
    750 
    751 #ifdef PLCONSOLE
    752 	/*
    753 	 * The IFPGA registers have just moved.
    754 	 * Detach the diagnostic serial port and reattach at the new address.
    755 	 */
    756 	plcomcndetach();
    757 #endif
    758 
    759 	/*
    760 	 * XXX this should only be done in main() but it useful to
    761 	 * have output earlier ...
    762 	 */
    763 	consinit();
    764 
    765 #ifdef VERBOSE_INIT_ARM
    766 	printf("bootstrap done.\n");
    767 #endif
    768 
    769 	/* Right set up the vectors at the bottom of page 0 */
    770 	memcpy((char *)0x00000000, page0, page0_end - page0);
    771 
    772 	/* We have modified a text page so sync the icache */
    773 	cpu_icache_sync_all();
    774 
    775 	/*
    776 	 * Pages were allocated during the secondary bootstrap for the
    777 	 * stacks for different CPU modes.
    778 	 * We must now set the r13 registers in the different CPU modes to
    779 	 * point to these stacks.
    780 	 * Since the ARM stacks use STMFD etc. we must set r13 to the top end
    781 	 * of the stack memory.
    782 	 */
    783 	printf("init subsystems: stacks ");
    784 
    785 	set_stackptr(PSR_IRQ32_MODE, irqstack.pv_va + IRQ_STACK_SIZE * NBPG);
    786 	set_stackptr(PSR_ABT32_MODE, abtstack.pv_va + ABT_STACK_SIZE * NBPG);
    787 	set_stackptr(PSR_UND32_MODE, undstack.pv_va + UND_STACK_SIZE * NBPG);
    788 
    789 	/*
    790 	 * Well we should set a data abort handler.
    791 	 * Once things get going this will change as we will need a proper handler.
    792 	 * Until then we will use a handler that just panics but tells us
    793 	 * why.
    794 	 * Initialisation of the vectors will just panic on a data abort.
    795 	 * This just fills in a slighly better one.
    796 	 */
    797 	printf("vectors ");
    798 	data_abort_handler_address = (u_int)data_abort_handler;
    799 	prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
    800 	undefined_handler_address = (u_int)undefinedinstruction_bounce;
    801 
    802 	/* At last !
    803 	 * We now have the kernel in physical memory from the bottom upwards.
    804 	 * Kernel page tables are physically above this.
    805 	 * The kernel is mapped to KERNEL_TEXT_BASE
    806 	 * The kernel data PTs will handle the mapping of 0xf1000000-0xf3ffffff
    807 	 * The page tables are mapped to 0xefc00000
    808 	 */
    809 
    810 	/* Initialise the undefined instruction handlers */
    811 	printf("undefined ");
    812 	undefined_init();
    813 
    814 	/* Boot strap pmap telling it where the kernel page table is */
    815 	printf("pmap ");
    816 	pmap_bootstrap((pd_entry_t *)kernel_l1pt.pv_va, kernel_ptpt);
    817 
    818 	/* Setup the IRQ system */
    819 	printf("irq ");
    820 	irq_init();
    821 
    822 	printf("done.\n");
    823 
    824 #ifdef IPKDB
    825 	/* Initialise ipkdb */
    826 	ipkdb_init();
    827 	if (boothowto & RB_KDB)
    828 		ipkdb_connect(0);
    829 #endif
    830 
    831 #ifdef DDB
    832 	db_machine_init();
    833 
    834 	/* Firmware doesn't load symbols. */
    835 	ddb_init(0, NULL, NULL);
    836 
    837 	if (boothowto & RB_KDB)
    838 		Debugger();
    839 #endif
    840 
    841 	/* We return the new stack pointer address */
    842 	return(kernelstack.pv_va + USPACE_SVC_STACK_TOP);
    843 }
    844 
    845 void
    846 process_kernel_args(args)
    847 	char *args;
    848 {
    849 
    850 	boothowto = 0;
    851 
    852 	/* Make a local copy of the bootargs */
    853 	strncpy(bootargs, args, MAX_BOOT_STRING);
    854 
    855 	args = bootargs;
    856 	boot_file = bootargs;
    857 
    858 	/* Skip the kernel image filename */
    859 	while (*args != ' ' && *args != 0)
    860 		++args;
    861 
    862 	if (*args != 0)
    863 		*args++ = 0;
    864 
    865 	while (*args == ' ')
    866 		++args;
    867 
    868 	boot_args = args;
    869 
    870 	printf("bootfile: %s\n", boot_file);
    871 	printf("bootargs: %s\n", boot_args);
    872 
    873 	parse_mi_bootargs(boot_args);
    874 }
    875 
    876 void
    877 consinit(void)
    878 {
    879 	static int consinit_called = 0;
    880 #if NPLCOM > 0 && defined(PLCONSOLE)
    881 	static struct bus_space plcom_bus_space;
    882 #endif
    883 #if 0
    884 	char *console = CONSDEVNAME;
    885 #endif
    886 
    887 	if (consinit_called != 0)
    888 		return;
    889 
    890 	consinit_called = 1;
    891 
    892 #if NPLCOM > 0 && defined(PLCONSOLE)
    893 	if (PLCOMCNUNIT == 0) {
    894 		ifpga_create_io_bs_tag(&plcom_bus_space,
    895 		    (void*)UART0_BOOT_BASE);
    896 		if (plcomcnattach(&plcom_bus_space, 0, plcomcnspeed,
    897 		    IFPGA_UART_CLK, plcomcnmode, PLCOMCNUNIT))
    898 			panic("can't init serial console");
    899 		return;
    900 	} else if (PLCOMCNUNIT == 1) {
    901 		ifpga_create_io_bs_tag(&plcom_bus_space,
    902 		    (void*)UART0_BOOT_BASE);
    903 		if (plcomcnattach(&plcom_bus_space, 0, plcomcnspeed,
    904 		    IFPGA_UART_CLK, plcomcnmode, PLCOMCNUNIT))
    905 			panic("can't init serial console");
    906 		return;
    907 	}
    908 #endif
    909 #if (NCOM > 0)
    910 	if (comcnattach(&isa_io_bs_tag, CONCOMADDR, comcnspeed,
    911 	    COM_FREQ, comcnmode))
    912 		panic("can't init serial console @%x", CONCOMADDR);
    913 	return;
    914 #endif
    915 	panic("No serial console configured");
    916 }
    917 
    918 #if 0
    919 static bus_space_handle_t kcom_base = (bus_space_handle_t) (DC21285_PCI_IO_VBASE + CONCOMADDR);
    920 
    921 u_int8_t footbridge_bs_r_1(void *, bus_space_handle_t, bus_size_t);
    922 void footbridge_bs_w_1(void *, bus_space_handle_t, bus_size_t, u_int8_t);
    923 
    924 #define	KCOM_GETBYTE(r)		footbridge_bs_r_1(0, kcom_base, (r))
    925 #define	KCOM_PUTBYTE(r,v)	footbridge_bs_w_1(0, kcom_base, (r), (v))
    926 
    927 static int
    928 kcomcngetc(dev_t dev)
    929 {
    930 	int stat, c;
    931 
    932 	/* block until a character becomes available */
    933 	while (!ISSET(stat = KCOM_GETBYTE(com_lsr), LSR_RXRDY))
    934 		;
    935 
    936 	c = KCOM_GETBYTE(com_data);
    937 	stat = KCOM_GETBYTE(com_iir);
    938 	return c;
    939 }
    940 
    941 /*
    942  * Console kernel output character routine.
    943  */
    944 static void
    945 kcomcnputc(dev_t dev, int c)
    946 {
    947 	int timo;
    948 
    949 	/* wait for any pending transmission to finish */
    950 	timo = 150000;
    951 	while (!ISSET(KCOM_GETBYTE(com_lsr), LSR_TXRDY) && --timo)
    952 		continue;
    953 
    954 	KCOM_PUTBYTE(com_data, c);
    955 
    956 	/* wait for this transmission to complete */
    957 	timo = 1500000;
    958 	while (!ISSET(KCOM_GETBYTE(com_lsr), LSR_TXRDY) && --timo)
    959 		continue;
    960 }
    961 
    962 static void
    963 kcomcnpollc(dev_t dev, int on)
    964 {
    965 }
    966 
    967 struct consdev kcomcons = {
    968 	NULL, NULL, kcomcngetc, kcomcnputc, kcomcnpollc, NULL,
    969 	NODEV, CN_NORMAL
    970 };
    971 
    972 #endif
    973