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 DRIVER_MODULE(central, nexus, central_driver, central_devclass, 0, 0);
 109 MODULE_VERSION(central, 1);
 110
 111 static int
 112 central_probe(device_t dev)
 113 {
 114
 115         if (strcmp(ofw_bus_get_name(dev), "central") == 0) {
 116                 device_set_desc(dev, "central");
 117                 return (0);
 118         }
 119         return (ENXIO);
 120 }
 121
 122 static int
 123 central_attach(device_t dev)
 124 {
 125         struct central_devinfo *cdi;
 126         struct sbus_regs *reg;
 127         struct central_softc *sc;
 128         phandle_t child;
 129         phandle_t node;
 130         device_t cdev;
 131         int nreg;
 132         int i;
 133
 134         sc = device_get_softc(dev);
 135         node = ofw_bus_get_node(dev);
 136
 137         sc->sc_nrange = OF_getprop_alloc(node, "ranges",
 138             sizeof(*sc->sc_ranges), (void **)&sc->sc_ranges);
 139         if (sc->sc_nrange == -1) {
 140                 device_printf(dev, "can't get ranges\n");
 141                 return (ENXIO);
 142         }
 143
 144         for (child = OF_child(node); child != 0; child = OF_peer(child)) {
 145                 cdi = malloc(sizeof(*cdi), M_DEVBUF, M_WAITOK | M_ZERO);
 146                 if (ofw_bus_gen_setup_devinfo(&cdi->cdi_obdinfo, child) != 0) {
 147                         free(cdi, M_DEVBUF);
 148                         continue;
 149                 }
 150                 nreg = OF_getprop_alloc(child, "reg", sizeof(*reg),
 151                     (void **)&reg);
 152                 if (nreg == -1) {
 153                         device_printf(dev, "<%s>: incomplete\n",
 154                             cdi->cdi_obdinfo.obd_name);
 155                         ofw_bus_gen_destroy_devinfo(&cdi->cdi_obdinfo);
 156                         free(cdi, M_DEVBUF);
 157                         continue;
 158                 }
 159                 resource_list_init(&cdi->cdi_rl);
 160                 for (i = 0; i < nreg; i++)
 161                         resource_list_add(&cdi->cdi_rl, SYS_RES_MEMORY, i,
 162                             reg[i].sbr_offset, reg[i].sbr_offset +
 163                             reg[i].sbr_size, reg[i].sbr_size);
 164                 free(reg, M_OFWPROP);
 165                 cdev = device_add_child(dev, NULL, -1);
 166                 if (cdev == NULL) {
 167                         device_printf(dev, "<%s>: device_add_child failed\n",
 168                             cdi->cdi_obdinfo.obd_name);
 169                         resource_list_free(&cdi->cdi_rl);
 170                         ofw_bus_gen_destroy_devinfo(&cdi->cdi_obdinfo);
 171                         free(cdi, M_DEVBUF);
 172                         continue;
 173                 }
 174                 device_set_ivars(cdev, cdi);
 175         }
 176
 177         return (bus_generic_attach(dev));
 178 }
 179
 180 static int
 181 central_print_child(device_t dev, device_t child)
 182 {
 183         int rv;
 184
 185         rv = bus_print_child_header(dev, child);
 186         rv += central_print_res(device_get_ivars(child));
 187         rv += bus_print_child_footer(dev, child);
 188         return (rv);
 189 }
 190
 191 static void
 192 central_probe_nomatch(device_t dev, device_t child)
 193 {
 194         const char *type;
 195
 196         device_printf(dev, "<%s>", ofw_bus_get_name(child));
 197         central_print_res(device_get_ivars(child));
 198         type = ofw_bus_get_type(child);
 199         printf(" type %s (no driver attached)\n",
 200             type != NULL ? type : "unknown");
 201 }
 202
 203 static struct resource *
 204 central_alloc_resource(device_t bus, device_t child, int type, int *rid,
 205     u_long start, u_long end, u_long count, u_int flags)
 206 {
 207         struct resource_list *rl;
 208         struct resource_list_entry *rle;
 209         struct central_softc *sc;
 210         struct resource *res;
 211         bus_addr_t coffset;
 212         bus_addr_t cend;
 213         bus_addr_t phys;
 214         int isdefault;
 215         int passthrough;
 216         int i;
 217
 218         isdefault = (start == 0UL && end == ~0UL);
 219         passthrough = (device_get_parent(child) != bus);
 220         res = NULL;
 221         rle = NULL;
 222         rl = BUS_GET_RESOURCE_LIST(bus, child);
 223         sc = device_get_softc(bus);
 224         switch (type) {
 225         case SYS_RES_IRQ:
 226                 return (resource_list_alloc(rl, bus, child, type, rid, start,
 227                     end, count, flags));
 228         case SYS_RES_MEMORY:
 229                 if (!passthrough) {
 230                         rle = resource_list_find(rl, type, *rid);
 231                         if (rle == NULL)
 232                                 return (NULL);
 233                         if (rle->res != NULL)
 234                                 panic("%s: resource entry is busy", __func__);
 235                         if (isdefault) {
 236                                 start = rle->start;
 237                                 count = ulmax(count, rle->count);
 238                                 end = ulmax(rle->end, start + count - 1);
 239                         }
 240                 }
 241                 for (i = 0; i < sc->sc_nrange; i++) {
 242                         coffset = sc->sc_ranges[i].coffset;
 243                         cend = coffset + sc->sc_ranges[i].size - 1;
 244                         if (start >= coffset && end <= cend) {
 245                                 start -= coffset;
 246                                 end -= coffset;
 247                                 phys = sc->sc_ranges[i].poffset |
 248                                     ((bus_addr_t)sc->sc_ranges[i].pspace << 32);
 249                                 res = bus_generic_alloc_resource(bus, child,
 250                                     type, rid, phys + start, phys + end,
 251                                     count, flags);
 252                                 if (!passthrough)
 253                                         rle->res = res;
 254                                 break;
 255                         }
 256                 }
 257                 break;
 258         }
 259         return (res);
 260 }
 261
 262 static struct resource_list *
 263 central_get_resource_list(device_t bus, device_t child)
 264 {
 265         struct central_devinfo *cdi;
 266
 267         cdi = device_get_ivars(child);
 268         return (&cdi->cdi_rl);
 269 }
 270
 271 static const struct ofw_bus_devinfo *
 272 central_get_devinfo(device_t bus, device_t child)
 273 {
 274         struct central_devinfo *cdi;
 275
 276         cdi = device_get_ivars(child);
 277         return (&cdi->cdi_obdinfo);
 278 }
 279
 280 static int
 281 central_print_res(struct central_devinfo *cdi)
 282 {
 283
 284         return (resource_list_print_type(&cdi->cdi_rl, "mem", SYS_RES_MEMORY,
 285             "%#lx"));
 286 }