Merge from vendor branch TCPDUMP:
[dragonfly.git] / sys / dev / misc / orm / orm.c
1 /*-
2  * Copyright (c) 2000 Nikolai Saoukh
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  *      $FreeBSD: src/sys/isa/orm.c,v 1.1.2.1 2001/06/19 05:48:29 imp Exp $
27  *      $DragonFly: src/sys/dev/misc/orm/orm.c,v 1.3 2003/08/07 21:16:57 dillon Exp $
28  */
29
30 /*
31  * Driver to take care of holes in ISA I/O memory occupied
32  * by option rom(s)
33  */
34
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/kernel.h>
38 #include <sys/socket.h>
39
40 #include <sys/module.h>
41 #include <sys/bus.h>
42
43 #include <machine/bus.h>
44 #include <machine/resource.h>
45 #include <sys/rman.h>
46
47 #include <bus/isa/isavar.h>
48 #include <bus/isa/pnpvar.h>
49
50 #define IOMEM_START     0x0a0000
51 #define IOMEM_STEP      0x000800
52 #define IOMEM_END       0x100000
53
54 #define ORM_ID  0x00004d3e
55
56 static struct isa_pnp_id orm_ids[] = {
57         { ORM_ID,       NULL },         /* ORM0000 */
58         { 0,            NULL },
59 };
60
61 #define MAX_ROMS        16
62
63 struct orm_softc {
64         int             rnum;
65         int             rid[MAX_ROMS];
66         struct resource *res[MAX_ROMS];
67 };
68
69 static int
70 orm_probe(device_t dev)
71 {
72         return (ISA_PNP_PROBE(device_get_parent(dev), dev, orm_ids));
73 }
74
75 static int
76 orm_attach(device_t dev)
77 {
78         return (0);
79 }
80
81 static void
82 orm_identify(driver_t* driver, device_t parent)
83 {
84         bus_space_handle_t      bh;
85         bus_space_tag_t         bt;
86         device_t                child;
87         u_int32_t               chunk = IOMEM_START;
88         struct resource         *res;
89         int                     rid;
90         u_int32_t               rom_size;
91         struct orm_softc        *sc;
92         u_int8_t                buf[3];
93
94         child = BUS_ADD_CHILD(parent, ISA_ORDER_SENSITIVE, "orm", -1);
95         device_set_driver(child, driver);
96         isa_set_logicalid(child, ORM_ID);
97         isa_set_vendorid(child, ORM_ID);
98         sc = device_get_softc(child);
99         sc->rnum = 0;
100         while (chunk < IOMEM_END) {
101                 bus_set_resource(child, SYS_RES_MEMORY, sc->rnum, chunk,
102                     IOMEM_STEP);
103                 rid = sc->rnum;
104                 res = bus_alloc_resource(child, SYS_RES_MEMORY, &rid, 0ul, 
105                     ~0ul, IOMEM_STEP, RF_ACTIVE);
106                 if (res == NULL) {
107                         bus_delete_resource(child, SYS_RES_MEMORY, sc->rnum);
108                         chunk += IOMEM_STEP;
109                         continue;
110                 }
111                 bt = rman_get_bustag(res);
112                 bh = rman_get_bushandle(res);
113                 bus_space_read_region_1(bt, bh, 0, buf, sizeof(buf));
114
115                 /*
116                  * We need to release and delete the resource since we're
117                  * changing its size, or the rom isn't there.  There
118                  * is a checksum field in the ROM to prevent false
119                  * positives.  However, some common hardware (IBM thinkpads)
120                  * neglects to put a valid checksum in the ROM, so we do
121                  * not double check the checksum here.  On the ISA bus
122                  * areas that have no hardware read back as 0xff, so the
123                  * tests to see if we have 0x55 followed by 0xaa are
124                  * generally sufficient.
125                  */
126                 bus_release_resource(child, SYS_RES_MEMORY, rid, res);
127                 bus_delete_resource(child, SYS_RES_MEMORY, sc->rnum);
128                 if (buf[0] != 0x55 || buf[1] != 0xAA || (buf[2] & 0x03) != 0) {
129                         chunk += IOMEM_STEP;
130                         continue;
131                 }
132                 rom_size = buf[2] << 9;
133                 bus_set_resource(child, SYS_RES_MEMORY, sc->rnum, chunk,
134                     rom_size);
135                 rid = sc->rnum;
136                 res = bus_alloc_resource(child, SYS_RES_MEMORY, &rid, 0ul,
137                     ~0ul, rom_size, 0);
138                 if (res == NULL) {
139                         bus_delete_resource(child, SYS_RES_MEMORY, sc->rnum);
140                         chunk += IOMEM_STEP;
141                         continue;
142                 }
143                 sc->rid[sc->rnum] = rid;
144                 sc->res[sc->rnum] = res;
145                 sc->rnum++;
146                 chunk += rom_size;
147         }
148
149         if (sc->rnum == 0)
150                 device_delete_child(parent, child);
151         else if (sc->rnum == 1)
152                 device_set_desc(child, "Option ROM");
153         else
154                 device_set_desc(child, "Option ROMs");
155 }
156
157 static int
158 orm_detach(device_t dev)
159 {
160         int                     i;
161         struct orm_softc        *sc = device_get_softc(dev);
162         
163         for (i = 0; i < sc->rnum; i++)
164                 bus_release_resource(dev, SYS_RES_MEMORY, sc->rid[i],
165                     sc->res[i]);
166         return (0);
167 }
168
169 static device_method_t orm_methods[] = {
170         /* Device interface */
171         DEVMETHOD(device_identify,      orm_identify),
172         DEVMETHOD(device_probe,         orm_probe),
173         DEVMETHOD(device_attach,        orm_attach),
174         DEVMETHOD(device_detach,        orm_detach),
175         { 0, 0 }
176 };
177
178 static driver_t orm_driver = {
179         "orm",
180         orm_methods,
181         sizeof (struct orm_softc)
182 };
183
184 static devclass_t orm_devclass;
185
186 DRIVER_MODULE(orm, isa, orm_driver, orm_devclass, 0, 0);