sys/sparc64/central/central.c

   1 /*-
   2  * Copyright (c) 2003 Jake Burkholder.
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include <sys/param.h>
  31 #include <sys/systm.h>
  32 #include <sys/bus.h>
  33 #include <sys/kernel.h>
  34 #include <sys/malloc.h>
  35 #include <sys/module.h>
  36
  37 #include <dev/ofw/ofw_bus.h>
  38 #include <dev/ofw/ofw_bus_subr.h>
  39 #include <dev/ofw/openfirm.h>
  40
  41 #include <machine/bus.h>
  42 #include <machine/resource.h>
  43
  44 #include <sys/rman.h>
  45
  46 #include <sparc64/sbus/ofw_sbus.h>
  47
  48 struct central_devinfo {
  49         struct ofw_bus_devinfo  cdi_obdinfo;
  50         struct resource_list    cdi_rl;
  51 };
  52
  53 struct central_softc {
  54         int                     sc_nrange;
  55         struct sbus_ranges      *sc_ranges;
  56 };
  57
  58 static device_probe_t central_probe;
  59 static device_attach_t central_attach;
  60 static bus_print_child_t central_print_child;
  61 static bus_probe_nomatch_t central_probe_nomatch;
  62 static bus_alloc_resource_t central_alloc_resource;
  63 static bus_get_resource_list_t central_get_resource_list;
  64 static ofw_bus_get_devinfo_t central_get_devinfo;
  65
  66 static int central_print_res(struct central_devinfo *);
  67
  68 static device_method_t central_methods[] = {
  69         /* Device interface */
  70         DEVMETHOD(device_probe,         central_probe),
  71         DEVMETHOD(device_attach,        central_attach),
  72         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
  73         DEVMETHOD(device_suspend,       bus_generic_suspend),
  74         DEVMETHOD(device_resume,        bus_generic_resume),
  75
  76         /* Bus interface */
  77         DEVMETHOD(bus_print_child,      central_print_child),
  78         DEVMETHOD(bus_probe_nomatch,    central_probe_nomatch),
  79         DEVMETHOD(bus_alloc_resource,   central_alloc_resource),
  80         DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
  81         DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
  82         DEVMETHOD(bus_release_resource, bus_generic_rl_release_resource),
  83         DEVMETHOD(bus_setup_intr,       bus_generic_setup_intr),
  84         DEVMETHOD(bus_teardown_intr,    bus_generic_teardown_intr),
  85         DEVMETHOD(bus_get_resource,     bus_generic_rl_get_resource),
  86         DEVMETHOD(bus_get_resource_list, central_get_resource_list),
  87         DEVMETHOD(bus_child_pnpinfo_str, ofw_bus_gen_child_pnpinfo_str),
  88
  89         /* ofw_bus interface */
  90         DEVMETHOD(ofw_bus_get_devinfo,  central_get_devinfo),
  91         DEVMETHOD(ofw_bus_get_compat,   ofw_bus_gen_get_compat),
  92         DEVMETHOD(ofw_bus_get_model,    ofw_bus_gen_get_model),
  93         DEVMETHOD(ofw_bus_get_name,     ofw_bus_gen_get_name),
  94         DEVMETHOD(ofw_bus_get_node,     ofw_bus_gen_get_node),
  95         DEVMETHOD(ofw_bus_get_type,     ofw_bus_gen_get_type),
  96
  97         KOBJMETHOD_END
  98 };
  99
 100 static driver_t central_driver = {
 101         "central",
 102         central_methods,
 103         sizeof(struct central_softc),
 104 };
 105
 106 static devclass_t central_devclass;
 107
 108 EARLY_DRIVER_MODULE(central, nexus, central_driver, central_devclass, 0, 0,
 109     BUS_PASS_BUS);
 110 MODULE_DEPEND(fhc, nexus, 1, 1, 1);
 111 MODULE_VERSION(central, 1);
 112
 113 static int
 114 central_probe(device_t dev)
 115 {
 116
 117         if (strcmp(ofw_bus_get_name(dev), "central") == 0) {
 118                 device_set_desc(dev, "central");
 119                 return (0);
 120         }
 121         return (ENXIO);
 122 }
 123
 124 static int
 125 central_attach(device_t dev)
 126 {
 127         struct central_devinfo *cdi;
 128         struct sbus_regs *reg;
 129         struct central_softc *sc;
 130         phandle_t child;
 131         phandle_t node;
 132         device_t cdev;
 133         int nreg;
 134         int i;
 135
 136         sc = device_get_softc(dev);
 137         node = ofw_bus_get_node(dev);
 138
 139         sc->sc_nrange = OF_getprop_alloc(node, "ranges",
 140             sizeof(*sc->sc_ranges), (void **)&sc->sc_ranges);
 141         if (sc->sc_nrange == -1) {
 142                 device_printf(dev, "can't get ranges\n");
 143                 return (ENXIO);
 144         }
 145
 146         for (child = OF_child(node); child != 0; child = OF_peer(child)) {
 147                 cdi = malloc(sizeof(*cdi), M_DEVBUF, M_WAITOK | M_ZERO);
 148                 if (ofw_bus_gen_setup_devinfo(&cdi->cdi_obdinfo, child) != 0) {
 149                         free(cdi, M_DEVBUF);
 150                         continue;
 151                 }
 152                 nreg = OF_getprop_alloc(child, "reg", sizeof(*reg),
 153                     (void **)&reg);
 154                 if (nreg == -1) {
 155                         device_printf(dev, "<%s>: incomplete\n",
 156                             cdi->cdi_obdinfo.obd_name);
 157                         ofw_bus_gen_destroy_devinfo(&cdi->cdi_obdinfo);
 158                         free(cdi, M_DEVBUF);
 159                         continue;
 160                 }
 161                 resource_list_init(&cdi->cdi_rl);
 162                 for (i = 0; i < nreg; i++)
 163                         resource_list_add(&cdi->cdi_rl, SYS_RES_MEMORY, i,
 164                             reg[i].sbr_offset, reg[i].sbr_offset +
 165                             reg[i].sbr_size, reg[i].sbr_size);
 166                 free(reg, M_OFWPROP);
 167                 cdev = device_add_child(dev, NULL, -1);
 168                 if (cdev == NULL) {
 169                         device_printf(dev, "<%s>: device_add_child failed\n",
 170                             cdi->cdi_obdinfo.obd_name);
 171                         resource_list_free(&cdi->cdi_rl);
 172                         ofw_bus_gen_destroy_devinfo(&cdi->cdi_obdinfo);
 173                         free(cdi, M_DEVBUF);
 174                         continue;
 175                 }
 176                 device_set_ivars(cdev, cdi);
 177         }
 178
 179         return (bus_generic_attach(dev));
 180 }
 181
 182 static int
 183 central_print_child(device_t dev, device_t child)
 184 {
 185         int rv;
 186
 187         rv = bus_print_child_header(dev, child);
 188         rv += central_print_res(device_get_ivars(child));
 189         rv += bus_print_child_footer(dev, child);
 190         return (rv);
 191 }
 192
 193 static void
 194 central_probe_nomatch(device_t dev, device_t child)
 195 {
 196         const char *type;
 197
 198         device_printf(dev, "<%s>", ofw_bus_get_name(child));
 199         central_print_res(device_get_ivars(child));
 200         type = ofw_bus_get_type(child);
 201         printf(" type %s (no driver attached)\n",
 202             type != NULL ? type : "unknown");
 203 }
 204
 205 static struct resource *
 206 central_alloc_resource(device_t bus, device_t child, int type, int *rid,
 207     u_long start, u_long end, u_long count, u_int flags)
 208 {
 209         struct resource_list *rl;
 210         struct resource_list_entry *rle;
 211         struct central_softc *sc;
 212         struct resource *res;
 213         bus_addr_t coffset;
 214         bus_addr_t cend;
 215         bus_addr_t phys;
 216         int isdefault;
 217         int passthrough;
 218         int i;
 219
 220         isdefault = (start == 0UL && end == ~0UL);
 221         passthrough = (device_get_parent(child) != bus);
 222         res = NULL;
 223         rle = NULL;
 224         rl = BUS_GET_RESOURCE_LIST(bus, child);
 225         sc = device_get_softc(bus);
 226         switch (type) {
 227         case SYS_RES_IRQ:
 228                 return (resource_list_alloc(rl, bus, child, type, rid, start,
 229                     end, count, flags));
 230         case SYS_RES_MEMORY:
 231                 if (!passthrough) {
 232                         rle = resource_list_find(rl, type, *rid);
 233                         if (rle == NULL)
 234                                 return (NULL);
 235                         if (rle->res != NULL)
 236                                 panic("%s: resource entry is busy", __func__);
 237                         if (isdefault) {
 238                                 start = rle->start;
 239                                 count = ulmax(count, rle->count);
 240                                 end = ulmax(rle->end, start + count - 1);
 241                         }
 242                 }
 243                 for (i = 0; i < sc->sc_nrange; i++) {
 244                         coffset = sc->sc_ranges[i].coffset;
 245                         cend = coffset + sc->sc_ranges[i].size - 1;
 246                         if (start >= coffset && end <= cend) {
 247                                 start -= coffset;
 248                                 end -= coffset;
 249                                 phys = sc->sc_ranges[i].poffset |
 250                                     ((bus_addr_t)sc->sc_ranges[i].pspace << 32);
 251                                 res = bus_generic_alloc_resource(bus, child,
 252                                     type, rid, phys + start, phys + end,
 253                                     count, flags);
 254                                 if (!passthrough)
 255                                         rle->res = res;
 256                                 break;
 257                         }
 258                 }
 259                 break;
 260         }
 261         return (res);
 262 }
 263
 264 static struct resource_list *
 265 central_get_resource_list(device_t bus, device_t child)
 266 {
 267         struct central_devinfo *cdi;
 268
 269         cdi = device_get_ivars(child);
 270         return (&cdi->cdi_rl);
 271 }
 272
 273 static const struct ofw_bus_devinfo *
 274 central_get_devinfo(device_t bus, device_t child)
 275 {
 276         struct central_devinfo *cdi;
 277
 278         cdi = device_get_ivars(child);
 279         return (&cdi->cdi_obdinfo);
 280 }
 281
 282 static int
 283 central_print_res(struct central_devinfo *cdi)
 284 {
 285
 286         return (resource_list_print_type(&cdi->cdi_rl, "mem", SYS_RES_MEMORY,
 287             "%#lx"));
 288 }