Home | History | Annotate | Line # | Download | only in dev
central.c revision 1.2
      1 /*	$NetBSD: central.c,v 1.2 2011/08/01 08:36:39 mrg Exp $	*/
      2 /*	$OpenBSD: central.c,v 1.7 2010/11/11 17:58:23 miod Exp $	*/
      3 
      4 /*
      5  * Copyright (c) 2004 Jason L. Wright (jason (at) thought.net)
      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  *
     17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     19  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     20  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     21  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     22  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     23  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     25  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     26  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     27  * POSSIBILITY OF SUCH DAMAGE.
     28  */
     29 
     30 #include <sys/types.h>
     31 #include <sys/param.h>
     32 #include <sys/systm.h>
     33 #include <sys/kernel.h>
     34 #include <sys/device.h>
     35 #include <sys/conf.h>
     36 #include <sys/malloc.h>
     37 #include <sys/bus.h>
     38 
     39 #include <machine/autoconf.h>
     40 #include <machine/openfirm.h>
     41 
     42 #include <sparc64/dev/centralvar.h>
     43 
     44 struct central_softc {
     45 	bus_space_tag_t sc_bt;
     46 	bus_space_tag_t sc_cbt;
     47 	int sc_node;
     48 	int sc_nrange;
     49 	struct central_range *sc_range;
     50 };
     51 
     52 static int central_match(device_t, cfdata_t, void *);
     53 static void central_attach(device_t, device_t, void *);
     54 
     55 CFATTACH_DECL_NEW(central, sizeof(struct central_softc),
     56     central_match, central_attach, NULL, NULL);
     57 
     58 static int central_print(void *, const char *);
     59 static int central_get_string(int, const char *, char **);
     60 
     61 static bus_space_tag_t central_alloc_bus_tag(struct central_softc *);
     62 static int _central_bus_map(
     63 		bus_space_tag_t,
     64 		bus_addr_t,		/*offset*/
     65 		bus_size_t,		/*size*/
     66 		int,			/*flags*/
     67 		vaddr_t,		/* XXX unused -- compat w/sparc */
     68 		bus_space_handle_t *);
     69 
     70 static int
     71 central_match(device_t parent, cfdata_t match, void *aux)
     72 {
     73 	struct mainbus_attach_args *ma = aux;
     74 
     75 	if (strcmp(ma->ma_name, "central") == 0)
     76 		return (1);
     77 	return (0);
     78 }
     79 
     80 static void
     81 central_attach(device_t parent, device_t self, void *aux)
     82 {
     83 	struct central_softc *sc = device_private(self);
     84 	struct mainbus_attach_args *ma = aux;
     85 	int node0, node;
     86 
     87 	sc->sc_bt = ma->ma_bustag;
     88 	sc->sc_node = ma->ma_node;
     89 	sc->sc_cbt = central_alloc_bus_tag(sc);
     90 
     91 	prom_getprop(sc->sc_node, "ranges", sizeof(struct central_range),
     92 	    &sc->sc_nrange, (void **)&sc->sc_range);
     93 
     94 	printf("\n");
     95 
     96 	node0 = firstchild(sc->sc_node);
     97 	for (node = node0; node; node = nextsibling(node)) {
     98 		struct central_attach_args ca;
     99 
    100 		bzero(&ca, sizeof(ca));
    101 		ca.ca_node = node;
    102 		ca.ca_bustag = sc->sc_cbt;
    103 		if (central_get_string(ca.ca_node, "name", &ca.ca_name)) {
    104 			printf("can't fetch name for node 0x%x\n", node);
    105 			continue;
    106 		}
    107 
    108 		prom_getprop(node, "reg", sizeof(struct central_reg),
    109 		    &ca.ca_nreg, (void **)&ca.ca_reg);
    110 
    111 		(void)config_found(self, (void *)&ca, central_print);
    112 
    113 		if (ca.ca_name != NULL)
    114 			free(ca.ca_name, M_DEVBUF);
    115 	}
    116 }
    117 
    118 static int
    119 central_get_string(int node, const char *name, char **buf)
    120 {
    121 	int len;
    122 
    123 	len = prom_getproplen(node, name);
    124 	if (len < 0)
    125 		return (len);
    126 	*buf = (char *)malloc(len + 1, M_DEVBUF, M_NOWAIT);
    127 	if (*buf == NULL)
    128 		return (-1);
    129 
    130 	if (len != 0)
    131 		prom_getpropstringA(node, name, *buf, len + 1);
    132 	(*buf)[len] = '\0';
    133 	return (0);
    134 }
    135 
    136 static int
    137 central_print(void *args, const char *busname)
    138 {
    139 	struct central_attach_args *ca = args;
    140 	char *class;
    141 
    142 	if (busname != NULL) {
    143 		printf("\"%s\" at %s", ca->ca_name, busname);
    144 		class = prom_getpropstring(ca->ca_node, "device_type");
    145 		if (*class != '\0')
    146 			printf(" class %s", class);
    147 	}
    148 	return (UNCONF);
    149 }
    150 
    151 static bus_space_tag_t
    152 central_alloc_bus_tag(struct central_softc *sc)
    153 {
    154 	struct sparc_bus_space_tag *bt;
    155 
    156 	bt = malloc(sizeof(*bt), M_DEVBUF, M_NOWAIT | M_ZERO);
    157 	if (bt == NULL)
    158 		panic("central: couldn't alloc bus tag");
    159 
    160 	bt->cookie = sc;
    161 	bt->parent = sc->sc_bt;
    162 #if 0
    163 	bt->asi = bt->parent->asi;
    164 	bt->sasi = bt->parent->sasi;
    165 #endif
    166 	bt->sparc_bus_map = _central_bus_map;
    167 	/* XXX bt->sparc_bus_mmap = central_bus_mmap; */
    168 	/* XXX bt->sparc_intr_establish = upa_intr_establish; */
    169 	return (bt);
    170 }
    171 
    172 static int
    173 _central_bus_map(bus_space_tag_t t, bus_addr_t addr, bus_size_t size, int flags,
    174 	vaddr_t v, bus_space_handle_t *hp)
    175 {
    176 	struct central_softc *sc = t->cookie;
    177 	int64_t slot = BUS_ADDR_IOSPACE(addr);
    178 	int64_t offset = BUS_ADDR_PADDR(addr);
    179 	int i;
    180 
    181 	if (t->parent == NULL || t->parent->sparc_bus_map == NULL) {
    182 		printf("\ncentral_bus_map: invalid parent");
    183 		return (EINVAL);
    184 	}
    185 
    186 
    187 	for (i = 0; i < sc->sc_nrange; i++) {
    188 		bus_addr_t paddr;
    189 
    190 		if (sc->sc_range[i].cspace != slot)
    191 			continue;
    192 
    193 		paddr = offset - sc->sc_range[i].coffset;
    194 		paddr += sc->sc_range[i].poffset;
    195 		paddr |= ((bus_addr_t)sc->sc_range[i].pspace << 32);
    196 
    197 		return bus_space_map(t->parent, paddr, size, flags, hp);
    198 	}
    199 
    200 	return (EINVAL);
    201 }
    202