xref: /netbsd-src/sys/arch/evbarm/smdk2xx0/smdk2800_machdep.c (revision 2980e352a13e8f0b545a366830c411e7a542ada8)
1 /*	$NetBSD: smdk2800_machdep.c,v 1.26 2008/04/27 18:58:47 matt Exp $ */
2 
3 /*
4  * Copyright (c) 2002, 2003, 2005 Fujitsu Component Limited
5  * Copyright (c) 2002, 2003, 2005 Genetec Corporation
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  * 3. Neither the name of The Fujitsu Component Limited nor the name of
17  *    Genetec corporation may not be used to endorse or promote products
18  *    derived from this software without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY FUJITSU COMPONENT LIMITED AND GENETEC
21  * CORPORATION ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES,
22  * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
23  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
24  * DISCLAIMED.  IN NO EVENT SHALL FUJITSU COMPONENT LIMITED OR GENETEC
25  * CORPORATION BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
28  * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
29  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
30  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
31  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32  * SUCH DAMAGE.
33  */
34 
35 /*
36  * Copyright (c) 2001,2002 ARM Ltd
37  * All rights reserved.
38  *
39  * Redistribution and use in source and binary forms, with or without
40  * modification, are permitted provided that the following conditions
41  * are met:
42  * 1. Redistributions of source code must retain the above copyright
43  *    notice, this list of conditions and the following disclaimer.
44  * 2. Redistributions in binary form must reproduce the above copyright
45  *    notice, this list of conditions and the following disclaimer in the
46  *    documentation and/or other materials provided with the distribution.
47  * 3. The name of the company may not be used to endorse or promote
48  *    products derived from this software without specific prior written
49  *    permission.
50  *
51  * THIS SOFTWARE IS PROVIDED BY ARM LTD ``AS IS'' AND
52  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
53  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
54  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ARM LTD
55  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
56  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
57  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
58  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
59  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
60  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
61  * POSSIBILITY OF SUCH DAMAGE.
62  *
63  */
64 
65 /*
66  * Copyright (c) 1997,1998 Mark Brinicombe.
67  * Copyright (c) 1997,1998 Causality Limited.
68  * All rights reserved.
69  *
70  * Redistribution and use in source and binary forms, with or without
71  * modification, are permitted provided that the following conditions
72  * are met:
73  * 1. Redistributions of source code must retain the above copyright
74  *    notice, this list of conditions and the following disclaimer.
75  * 2. Redistributions in binary form must reproduce the above copyright
76  *    notice, this list of conditions and the following disclaimer in the
77  *    documentation and/or other materials provided with the distribution.
78  * 3. All advertising materials mentioning features or use of this software
79  *    must display the following acknowledgement:
80  *	This product includes software developed by Mark Brinicombe
81  *	for the NetBSD Project.
82  * 4. The name of the company nor the name of the author may be used to
83  *    endorse or promote products derived from this software without specific
84  *    prior written permission.
85  *
86  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
87  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
88  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
89  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
90  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
91  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
92  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
93  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
94  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
95  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
96  * SUCH DAMAGE.
97  *
98  * Machine dependant functions for kernel setup for integrator board
99  *
100  * Created      : 24/11/97
101  */
102 
103 /*
104  * Machine dependant functions for kernel setup for Samsung SMDK2800
105  * derived from integrator_machdep.c
106  */
107 
108 #include <sys/cdefs.h>
109 __KERNEL_RCSID(0, "$NetBSD: smdk2800_machdep.c,v 1.26 2008/04/27 18:58:47 matt Exp $");
110 
111 #include "opt_ddb.h"
112 #include "opt_kgdb.h"
113 #include "opt_pmap_debug.h"
114 #include "opt_md.h"
115 #include "pci.h"
116 
117 #include <sys/param.h>
118 #include <sys/device.h>
119 #include <sys/systm.h>
120 #include <sys/kernel.h>
121 #include <sys/exec.h>
122 #include <sys/proc.h>
123 #include <sys/msgbuf.h>
124 #include <sys/reboot.h>
125 #include <sys/termios.h>
126 #include <sys/ksyms.h>
127 
128 #include <uvm/uvm_extern.h>
129 
130 #include <dev/cons.h>
131 #include <dev/md.h>
132 
133 #include <machine/db_machdep.h>
134 #include <ddb/db_sym.h>
135 #include <ddb/db_extern.h>
136 #ifdef KGDB
137 #include <sys/kgdb.h>
138 #endif
139 
140 #include <machine/bootconfig.h>
141 #include <machine/bus.h>
142 #include <machine/cpu.h>
143 #include <machine/frame.h>
144 #include <machine/intr.h>
145 #include <arm/undefined.h>
146 
147 #include <arm/arm32/machdep.h>
148 
149 #include <arm/s3c2xx0/s3c2800reg.h>
150 #include <arm/s3c2xx0/s3c2800var.h>
151 #include <evbarm/smdk2xx0/smdk2800var.h>
152 
153 #include "ksyms.h"
154 
155 /* Kernel text starts 2MB in from the bottom of the kernel address space. */
156 #define	KERNEL_TEXT_BASE	(KERNEL_BASE + 0x00200000)
157 #define	KERNEL_VM_BASE		(KERNEL_BASE + 0x01000000)
158 
159 /*
160  * The range 0xc1000000 - 0xccffffff is available for kernel VM space
161  * Core-logic registers and I/O mappings occupy 0xfd000000 - 0xffffffff
162  */
163 #define KERNEL_VM_SIZE		0x0C000000
164 
165 /* Memory disk support */
166 #if defined(MEMORY_DISK_DYNAMIC) && defined(MEMORY_DISK_ROOT_ADDR)
167 #define DO_MEMORY_DISK
168 /* We have memory disk image outside of the kernel on ROM. */
169 #ifdef MEMORY_DISK_ROOT_ROM
170 /* map the image directory and use read-only */
171 #else
172 /* copy the image to RAM */
173 #endif
174 #endif
175 
176 
177 /*
178  * Address to call from cpu_reset() to reset the machine.
179  * This is machine architecture dependant as it varies depending
180  * on where the ROM appears when you turn the MMU off.
181  */
182 u_int cpu_reset_address = (u_int)0;
183 
184 /* Define various stack sizes in pages */
185 #define IRQ_STACK_SIZE	1
186 #define ABT_STACK_SIZE	1
187 #define UND_STACK_SIZE	1
188 
189 BootConfig bootconfig;		/* Boot config storage */
190 char *boot_args = NULL;
191 char *boot_file = NULL;
192 
193 vm_offset_t physical_start;
194 vm_offset_t physical_freestart;
195 vm_offset_t physical_freeend;
196 vm_offset_t physical_end;
197 u_int free_pages;
198 vm_offset_t pagetables_start;
199 int physmem = 0;
200 
201 /*int debug_flags;*/
202 #ifndef PMAP_STATIC_L1S
203 int max_processes = 64;		/* Default number */
204 #endif				/* !PMAP_STATIC_L1S */
205 
206 /* Physical and virtual addresses for some global pages */
207 pv_addr_t irqstack;
208 pv_addr_t undstack;
209 pv_addr_t abtstack;
210 pv_addr_t kernelstack;
211 
212 vm_offset_t msgbufphys;
213 
214 extern u_int data_abort_handler_address;
215 extern u_int prefetch_abort_handler_address;
216 extern u_int undefined_handler_address;
217 
218 #ifdef PMAP_DEBUG
219 extern int pmap_debug_level;
220 #endif
221 
222 #define KERNEL_PT_SYS		0	/* L2 table for mapping zero page */
223 #define KERNEL_PT_KERNEL	1	/* L2 table for mapping kernel */
224 #define	KERNEL_PT_KERNEL_NUM	2	/* L2 tables for mapping kernel VM */
225 
226 #define KERNEL_PT_VMDATA	(KERNEL_PT_KERNEL + KERNEL_PT_KERNEL_NUM)
227 
228 #define	KERNEL_PT_VMDATA_NUM	4	/* start with 16MB of KVM */
229 #define NUM_KERNEL_PTS		(KERNEL_PT_VMDATA + KERNEL_PT_VMDATA_NUM)
230 
231 pv_addr_t kernel_pt_table[NUM_KERNEL_PTS];
232 
233 struct user *proc0paddr;
234 
235 /* Prototypes */
236 
237 void consinit(void);
238 void kgdb_port_init(void);
239 
240 /* A load of console goo. */
241 #include "vga.h"
242 #if NVGA > 0
243 #include <dev/ic/mc6845reg.h>
244 #include <dev/ic/pcdisplayvar.h>
245 #include <dev/ic/vgareg.h>
246 #include <dev/ic/vgavar.h>
247 #endif
248 
249 #include "com.h"
250 #if NCOM > 0
251 #include <dev/ic/comreg.h>
252 #include <dev/ic/comvar.h>
253 #endif
254 
255 #include "sscom.h"
256 #if NSSCOM > 0
257 #include "opt_sscom.h"
258 #include <arm/s3c2xx0/sscom_var.h>
259 #endif
260 
261 /*
262  * Define the default console speed for the board.  This is generally
263  * what the firmware provided with the board defaults to.
264  */
265 #ifndef CONSPEED
266 #define CONSPEED B115200	/* TTYDEF_SPEED */
267 #endif
268 #ifndef CONMODE
269 #define CONMODE ((TTYDEF_CFLAG & ~(CSIZE | CSTOPB | PARENB)) | CS8)   /* 8N1 */
270 #endif
271 
272 int comcnspeed = CONSPEED;
273 int comcnmode = CONMODE;
274 
275 /*
276  * void cpu_reboot(int howto, char *bootstr)
277  *
278  * Reboots the system
279  *
280  * Deal with any syncing, unmounting, dumping and shutdown hooks,
281  * then reset the CPU.
282  */
283 void
284 cpu_reboot(int howto, char *bootstr)
285 {
286 
287 	cpu_reset_address = vtophys((u_int)s3c2800_softreset);
288 
289 	/*
290 	 * If we are still cold then hit the air brakes
291 	 * and crash to earth fast
292 	 */
293 	if (cold) {
294 		doshutdownhooks();
295 		printf("The operating system has halted.\n");
296 		printf("Please press any key to reboot.\n\n");
297 		cngetc();
298 		printf("rebooting...\n");
299 		cpu_reset();
300 		/* NOTREACHED */
301 	}
302 	/* Disable console buffering */
303 
304 	/*
305 	 * If RB_NOSYNC was not specified sync the discs.
306 	 * Note: Unless cold is set to 1 here, syslogd will die during the
307 	 * unmount.  It looks like syslogd is getting woken up only to find
308 	 * that it cannot page part of the binary in as the filesystem has
309 	 * been unmounted.
310 	 */
311 	if (!(howto & RB_NOSYNC))
312 		bootsync();
313 
314 	/* Say NO to interrupts */
315 	splhigh();
316 
317 	/* Do a dump if requested. */
318 	if ((howto & (RB_DUMP | RB_HALT)) == RB_DUMP)
319 		dumpsys();
320 
321 	/* Run any shutdown hooks */
322 	doshutdownhooks();
323 
324 	/* Make sure IRQ's are disabled */
325 	IRQdisable;
326 
327 	if (howto & RB_HALT) {
328 		printf("The operating system has halted.\n");
329 		printf("Please press any key to reboot.\n\n");
330 		cngetc();
331 	}
332 	printf("rebooting...\n");
333 	cpu_reset();
334 	/* NOTREACHED */
335 }
336 
337 /*
338  * All built-in peripheral registers are statically mapped in start up
339  * routine.  This table tells pmap subsystem about it, and to map them
340  * at the same position.
341  */
342 static const struct pmap_devmap smdk2800_devmap[] = {
343 	{
344 		SMDK2800_IO_AREA_VBASE,
345 		S3C2800_PERIPHERALS,
346 		S3C2800_PERIPHERALS_SIZE,
347 		VM_PROT_READ|VM_PROT_WRITE, PTE_NOCACHE,
348 	},
349 	{ 0, 0, 0, 0 }
350 };
351 
352 #define ioreg_vaddr(pa)	((pa) - S3C2800_PERIPHERALS + SMDK2800_IO_AREA_VBASE)
353 #define	ioreg32(pa)	(*(volatile uint32_t *)ioreg_vaddr(pa))
354 
355 /*
356  * u_int initarm(...)
357  *
358  * Initial entry point on startup. This gets called before main() is
359  * entered.
360  * It should be responsible for setting up everything that must be
361  * in place when main is called.
362  * This includes
363  *   Taking a copy of the boot configuration structure.
364  *   Initialising the physical console so characters can be printed.
365  *   Setting up page tables for the kernel
366  *   Relocating the kernel to the bottom of physical memory
367  */
368 
369 u_int
370 initarm(void *arg)
371 {
372 	int loop;
373 	int loop1;
374 	u_int l1pagetable;
375 	extern int etext __asm("_etext");
376 	extern int end __asm("_end");
377 	int progress_counter = 0;
378 
379 #ifdef DO_MEMORY_DISK
380 	vm_offset_t md_root_start;
381 #define MD_ROOT_SIZE (MEMORY_DISK_ROOT_SIZE * DEV_BSIZE)
382 #endif
383 
384 #define gpio8(reg) (*(volatile uint8_t *)(ioreg_vaddr(S3C2800_GPIO_BASE) + (reg)))
385 
386 #define LEDSTEP()  __LED(progress_counter++)
387 
388 #define pdatc gpio8(GPIO_PDATC)
389 #define __LED(x)  (pdatc = (pdatc & ~0x07) | (~(x) & 0x07))
390 
391 	LEDSTEP();
392 	/*
393 	 * Heads up ... Setup the CPU / MMU / TLB functions
394 	 */
395 	if (set_cpufuncs())
396 		panic("CPU not recognized!");
397 
398 	LEDSTEP();
399 
400 
401 	/* Disable all peripheral interrupts */
402 	ioreg32(S3C2800_INTCTL_BASE + INTCTL_INTMSK) = 0;
403 
404 	consinit();
405 #ifdef VERBOSE_INIT_ARM
406 	printf("consinit done\n");
407 #endif
408 
409 #ifdef KGDB
410 	LEDSTEP();
411 	kgdb_port_init();
412 #endif
413 	LEDSTEP();
414 
415 #ifdef VERBOSE_INIT_ARM
416 	/* Talk to the user */
417 	printf("\nNetBSD/evbarm (SMDK2800) booting ...\n");
418 #endif
419 
420 	/*
421 	 * Ok we have the following memory map
422 	 *
423 	 * Physical Address Range     Description
424 	 * -----------------------    ----------------------------------
425 	 * 0x00000000 - 0x00ffffff    Intel flash Memory   (16MB)
426 	 * 0x02000000 - 0x020fffff    AMD flash Memory   (1MB)
427 	 * or 			       (depend on DIPSW setting)
428 	 * 0x00000000 - 0x000fffff    AMD flash Memory   (1MB)
429 	 * 0x02000000 - 0x02ffffff    Intel flash Memory   (16MB)
430 	 *
431 	 * 0x08000000 - 0x09ffffff    SDRAM (32MB)
432 	 * 0x20000000 - 0x3fffffff    PCI space
433 	 *
434 	 * The initarm() has the responsibility for creating the kernel
435 	 * page tables.
436 	 * It must also set up various memory pointers that are used
437 	 * by pmap etc.
438 	 */
439 
440 	/* Fake bootconfig structure for the benefit of pmap.c */
441 	/* XXX must make the memory description h/w independent */
442 	bootconfig.dramblocks = 1;
443 	bootconfig.dram[0].address = SDRAM_START;
444 	bootconfig.dram[0].pages = SDRAM_SIZE / PAGE_SIZE;
445 
446 	/*
447 	 * Set up the variables that define the availablilty of
448 	 * physical memory.  For now, we're going to set
449 	 * physical_freestart to 0x08200000 (where the kernel
450 	 * was loaded), and allocate the memory we need downwards.
451 	 * If we get too close to the bottom of SDRAM, we
452 	 * will panic.  We will update physical_freestart and
453 	 * physical_freeend later to reflect what pmap_bootstrap()
454 	 * wants to see.
455 	 *
456 	 * XXX pmap_bootstrap() needs an enema.
457 	 */
458 	physical_start = bootconfig.dram[0].address;
459 	physical_end = physical_start + (bootconfig.dram[0].pages * PAGE_SIZE);
460 
461 #if DO_MEMORY_DISK
462 #ifdef MEMORY_DISK_ROOT_ROM
463 	md_root_start = MEMORY_DISK_ROOT_ADDR;
464 	boothowto |= RB_RDONLY;
465 #else
466 	/* Reserve physmem for ram disk */
467 	md_root_start = ((physical_end - MD_ROOT_SIZE) & ~(L1_S_SIZE-1));
468 	printf("Reserve %ld bytes for memory disk\n",
469 	    physical_end - md_root_start);
470 	/* copy fs contents */
471 	memcpy((void *)md_root_start, (void *)MEMORY_DISK_ROOT_ADDR,
472 	    MD_ROOT_SIZE);
473 	physical_end = md_root_start;
474 #endif
475 #endif
476 
477 	physical_freestart = 0x08000000UL;	/* XXX */
478 	physical_freeend = 0x08200000UL;
479 
480 	physmem = (physical_end - physical_start) / PAGE_SIZE;
481 
482 #ifdef VERBOSE_INIT_ARM
483 	/* Tell the user about the memory */
484 	printf("physmemory: %d pages at 0x%08lx -> 0x%08lx\n", physmem,
485 	    physical_start, physical_end - 1);
486 #endif
487 
488 	/*
489 	 * XXX
490 	 * Okay, the kernel starts 2MB in from the bottom of physical
491 	 * memory.  We are going to allocate our bootstrap pages downwards
492 	 * from there.
493 	 *
494 	 * We need to allocate some fixed page tables to get the kernel
495 	 * going.  We allocate one page directory and a number of page
496 	 * tables and store the physical addresses in the kernel_pt_table
497 	 * array.
498 	 *
499 	 * The kernel page directory must be on a 16K boundary.  The page
500 	 * tables must be on 4K boundaries.  What we do is allocate the
501 	 * page directory on the first 16K boundary that we encounter, and
502 	 * the page tables on 4K boundaries otherwise.  Since we allocate
503 	 * at least 3 L2 page tables, we are guaranteed to encounter at
504 	 * least one 16K aligned region.
505 	 */
506 
507 #ifdef VERBOSE_INIT_ARM
508 	printf("Allocating page tables\n");
509 #endif
510 
511 	free_pages = (physical_freeend - physical_freestart) / PAGE_SIZE;
512 
513 #ifdef VERBOSE_INIT_ARM
514 	printf("freestart = 0x%08lx, free_pages = %d (0x%08x)\n",
515 	    physical_freestart, free_pages, free_pages);
516 #endif
517 
518 	/* Define a macro to simplify memory allocation */
519 #define	valloc_pages(var, np)				\
520 	alloc_pages((var).pv_pa, (np));			\
521 	(var).pv_va = KERNEL_BASE + (var).pv_pa - physical_start;
522 
523 #define alloc_pages(var, np)				\
524 	physical_freeend -= ((np) * PAGE_SIZE);		\
525 	if (physical_freeend < physical_freestart)	\
526 		panic("initarm: out of memory");	\
527 	(var) = physical_freeend;			\
528 	free_pages -= (np);				\
529 	memset((char *)(var), 0, ((np) * PAGE_SIZE));
530 
531 	loop1 = 0;
532 	for (loop = 0; loop <= NUM_KERNEL_PTS; ++loop) {
533 		/* Are we 16KB aligned for an L1 ? */
534 		if (((physical_freeend - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) == 0
535 		    && kernel_l1pt.pv_pa == 0) {
536 			valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
537 		} else {
538 			valloc_pages(kernel_pt_table[loop1],
539 			    L2_TABLE_SIZE / PAGE_SIZE);
540 			++loop1;
541 		}
542 	}
543 
544 	/* This should never be able to happen but better confirm that. */
545 	if (!kernel_l1pt.pv_pa || (kernel_l1pt.pv_pa & (L1_TABLE_SIZE-1)) != 0)
546 		panic("initarm: Failed to align the kernel page directory\n");
547 
548 	/*
549 	 * Allocate a page for the system page mapped to V0x00000000
550 	 * This page will just contain the system vectors and can be
551 	 * shared by all processes.
552 	 */
553 	alloc_pages(systempage.pv_pa, 1);
554 
555 	/* Allocate stacks for all modes */
556 	valloc_pages(irqstack, IRQ_STACK_SIZE);
557 	valloc_pages(abtstack, ABT_STACK_SIZE);
558 	valloc_pages(undstack, UND_STACK_SIZE);
559 	valloc_pages(kernelstack, UPAGES);
560 
561 #ifdef VERBOSE_INIT_ARM
562 	printf("IRQ stack: p0x%08lx v0x%08lx\n", irqstack.pv_pa,
563 	    irqstack.pv_va);
564 	printf("ABT stack: p0x%08lx v0x%08lx\n", abtstack.pv_pa,
565 	    abtstack.pv_va);
566 	printf("UND stack: p0x%08lx v0x%08lx\n", undstack.pv_pa,
567 	    undstack.pv_va);
568 	printf("SVC stack: p0x%08lx v0x%08lx\n", kernelstack.pv_pa,
569 	    kernelstack.pv_va);
570 #endif
571 
572 	alloc_pages(msgbufphys, round_page(MSGBUFSIZE) / PAGE_SIZE);
573 
574 	LEDSTEP();
575 
576 	/*
577 	 * Ok we have allocated physical pages for the primary kernel
578 	 * page tables
579 	 */
580 
581 #ifdef VERBOSE_INIT_ARM
582 	printf("Creating L1 page table at 0x%08lx\n", kernel_l1pt.pv_pa);
583 #endif
584 
585 	/*
586 	 * Now we start construction of the L1 page table
587 	 * We start by mapping the L2 page tables into the L1.
588 	 * This means that we can replace L1 mappings later on if necessary
589 	 */
590 	l1pagetable = kernel_l1pt.pv_pa;
591 
592 	/* Map the L2 pages tables in the L1 page table */
593 	pmap_link_l2pt(l1pagetable, 0x00000000,
594 	    &kernel_pt_table[KERNEL_PT_SYS]);
595 	for (loop = 0; loop < KERNEL_PT_KERNEL_NUM; loop++)
596 		pmap_link_l2pt(l1pagetable, KERNEL_BASE + loop * 0x00400000,
597 		    &kernel_pt_table[KERNEL_PT_KERNEL + loop]);
598 	for (loop = 0; loop < KERNEL_PT_VMDATA_NUM; loop++)
599 		pmap_link_l2pt(l1pagetable, KERNEL_VM_BASE + loop * 0x00400000,
600 		    &kernel_pt_table[KERNEL_PT_VMDATA + loop]);
601 
602 	/* update the top of the kernel VM */
603 	pmap_curmaxkvaddr =
604 	    KERNEL_VM_BASE + (KERNEL_PT_VMDATA_NUM * 0x00400000);
605 
606 #ifdef VERBOSE_INIT_ARM
607 	printf("Mapping kernel\n");
608 #endif
609 
610 	/* Now we fill in the L2 pagetable for the kernel static code/data */
611 	{
612 		size_t textsize = (uintptr_t)&etext - KERNEL_TEXT_BASE;
613 		size_t totalsize = (uintptr_t)&end - KERNEL_TEXT_BASE;
614 		u_int logical;
615 
616 		textsize = (textsize + PGOFSET) & ~PGOFSET;
617 		totalsize = (totalsize + PGOFSET) & ~PGOFSET;
618 
619 		logical = 0x00200000;	/* offset of kernel in RAM */
620 
621 		logical += pmap_map_chunk(l1pagetable, KERNEL_BASE + logical,
622 		    physical_start + logical, textsize,
623 		    VM_PROT_READ | VM_PROT_WRITE, PTE_CACHE);
624 		logical += pmap_map_chunk(l1pagetable, KERNEL_BASE + logical,
625 		    physical_start + logical, totalsize - textsize,
626 		    VM_PROT_READ | VM_PROT_WRITE, PTE_CACHE);
627 	}
628 
629 #ifdef VERBOSE_INIT_ARM
630 	printf("Constructing L2 page tables\n");
631 #endif
632 
633 	/* Map the stack pages */
634 	pmap_map_chunk(l1pagetable, irqstack.pv_va, irqstack.pv_pa,
635 	    IRQ_STACK_SIZE * PAGE_SIZE, VM_PROT_READ | VM_PROT_WRITE,
636 	    PTE_CACHE);
637 	pmap_map_chunk(l1pagetable, abtstack.pv_va, abtstack.pv_pa,
638 	    ABT_STACK_SIZE * PAGE_SIZE, VM_PROT_READ | VM_PROT_WRITE,
639 	    PTE_CACHE);
640 	pmap_map_chunk(l1pagetable, undstack.pv_va, undstack.pv_pa,
641 	    UND_STACK_SIZE * PAGE_SIZE, VM_PROT_READ | VM_PROT_WRITE,
642 	    PTE_CACHE);
643 	pmap_map_chunk(l1pagetable, kernelstack.pv_va, kernelstack.pv_pa,
644 	    UPAGES * PAGE_SIZE, VM_PROT_READ | VM_PROT_WRITE, PTE_CACHE);
645 
646 	pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
647 	    L1_TABLE_SIZE, VM_PROT_READ | VM_PROT_WRITE, PTE_PAGETABLE);
648 
649 	for (loop = 0; loop < NUM_KERNEL_PTS; ++loop) {
650 		pmap_map_chunk(l1pagetable, kernel_pt_table[loop].pv_va,
651 		    kernel_pt_table[loop].pv_pa, L2_TABLE_SIZE,
652 		    VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
653 	}
654 
655 	/* Map the vector page. */
656 #if 1
657 	/* MULTI-ICE requires that page 0 is NC/NB so that it can download the
658 	 * cache-clean code there.  */
659 	pmap_map_entry(l1pagetable, vector_page, systempage.pv_pa,
660 	    VM_PROT_READ | VM_PROT_WRITE, PTE_NOCACHE);
661 #else
662 	pmap_map_entry(l1pagetable, vector_page, systempage.pv_pa,
663 	    VM_PROT_READ | VM_PROT_WRITE, PTE_CACHE);
664 #endif
665 
666 #ifdef MEMORY_DISK_DYNAMIC
667 	/* map MD root image */
668 	pmap_map_chunk(l1pagetable, SMDK2800_MEMORY_DISK_VADDR, md_root_start,
669 	    MD_ROOT_SIZE, VM_PROT_READ | VM_PROT_WRITE, PTE_CACHE);
670 
671 	md_root_setconf((void *)md_root_start, MD_ROOT_SIZE);
672 #endif /* MEMORY_DISK_DYNAMIC */
673 	/*
674 	 * map integrated peripherals at same address in l1pagetable
675 	 * so that we can continue to use console.
676 	 */
677 	pmap_devmap_bootstrap(l1pagetable, smdk2800_devmap);
678 
679 	/*
680 	 * Now we have the real page tables in place so we can switch to them.
681 	 * Once this is done we will be running with the REAL kernel page
682 	 * tables.
683 	 */
684 
685 	/*
686 	 * Update the physical_freestart/physical_freeend/free_pages
687 	 * variables.
688 	 */
689 	{
690 		physical_freestart = physical_start +
691 		    (((((uintptr_t)&end) + PGOFSET) & ~PGOFSET) - KERNEL_BASE);
692 		physical_freeend = physical_end;
693 		free_pages =
694 		    (physical_freeend - physical_freestart) / PAGE_SIZE;
695 	}
696 
697 	/* Switch tables */
698 #ifdef VERBOSE_INIT_ARM
699 	printf("freestart = 0x%08lx, free_pages = %d (0x%x)\n",
700 	    physical_freestart, free_pages, free_pages);
701 	printf("switching to new L1 page table  @%#lx...", kernel_l1pt.pv_pa);
702 #endif
703 	LEDSTEP();
704 	cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL*2)) | DOMAIN_CLIENT);
705 	setttb(kernel_l1pt.pv_pa);
706 	cpu_tlb_flushID();
707 	cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL*2));
708 
709 	/*
710 	 * Moved from cpu_startup() as data_abort_handler() references
711 	 * this during uvm init
712 	 */
713 	proc0paddr = (struct user *)kernelstack.pv_va;
714 	lwp0.l_addr = proc0paddr;
715 
716 #ifdef VERBOSE_INIT_ARM
717 	printf("done!\n");
718 #endif
719 
720 #if 0
721 	/*
722 	 * The IFPGA registers have just moved.
723 	 * Detach the diagnostic serial port and reattach at the new address.
724 	 */
725 	plcomcndetach();
726 	/*
727 	 * XXX this should only be done in main() but it useful to
728 	 * have output earlier ...
729 	 */
730 	consinit();
731 #endif
732 
733 	LEDSTEP();
734 #ifdef VERBOSE_INIT_ARM
735 	printf("bootstrap done.\n");
736 #endif
737 
738 	arm32_vector_init(ARM_VECTORS_LOW, ARM_VEC_ALL);
739 
740 	/*
741 	 * Pages were allocated during the secondary bootstrap for the
742 	 * stacks for different CPU modes.
743 	 * We must now set the r13 registers in the different CPU modes to
744 	 * point to these stacks.
745 	 * Since the ARM stacks use STMFD etc. we must set r13 to the top end
746 	 * of the stack memory.
747 	 */
748 #ifdef VERBOSE_INIT_ARM
749 	printf("init subsystems: stacks ");
750 #endif
751 
752 	set_stackptr(PSR_IRQ32_MODE,
753 	    irqstack.pv_va + IRQ_STACK_SIZE * PAGE_SIZE);
754 	set_stackptr(PSR_ABT32_MODE,
755 	    abtstack.pv_va + ABT_STACK_SIZE * PAGE_SIZE);
756 	set_stackptr(PSR_UND32_MODE,
757 	    undstack.pv_va + UND_STACK_SIZE * PAGE_SIZE);
758 
759 	LEDSTEP();
760 
761 	/*
762 	 * Well we should set a data abort handler.
763 	 * Once things get going this will change as we will need a proper
764 	 * handler.
765 	 * Until then we will use a handler that just panics but tells us
766 	 * why.
767 	 * Initialisation of the vectors will just panic on a data abort.
768 	 * This just fills in a slightly better one.
769 	 */
770 #ifdef VERBOSE_INIT_ARM
771 	printf("vectors ");
772 #endif
773 	data_abort_handler_address = (u_int)data_abort_handler;
774 	prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
775 	undefined_handler_address = (u_int)undefinedinstruction_bounce;
776 
777 	/* Initialise the undefined instruction handlers */
778 #ifdef VERBOSE_INIT_ARM
779 	printf("undefined ");
780 #endif
781 	undefined_init();
782 
783 	LEDSTEP();
784 
785 	/* Load memory into UVM. */
786 #ifdef VERBOSE_INIT_ARM
787 	printf("page ");
788 #endif
789 	uvm_setpagesize();	/* initialize PAGE_SIZE-dependent variables */
790 	uvm_page_physload(atop(physical_freestart), atop(physical_freeend),
791 	    atop(physical_freestart), atop(physical_freeend),
792 	    VM_FREELIST_DEFAULT);
793 
794 	LEDSTEP();
795 	/* Boot strap pmap telling it where the kernel page table is */
796 #ifdef VERBOSE_INIT_ARM
797 	printf("pmap ");
798 #endif
799 	pmap_bootstrap(KERNEL_VM_BASE, KERNEL_VM_BASE + KERNEL_VM_SIZE);
800 
801 	LEDSTEP();
802 
803 	/* Setup the IRQ system */
804 #ifdef VERBOSE_INIT_ARM
805 	printf("irq ");
806 #endif
807 	/* XXX irq_init(); */
808 
809 #ifdef VERBOSE_INIT_ARM
810 	printf("done.\n");
811 #endif
812 
813 #ifdef BOOTHOWTO_INIT
814 	boothowto |= BOOTHOWTO_INIT;
815 #endif
816 	{
817 		uint8_t  gpio = ~gpio8(GPIO_PDATF);
818 
819 		if (gpio & (1<<5)) /* SW3 */
820 			boothowto ^= RB_SINGLE;
821 		if (gpio & (1<<7)) /* SW7 */
822 			boothowto ^= RB_KDB;
823 #ifdef VERBOSE_INIT_ARM
824 		printf( "sw: %x boothowto: %x\n", gpio, boothowto );
825 #endif
826 	}
827 
828 #ifdef KGDB
829 	if (boothowto & RB_KDB) {
830 		kgdb_debug_init = 1;
831 		kgdb_connect(1);
832 	}
833 #endif
834 
835 #if NKSYMS || defined(DDB) || defined(LKM)
836 	/* Firmware doesn't load symbols. */
837 	ksyms_init(0, NULL, NULL);
838 #endif
839 
840 #ifdef DDB
841 	db_machine_init();
842 	if (boothowto & RB_KDB)
843 		Debugger();
844 #endif
845 
846 	/* We return the new stack pointer address */
847 	return (kernelstack.pv_va + USPACE_SVC_STACK_TOP);
848 }
849 
850 void
851 consinit(void)
852 {
853 	static int consinit_done = 0;
854 	bus_space_tag_t iot = &s3c2xx0_bs_tag;
855 	int pclk;
856 
857 	if (consinit_done != 0)
858 		return;
859 
860 	consinit_done = 1;
861 
862 	pmap_devmap_register(smdk2800_devmap);
863 
864 	s3c2800_clock_freq2(ioreg_vaddr(S3C2800_CLKMAN_BASE), NULL, NULL, &pclk);
865 
866 #if NSSCOM > 0
867 #ifdef SSCOM0CONSOLE
868 	if (0 == s3c2800_sscom_cnattach(iot, 0, comcnspeed,
869 		pclk, comcnmode))
870 		return;
871 #endif
872 #ifdef SSCOM1CONSOLE
873 	if (0 == s3c2800_sscom_cnattach(iot, 1, comcnspeed,
874 		pclk, comcnmode))
875 		return;
876 #endif
877 #endif				/* NSSCOM */
878 #if NCOM>0 && defined(CONCOMADDR)
879 	if (comcnattach(&isa_io_bs_tag, CONCOMADDR, comcnspeed,
880 		COM_FREQ, COM_TYPE_NORMAL, comcnmode))
881 		panic("can't init serial console @%x", CONCOMADDR);
882 	return;
883 #endif
884 
885 	consinit_done = 0;
886 }
887 
888 
889 #ifdef KGDB
890 
891 #if (NSSCOM > 0)
892 
893 #ifdef KGDB_DEVNAME
894 const char kgdb_devname[] = KGDB_DEVNAME;
895 #else
896 const char kgdb_devname[] = "";
897 #endif
898 
899 #ifndef KGDB_DEVMODE
900 #define KGDB_DEVMODE ((TTYDEF_CFLAG & ~(CSIZE|CSTOPB|PARENB))|CS8) /* 8N1 */
901 #endif
902 int kgdb_sscom_mode = KGDB_DEVMODE;
903 
904 #endif				/* NSSCOM */
905 
906 void
907 kgdb_port_init(void)
908 {
909 #if (NSSCOM > 0)
910 	int unit = -1;
911 	int pclk;
912 
913 	if (strcmp(kgdb_devname, "sscom0") == 0)
914 		unit = 0;
915 	else if (strcmp(kgdb_devname, "sscom1") == 0)
916 		unit = 1;
917 
918 	if (unit >= 0) {
919 		s3c2800_clock_freq2(ioreg_vaddr(S3C2800_CLKMAN_BASE),
920 		    NULL, NULL, &pclk);
921 
922 		s3c2800_sscom_kgdb_attach(&s3c2xx0_bs_tag,
923 		    unit, kgdb_rate, pclk, kgdb_sscom_mode);
924 	}
925 #endif
926 }
927 #endif
928