sys/dev/proto/proto_bus_isa.c

   1 /*-
   2  * Copyright (c) 2015 Marcel Moolenaar
   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 ``AS IS'' AND ANY EXPRESS OR
  15  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  16  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  17  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  18  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  19  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  20  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  21  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  22  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  23  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  24  */
  25
  26 #include <sys/cdefs.h>
  27 __FBSDID("$FreeBSD$");
  28
  29 #include <sys/param.h>
  30 #include <sys/systm.h>
  31 #include <sys/bus.h>
  32 #include <sys/conf.h>
  33 #include <sys/kernel.h>
  34 #include <sys/module.h>
  35 #include <machine/bus.h>
  36 #include <sys/rman.h>
  37 #include <machine/resource.h>
  38 #include <sys/sbuf.h>
  39
  40 #include <isa/isavar.h>
  41 #include <isa/pnpvar.h>
  42
  43 #include <dev/proto/proto.h>
  44
  45 static int proto_isa_probe(device_t dev);
  46 static int proto_isa_attach(device_t dev);
  47
  48 static device_method_t proto_isa_methods[] = {
  49         /* Device interface */
  50         DEVMETHOD(device_probe,         proto_isa_probe),
  51         DEVMETHOD(device_attach,        proto_isa_attach),
  52         DEVMETHOD(device_detach,        proto_detach),
  53         DEVMETHOD_END
  54 };
  55
  56 static driver_t proto_isa_driver = {
  57         proto_driver_name,
  58         proto_isa_methods,
  59         sizeof(struct proto_softc),
  60 };
  61
  62 static int
  63 proto_isa_probe(device_t dev)
  64 {
  65         struct sbuf *sb;
  66         struct resource *res;
  67         int rid, type;
  68
  69         rid = 0;
  70         type = SYS_RES_IOPORT;
  71         res = bus_alloc_resource_any(dev, type, &rid, RF_ACTIVE);
  72         if (res == NULL) {
  73                 type = SYS_RES_MEMORY;
  74                 res = bus_alloc_resource_any(dev, type, &rid, RF_ACTIVE);
  75         }
  76         if (res == NULL)
  77                 return (ENODEV);
  78
  79         sb = sbuf_new_auto();
  80         sbuf_printf(sb, "isa:%#lx", rman_get_start(res));
  81         sbuf_finish(sb);
  82         device_set_desc_copy(dev, sbuf_data(sb));
  83         sbuf_delete(sb);
  84         bus_release_resource(dev, type, rid, res);
  85         return (BUS_PROBE_HOOVER);
  86 }
  87
  88 static int
  89 proto_isa_alloc(device_t dev, int type, int nrids)
  90 {
  91         struct resource *res;
  92         struct proto_softc *sc;
  93         int count, rid;
  94
  95         sc = device_get_softc(dev);
  96         count = 0;
  97         for (rid = 0; rid < nrids; rid++) {
  98                 res = bus_alloc_resource_any(dev, type, &rid, RF_ACTIVE);
  99                 if (res == NULL)
 100                         break;
 101                 proto_add_resource(sc, type, rid, res);
 102                 count++;
 103         }
 104         if (type == SYS_RES_DRQ && count > 0)
 105                 proto_add_resource(sc, PROTO_RES_BUSDMA, 0, NULL);
 106         return (count);
 107 }
 108
 109 static int
 110 proto_isa_attach(device_t dev)
 111 {
 112
 113         proto_isa_alloc(dev, SYS_RES_IRQ, ISA_NIRQ);
 114         proto_isa_alloc(dev, SYS_RES_DRQ, ISA_NDRQ);
 115         proto_isa_alloc(dev, SYS_RES_IOPORT, ISA_NPORT);
 116         proto_isa_alloc(dev, SYS_RES_MEMORY, ISA_NMEM);
 117         return (proto_attach(dev));
 118 }
 119
 120 DRIVER_MODULE(proto, acpi, proto_isa_driver, proto_devclass, NULL, NULL);
 121 DRIVER_MODULE(proto, isa, proto_isa_driver, proto_devclass, NULL, NULL);