xref: /freebsd/sys/powerpc/powerpc/machdep.c (revision 780fb4a2)
1 /*-
2  * Copyright (C) 1995, 1996 Wolfgang Solfrank.
3  * Copyright (C) 1995, 1996 TooLs GmbH.
4  * All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions and the following disclaimer.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  * 3. All advertising materials mentioning features or use of this software
15  *    must display the following acknowledgement:
16  *      This product includes software developed by TooLs GmbH.
17  * 4. The name of TooLs GmbH 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 TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
24  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
25  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
26  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
27  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
28  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
29  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30  */
31 /*-
32  * Copyright (C) 2001 Benno Rice
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  *
44  * THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND ANY EXPRESS OR
45  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
46  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
47  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
48  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
49  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
50  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
51  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
52  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
53  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
54  *	$NetBSD: machdep.c,v 1.74.2.1 2000/11/01 16:13:48 tv Exp $
55  */
56 
57 #include <sys/cdefs.h>
58 __FBSDID("$FreeBSD$");
59 
60 #include "opt_ddb.h"
61 #include "opt_kstack_pages.h"
62 #include "opt_platform.h"
63 
64 #include <sys/param.h>
65 #include <sys/proc.h>
66 #include <sys/systm.h>
67 #include <sys/bio.h>
68 #include <sys/buf.h>
69 #include <sys/bus.h>
70 #include <sys/cons.h>
71 #include <sys/cpu.h>
72 #include <sys/eventhandler.h>
73 #include <sys/exec.h>
74 #include <sys/imgact.h>
75 #include <sys/kdb.h>
76 #include <sys/kernel.h>
77 #include <sys/ktr.h>
78 #include <sys/linker.h>
79 #include <sys/lock.h>
80 #include <sys/malloc.h>
81 #include <sys/mbuf.h>
82 #include <sys/msgbuf.h>
83 #include <sys/mutex.h>
84 #include <sys/ptrace.h>
85 #include <sys/reboot.h>
86 #include <sys/rwlock.h>
87 #include <sys/signalvar.h>
88 #include <sys/syscallsubr.h>
89 #include <sys/sysctl.h>
90 #include <sys/sysent.h>
91 #include <sys/sysproto.h>
92 #include <sys/ucontext.h>
93 #include <sys/uio.h>
94 #include <sys/vmmeter.h>
95 #include <sys/vnode.h>
96 
97 #include <net/netisr.h>
98 
99 #include <vm/vm.h>
100 #include <vm/vm_extern.h>
101 #include <vm/vm_kern.h>
102 #include <vm/vm_page.h>
103 #include <vm/vm_map.h>
104 #include <vm/vm_object.h>
105 #include <vm/vm_pager.h>
106 
107 #include <machine/altivec.h>
108 #ifndef __powerpc64__
109 #include <machine/bat.h>
110 #endif
111 #include <machine/cpu.h>
112 #include <machine/elf.h>
113 #include <machine/fpu.h>
114 #include <machine/hid.h>
115 #include <machine/kdb.h>
116 #include <machine/md_var.h>
117 #include <machine/metadata.h>
118 #include <machine/mmuvar.h>
119 #include <machine/pcb.h>
120 #include <machine/reg.h>
121 #include <machine/sigframe.h>
122 #include <machine/spr.h>
123 #include <machine/trap.h>
124 #include <machine/vmparam.h>
125 #include <machine/ofw_machdep.h>
126 
127 #include <ddb/ddb.h>
128 
129 #include <dev/ofw/openfirm.h>
130 #include <dev/ofw/ofw_subr.h>
131 
132 int cold = 1;
133 #ifdef __powerpc64__
134 int cacheline_size = 128;
135 #else
136 int cacheline_size = 32;
137 #endif
138 int hw_direct_map = 1;
139 
140 extern void *ap_pcpu;
141 
142 struct pcpu __pcpu[MAXCPU];
143 static char init_kenv[2048];
144 
145 static struct trapframe frame0;
146 
147 char		machine[] = "powerpc";
148 SYSCTL_STRING(_hw, HW_MACHINE, machine, CTLFLAG_RD, machine, 0, "");
149 
150 static void	cpu_startup(void *);
151 SYSINIT(cpu, SI_SUB_CPU, SI_ORDER_FIRST, cpu_startup, NULL);
152 
153 SYSCTL_INT(_machdep, CPU_CACHELINE, cacheline_size,
154 	   CTLFLAG_RD, &cacheline_size, 0, "");
155 
156 uintptr_t	powerpc_init(vm_offset_t, vm_offset_t, vm_offset_t, void *,
157 		    uint32_t);
158 
159 long		Maxmem = 0;
160 long		realmem = 0;
161 
162 /* Default MSR values set in the AIM/Book-E early startup code */
163 register_t	psl_kernset;
164 register_t	psl_userset;
165 register_t	psl_userstatic;
166 #ifdef __powerpc64__
167 register_t	psl_userset32;
168 #endif
169 
170 struct kva_md_info kmi;
171 
172 static void
173 cpu_startup(void *dummy)
174 {
175 
176 	/*
177 	 * Initialise the decrementer-based clock.
178 	 */
179 	decr_init();
180 
181 	/*
182 	 * Good {morning,afternoon,evening,night}.
183 	 */
184 	cpu_setup(PCPU_GET(cpuid));
185 
186 #ifdef PERFMON
187 	perfmon_init();
188 #endif
189 	printf("real memory  = %ju (%ju MB)\n", ptoa((uintmax_t)physmem),
190 	    ptoa((uintmax_t)physmem) / 1048576);
191 	realmem = physmem;
192 
193 	if (bootverbose)
194 		printf("available KVA = %zu (%zu MB)\n",
195 		    virtual_end - virtual_avail,
196 		    (virtual_end - virtual_avail) / 1048576);
197 
198 	/*
199 	 * Display any holes after the first chunk of extended memory.
200 	 */
201 	if (bootverbose) {
202 		int indx;
203 
204 		printf("Physical memory chunk(s):\n");
205 		for (indx = 0; phys_avail[indx + 1] != 0; indx += 2) {
206 			vm_paddr_t size1 =
207 			    phys_avail[indx + 1] - phys_avail[indx];
208 
209 			#ifdef __powerpc64__
210 			printf("0x%016jx - 0x%016jx, %ju bytes (%ju pages)\n",
211 			#else
212 			printf("0x%09jx - 0x%09jx, %ju bytes (%ju pages)\n",
213 			#endif
214 			    (uintmax_t)phys_avail[indx],
215 			    (uintmax_t)phys_avail[indx + 1] - 1,
216 			    (uintmax_t)size1, (uintmax_t)size1 / PAGE_SIZE);
217 		}
218 	}
219 
220 	vm_ksubmap_init(&kmi);
221 
222 	printf("avail memory = %ju (%ju MB)\n",
223 	    ptoa((uintmax_t)vm_free_count()),
224 	    ptoa((uintmax_t)vm_free_count()) / 1048576);
225 
226 	/*
227 	 * Set up buffers, so they can be used to read disk labels.
228 	 */
229 	bufinit();
230 	vm_pager_bufferinit();
231 }
232 
233 extern vm_offset_t	__startkernel, __endkernel;
234 extern unsigned char	__bss_start[];
235 extern unsigned char	__sbss_start[];
236 extern unsigned char	__sbss_end[];
237 extern unsigned char	_end[];
238 
239 void aim_early_init(vm_offset_t fdt, vm_offset_t toc, vm_offset_t ofentry,
240     void *mdp, uint32_t mdp_cookie);
241 void aim_cpu_init(vm_offset_t toc);
242 void booke_cpu_init(void);
243 
244 uintptr_t
245 powerpc_init(vm_offset_t fdt, vm_offset_t toc, vm_offset_t ofentry, void *mdp,
246     uint32_t mdp_cookie)
247 {
248 	struct		pcpu *pc;
249 	struct cpuref	bsp;
250 	vm_offset_t	startkernel, endkernel;
251 	char		*env;
252         bool		ofw_bootargs = false;
253 #ifdef DDB
254 	vm_offset_t ksym_start;
255 	vm_offset_t ksym_end;
256 #endif
257 
258 	/* First guess at start/end kernel positions */
259 	startkernel = __startkernel;
260 	endkernel = __endkernel;
261 
262 	/*
263 	 * If the metadata pointer cookie is not set to the magic value,
264 	 * the number in mdp should be treated as nonsense.
265 	 */
266 	if (mdp_cookie != 0xfb5d104d)
267 		mdp = NULL;
268 
269 #if !defined(BOOKE)
270 	/*
271 	 * On BOOKE the BSS is already cleared and some variables
272 	 * initialized.  Do not wipe them out.
273 	 */
274 	bzero(__sbss_start, __sbss_end - __sbss_start);
275 	bzero(__bss_start, _end - __bss_start);
276 #endif
277 
278 	cpu_feature_setup();
279 
280 #ifdef AIM
281 	aim_early_init(fdt, toc, ofentry, mdp, mdp_cookie);
282 #endif
283 
284 	/*
285 	 * Parse metadata if present and fetch parameters.  Must be done
286 	 * before console is inited so cninit gets the right value of
287 	 * boothowto.
288 	 */
289 	if (mdp != NULL) {
290 		void *kmdp = NULL;
291 		char *envp = NULL;
292 		uintptr_t md_offset = 0;
293 		vm_paddr_t kernelendphys;
294 
295 #ifdef AIM
296 		if ((uintptr_t)&powerpc_init > DMAP_BASE_ADDRESS)
297 			md_offset = DMAP_BASE_ADDRESS;
298 #endif
299 
300 		preload_metadata = mdp;
301 		if (md_offset > 0) {
302 			preload_metadata += md_offset;
303 			preload_bootstrap_relocate(md_offset);
304 		}
305 		kmdp = preload_search_by_type("elf kernel");
306 		if (kmdp != NULL) {
307 			boothowto = MD_FETCH(kmdp, MODINFOMD_HOWTO, int);
308 			envp = MD_FETCH(kmdp, MODINFOMD_ENVP, char *);
309 			if (envp != NULL)
310 				envp += md_offset;
311 			init_static_kenv(envp, 0);
312 			kernelendphys = MD_FETCH(kmdp, MODINFOMD_KERNEND,
313 			    vm_offset_t);
314 			if (kernelendphys != 0)
315 				kernelendphys += md_offset;
316 			endkernel = ulmax(endkernel, kernelendphys);
317 #ifdef DDB
318 			ksym_start = MD_FETCH(kmdp, MODINFOMD_SSYM, uintptr_t);
319 			ksym_end = MD_FETCH(kmdp, MODINFOMD_ESYM, uintptr_t);
320 			db_fetch_ksymtab(ksym_start, ksym_end);
321 #endif
322 		}
323 	} else {
324 		init_static_kenv(init_kenv, sizeof(init_kenv));
325 		ofw_bootargs = true;
326 	}
327 	/* Store boot environment state */
328 	OF_initial_setup((void *)fdt, NULL, (int (*)(void *))ofentry);
329 
330 	/*
331 	 * Init params/tunables that can be overridden by the loader
332 	 */
333 	init_param1();
334 
335 	/*
336 	 * Start initializing proc0 and thread0.
337 	 */
338 	proc_linkup0(&proc0, &thread0);
339 	thread0.td_frame = &frame0;
340 #ifdef __powerpc64__
341 	__asm __volatile("mr 13,%0" :: "r"(&thread0));
342 #else
343 	__asm __volatile("mr 2,%0" :: "r"(&thread0));
344 #endif
345 
346 	/*
347 	 * Init mutexes, which we use heavily in PMAP
348 	 */
349 	mutex_init();
350 
351 	/*
352 	 * Install the OF client interface
353 	 */
354 	OF_bootstrap();
355 
356 	if (ofw_bootargs)
357 		ofw_parse_bootargs();
358 
359 	/*
360 	 * Initialize the console before printing anything.
361 	 */
362 	cninit();
363 
364 #ifdef AIM
365 	aim_cpu_init(toc);
366 #else /* BOOKE */
367 	booke_cpu_init();
368 
369 	/* Make sure the kernel icache is valid before we go too much further */
370 	__syncicache((caddr_t)startkernel, endkernel - startkernel);
371 #endif
372 
373 	/*
374 	 * Choose a platform module so we can get the physical memory map.
375 	 */
376 
377 	platform_probe_and_attach();
378 
379 	/*
380 	 * Set up per-cpu data for the BSP now that the platform can tell
381 	 * us which that is.
382 	 */
383 	if (platform_smp_get_bsp(&bsp) != 0)
384 		bsp.cr_cpuid = 0;
385 	pc = &__pcpu[bsp.cr_cpuid];
386 	pcpu_init(pc, bsp.cr_cpuid, sizeof(struct pcpu));
387 	pc->pc_curthread = &thread0;
388 	thread0.td_oncpu = bsp.cr_cpuid;
389 	pc->pc_cpuid = bsp.cr_cpuid;
390 	pc->pc_hwref = bsp.cr_hwref;
391 	__asm __volatile("mtsprg 0, %0" :: "r"(pc));
392 
393 	/*
394 	 * Init KDB
395 	 */
396 	kdb_init();
397 
398 	/*
399 	 * Bring up MMU
400 	 */
401 	pmap_bootstrap(startkernel, endkernel);
402 	mtmsr(psl_kernset & ~PSL_EE);
403 
404 	/*
405 	 * Initialize params/tunables that are derived from memsize
406 	 */
407 	init_param2(physmem);
408 
409 	/*
410 	 * Grab booted kernel's name
411 	 */
412         env = kern_getenv("kernelname");
413         if (env != NULL) {
414 		strlcpy(kernelname, env, sizeof(kernelname));
415 		freeenv(env);
416 	}
417 
418 	/*
419 	 * Finish setting up thread0.
420 	 */
421 	thread0.td_pcb = (struct pcb *)
422 	    ((thread0.td_kstack + thread0.td_kstack_pages * PAGE_SIZE -
423 	    sizeof(struct pcb)) & ~15UL);
424 	bzero((void *)thread0.td_pcb, sizeof(struct pcb));
425 	pc->pc_curpcb = thread0.td_pcb;
426 
427 	/* Initialise the message buffer. */
428 	msgbufinit(msgbufp, msgbufsize);
429 
430 #ifdef KDB
431 	if (boothowto & RB_KDB)
432 		kdb_enter(KDB_WHY_BOOTFLAGS,
433 		    "Boot flags requested debugger");
434 #endif
435 
436 	return (((uintptr_t)thread0.td_pcb -
437 	    (sizeof(struct callframe) - 3*sizeof(register_t))) & ~15UL);
438 }
439 
440 /*
441  * Flush the D-cache for non-DMA I/O so that the I-cache can
442  * be made coherent later.
443  */
444 void
445 cpu_flush_dcache(void *ptr, size_t len)
446 {
447 	register_t addr, off;
448 
449 	/*
450 	 * Align the address to a cacheline and adjust the length
451 	 * accordingly. Then round the length to a multiple of the
452 	 * cacheline for easy looping.
453 	 */
454 	addr = (uintptr_t)ptr;
455 	off = addr & (cacheline_size - 1);
456 	addr -= off;
457 	len = roundup2(len + off, cacheline_size);
458 
459 	while (len > 0) {
460 		__asm __volatile ("dcbf 0,%0" :: "r"(addr));
461 		__asm __volatile ("sync");
462 		addr += cacheline_size;
463 		len -= cacheline_size;
464 	}
465 }
466 
467 int
468 ptrace_set_pc(struct thread *td, unsigned long addr)
469 {
470 	struct trapframe *tf;
471 
472 	tf = td->td_frame;
473 	tf->srr0 = (register_t)addr;
474 
475 	return (0);
476 }
477 
478 void
479 spinlock_enter(void)
480 {
481 	struct thread *td;
482 	register_t msr;
483 
484 	td = curthread;
485 	if (td->td_md.md_spinlock_count == 0) {
486 		__asm __volatile("or 2,2,2"); /* Set high thread priority */
487 		msr = intr_disable();
488 		td->td_md.md_spinlock_count = 1;
489 		td->td_md.md_saved_msr = msr;
490 	} else
491 		td->td_md.md_spinlock_count++;
492 	critical_enter();
493 }
494 
495 void
496 spinlock_exit(void)
497 {
498 	struct thread *td;
499 	register_t msr;
500 
501 	td = curthread;
502 	critical_exit();
503 	msr = td->td_md.md_saved_msr;
504 	td->td_md.md_spinlock_count--;
505 	if (td->td_md.md_spinlock_count == 0) {
506 		intr_restore(msr);
507 		__asm __volatile("or 6,6,6"); /* Set normal thread priority */
508 	}
509 }
510 
511 /*
512  * Simple ddb(4) command/hack to view any SPR on the running CPU.
513  * Uses a trivial asm function to perform the mfspr, and rewrites the mfspr
514  * instruction each time.
515  * XXX: Since it uses code modification, it won't work if the kernel code pages
516  * are marked RO.
517  */
518 extern register_t get_spr(int);
519 
520 #ifdef DDB
521 DB_SHOW_COMMAND(spr, db_show_spr)
522 {
523 	register_t spr;
524 	volatile uint32_t *p;
525 	int sprno, saved_sprno;
526 
527 	if (!have_addr)
528 		return;
529 
530 	saved_sprno = sprno = (intptr_t) addr;
531 	sprno = ((sprno & 0x3e0) >> 5) | ((sprno & 0x1f) << 5);
532 	p = (uint32_t *)(void *)&get_spr;
533 	*p = (*p & ~0x001ff800) | (sprno << 11);
534 	__syncicache(get_spr, cacheline_size);
535 	spr = get_spr(sprno);
536 
537 	db_printf("SPR %d(%x): %lx\n", saved_sprno, saved_sprno,
538 	    (unsigned long)spr);
539 }
540 #endif
541 
542 #undef bzero
543 void
544 bzero(void *buf, size_t len)
545 {
546 	caddr_t	p;
547 
548 	p = buf;
549 
550 	while (((vm_offset_t) p & (sizeof(u_long) - 1)) && len) {
551 		*p++ = 0;
552 		len--;
553 	}
554 
555 	while (len >= sizeof(u_long) * 8) {
556 		*(u_long*) p = 0;
557 		*((u_long*) p + 1) = 0;
558 		*((u_long*) p + 2) = 0;
559 		*((u_long*) p + 3) = 0;
560 		len -= sizeof(u_long) * 8;
561 		*((u_long*) p + 4) = 0;
562 		*((u_long*) p + 5) = 0;
563 		*((u_long*) p + 6) = 0;
564 		*((u_long*) p + 7) = 0;
565 		p += sizeof(u_long) * 8;
566 	}
567 
568 	while (len >= sizeof(u_long)) {
569 		*(u_long*) p = 0;
570 		len -= sizeof(u_long);
571 		p += sizeof(u_long);
572 	}
573 
574 	while (len) {
575 		*p++ = 0;
576 		len--;
577 	}
578 }
579