booke_machdep.c revision 1.21 1 1.21 matt /* $NetBSD: booke_machdep.c,v 1.21 2014/09/22 21:35:15 matt Exp $ */
2 1.2 matt /*-
3 1.2 matt * Copyright (c) 2010, 2011 The NetBSD Foundation, Inc.
4 1.2 matt * All rights reserved.
5 1.2 matt *
6 1.2 matt * This code is derived from software contributed to The NetBSD Foundation
7 1.2 matt * by Raytheon BBN Technologies Corp and Defense Advanced Research Projects
8 1.2 matt * Agency and which was developed by Matt Thomas of 3am Software Foundry.
9 1.2 matt *
10 1.2 matt * This material is based upon work supported by the Defense Advanced Research
11 1.2 matt * Projects Agency and Space and Naval Warfare Systems Center, Pacific, under
12 1.2 matt * Contract No. N66001-09-C-2073.
13 1.2 matt * Approved for Public Release, Distribution Unlimited
14 1.2 matt *
15 1.2 matt * Redistribution and use in source and binary forms, with or without
16 1.2 matt * modification, are permitted provided that the following conditions
17 1.2 matt * are met:
18 1.2 matt * 1. Redistributions of source code must retain the above copyright
19 1.2 matt * notice, this list of conditions and the following disclaimer.
20 1.2 matt * 2. Redistributions in binary form must reproduce the above copyright
21 1.2 matt * notice, this list of conditions and the following disclaimer in the
22 1.2 matt * documentation and/or other materials provided with the distribution.
23 1.2 matt *
24 1.2 matt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
25 1.2 matt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
26 1.2 matt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
27 1.2 matt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
28 1.2 matt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 1.2 matt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 1.2 matt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 1.2 matt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 1.2 matt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 1.2 matt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34 1.2 matt * POSSIBILITY OF SUCH DAMAGE.
35 1.2 matt */
36 1.2 matt
37 1.2 matt #define __INTR_PRIVATE
38 1.2 matt #define _POWERPC_BUS_DMA_PRIVATE
39 1.2 matt
40 1.2 matt #include <sys/cdefs.h>
41 1.21 matt __KERNEL_RCSID(0, "$NetBSD: booke_machdep.c,v 1.21 2014/09/22 21:35:15 matt Exp $");
42 1.2 matt
43 1.9 matt #include "opt_modular.h"
44 1.9 matt
45 1.2 matt #include <sys/param.h>
46 1.2 matt #include <sys/cpu.h>
47 1.2 matt #include <sys/device.h>
48 1.2 matt #include <sys/intr.h>
49 1.2 matt #include <sys/mount.h>
50 1.2 matt #include <sys/msgbuf.h>
51 1.2 matt #include <sys/kernel.h>
52 1.2 matt #include <sys/reboot.h>
53 1.2 matt #include <sys/bus.h>
54 1.20 christos #include <sys/cpu.h>
55 1.2 matt
56 1.2 matt #include <uvm/uvm_extern.h>
57 1.2 matt
58 1.12 matt #include <powerpc/pcb.h>
59 1.4 matt #include <powerpc/spr.h>
60 1.4 matt #include <powerpc/booke/spr.h>
61 1.4 matt #include <powerpc/booke/cpuvar.h>
62 1.2 matt
63 1.2 matt /*
64 1.2 matt * Global variables used here and there
65 1.2 matt */
66 1.2 matt paddr_t msgbuf_paddr;
67 1.2 matt psize_t pmemsize;
68 1.2 matt struct vm_map *phys_map;
69 1.2 matt
70 1.9 matt #ifdef MODULAR
71 1.9 matt register_t cpu_psluserset = PSL_USERSET;
72 1.9 matt register_t cpu_pslusermod = PSL_USERMOD;
73 1.9 matt register_t cpu_pslusermask = PSL_USERMASK;
74 1.9 matt #endif
75 1.9 matt
76 1.2 matt static bus_addr_t booke_dma_phys_to_bus_mem(bus_dma_tag_t, bus_addr_t);
77 1.2 matt static bus_addr_t booke_dma_bus_mem_to_phys(bus_dma_tag_t, bus_addr_t);
78 1.2 matt
79 1.2 matt
80 1.2 matt struct powerpc_bus_dma_tag booke_bus_dma_tag = {
81 1.2 matt ._dmamap_create = _bus_dmamap_create,
82 1.2 matt ._dmamap_destroy = _bus_dmamap_destroy,
83 1.2 matt ._dmamap_load = _bus_dmamap_load,
84 1.2 matt ._dmamap_load_mbuf = _bus_dmamap_load_mbuf,
85 1.2 matt ._dmamap_load_uio = _bus_dmamap_load_uio,
86 1.2 matt ._dmamap_load_raw = _bus_dmamap_load_raw,
87 1.2 matt ._dmamap_unload = _bus_dmamap_unload,
88 1.17 matt /*
89 1.17 matt * The caches on BookE are coherent so we don't need to do any special
90 1.17 matt * cache synchronization.
91 1.17 matt */
92 1.17 matt //._dmamap_sync = _bus_dmamap_sync,
93 1.2 matt ._dmamem_alloc = _bus_dmamem_alloc,
94 1.2 matt ._dmamem_free = _bus_dmamem_free,
95 1.2 matt ._dmamem_map = _bus_dmamem_map,
96 1.2 matt ._dmamem_unmap = _bus_dmamem_unmap,
97 1.2 matt ._dmamem_mmap = _bus_dmamem_mmap,
98 1.2 matt ._dma_phys_to_bus_mem = booke_dma_phys_to_bus_mem,
99 1.2 matt ._dma_bus_mem_to_phys = booke_dma_bus_mem_to_phys,
100 1.2 matt };
101 1.2 matt
102 1.2 matt static bus_addr_t
103 1.2 matt booke_dma_phys_to_bus_mem(bus_dma_tag_t t, bus_addr_t a)
104 1.2 matt {
105 1.2 matt return a;
106 1.2 matt }
107 1.2 matt
108 1.2 matt static bus_addr_t
109 1.2 matt booke_dma_bus_mem_to_phys(bus_dma_tag_t t, bus_addr_t a)
110 1.2 matt {
111 1.2 matt return a;
112 1.2 matt }
113 1.2 matt
114 1.2 matt struct cpu_md_ops cpu_md_ops;
115 1.2 matt
116 1.6 matt struct cpu_softc cpu_softc[] = {
117 1.2 matt [0] = {
118 1.6 matt .cpu_ci = &cpu_info[0],
119 1.6 matt },
120 1.6 matt #ifdef MULTIPROCESSOR
121 1.6 matt [CPU_MAXNUM-1] = {
122 1.6 matt .cpu_ci = &cpu_info[CPU_MAXNUM-1],
123 1.2 matt },
124 1.6 matt #endif
125 1.2 matt };
126 1.6 matt struct cpu_info cpu_info[] = {
127 1.2 matt [0] = {
128 1.2 matt .ci_curlwp = &lwp0,
129 1.2 matt .ci_tlb_info = &pmap_tlb0_info,
130 1.6 matt .ci_softc = &cpu_softc[0],
131 1.6 matt .ci_cpl = IPL_HIGH,
132 1.12 matt .ci_idepth = -1,
133 1.6 matt },
134 1.6 matt #ifdef MULTIPROCESSOR
135 1.6 matt [CPU_MAXNUM-1] = {
136 1.6 matt .ci_curlwp = NULL,
137 1.6 matt .ci_tlb_info = &pmap_tlb0_info,
138 1.6 matt .ci_softc = &cpu_softc[CPU_MAXNUM-1],
139 1.2 matt .ci_cpl = IPL_HIGH,
140 1.12 matt .ci_idepth = -1,
141 1.6 matt },
142 1.2 matt #endif
143 1.2 matt };
144 1.12 matt __CTASSERT(__arraycount(cpu_info) == __arraycount(cpu_softc));
145 1.2 matt
146 1.2 matt /*
147 1.2 matt * This should probably be in autoconf! XXX
148 1.2 matt */
149 1.2 matt char machine[] = MACHINE; /* from <machine/param.h> */
150 1.2 matt char machine_arch[] = MACHINE_ARCH; /* from <machine/param.h> */
151 1.2 matt
152 1.2 matt char bootpath[256];
153 1.2 matt
154 1.2 matt #if NKSYMS || defined(DDB) || defined(MODULAR)
155 1.2 matt void *startsym, *endsym;
156 1.2 matt #endif
157 1.2 matt
158 1.12 matt #if defined(MULTIPROCESSOR)
159 1.12 matt volatile struct cpu_hatch_data cpu_hatch_data __cacheline_aligned;
160 1.12 matt #endif
161 1.12 matt
162 1.2 matt int fake_mapiodev = 1;
163 1.2 matt
164 1.2 matt void
165 1.2 matt booke_cpu_startup(const char *model)
166 1.2 matt {
167 1.2 matt vaddr_t minaddr, maxaddr;
168 1.2 matt char pbuf[9];
169 1.2 matt
170 1.20 christos cpu_setmodel("%s", model);
171 1.2 matt
172 1.2 matt printf("%s%s", copyright, version);
173 1.2 matt
174 1.5 matt format_bytes(pbuf, sizeof(pbuf), ctob((uint64_t)physmem));
175 1.2 matt printf("total memory = %s\n", pbuf);
176 1.2 matt
177 1.2 matt minaddr = 0;
178 1.2 matt /*
179 1.2 matt * Allocate a submap for physio
180 1.2 matt */
181 1.2 matt phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
182 1.2 matt VM_PHYS_SIZE, 0, false, NULL);
183 1.2 matt
184 1.2 matt /*
185 1.2 matt * No need to allocate an mbuf cluster submap. Mbuf clusters
186 1.2 matt * are allocated via the pool allocator, and we use direct-mapped
187 1.2 matt * pool pages.
188 1.2 matt */
189 1.2 matt
190 1.2 matt format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
191 1.2 matt printf("avail memory = %s\n", pbuf);
192 1.2 matt
193 1.2 matt /*
194 1.11 matt * Register the tlb's evcnts
195 1.11 matt */
196 1.11 matt pmap_tlb_info_evcnt_attach(curcpu()->ci_tlb_info);
197 1.11 matt
198 1.11 matt /*
199 1.2 matt * Set up the board properties database.
200 1.2 matt */
201 1.2 matt board_info_init();
202 1.2 matt
203 1.2 matt /*
204 1.2 matt * Now that we have VM, malloc()s are OK in bus_space.
205 1.2 matt */
206 1.2 matt bus_space_mallocok();
207 1.2 matt fake_mapiodev = 0;
208 1.12 matt
209 1.12 matt #ifdef MULTIPROCESSOR
210 1.12 matt for (size_t i = 1; i < __arraycount(cpu_info); i++) {
211 1.12 matt struct cpu_info * const ci = &cpu_info[i];
212 1.12 matt struct cpu_softc * const cpu = &cpu_softc[i];
213 1.12 matt cpu->cpu_ci = ci;
214 1.12 matt cpu->cpu_bst = cpu_softc[0].cpu_bst;
215 1.12 matt cpu->cpu_le_bst = cpu_softc[0].cpu_le_bst;
216 1.12 matt cpu->cpu_bsh = cpu_softc[0].cpu_bsh;
217 1.12 matt cpu->cpu_highmem = cpu_softc[0].cpu_highmem;
218 1.12 matt ci->ci_softc = cpu;
219 1.12 matt ci->ci_tlb_info = &pmap_tlb0_info;
220 1.12 matt ci->ci_cpl = IPL_HIGH;
221 1.12 matt ci->ci_idepth = -1;
222 1.12 matt ci->ci_pmap_kern_segtab = curcpu()->ci_pmap_kern_segtab;
223 1.12 matt }
224 1.18 matt
225 1.18 matt kcpuset_create(&cpuset_info.cpus_running, true);
226 1.18 matt kcpuset_create(&cpuset_info.cpus_hatched, true);
227 1.18 matt kcpuset_create(&cpuset_info.cpus_paused, true);
228 1.18 matt kcpuset_create(&cpuset_info.cpus_resumed, true);
229 1.18 matt kcpuset_create(&cpuset_info.cpus_halted, true);
230 1.12 matt #endif /* MULTIPROCESSOR */
231 1.2 matt }
232 1.2 matt
233 1.2 matt static void
234 1.2 matt dumpsys(void)
235 1.2 matt {
236 1.2 matt
237 1.2 matt printf("dumpsys: TBD\n");
238 1.2 matt }
239 1.2 matt
240 1.2 matt /*
241 1.2 matt * Halt or reboot the machine after syncing/dumping according to howto.
242 1.2 matt */
243 1.2 matt void
244 1.2 matt cpu_reboot(int howto, char *what)
245 1.2 matt {
246 1.2 matt static int syncing;
247 1.2 matt static char str[256];
248 1.2 matt char *ap = str, *ap1 = ap;
249 1.2 matt
250 1.2 matt boothowto = howto;
251 1.2 matt if (!cold && !(howto & RB_NOSYNC) && !syncing) {
252 1.2 matt syncing = 1;
253 1.2 matt vfs_shutdown(); /* sync */
254 1.2 matt resettodr(); /* set wall clock */
255 1.2 matt }
256 1.2 matt
257 1.2 matt splhigh();
258 1.2 matt
259 1.2 matt if (!cold && (howto & RB_DUMP))
260 1.2 matt dumpsys();
261 1.2 matt
262 1.2 matt doshutdownhooks();
263 1.2 matt
264 1.2 matt pmf_system_shutdown(boothowto);
265 1.2 matt
266 1.2 matt if ((howto & RB_POWERDOWN) == RB_POWERDOWN) {
267 1.2 matt /* Power off here if we know how...*/
268 1.2 matt }
269 1.2 matt
270 1.2 matt if (howto & RB_HALT) {
271 1.2 matt printf("halted\n\n");
272 1.2 matt
273 1.2 matt goto reboot; /* XXX for now... */
274 1.2 matt
275 1.2 matt #ifdef DDB
276 1.2 matt printf("dropping to debugger\n");
277 1.2 matt while(1)
278 1.2 matt Debugger();
279 1.2 matt #endif
280 1.2 matt }
281 1.2 matt
282 1.2 matt printf("rebooting\n\n");
283 1.2 matt if (what && *what) {
284 1.2 matt if (strlen(what) > sizeof str - 5)
285 1.2 matt printf("boot string too large, ignored\n");
286 1.2 matt else {
287 1.2 matt strcpy(str, what);
288 1.2 matt ap1 = ap = str + strlen(str);
289 1.2 matt *ap++ = ' ';
290 1.2 matt }
291 1.2 matt }
292 1.2 matt *ap++ = '-';
293 1.2 matt if (howto & RB_SINGLE)
294 1.2 matt *ap++ = 's';
295 1.2 matt if (howto & RB_KDB)
296 1.2 matt *ap++ = 'd';
297 1.2 matt *ap++ = 0;
298 1.2 matt if (ap[-2] == '-')
299 1.2 matt *ap1 = 0;
300 1.2 matt
301 1.2 matt /* flush cache for msgbuf */
302 1.2 matt dcache_wb(msgbuf_paddr, round_page(MSGBUFSIZE));
303 1.2 matt
304 1.2 matt reboot:
305 1.2 matt __asm volatile("msync; isync");
306 1.2 matt (*cpu_md_ops.md_cpu_reset)();
307 1.2 matt
308 1.2 matt printf("%s: md_cpu_reset() failed!\n", __func__);
309 1.2 matt #ifdef DDB
310 1.2 matt for (;;)
311 1.2 matt Debugger();
312 1.2 matt #else
313 1.2 matt for (;;)
314 1.2 matt /* nothing */;
315 1.2 matt #endif
316 1.2 matt }
317 1.2 matt
318 1.2 matt /*
319 1.2 matt * mapiodev:
320 1.2 matt *
321 1.2 matt * Allocate vm space and mapin the I/O address. Use reserved TLB
322 1.2 matt * mapping if one is found.
323 1.2 matt */
324 1.2 matt void *
325 1.14 matt mapiodev(paddr_t pa, psize_t len, bool prefetchable)
326 1.2 matt {
327 1.2 matt const vsize_t off = pa & PAGE_MASK;
328 1.2 matt
329 1.2 matt /*
330 1.2 matt * See if we have reserved TLB entry for the pa. This needs to be
331 1.2 matt * true for console as we can't use uvm during early bootstrap.
332 1.2 matt */
333 1.14 matt void * const p = tlb_mapiodev(pa, len, prefetchable);
334 1.2 matt if (p != NULL)
335 1.2 matt return p;
336 1.2 matt
337 1.2 matt if (fake_mapiodev)
338 1.2 matt panic("mapiodev: no TLB entry reserved for %llx+%llx",
339 1.2 matt (long long)pa, (long long)len);
340 1.2 matt
341 1.15 matt const paddr_t orig_pa = pa;
342 1.15 matt const psize_t orig_len = len;
343 1.15 matt vsize_t align = 0;
344 1.2 matt pa = trunc_page(pa);
345 1.2 matt len = round_page(off + len);
346 1.15 matt /*
347 1.15 matt * If we are allocating a large amount (>= 1MB) try to get an
348 1.15 matt * aligned VA region for it so try to do a large mapping for it.
349 1.15 matt */
350 1.15 matt if ((len & (len - 1)) == 0 && len >= 0x100000)
351 1.15 matt align = len;
352 1.15 matt
353 1.15 matt vaddr_t va = uvm_km_alloc(kernel_map, len, align, UVM_KMF_VAONLY);
354 1.2 matt
355 1.15 matt if (va == 0 && align > 0) {
356 1.15 matt /*
357 1.15 matt * Large aligned request failed. Let's just get anything.
358 1.15 matt */
359 1.15 matt align = 0;
360 1.15 matt va = uvm_km_alloc(kernel_map, len, align, UVM_KMF_VAONLY);
361 1.15 matt }
362 1.2 matt if (va == 0)
363 1.2 matt return NULL;
364 1.2 matt
365 1.15 matt if (align) {
366 1.15 matt /*
367 1.15 matt * Now try to map that via one big TLB entry.
368 1.15 matt */
369 1.15 matt pt_entry_t pte = pte_make_kenter_pa(pa, NULL,
370 1.15 matt VM_PROT_READ|VM_PROT_WRITE,
371 1.15 matt prefetchable ? 0 : PMAP_NOCACHE);
372 1.15 matt if (!tlb_ioreserve(va, len, pte)) {
373 1.15 matt void * const p0 = tlb_mapiodev(orig_pa, orig_len,
374 1.15 matt prefetchable);
375 1.15 matt KASSERT(p0 != NULL);
376 1.15 matt return p0;
377 1.15 matt }
378 1.15 matt }
379 1.15 matt
380 1.2 matt for (va += len, pa += len; len > 0; len -= PAGE_SIZE) {
381 1.2 matt va -= PAGE_SIZE;
382 1.2 matt pa -= PAGE_SIZE;
383 1.2 matt pmap_kenter_pa(va, pa, VM_PROT_READ|VM_PROT_WRITE,
384 1.14 matt prefetchable ? 0 : PMAP_NOCACHE);
385 1.2 matt }
386 1.2 matt pmap_update(pmap_kernel());
387 1.2 matt return (void *)(va + off);
388 1.2 matt }
389 1.2 matt
390 1.2 matt void
391 1.2 matt unmapiodev(vaddr_t va, vsize_t len)
392 1.2 matt {
393 1.2 matt /* Nothing to do for reserved (ie. not uvm_km_alloc'd) mappings. */
394 1.2 matt if (va < VM_MIN_KERNEL_ADDRESS || va > VM_MAX_KERNEL_ADDRESS) {
395 1.2 matt tlb_unmapiodev(va, len);
396 1.2 matt return;
397 1.2 matt }
398 1.2 matt
399 1.2 matt len = round_page((va & PAGE_MASK) + len);
400 1.2 matt va = trunc_page(va);
401 1.2 matt
402 1.2 matt pmap_kremove(va, len);
403 1.2 matt uvm_km_free(kernel_map, va, len, UVM_KMF_VAONLY);
404 1.2 matt }
405 1.2 matt
406 1.2 matt void
407 1.2 matt cpu_evcnt_attach(struct cpu_info *ci)
408 1.2 matt {
409 1.2 matt struct cpu_softc * const cpu = ci->ci_softc;
410 1.12 matt const char * const xname = ci->ci_data.cpu_name;
411 1.2 matt
412 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_clock, EVCNT_TYPE_INTR,
413 1.2 matt NULL, xname, "clock");
414 1.2 matt evcnt_attach_dynamic_nozero(&cpu->cpu_ev_late_clock, EVCNT_TYPE_INTR,
415 1.2 matt NULL, xname, "late clock");
416 1.2 matt evcnt_attach_dynamic_nozero(&cpu->cpu_ev_exec_trap_sync, EVCNT_TYPE_TRAP,
417 1.2 matt NULL, xname, "exec pages synced (trap)");
418 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_traps, EVCNT_TYPE_TRAP,
419 1.2 matt NULL, xname, "traps");
420 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_kdsi, EVCNT_TYPE_TRAP,
421 1.2 matt &ci->ci_ev_traps, xname, "kernel DSI traps");
422 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_udsi, EVCNT_TYPE_TRAP,
423 1.2 matt &ci->ci_ev_traps, xname, "user DSI traps");
424 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_udsi_fatal, EVCNT_TYPE_TRAP,
425 1.2 matt &ci->ci_ev_udsi, xname, "user DSI failures");
426 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_kisi, EVCNT_TYPE_TRAP,
427 1.2 matt &ci->ci_ev_traps, xname, "kernel ISI traps");
428 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_isi, EVCNT_TYPE_TRAP,
429 1.2 matt &ci->ci_ev_traps, xname, "user ISI traps");
430 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_isi_fatal, EVCNT_TYPE_TRAP,
431 1.2 matt &ci->ci_ev_isi, xname, "user ISI failures");
432 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_scalls, EVCNT_TYPE_TRAP,
433 1.2 matt &ci->ci_ev_traps, xname, "system call traps");
434 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_pgm, EVCNT_TYPE_TRAP,
435 1.2 matt &ci->ci_ev_traps, xname, "PGM traps");
436 1.3 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_debug, EVCNT_TYPE_TRAP,
437 1.3 matt &ci->ci_ev_traps, xname, "debug traps");
438 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_fpu, EVCNT_TYPE_TRAP,
439 1.2 matt &ci->ci_ev_traps, xname, "FPU unavailable traps");
440 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_fpusw, EVCNT_TYPE_MISC,
441 1.2 matt &ci->ci_ev_fpu, xname, "FPU context switches");
442 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_ali, EVCNT_TYPE_TRAP,
443 1.2 matt &ci->ci_ev_traps, xname, "user alignment traps");
444 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_ali_fatal, EVCNT_TYPE_TRAP,
445 1.2 matt &ci->ci_ev_ali, xname, "user alignment traps");
446 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_umchk, EVCNT_TYPE_TRAP,
447 1.2 matt &ci->ci_ev_umchk, xname, "user MCHK failures");
448 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_vec, EVCNT_TYPE_TRAP,
449 1.2 matt &ci->ci_ev_traps, xname, "SPE unavailable");
450 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_vecsw, EVCNT_TYPE_MISC,
451 1.2 matt &ci->ci_ev_vec, xname, "SPE context switches");
452 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_ipi, EVCNT_TYPE_INTR,
453 1.2 matt NULL, xname, "IPIs");
454 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_tlbmiss_soft, EVCNT_TYPE_TRAP,
455 1.2 matt &ci->ci_ev_traps, xname, "soft tlb misses");
456 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_dtlbmiss_hard, EVCNT_TYPE_TRAP,
457 1.2 matt &ci->ci_ev_traps, xname, "data tlb misses");
458 1.2 matt evcnt_attach_dynamic_nozero(&ci->ci_ev_itlbmiss_hard, EVCNT_TYPE_TRAP,
459 1.2 matt &ci->ci_ev_traps, xname, "inst tlb misses");
460 1.2 matt }
461 1.2 matt
462 1.12 matt #ifdef MULTIPROCESSOR
463 1.12 matt register_t
464 1.12 matt cpu_hatch(void)
465 1.12 matt {
466 1.18 matt struct cpuset_info * const csi = &cpuset_info;
467 1.12 matt const size_t id = cpu_number();
468 1.12 matt
469 1.12 matt /*
470 1.12 matt * We've hatched so tell the spinup code.
471 1.12 matt */
472 1.18 matt kcpuset_set(csi->cpus_hatched, id);
473 1.12 matt
474 1.12 matt /*
475 1.12 matt * Loop until running bit for this cpu is set.
476 1.12 matt */
477 1.18 matt while (!kcpuset_isset(csi->cpus_running, id)) {
478 1.12 matt continue;
479 1.12 matt }
480 1.12 matt
481 1.12 matt /*
482 1.12 matt * Now that we are active, start the clocks.
483 1.12 matt */
484 1.12 matt cpu_initclocks();
485 1.12 matt
486 1.12 matt /*
487 1.12 matt * Return sp of the idlelwp. Which we should be already using but ...
488 1.12 matt */
489 1.12 matt return curcpu()->ci_curpcb->pcb_sp;
490 1.12 matt }
491 1.12 matt
492 1.12 matt void
493 1.12 matt cpu_boot_secondary_processors(void)
494 1.12 matt {
495 1.12 matt volatile struct cpuset_info * const csi = &cpuset_info;
496 1.12 matt CPU_INFO_ITERATOR cii;
497 1.12 matt struct cpu_info *ci;
498 1.18 matt kcpuset_t *running;
499 1.18 matt
500 1.18 matt kcpuset_create(&running, true);
501 1.12 matt
502 1.12 matt for (CPU_INFO_FOREACH(cii, ci)) {
503 1.12 matt /*
504 1.12 matt * Skip this CPU if it didn't sucessfully hatch.
505 1.12 matt */
506 1.18 matt if (!kcpuset_isset(csi->cpus_hatched, cpu_index(ci)))
507 1.12 matt continue;
508 1.12 matt
509 1.12 matt KASSERT(!CPU_IS_PRIMARY(ci));
510 1.12 matt KASSERT(ci->ci_data.cpu_idlelwp);
511 1.12 matt
512 1.18 matt kcpuset_set(running, cpu_index(ci));
513 1.12 matt }
514 1.18 matt KASSERT(kcpuset_match(csi->cpus_hatched, running));
515 1.18 matt if (!kcpuset_iszero(running)) {
516 1.18 matt kcpuset_merge(csi->cpus_running, running);
517 1.12 matt }
518 1.18 matt kcpuset_destroy(running);
519 1.12 matt }
520 1.12 matt #endif
521 1.12 matt
522 1.2 matt uint32_t
523 1.2 matt cpu_read_4(bus_addr_t a)
524 1.2 matt {
525 1.2 matt struct cpu_softc * const cpu = curcpu()->ci_softc;
526 1.2 matt // printf(" %s(%p, %x, %x)", __func__, cpu->cpu_bst, cpu->cpu_bsh, a);
527 1.2 matt return bus_space_read_4(cpu->cpu_bst, cpu->cpu_bsh, a);
528 1.2 matt }
529 1.2 matt
530 1.2 matt uint8_t
531 1.2 matt cpu_read_1(bus_addr_t a)
532 1.2 matt {
533 1.2 matt struct cpu_softc * const cpu = curcpu()->ci_softc;
534 1.2 matt // printf(" %s(%p, %x, %x)", __func__, cpu->cpu_bst, cpu->cpu_bsh, a);
535 1.2 matt return bus_space_read_1(cpu->cpu_bst, cpu->cpu_bsh, a);
536 1.2 matt }
537 1.2 matt
538 1.2 matt void
539 1.2 matt cpu_write_4(bus_addr_t a, uint32_t v)
540 1.2 matt {
541 1.2 matt struct cpu_softc * const cpu = curcpu()->ci_softc;
542 1.2 matt bus_space_write_4(cpu->cpu_bst, cpu->cpu_bsh, a, v);
543 1.2 matt }
544 1.2 matt
545 1.2 matt void
546 1.2 matt cpu_write_1(bus_addr_t a, uint8_t v)
547 1.2 matt {
548 1.2 matt struct cpu_softc * const cpu = curcpu()->ci_softc;
549 1.2 matt bus_space_write_1(cpu->cpu_bst, cpu->cpu_bsh, a, v);
550 1.2 matt }
551 1.4 matt
552 1.4 matt void
553 1.4 matt booke_sstep(struct trapframe *tf)
554 1.4 matt {
555 1.4 matt KASSERT(tf->tf_srr1 & PSL_DE);
556 1.4 matt const uint32_t insn = ufetch_32((const void *)tf->tf_srr0);
557 1.4 matt register_t dbcr0 = DBCR0_IAC1 | DBCR0_IDM;
558 1.4 matt register_t dbcr1 = DBCR1_IAC1US_USER | DBCR1_IAC1ER_DS1;
559 1.4 matt if ((insn >> 28) == 4) {
560 1.4 matt uint32_t iac2 = 0;
561 1.4 matt if ((insn >> 26) == 0x12) {
562 1.4 matt const int32_t off = (((int32_t)insn << 6) >> 6) & ~3;
563 1.4 matt iac2 = ((insn & 2) ? 0 : tf->tf_srr0) + off;
564 1.4 matt dbcr0 |= DBCR0_IAC2;
565 1.4 matt } else if ((insn >> 26) == 0x10) {
566 1.4 matt const int16_t off = insn & ~3;
567 1.4 matt iac2 = ((insn & 2) ? 0 : tf->tf_srr0) + off;
568 1.4 matt dbcr0 |= DBCR0_IAC2;
569 1.21 matt } else if ((insn & 0xfc00fffe) == 0x4c000420) {
570 1.4 matt iac2 = tf->tf_ctr;
571 1.4 matt dbcr0 |= DBCR0_IAC2;
572 1.21 matt } else if ((insn & 0xfc00fffe) == 0x4c000020) {
573 1.4 matt iac2 = tf->tf_lr;
574 1.4 matt dbcr0 |= DBCR0_IAC2;
575 1.4 matt }
576 1.4 matt if (dbcr0 & DBCR0_IAC2) {
577 1.4 matt dbcr1 |= DBCR1_IAC2US_USER | DBCR1_IAC2ER_DS1;
578 1.4 matt mtspr(SPR_IAC2, iac2);
579 1.4 matt }
580 1.4 matt }
581 1.4 matt mtspr(SPR_IAC1, tf->tf_srr0 + 4);
582 1.4 matt mtspr(SPR_DBCR1, dbcr1);
583 1.4 matt mtspr(SPR_DBCR0, dbcr0);
584 1.4 matt }
585 1.16 matt
586 1.16 matt #ifdef DIAGNOSTIC
587 1.16 matt static inline void
588 1.16 matt swap_data(uint64_t *data, size_t a, size_t b)
589 1.16 matt {
590 1.16 matt uint64_t swap = data[a];
591 1.16 matt data[a] = data[b];
592 1.16 matt data[b] = swap;
593 1.16 matt }
594 1.16 matt
595 1.16 matt static void
596 1.16 matt sort_data(uint64_t *data, size_t count)
597 1.16 matt {
598 1.16 matt #if 0
599 1.16 matt /*
600 1.16 matt * Mostly classic bubble sort
601 1.16 matt */
602 1.16 matt do {
603 1.16 matt size_t new_count = 0;
604 1.16 matt for (size_t i = 1; i < count; i++) {
605 1.16 matt if (tbs[i - 1] > tbs[i]) {
606 1.16 matt swap_tbs(tbs, i - 1, i);
607 1.16 matt new_count = i;
608 1.16 matt }
609 1.16 matt }
610 1.16 matt count = new_count;
611 1.16 matt } while (count > 0);
612 1.16 matt #else
613 1.16 matt /*
614 1.16 matt * Comb sort
615 1.16 matt */
616 1.16 matt size_t gap = count;
617 1.16 matt bool swapped = false;
618 1.16 matt while (gap > 1 || swapped) {
619 1.16 matt if (gap > 1) {
620 1.16 matt /*
621 1.16 matt * phi = (1 + sqrt(5)) / 2 [golden ratio]
622 1.16 matt * N = 1 / (1 - e^-phi)) = 1.247330950103979
623 1.16 matt *
624 1.16 matt * We want to but can't use floating point to calculate
625 1.16 matt * gap = (size_t)((double)gap / N)
626 1.16 matt *
627 1.16 matt * So we will use the multicative inverse of N
628 1.16 matt * (module 65536) to achieve the division.
629 1.16 matt *
630 1.16 matt * iN = 2^16 / 1.24733... = 52540
631 1.16 matt * x / N == (x * iN) / 65536
632 1.16 matt */
633 1.16 matt gap = (gap * 52540) / 65536;
634 1.16 matt }
635 1.16 matt
636 1.16 matt swapped = false;
637 1.16 matt
638 1.16 matt for (size_t i = 0; gap + i < count; i++) {
639 1.16 matt if (data[i] > data[i + gap]) {
640 1.16 matt swap_data(data, i, i + gap);
641 1.16 matt swapped = true;
642 1.16 matt }
643 1.16 matt }
644 1.16 matt }
645 1.16 matt #endif
646 1.16 matt }
647 1.16 matt #endif
648 1.16 matt
649 1.16 matt void
650 1.16 matt dump_splhist(struct cpu_info *ci, void (*pr)(const char *, ...))
651 1.16 matt {
652 1.16 matt #ifdef DIAGNOSTIC
653 1.16 matt struct cpu_softc * const cpu = ci->ci_softc;
654 1.16 matt uint64_t tbs[NIPL*NIPL];
655 1.16 matt size_t ntbs = 0;
656 1.16 matt for (size_t to = 0; to < NIPL; to++) {
657 1.16 matt for (size_t from = 0; from < NIPL; from++) {
658 1.16 matt uint64_t tb = cpu->cpu_spl_tb[to][from];
659 1.16 matt if (tb == 0)
660 1.16 matt continue;
661 1.16 matt tbs[ntbs++] = (tb << 8) | (to << 4) | from;
662 1.16 matt }
663 1.16 matt }
664 1.16 matt sort_data(tbs, ntbs);
665 1.16 matt
666 1.16 matt if (pr == NULL)
667 1.16 matt pr = printf;
668 1.16 matt uint64_t last_tb = 0;
669 1.16 matt for (size_t i = 0; i < ntbs; i++) {
670 1.16 matt uint64_t tb = tbs[i];
671 1.16 matt size_t from = tb & 15;
672 1.16 matt size_t to = (tb >> 4) & 15;
673 1.16 matt tb >>= 8;
674 1.16 matt (*pr)("%s(%zu) from %zu at %"PRId64"",
675 1.16 matt from < to ? "splraise" : "splx",
676 1.16 matt to, from, tb);
677 1.16 matt if (last_tb && from != IPL_NONE)
678 1.16 matt (*pr)(" (+%"PRId64")", tb - last_tb);
679 1.16 matt (*pr)("\n");
680 1.16 matt last_tb = tb;
681 1.16 matt }
682 1.16 matt #endif
683 1.16 matt }
684