Home | History | Annotate | Line # | Download | only in dev
cpunode.c revision 1.2.2.2
      1  1.2.2.2  bouyer /*	$NetBSD: cpunode.c,v 1.2.2.2 2011/02/17 11:59:55 bouyer 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 #include <sys/cdefs.h>
     38      1.2    matt 
     39  1.2.2.2  bouyer __KERNEL_RCSID(0, "$NetBSD: cpunode.c,v 1.2.2.2 2011/02/17 11:59:55 bouyer Exp $");
     40      1.2    matt 
     41      1.2    matt #include <sys/param.h>
     42      1.2    matt #include <sys/device.h>
     43      1.2    matt #include <sys/cpu.h>
     44      1.2    matt 
     45      1.2    matt #include "ioconf.h"
     46      1.2    matt 
     47      1.2    matt #include <powerpc/booke/cpuvar.h>
     48      1.2    matt 
     49      1.2    matt static int cpunode_match(device_t, cfdata_t, void *);
     50      1.2    matt static void cpunode_attach(device_t, device_t, void *);
     51      1.2    matt 
     52      1.2    matt CFATTACH_DECL_NEW(cpunode, sizeof(struct cpunode_softc),
     53      1.2    matt     cpunode_match, cpunode_attach, NULL, NULL);
     54      1.2    matt 
     55      1.2    matt static u_int nodes;
     56      1.2    matt 
     57      1.2    matt static int
     58      1.2    matt cpunode_match(device_t parent, cfdata_t cf, void *aux)
     59      1.2    matt {
     60      1.2    matt 	struct mainbus_attach_args * const ma = aux;
     61      1.2    matt 	if (strcmp(ma->ma_name, cpunode_cd.cd_name) != 0)
     62      1.2    matt 		return 0;
     63      1.2    matt 
     64      1.2    matt 	if (ma->ma_node > 8 || (nodes & (1 << ma->ma_node)))
     65      1.2    matt 		return 0;
     66      1.2    matt 
     67      1.2    matt 	return 1;
     68      1.2    matt }
     69      1.2    matt 
     70      1.2    matt static int
     71      1.2    matt cpunode_print(void *aux, const char *pnp)
     72      1.2    matt {
     73      1.2    matt 	struct cpunode_attach_args *cna = aux;
     74      1.2    matt 
     75      1.2    matt 	if (pnp)
     76      1.2    matt #if 0
     77      1.2    matt 		return QUIET;
     78      1.2    matt #else
     79      1.2    matt 		aprint_normal("%s at %s", cna->cna_locs.cnl_name, pnp);
     80      1.2    matt #endif
     81      1.2    matt 
     82      1.2    matt 	if (cna->cna_locs.cnl_instance != 0)
     83      1.2    matt 		aprint_normal(" instance %d", cna->cna_locs.cnl_instance);
     84      1.2    matt 
     85      1.2    matt 	return UNCONF;
     86      1.2    matt }
     87      1.2    matt 
     88      1.2    matt static void
     89      1.2    matt cpunode_attach(device_t parent, device_t self, void *aux)
     90      1.2    matt {
     91      1.2    matt 	const struct cpunode_locators *cnl = cpu_md_ops.md_cpunode_locs;
     92      1.2    matt 	struct cpunode_softc * const sc = device_private(self);
     93      1.2    matt 	struct mainbus_attach_args * const ma = aux;
     94      1.2    matt 	struct cpunode_attach_args cna;
     95      1.2    matt 
     96      1.2    matt 	sc->sc_dev = self;
     97      1.2    matt 
     98      1.2    matt 	aprint_normal("\n");
     99      1.2    matt 	aprint_normal_dev(self,
    100      1.2    matt 	    "%"PRIu64"KB/%"PRIu64"B %"PRIu64"-banked %"PRIu64"-way unified L2 cache\n",
    101      1.2    matt 	    board_info_get_number("l2-cache-size") / 1024,
    102      1.2    matt 	    board_info_get_number("l2-cache-line-size"),
    103      1.2    matt 	    board_info_get_number("l2-cache-banks"),
    104      1.2    matt 	    board_info_get_number("l2-cache-ways"));
    105      1.2    matt 
    106      1.2    matt 	nodes |= 1 << ma->ma_node;
    107      1.2    matt 
    108  1.2.2.1  bouyer 	const uint16_t my_id = board_info_get_number("my-id");
    109  1.2.2.1  bouyer 
    110  1.2.2.1  bouyer 	for (u_int childmask = 1; cnl->cnl_name != NULL; cnl++) {
    111  1.2.2.1  bouyer 		bool inclusive = true;
    112  1.2.2.1  bouyer 		bool found = (cnl->cnl_ids[0] == 0);
    113  1.2.2.1  bouyer 		for (u_int i = 0;
    114  1.2.2.1  bouyer 		     !found
    115  1.2.2.1  bouyer 		     && i < __arraycount(cnl->cnl_ids)
    116  1.2.2.1  bouyer 		     && cnl->cnl_ids[i] != 0;
    117  1.2.2.1  bouyer 		     i++) {
    118  1.2.2.1  bouyer 			if (cnl->cnl_ids[i] == 0xffff) {
    119  1.2.2.1  bouyer 				inclusive = false;
    120  1.2.2.1  bouyer 				continue;
    121  1.2.2.1  bouyer 			}
    122  1.2.2.1  bouyer 			found = (cnl->cnl_ids[i] == my_id);
    123  1.2.2.1  bouyer 		}
    124  1.2.2.1  bouyer 		/*
    125  1.2.2.1  bouyer 		 * found & inclusive == match
    126  1.2.2.1  bouyer 		 * !found & !inclusive == match
    127  1.2.2.1  bouyer 		 * found & !inclusive == no match
    128  1.2.2.1  bouyer 		 * !found & inclusive == no match
    129  1.2.2.1  bouyer 		 * therefore
    130  1.2.2.1  bouyer 		 * found ^ inclusive = no match
    131  1.2.2.1  bouyer 		 * so
    132  1.2.2.1  bouyer 		 * !(found ^ inclusive) = match
    133  1.2.2.1  bouyer 		 */
    134  1.2.2.1  bouyer 		if (found ^ inclusive)
    135  1.2.2.1  bouyer 			continue;
    136  1.2.2.1  bouyer 
    137      1.2    matt 		cna.cna_busname = "cpunode";
    138      1.2    matt 		cna.cna_memt = ma->ma_memt;
    139  1.2.2.2  bouyer 		cna.cna_le_memt = ma->ma_le_memt;
    140      1.2    matt 		cna.cna_dmat = ma->ma_dmat;
    141      1.2    matt 		cna.cna_childmask = childmask;
    142      1.2    matt 		cna.cna_locs = *cnl;
    143      1.2    matt 
    144      1.2    matt #if DEBUG > 1
    145      1.2    matt 		aprint_normal_dev(self, "dev=%s[%u], addr=%x@%x",
    146      1.2    matt 		    cnl->cnl_name, cnl->cnl_instance, cnl->cnl_size,
    147      1.2    matt 		    cnl->cnl_addr);
    148      1.2    matt 		if (cnl->cnl_nintr > 0) {
    149      1.2    matt 			aprint_normal(", intrs=%u", cnl->cnl_intrs[0]);
    150      1.2    matt 			for (u_int i = 1; i < cnl->cnl_nintr; i++)
    151      1.2    matt 				aprint_normal(",%u", cnl->cnl_intrs[i]);
    152      1.2    matt 		}
    153      1.2    matt 		aprint_normal("\n");
    154      1.2    matt #endif
    155      1.2    matt 		(void)config_found_sm_loc(self, "cpunode", NULL, &cna,
    156      1.2    matt 		    cpunode_print, NULL);
    157  1.2.2.1  bouyer 		childmask <<= 1;
    158      1.2    matt 	}
    159      1.2    matt 	/*
    160      1.2    matt 	 * Anything MD left to do?
    161      1.2    matt 	 */
    162      1.2    matt 	if (cpu_md_ops.md_cpunode_attach != NULL)
    163      1.2    matt 		(*cpu_md_ops.md_cpunode_attach)(parent, self, aux);
    164      1.2    matt }
    165      1.2    matt 
    166      1.2    matt static int cpu_match(device_t, cfdata_t, void *);
    167      1.2    matt static void cpu_attach(device_t, device_t, void *);
    168      1.2    matt 
    169      1.2    matt CFATTACH_DECL_NEW(cpu, 0,
    170      1.2    matt     cpu_match, cpu_attach, NULL, NULL);
    171      1.2    matt 
    172      1.2    matt static int
    173      1.2    matt cpu_match(device_t parent, cfdata_t cf, void *aux)
    174      1.2    matt {
    175      1.2    matt 	struct cpunode_softc * const psc = device_private(parent);
    176      1.2    matt 	struct cpunode_attach_args * const cna = aux;
    177      1.2    matt 
    178      1.2    matt 	if (strcmp(cna->cna_locs.cnl_name, cpu_cd.cd_name) != 0)
    179      1.2    matt 		return 0;
    180      1.2    matt 
    181      1.2    matt 	if (psc->sc_children & cna->cna_childmask)
    182      1.2    matt 		return 0;
    183      1.2    matt 
    184      1.2    matt 	return 1;
    185      1.2    matt }
    186      1.2    matt 
    187      1.2    matt static void
    188      1.2    matt cpu_attach(device_t parent, device_t self, void *aux)
    189      1.2    matt {
    190      1.2    matt 	struct cpunode_softc * const psc = device_private(parent);
    191      1.2    matt 	struct cpunode_attach_args * const cna = aux;
    192      1.2    matt 
    193      1.2    matt 	psc->sc_children |= cna->cna_childmask;
    194      1.2    matt 
    195      1.2    matt 	aprint_normal("\n");
    196      1.2    matt 
    197      1.2    matt 	(*cpu_md_ops.md_cpu_attach)(self, cna->cna_locs.cnl_instance);
    198      1.2    matt }
    199