Home | History | Annotate | Line # | Download | only in booke
booke_machdep.c revision 1.16.2.1
      1  1.16.2.1   tls /*	$NetBSD: booke_machdep.c,v 1.16.2.1 2012/11/20 03:01:38 tls 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.16.2.1   tls __KERNEL_RCSID(0, "$NetBSD: booke_machdep.c,v 1.16.2.1 2012/11/20 03:01:38 tls 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.2  matt 
     55       1.2  matt #include <uvm/uvm_extern.h>
     56       1.2  matt 
     57      1.12  matt #include <powerpc/cpuset.h>
     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.16.2.1   tls 	/*
     89  1.16.2.1   tls 	 * The caches on BookE are coherent so we don't need to do any special
     90  1.16.2.1   tls 	 * cache synchronization.
     91  1.16.2.1   tls 	 */
     92  1.16.2.1   tls 	//._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 cpu_model[80];
    150       1.2  matt char machine[] = MACHINE;		/* from <machine/param.h> */
    151       1.2  matt char machine_arch[] = MACHINE_ARCH;	/* from <machine/param.h> */
    152       1.2  matt 
    153       1.2  matt char bootpath[256];
    154       1.2  matt 
    155       1.2  matt #if NKSYMS || defined(DDB) || defined(MODULAR)
    156       1.2  matt void *startsym, *endsym;
    157       1.2  matt #endif
    158       1.2  matt 
    159      1.12  matt #if defined(MULTIPROCESSOR)
    160      1.12  matt volatile struct cpu_hatch_data cpu_hatch_data __cacheline_aligned;
    161      1.12  matt #endif
    162      1.12  matt 
    163       1.2  matt int fake_mapiodev = 1;
    164       1.2  matt 
    165       1.2  matt void
    166       1.2  matt booke_cpu_startup(const char *model)
    167       1.2  matt {
    168       1.2  matt 	vaddr_t 	minaddr, maxaddr;
    169       1.2  matt 	char 		pbuf[9];
    170       1.2  matt 
    171       1.2  matt 	strlcpy(cpu_model, model, sizeof(cpu_model));
    172       1.2  matt 
    173       1.2  matt 	printf("%s%s", copyright, version);
    174       1.2  matt 
    175       1.5  matt 	format_bytes(pbuf, sizeof(pbuf), ctob((uint64_t)physmem));
    176       1.2  matt 	printf("total memory = %s\n", pbuf);
    177       1.2  matt 
    178       1.2  matt 	minaddr = 0;
    179       1.2  matt 	/*
    180       1.2  matt 	 * Allocate a submap for physio
    181       1.2  matt 	 */
    182       1.2  matt 	phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
    183       1.2  matt 				 VM_PHYS_SIZE, 0, false, NULL);
    184       1.2  matt 
    185       1.2  matt 	/*
    186       1.2  matt 	 * No need to allocate an mbuf cluster submap.  Mbuf clusters
    187       1.2  matt 	 * are allocated via the pool allocator, and we use direct-mapped
    188       1.2  matt 	 * pool pages.
    189       1.2  matt 	 */
    190       1.2  matt 
    191       1.2  matt 	format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
    192       1.2  matt 	printf("avail memory = %s\n", pbuf);
    193       1.2  matt 
    194       1.2  matt 	/*
    195      1.11  matt 	 * Register the tlb's evcnts
    196      1.11  matt 	 */
    197      1.11  matt 	pmap_tlb_info_evcnt_attach(curcpu()->ci_tlb_info);
    198      1.11  matt 
    199      1.11  matt 	/*
    200       1.2  matt 	 * Set up the board properties database.
    201       1.2  matt 	 */
    202       1.2  matt 	board_info_init();
    203       1.2  matt 
    204       1.2  matt 	/*
    205       1.2  matt 	 * Now that we have VM, malloc()s are OK in bus_space.
    206       1.2  matt 	 */
    207       1.2  matt 	bus_space_mallocok();
    208       1.2  matt 	fake_mapiodev = 0;
    209      1.12  matt 
    210      1.12  matt #ifdef MULTIPROCESSOR
    211      1.12  matt 	for (size_t i = 1; i < __arraycount(cpu_info); i++) {
    212      1.12  matt 		struct cpu_info * const ci = &cpu_info[i];
    213      1.12  matt 		struct cpu_softc * const cpu = &cpu_softc[i];
    214      1.12  matt 		cpu->cpu_ci = ci;
    215      1.12  matt 		cpu->cpu_bst = cpu_softc[0].cpu_bst;
    216      1.12  matt 		cpu->cpu_le_bst = cpu_softc[0].cpu_le_bst;
    217      1.12  matt 		cpu->cpu_bsh = cpu_softc[0].cpu_bsh;
    218      1.12  matt 		cpu->cpu_highmem = cpu_softc[0].cpu_highmem;
    219      1.12  matt 		ci->ci_softc = cpu;
    220      1.12  matt 		ci->ci_tlb_info = &pmap_tlb0_info;
    221      1.12  matt 		ci->ci_cpl = IPL_HIGH;
    222      1.12  matt 		ci->ci_idepth = -1;
    223      1.12  matt 		ci->ci_pmap_kern_segtab = curcpu()->ci_pmap_kern_segtab;
    224      1.12  matt 	}
    225      1.12  matt #endif /* MULTIPROCESSOR */
    226       1.2  matt }
    227       1.2  matt 
    228       1.2  matt static void
    229       1.2  matt dumpsys(void)
    230       1.2  matt {
    231       1.2  matt 
    232       1.2  matt 	printf("dumpsys: TBD\n");
    233       1.2  matt }
    234       1.2  matt 
    235       1.2  matt /*
    236       1.2  matt  * Halt or reboot the machine after syncing/dumping according to howto.
    237       1.2  matt  */
    238       1.2  matt void
    239       1.2  matt cpu_reboot(int howto, char *what)
    240       1.2  matt {
    241       1.2  matt 	static int syncing;
    242       1.2  matt 	static char str[256];
    243       1.2  matt 	char *ap = str, *ap1 = ap;
    244       1.2  matt 
    245       1.2  matt 	boothowto = howto;
    246       1.2  matt 	if (!cold && !(howto & RB_NOSYNC) && !syncing) {
    247       1.2  matt 		syncing = 1;
    248       1.2  matt 		vfs_shutdown();		/* sync */
    249       1.2  matt 		resettodr();		/* set wall clock */
    250       1.2  matt 	}
    251       1.2  matt 
    252       1.2  matt 	splhigh();
    253       1.2  matt 
    254       1.2  matt 	if (!cold && (howto & RB_DUMP))
    255       1.2  matt 		dumpsys();
    256       1.2  matt 
    257       1.2  matt 	doshutdownhooks();
    258       1.2  matt 
    259       1.2  matt 	pmf_system_shutdown(boothowto);
    260       1.2  matt 
    261       1.2  matt 	if ((howto & RB_POWERDOWN) == RB_POWERDOWN) {
    262       1.2  matt 	  /* Power off here if we know how...*/
    263       1.2  matt 	}
    264       1.2  matt 
    265       1.2  matt 	if (howto & RB_HALT) {
    266       1.2  matt 		printf("halted\n\n");
    267       1.2  matt 
    268       1.2  matt 		goto reboot;	/* XXX for now... */
    269       1.2  matt 
    270       1.2  matt #ifdef DDB
    271       1.2  matt 		printf("dropping to debugger\n");
    272       1.2  matt 		while(1)
    273       1.2  matt 			Debugger();
    274       1.2  matt #endif
    275       1.2  matt 	}
    276       1.2  matt 
    277       1.2  matt 	printf("rebooting\n\n");
    278       1.2  matt 	if (what && *what) {
    279       1.2  matt 		if (strlen(what) > sizeof str - 5)
    280       1.2  matt 			printf("boot string too large, ignored\n");
    281       1.2  matt 		else {
    282       1.2  matt 			strcpy(str, what);
    283       1.2  matt 			ap1 = ap = str + strlen(str);
    284       1.2  matt 			*ap++ = ' ';
    285       1.2  matt 		}
    286       1.2  matt 	}
    287       1.2  matt 	*ap++ = '-';
    288       1.2  matt 	if (howto & RB_SINGLE)
    289       1.2  matt 		*ap++ = 's';
    290       1.2  matt 	if (howto & RB_KDB)
    291       1.2  matt 		*ap++ = 'd';
    292       1.2  matt 	*ap++ = 0;
    293       1.2  matt 	if (ap[-2] == '-')
    294       1.2  matt 		*ap1 = 0;
    295       1.2  matt 
    296       1.2  matt 	/* flush cache for msgbuf */
    297       1.2  matt 	dcache_wb(msgbuf_paddr, round_page(MSGBUFSIZE));
    298       1.2  matt 
    299       1.2  matt  reboot:
    300       1.2  matt 	__asm volatile("msync; isync");
    301       1.2  matt 	(*cpu_md_ops.md_cpu_reset)();
    302       1.2  matt 
    303       1.2  matt 	printf("%s: md_cpu_reset() failed!\n", __func__);
    304       1.2  matt #ifdef DDB
    305       1.2  matt 	for (;;)
    306       1.2  matt 		Debugger();
    307       1.2  matt #else
    308       1.2  matt 	for (;;)
    309       1.2  matt 		/* nothing */;
    310       1.2  matt #endif
    311       1.2  matt }
    312       1.2  matt 
    313       1.2  matt /*
    314       1.2  matt  * mapiodev:
    315       1.2  matt  *
    316       1.2  matt  * 	Allocate vm space and mapin the I/O address. Use reserved TLB
    317       1.2  matt  * 	mapping if one is found.
    318       1.2  matt  */
    319       1.2  matt void *
    320      1.14  matt mapiodev(paddr_t pa, psize_t len, bool prefetchable)
    321       1.2  matt {
    322       1.2  matt 	const vsize_t off = pa & PAGE_MASK;
    323       1.2  matt 
    324       1.2  matt 	/*
    325       1.2  matt 	 * See if we have reserved TLB entry for the pa. This needs to be
    326       1.2  matt 	 * true for console as we can't use uvm during early bootstrap.
    327       1.2  matt 	 */
    328      1.14  matt 	void * const p = tlb_mapiodev(pa, len, prefetchable);
    329       1.2  matt 	if (p != NULL)
    330       1.2  matt 		return p;
    331       1.2  matt 
    332       1.2  matt 	if (fake_mapiodev)
    333       1.2  matt 		panic("mapiodev: no TLB entry reserved for %llx+%llx",
    334       1.2  matt 		    (long long)pa, (long long)len);
    335       1.2  matt 
    336      1.15  matt 	const paddr_t orig_pa = pa;
    337      1.15  matt 	const psize_t orig_len = len;
    338      1.15  matt 	vsize_t align = 0;
    339       1.2  matt 	pa = trunc_page(pa);
    340       1.2  matt 	len = round_page(off + len);
    341      1.15  matt 	/*
    342      1.15  matt 	 * If we are allocating a large amount (>= 1MB) try to get an
    343      1.15  matt 	 * aligned VA region for it so try to do a large mapping for it.
    344      1.15  matt 	 */
    345      1.15  matt 	if ((len & (len - 1)) == 0 && len >= 0x100000)
    346      1.15  matt 		align = len;
    347      1.15  matt 
    348      1.15  matt 	vaddr_t va = uvm_km_alloc(kernel_map, len, align, UVM_KMF_VAONLY);
    349       1.2  matt 
    350      1.15  matt 	if (va == 0 && align > 0) {
    351      1.15  matt 		/*
    352      1.15  matt 		 * Large aligned request failed.  Let's just get anything.
    353      1.15  matt 		 */
    354      1.15  matt 		align = 0;
    355      1.15  matt 		va = uvm_km_alloc(kernel_map, len, align, UVM_KMF_VAONLY);
    356      1.15  matt 	}
    357       1.2  matt 	if (va == 0)
    358       1.2  matt 		return NULL;
    359       1.2  matt 
    360      1.15  matt 	if (align) {
    361      1.15  matt 		/*
    362      1.15  matt 		 * Now try to map that via one big TLB entry.
    363      1.15  matt 		 */
    364      1.15  matt 		pt_entry_t pte = pte_make_kenter_pa(pa, NULL,
    365      1.15  matt 		    VM_PROT_READ|VM_PROT_WRITE,
    366      1.15  matt 		    prefetchable ? 0 : PMAP_NOCACHE);
    367      1.15  matt 		if (!tlb_ioreserve(va, len, pte)) {
    368      1.15  matt 			void * const p0 = tlb_mapiodev(orig_pa, orig_len,
    369      1.15  matt 			    prefetchable);
    370      1.15  matt 			KASSERT(p0 != NULL);
    371      1.15  matt 			return p0;
    372      1.15  matt 		}
    373      1.15  matt 	}
    374      1.15  matt 
    375       1.2  matt 	for (va += len, pa += len; len > 0; len -= PAGE_SIZE) {
    376       1.2  matt 		va -= PAGE_SIZE;
    377       1.2  matt 		pa -= PAGE_SIZE;
    378       1.2  matt 		pmap_kenter_pa(va, pa, VM_PROT_READ|VM_PROT_WRITE,
    379      1.14  matt 		    prefetchable ? 0 : PMAP_NOCACHE);
    380       1.2  matt 	}
    381       1.2  matt 	pmap_update(pmap_kernel());
    382       1.2  matt 	return (void *)(va + off);
    383       1.2  matt }
    384       1.2  matt 
    385       1.2  matt void
    386       1.2  matt unmapiodev(vaddr_t va, vsize_t len)
    387       1.2  matt {
    388       1.2  matt 	/* Nothing to do for reserved (ie. not uvm_km_alloc'd) mappings. */
    389       1.2  matt 	if (va < VM_MIN_KERNEL_ADDRESS || va > VM_MAX_KERNEL_ADDRESS) {
    390       1.2  matt 		tlb_unmapiodev(va, len);
    391       1.2  matt 		return;
    392       1.2  matt 	}
    393       1.2  matt 
    394       1.2  matt 	len = round_page((va & PAGE_MASK) + len);
    395       1.2  matt 	va = trunc_page(va);
    396       1.2  matt 
    397       1.2  matt 	pmap_kremove(va, len);
    398       1.2  matt 	uvm_km_free(kernel_map, va, len, UVM_KMF_VAONLY);
    399       1.2  matt }
    400       1.2  matt 
    401       1.2  matt void
    402       1.2  matt cpu_evcnt_attach(struct cpu_info *ci)
    403       1.2  matt {
    404       1.2  matt 	struct cpu_softc * const cpu = ci->ci_softc;
    405      1.12  matt 	const char * const xname = ci->ci_data.cpu_name;
    406       1.2  matt 
    407       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_clock, EVCNT_TYPE_INTR,
    408       1.2  matt 		NULL, xname, "clock");
    409       1.2  matt 	evcnt_attach_dynamic_nozero(&cpu->cpu_ev_late_clock, EVCNT_TYPE_INTR,
    410       1.2  matt 		NULL, xname, "late clock");
    411       1.2  matt 	evcnt_attach_dynamic_nozero(&cpu->cpu_ev_exec_trap_sync, EVCNT_TYPE_TRAP,
    412       1.2  matt 		NULL, xname, "exec pages synced (trap)");
    413       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_traps, EVCNT_TYPE_TRAP,
    414       1.2  matt 		NULL, xname, "traps");
    415       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_kdsi, EVCNT_TYPE_TRAP,
    416       1.2  matt 		&ci->ci_ev_traps, xname, "kernel DSI traps");
    417       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_udsi, EVCNT_TYPE_TRAP,
    418       1.2  matt 		&ci->ci_ev_traps, xname, "user DSI traps");
    419       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_udsi_fatal, EVCNT_TYPE_TRAP,
    420       1.2  matt 		&ci->ci_ev_udsi, xname, "user DSI failures");
    421       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_kisi, EVCNT_TYPE_TRAP,
    422       1.2  matt 		&ci->ci_ev_traps, xname, "kernel ISI traps");
    423       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_isi, EVCNT_TYPE_TRAP,
    424       1.2  matt 		&ci->ci_ev_traps, xname, "user ISI traps");
    425       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_isi_fatal, EVCNT_TYPE_TRAP,
    426       1.2  matt 		&ci->ci_ev_isi, xname, "user ISI failures");
    427       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_scalls, EVCNT_TYPE_TRAP,
    428       1.2  matt 		&ci->ci_ev_traps, xname, "system call traps");
    429       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_pgm, EVCNT_TYPE_TRAP,
    430       1.2  matt 		&ci->ci_ev_traps, xname, "PGM traps");
    431       1.3  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_debug, EVCNT_TYPE_TRAP,
    432       1.3  matt 		&ci->ci_ev_traps, xname, "debug traps");
    433       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_fpu, EVCNT_TYPE_TRAP,
    434       1.2  matt 		&ci->ci_ev_traps, xname, "FPU unavailable traps");
    435       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_fpusw, EVCNT_TYPE_MISC,
    436       1.2  matt 		&ci->ci_ev_fpu, xname, "FPU context switches");
    437       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_ali, EVCNT_TYPE_TRAP,
    438       1.2  matt 		&ci->ci_ev_traps, xname, "user alignment traps");
    439       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_ali_fatal, EVCNT_TYPE_TRAP,
    440       1.2  matt 		&ci->ci_ev_ali, xname, "user alignment traps");
    441       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_umchk, EVCNT_TYPE_TRAP,
    442       1.2  matt 		&ci->ci_ev_umchk, xname, "user MCHK failures");
    443       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_vec, EVCNT_TYPE_TRAP,
    444       1.2  matt 		&ci->ci_ev_traps, xname, "SPE unavailable");
    445       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_vecsw, EVCNT_TYPE_MISC,
    446       1.2  matt 	    &ci->ci_ev_vec, xname, "SPE context switches");
    447       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_ipi, EVCNT_TYPE_INTR,
    448       1.2  matt 		NULL, xname, "IPIs");
    449       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_tlbmiss_soft, EVCNT_TYPE_TRAP,
    450       1.2  matt 		&ci->ci_ev_traps, xname, "soft tlb misses");
    451       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_dtlbmiss_hard, EVCNT_TYPE_TRAP,
    452       1.2  matt 		&ci->ci_ev_traps, xname, "data tlb misses");
    453       1.2  matt 	evcnt_attach_dynamic_nozero(&ci->ci_ev_itlbmiss_hard, EVCNT_TYPE_TRAP,
    454       1.2  matt 		&ci->ci_ev_traps, xname, "inst tlb misses");
    455       1.2  matt }
    456       1.2  matt 
    457      1.12  matt #ifdef MULTIPROCESSOR
    458      1.12  matt register_t
    459      1.12  matt cpu_hatch(void)
    460      1.12  matt {
    461      1.12  matt 	volatile struct cpuset_info * const csi = &cpuset_info;
    462      1.12  matt 	const size_t id = cpu_number();
    463      1.12  matt 
    464      1.12  matt 	/*
    465      1.12  matt 	 * We've hatched so tell the spinup code.
    466      1.12  matt 	 */
    467      1.12  matt 	CPUSET_ADD(csi->cpus_hatched, id);
    468      1.12  matt 
    469      1.12  matt 	/*
    470      1.12  matt 	 * Loop until running bit for this cpu is set.
    471      1.12  matt 	 */
    472      1.12  matt 	while (!CPUSET_HAS_P(csi->cpus_running, id)) {
    473      1.12  matt 		continue;
    474      1.12  matt 	}
    475      1.12  matt 
    476      1.12  matt 	/*
    477      1.12  matt 	 * Now that we are active, start the clocks.
    478      1.12  matt 	 */
    479      1.12  matt 	cpu_initclocks();
    480      1.12  matt 
    481      1.12  matt 	/*
    482      1.12  matt 	 * Return sp of the idlelwp.  Which we should be already using but ...
    483      1.12  matt 	 */
    484      1.12  matt 	return curcpu()->ci_curpcb->pcb_sp;
    485      1.12  matt }
    486      1.12  matt 
    487      1.12  matt void
    488      1.12  matt cpu_boot_secondary_processors(void)
    489      1.12  matt {
    490      1.12  matt 	volatile struct cpuset_info * const csi = &cpuset_info;
    491      1.12  matt 	CPU_INFO_ITERATOR cii;
    492      1.12  matt 	struct cpu_info *ci;
    493      1.12  matt 	__cpuset_t running = CPUSET_NULLSET;
    494      1.12  matt 
    495      1.12  matt 	for (CPU_INFO_FOREACH(cii, ci)) {
    496      1.12  matt 		/*
    497      1.12  matt 		 * Skip this CPU if it didn't sucessfully hatch.
    498      1.12  matt 		 */
    499      1.12  matt 		if (! CPUSET_HAS_P(csi->cpus_hatched, cpu_index(ci)))
    500      1.12  matt 			continue;
    501      1.12  matt 
    502      1.12  matt 		KASSERT(!CPU_IS_PRIMARY(ci));
    503      1.12  matt 		KASSERT(ci->ci_data.cpu_idlelwp);
    504      1.12  matt 
    505      1.12  matt 		CPUSET_ADD(running, cpu_index(ci));
    506      1.12  matt 	}
    507      1.12  matt 	KASSERT(CPUSET_EQUAL_P(csi->cpus_hatched, running));
    508      1.12  matt 	if (!CPUSET_EMPTY_P(running)) {
    509      1.12  matt 		CPUSET_ADDSET(csi->cpus_running, running);
    510      1.12  matt 	}
    511      1.12  matt }
    512      1.12  matt #endif
    513      1.12  matt 
    514       1.2  matt uint32_t
    515       1.2  matt cpu_read_4(bus_addr_t a)
    516       1.2  matt {
    517       1.2  matt 	struct cpu_softc * const cpu = curcpu()->ci_softc;
    518       1.2  matt //	printf(" %s(%p, %x, %x)", __func__, cpu->cpu_bst, cpu->cpu_bsh, a);
    519       1.2  matt 	return bus_space_read_4(cpu->cpu_bst, cpu->cpu_bsh, a);
    520       1.2  matt }
    521       1.2  matt 
    522       1.2  matt uint8_t
    523       1.2  matt cpu_read_1(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_1(cpu->cpu_bst, cpu->cpu_bsh, a);
    528       1.2  matt }
    529       1.2  matt 
    530       1.2  matt void
    531       1.2  matt cpu_write_4(bus_addr_t a, uint32_t v)
    532       1.2  matt {
    533       1.2  matt 	struct cpu_softc * const cpu = curcpu()->ci_softc;
    534       1.2  matt 	bus_space_write_4(cpu->cpu_bst, cpu->cpu_bsh, a, v);
    535       1.2  matt }
    536       1.2  matt 
    537       1.2  matt void
    538       1.2  matt cpu_write_1(bus_addr_t a, uint8_t v)
    539       1.2  matt {
    540       1.2  matt 	struct cpu_softc * const cpu = curcpu()->ci_softc;
    541       1.2  matt 	bus_space_write_1(cpu->cpu_bst, cpu->cpu_bsh, a, v);
    542       1.2  matt }
    543       1.4  matt 
    544       1.4  matt void
    545       1.4  matt booke_sstep(struct trapframe *tf)
    546       1.4  matt {
    547       1.4  matt 	KASSERT(tf->tf_srr1 & PSL_DE);
    548       1.4  matt 	const uint32_t insn = ufetch_32((const void *)tf->tf_srr0);
    549       1.4  matt 	register_t dbcr0 = DBCR0_IAC1 | DBCR0_IDM;
    550       1.4  matt 	register_t dbcr1 = DBCR1_IAC1US_USER | DBCR1_IAC1ER_DS1;
    551       1.4  matt 	if ((insn >> 28) == 4) {
    552       1.4  matt 		uint32_t iac2 = 0;
    553       1.4  matt 		if ((insn >> 26) == 0x12) {
    554       1.4  matt 			const int32_t off = (((int32_t)insn << 6) >> 6) & ~3;
    555       1.4  matt 			iac2 = ((insn & 2) ? 0 : tf->tf_srr0) + off;
    556       1.4  matt 			dbcr0 |= DBCR0_IAC2;
    557       1.4  matt 		} else if ((insn >> 26) == 0x10) {
    558       1.4  matt 			const int16_t off = insn & ~3;
    559       1.4  matt 			iac2 = ((insn & 2) ? 0 : tf->tf_srr0) + off;
    560       1.4  matt 			dbcr0 |= DBCR0_IAC2;
    561       1.4  matt 		} else if ((insn & 0xfc00ffde) == 0x4c000420) {
    562       1.4  matt 			iac2 = tf->tf_ctr;
    563       1.4  matt 			dbcr0 |= DBCR0_IAC2;
    564       1.4  matt 		} else if ((insn & 0xfc00ffde) == 0x4c000020) {
    565       1.4  matt 			iac2 = tf->tf_lr;
    566       1.4  matt 			dbcr0 |= DBCR0_IAC2;
    567       1.4  matt 		}
    568       1.4  matt 		if (dbcr0 & DBCR0_IAC2) {
    569       1.4  matt 			dbcr1 |= DBCR1_IAC2US_USER | DBCR1_IAC2ER_DS1;
    570       1.4  matt 			mtspr(SPR_IAC2, iac2);
    571       1.4  matt 		}
    572       1.4  matt 	}
    573       1.4  matt 	mtspr(SPR_IAC1, tf->tf_srr0 + 4);
    574       1.4  matt 	mtspr(SPR_DBCR1, dbcr1);
    575       1.4  matt 	mtspr(SPR_DBCR0, dbcr0);
    576       1.4  matt }
    577      1.16  matt 
    578      1.16  matt #ifdef DIAGNOSTIC
    579      1.16  matt static inline void
    580      1.16  matt swap_data(uint64_t *data, size_t a, size_t b)
    581      1.16  matt {
    582      1.16  matt 	uint64_t swap = data[a];
    583      1.16  matt 	data[a] = data[b];
    584      1.16  matt 	data[b] = swap;
    585      1.16  matt }
    586      1.16  matt 
    587      1.16  matt static void
    588      1.16  matt sort_data(uint64_t *data, size_t count)
    589      1.16  matt {
    590      1.16  matt #if 0
    591      1.16  matt 	/*
    592      1.16  matt 	 * Mostly classic bubble sort
    593      1.16  matt 	 */
    594      1.16  matt 	do {
    595      1.16  matt 		size_t new_count = 0;
    596      1.16  matt 		for (size_t i = 1; i < count; i++) {
    597      1.16  matt 			if (tbs[i - 1] > tbs[i]) {
    598      1.16  matt 				swap_tbs(tbs, i - 1, i);
    599      1.16  matt 				new_count = i;
    600      1.16  matt 			}
    601      1.16  matt 		}
    602      1.16  matt 		count = new_count;
    603      1.16  matt 	} while (count > 0);
    604      1.16  matt #else
    605      1.16  matt 	/*
    606      1.16  matt 	 * Comb sort
    607      1.16  matt 	 */
    608      1.16  matt 	size_t gap = count;
    609      1.16  matt 	bool swapped = false;
    610      1.16  matt 	while (gap > 1 || swapped) {
    611      1.16  matt 		if (gap > 1) {
    612      1.16  matt 			/*
    613      1.16  matt 			 * phi = (1 + sqrt(5)) / 2 [golden ratio]
    614      1.16  matt 			 * N = 1 / (1 - e^-phi)) = 1.247330950103979
    615      1.16  matt 			 *
    616      1.16  matt 			 * We want to but can't use floating point to calculate
    617      1.16  matt 			 *	gap = (size_t)((double)gap / N)
    618      1.16  matt 			 *
    619      1.16  matt 			 * So we will use the multicative inverse of N
    620      1.16  matt 			 * (module 65536) to achieve the division.
    621      1.16  matt 			 *
    622      1.16  matt 			 * iN = 2^16 / 1.24733... = 52540
    623      1.16  matt 			 * x / N == (x * iN) / 65536
    624      1.16  matt 			 */
    625      1.16  matt 			gap = (gap * 52540) / 65536;
    626      1.16  matt 		}
    627      1.16  matt 
    628      1.16  matt 		swapped = false;
    629      1.16  matt 
    630      1.16  matt 		for (size_t i = 0; gap + i < count; i++) {
    631      1.16  matt 			if (data[i] > data[i + gap]) {
    632      1.16  matt 				swap_data(data, i, i + gap);
    633      1.16  matt 				swapped = true;
    634      1.16  matt 			}
    635      1.16  matt 		}
    636      1.16  matt 	}
    637      1.16  matt #endif
    638      1.16  matt }
    639      1.16  matt #endif
    640      1.16  matt 
    641      1.16  matt void
    642      1.16  matt dump_splhist(struct cpu_info *ci, void (*pr)(const char *, ...))
    643      1.16  matt {
    644      1.16  matt #ifdef DIAGNOSTIC
    645      1.16  matt 	struct cpu_softc * const cpu = ci->ci_softc;
    646      1.16  matt 	uint64_t tbs[NIPL*NIPL];
    647      1.16  matt 	size_t ntbs = 0;
    648      1.16  matt 	for (size_t to = 0; to < NIPL; to++) {
    649      1.16  matt 		for (size_t from = 0; from < NIPL; from++) {
    650      1.16  matt 			uint64_t tb = cpu->cpu_spl_tb[to][from];
    651      1.16  matt 			if (tb == 0)
    652      1.16  matt 				continue;
    653      1.16  matt 			tbs[ntbs++] = (tb << 8) | (to << 4) | from;
    654      1.16  matt 		}
    655      1.16  matt 	}
    656      1.16  matt 	sort_data(tbs, ntbs);
    657      1.16  matt 
    658      1.16  matt 	if (pr == NULL)
    659      1.16  matt 		pr = printf;
    660      1.16  matt 	uint64_t last_tb = 0;
    661      1.16  matt 	for (size_t i = 0; i < ntbs; i++) {
    662      1.16  matt 		uint64_t tb = tbs[i];
    663      1.16  matt 		size_t from = tb & 15;
    664      1.16  matt 		size_t to = (tb >> 4) & 15;
    665      1.16  matt 		tb >>= 8;
    666      1.16  matt 		(*pr)("%s(%zu) from %zu at %"PRId64"",
    667      1.16  matt 		     from < to ? "splraise" : "splx",
    668      1.16  matt 		     to, from, tb);
    669      1.16  matt 		if (last_tb && from != IPL_NONE)
    670      1.16  matt 			(*pr)(" (+%"PRId64")", tb - last_tb);
    671      1.16  matt 		(*pr)("\n");
    672      1.16  matt 		last_tb = tb;
    673      1.16  matt 	}
    674      1.16  matt #endif
    675      1.16  matt }
    676