sys/arm/xscale/pxa/pxa_smi.c

   1 /*-
   2  * Copyright (c) 2006 Benno Rice.  All rights reserved.
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions
   6  * are met:
   7  * 1. Redistributions of source code must retain the above copyright
   8  *    notice, this list of conditions and the following disclaimer.
   9  * 2. Redistributions in binary form must reproduce the above copyright
  10  *    notice, this list of conditions and the following disclaimer in the
  11  *    documentation and/or other materials provided with the distribution.
  12  *
  13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  14  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  15  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  16  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  17  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  18  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  19  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  20  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  21  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  22  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  23  */
  24
  25 #include <sys/cdefs.h>
  26 __FBSDID("$FreeBSD$");
  27
  28 #include <sys/param.h>
  29 #include <sys/systm.h>
  30 #include <sys/bus.h>
  31 #include <sys/kernel.h>
  32 #include <sys/module.h>
  33 #include <sys/malloc.h>
  34 #include <sys/rman.h>
  35 #include <sys/timetc.h>
  36 #include <machine/bus.h>
  37 #include <machine/intr.h>
  38
  39 #include <vm/vm.h>
  40 #include <vm/pmap.h>
  41
  42 #include <arm/xscale/pxa/pxavar.h>
  43 #include <arm/xscale/pxa/pxareg.h>
  44
  45 MALLOC_DEFINE(M_PXASMI, "PXA SMI", "Data for static memory interface devices.");
  46
  47 struct pxa_smi_softc {
  48         struct resource *ps_res[1];
  49         struct rman     ps_mem;
  50         bus_space_tag_t ps_bst;
  51         bus_addr_t      ps_base;
  52 };
  53
  54 struct smi_ivars {
  55         struct resource_list    smid_resources;
  56         bus_addr_t              smid_mem;
  57 };
  58
  59 static struct resource_spec pxa_smi_spec[] = {
  60         { SYS_RES_MEMORY,       0,      RF_ACTIVE },
  61         { -1, 0 }
  62 };
  63
  64 static int      pxa_smi_probe(device_t);
  65 static int      pxa_smi_attach(device_t);
  66
  67 static int      pxa_smi_print_child(device_t, device_t);
  68
  69 static int      pxa_smi_read_ivar(device_t, device_t, int, uintptr_t *);
  70
  71 static struct resource *        pxa_smi_alloc_resource(device_t, device_t,
  72                                     int, int *, u_long, u_long, u_long, u_int);
  73 static int                      pxa_smi_release_resource(device_t, device_t,
  74                                     int, int, struct resource *);
  75 static int                      pxa_smi_activate_resource(device_t, device_t,
  76                                     int, int, struct resource *);
  77
  78 static void     pxa_smi_add_device(device_t, const char *, int);
  79
  80 static int
  81 pxa_smi_probe(device_t dev)
  82 {
  83
  84         if (resource_disabled("smi", device_get_unit(dev)))
  85                 return (ENXIO);
  86
  87         device_set_desc(dev, "Static Memory Interface");
  88         return (0);
  89 }
  90
  91 static int
  92 pxa_smi_attach(device_t dev)
  93 {
  94         int             error, i, dunit;
  95         const char      *dname;
  96         struct          pxa_smi_softc *sc;
  97
  98         sc = (struct pxa_smi_softc *)device_get_softc(dev);
  99
 100         error = bus_alloc_resources(dev, pxa_smi_spec, sc->ps_res);
 101         if (error) {
 102                 device_printf(dev, "could not allocate resources\n");
 103                 return (ENXIO);
 104         }
 105
 106         sc->ps_mem.rm_type = RMAN_ARRAY;
 107         sc->ps_mem.rm_descr = device_get_nameunit(dev);
 108         if (rman_init(&sc->ps_mem) != 0)
 109                 panic("pxa_smi_attach: failed to init mem rman");
 110         if (rman_manage_region(&sc->ps_mem, 0, PXA2X0_CS_SIZE * 6) != 0)
 111                 panic("pxa_smi_attach: failed ot set up mem rman");
 112
 113         sc->ps_bst = base_tag;
 114         sc->ps_base = rman_get_start(sc->ps_res[0]);
 115
 116         i = 0;
 117         while (resource_find_match(&i, &dname, &dunit, "at",
 118             device_get_nameunit(dev)) == 0) {
 119                 pxa_smi_add_device(dev, dname, dunit);
 120         }
 121
 122         bus_generic_probe(dev);
 123         bus_generic_attach(dev);
 124
 125         return (0);
 126 }
 127
 128 static int
 129 pxa_smi_print_child(device_t dev, device_t child)
 130 {
 131         struct  smi_ivars *smid;
 132         int     retval;
 133
 134         smid = (struct smi_ivars *)device_get_ivars(child);
 135         if (smid == NULL) {
 136                 device_printf(dev, "unknown device: %s\n",
 137                     device_get_nameunit(child));
 138                 return (0);
 139         }
 140
 141         retval = 0;
 142
 143         retval += bus_print_child_header(dev, child);
 144
 145         retval += resource_list_print_type(&smid->smid_resources, "at mem",
 146             SYS_RES_MEMORY, "%#lx");
 147         retval += resource_list_print_type(&smid->smid_resources, "irq",
 148             SYS_RES_IRQ, "%ld");
 149
 150         retval += bus_print_child_footer(dev, child);
 151
 152         return (retval);
 153 }
 154
 155 static int
 156 pxa_smi_read_ivar(device_t dev, device_t child, int which, uintptr_t *result)
 157 {
 158         struct  pxa_smi_softc *sc;
 159         struct  smi_ivars *smid;
 160
 161         sc = device_get_softc(dev);
 162         smid = device_get_ivars(child);
 163
 164         switch (which) {
 165         case SMI_IVAR_PHYSBASE:
 166                 *((bus_addr_t *)result) = smid->smid_mem;
 167                 break;
 168
 169         default:
 170                 return (ENOENT);
 171         }
 172
 173         return (0);
 174 }
 175
 176 static struct resource *
 177 pxa_smi_alloc_resource(device_t dev, device_t child, int type, int *rid,
 178     u_long start, u_long end, u_long count, u_int flags)
 179 {
 180         struct  pxa_smi_softc *sc;
 181         struct  smi_ivars *smid;
 182         struct  resource *rv;
 183         struct  resource_list *rl;
 184         struct  resource_list_entry *rle;
 185         int     needactivate;
 186
 187         sc = (struct pxa_smi_softc *)device_get_softc(dev);
 188         smid = (struct smi_ivars *)device_get_ivars(child);
 189         rl = &smid->smid_resources;
 190
 191         if (type == SYS_RES_IOPORT)
 192                 type = SYS_RES_MEMORY;
 193
 194         rle = resource_list_find(rl, type, *rid);
 195         if (rle == NULL)
 196                 return (NULL);
 197         if (rle->res != NULL)
 198                 panic("pxa_smi_alloc_resource: resource is busy");
 199
 200         needactivate = flags & RF_ACTIVE;
 201         flags &= ~RF_ACTIVE;
 202
 203         switch (type) {
 204         case SYS_RES_MEMORY:
 205                 rv = rman_reserve_resource(&sc->ps_mem, rle->start, rle->end,
 206                     rle->count, flags, child);
 207                 if (rv == NULL)
 208                         return (NULL);
 209                 rle->res = rv;
 210                 rman_set_rid(rv, *rid);
 211                 rman_set_bustag(rv, sc->ps_bst);
 212                 rman_set_bushandle(rv, rle->start);
 213                 if (needactivate) {
 214                         if (bus_activate_resource(child, type, *rid, rv) != 0) {
 215                                 rman_release_resource(rv);
 216                                 return (NULL);
 217                         }
 218                 }
 219
 220                 break;
 221
 222         case SYS_RES_IRQ:
 223                 rv = bus_alloc_resource(dev, type, rid, rle->start, rle->end,
 224                     rle->count, flags);
 225                 if (rv == NULL)
 226                         return (NULL);
 227                 if (needactivate) {
 228                         if (bus_activate_resource(child, type, *rid, rv) != 0) {
 229                                 bus_release_resource(dev, type, *rid, rv);
 230                                 return (NULL);
 231                         }
 232                 }
 233
 234                 break;
 235
 236         default:
 237                 return (NULL);
 238         }
 239
 240         return (rv);
 241 }
 242
 243 static int
 244 pxa_smi_release_resource(device_t dev, device_t child, int type, int rid,
 245     struct resource *r)
 246 {
 247         struct  smi_ivars *smid;
 248         struct  resource_list *rl;
 249         struct  resource_list_entry *rle;
 250
 251         if (type == SYS_RES_IRQ)
 252                 return (bus_release_resource(dev, SYS_RES_IRQ, rid, r));
 253
 254         smid = (struct smi_ivars *)device_get_ivars(child);
 255         rl = &smid->smid_resources;
 256
 257         if (type == SYS_RES_IOPORT)
 258                 type = SYS_RES_MEMORY;
 259
 260         rle = resource_list_find(rl, type, rid);
 261         if (rle == NULL)
 262                 panic("pxa_smi_release_resource: can't find resource");
 263         if (rle->res == NULL)
 264                 panic("pxa_smi_release_resource: resource entry not busy");
 265
 266         rman_release_resource(rle->res);
 267         rle->res = NULL;
 268
 269         return (0);
 270 }
 271
 272 static int
 273 pxa_smi_activate_resource(device_t dev, device_t child, int type, int rid,
 274     struct resource *r)
 275 {
 276         struct  pxa_smi_softc *sc;
 277
 278         sc = (struct pxa_smi_softc *)device_get_softc(dev);
 279
 280         if (type == SYS_RES_IRQ)
 281                 return (bus_activate_resource(dev, SYS_RES_IRQ, rid, r));
 282
 283         rman_set_bushandle(r, (bus_space_handle_t)pmap_mapdev(rman_get_start(r),
 284             rman_get_size(r)));
 285         return (rman_activate_resource(r));
 286 }
 287
 288 static device_method_t pxa_smi_methods[] = {
 289         DEVMETHOD(device_probe, pxa_smi_probe),
 290         DEVMETHOD(device_attach, pxa_smi_attach),
 291
 292         DEVMETHOD(bus_print_child, pxa_smi_print_child),
 293
 294         DEVMETHOD(bus_read_ivar, pxa_smi_read_ivar),
 295
 296         DEVMETHOD(bus_setup_intr, bus_generic_setup_intr),
 297
 298         DEVMETHOD(bus_alloc_resource, pxa_smi_alloc_resource),
 299         DEVMETHOD(bus_release_resource, pxa_smi_release_resource),
 300         DEVMETHOD(bus_activate_resource, pxa_smi_activate_resource),
 301
 302         {0, 0}
 303 };
 304
 305 static driver_t pxa_smi_driver = {
 306         "smi",
 307         pxa_smi_methods,
 308         sizeof(struct pxa_smi_softc),
 309 };
 310
 311 static devclass_t pxa_smi_devclass;
 312
 313 DRIVER_MODULE(smi, pxa, pxa_smi_driver, pxa_smi_devclass, 0, 0);
 314
 315 static void
 316 pxa_smi_add_device(device_t dev, const char *name, int unit)
 317 {
 318         device_t        child;
 319         int             start, count;
 320         struct          smi_ivars *ivars;
 321
 322         ivars = (struct smi_ivars *)malloc(
 323             sizeof(struct smi_ivars), M_PXASMI, M_WAITOK);
 324         if (ivars == NULL)
 325                 return;
 326
 327         child = device_add_child(dev, name, unit);
 328         if (child == NULL) {
 329                 free(ivars, M_PXASMI);
 330                 return;
 331         }
 332
 333         device_set_ivars(child, ivars);
 334         resource_list_init(&ivars->smid_resources);
 335
 336         start = 0;
 337         count = 0;
 338         resource_int_value(name, unit, "mem", &start);
 339         resource_int_value(name, unit, "size", &count);
 340         if (start > 0 || count > 0) {
 341                 resource_list_add(&ivars->smid_resources, SYS_RES_MEMORY, 0,
 342                     start, start + count, count);
 343                 ivars->smid_mem = (bus_addr_t)start;
 344         }
 345
 346         start = -1;
 347         count = 0;
 348         resource_int_value(name, unit, "irq", &start);
 349         if (start > -1)
 350                 resource_list_add(&ivars->smid_resources, SYS_RES_IRQ, 0, start,
 351                      start, 1);
 352
 353         if (resource_disabled(name, unit))
 354                 device_disable(child);
 355 }