FreeBSD/Linux Kernel Cross Reference
sys/isa/atkbdc_isa.c
1 /*-
2 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
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 as
10 * the first lines of this file unmodified.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 *
26 * $FreeBSD$
27 */
28
29 #include "opt_kbd.h"
30
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/kernel.h>
34 #include <sys/bus.h>
35 #include <sys/malloc.h>
36 #include <machine/bus_pio.h>
37 #include <machine/bus.h>
38 #include <machine/resource.h>
39 #include <sys/rman.h>
40
41 #include <dev/kbd/atkbdcreg.h>
42
43 #include <isa/isareg.h>
44 #include <isa/isavar.h>
45
46 MALLOC_DEFINE(M_ATKBDDEV, "atkbddev", "AT Keyboard device");
47
48 /* children */
49 typedef struct atkbdc_device {
50 int flags; /* configuration flags */
51 int irq; /* ISA IRQ mask */
52 u_int32_t vendorid;
53 u_int32_t serial;
54 u_int32_t logicalid;
55 u_int32_t compatid;
56 } atkbdc_device_t;
57
58 /* kbdc */
59 devclass_t atkbdc_devclass;
60
61 static int atkbdc_probe(device_t dev);
62 static int atkbdc_attach(device_t dev);
63 static int atkbdc_print_child(device_t bus, device_t dev);
64 static int atkbdc_read_ivar(device_t bus, device_t dev, int index,
65 u_long *val);
66 static int atkbdc_write_ivar(device_t bus, device_t dev, int index,
67 u_long val);
68
69 static device_method_t atkbdc_methods[] = {
70 DEVMETHOD(device_probe, atkbdc_probe),
71 DEVMETHOD(device_attach, atkbdc_attach),
72 DEVMETHOD(device_suspend, bus_generic_suspend),
73 DEVMETHOD(device_resume, bus_generic_resume),
74
75 DEVMETHOD(bus_print_child, atkbdc_print_child),
76 DEVMETHOD(bus_read_ivar, atkbdc_read_ivar),
77 DEVMETHOD(bus_write_ivar, atkbdc_write_ivar),
78 DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource),
79 DEVMETHOD(bus_release_resource, bus_generic_release_resource),
80 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
81 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
82 DEVMETHOD(bus_setup_intr, bus_generic_setup_intr),
83 DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr),
84
85 { 0, 0 }
86 };
87
88 static driver_t atkbdc_driver = {
89 ATKBDC_DRIVER_NAME,
90 atkbdc_methods,
91 sizeof(atkbdc_softc_t *),
92 };
93
94 static struct isa_pnp_id atkbdc_ids[] = {
95 { 0x0303d041, "Keyboard controller (i8042)" }, /* PNP0303 */
96 { 0 }
97 };
98
99 static int
100 atkbdc_probe(device_t dev)
101 {
102 struct resource *port0;
103 struct resource *port1;
104 int error;
105 int rid;
106
107 /* check PnP IDs */
108 if (ISA_PNP_PROBE(device_get_parent(dev), dev, atkbdc_ids) == ENXIO)
109 return ENXIO;
110
111 device_set_desc(dev, "Keyboard controller (i8042)");
112
113 rid = 0;
114 port0 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1,
115 RF_ACTIVE);
116 if (port0 == NULL)
117 return ENXIO;
118 /* XXX */
119 if (bus_get_resource_start(dev, SYS_RES_IOPORT, 1) <= 0) {
120 bus_set_resource(dev, SYS_RES_IOPORT, 1,
121 rman_get_start(port0) + KBD_STATUS_PORT, 1);
122 }
123 rid = 1;
124 port1 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1,
125 RF_ACTIVE);
126 if (port1 == NULL) {
127 bus_release_resource(dev, SYS_RES_IOPORT, 0, port0);
128 return ENXIO;
129 }
130
131 error = atkbdc_probe_unit(device_get_unit(dev), port0, port1);
132
133 bus_release_resource(dev, SYS_RES_IOPORT, 0, port0);
134 bus_release_resource(dev, SYS_RES_IOPORT, 1, port1);
135
136 return error;
137 }
138
139 static void
140 atkbdc_add_device(device_t dev, const char *name, int unit)
141 {
142 atkbdc_device_t *kdev;
143 device_t child;
144 int t;
145
146 if (resource_int_value(name, unit, "disabled", &t) == 0 && t != 0)
147 return;
148
149 kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT);
150 if (!kdev)
151 return;
152 bzero(kdev, sizeof *kdev);
153
154 if (resource_int_value(name, unit, "irq", &t) == 0)
155 kdev->irq = t;
156 else
157 kdev->irq = -1;
158
159 if (resource_int_value(name, unit, "flags", &t) == 0)
160 kdev->flags = t;
161 else
162 kdev->flags = 0;
163
164 child = device_add_child(dev, name, unit);
165 device_set_ivars(child, kdev);
166 }
167
168 static int
169 atkbdc_attach(device_t dev)
170 {
171 atkbdc_softc_t *sc;
172 int unit;
173 int error;
174 int rid;
175 int i;
176
177 unit = device_get_unit(dev);
178 sc = *(atkbdc_softc_t **)device_get_softc(dev);
179 if (sc == NULL) {
180 /*
181 * We have to maintain two copies of the kbdc_softc struct,
182 * as the low-level console needs to have access to the
183 * keyboard controller before kbdc is probed and attached.
184 * kbdc_soft[] contains the default entry for that purpose.
185 * See atkbdc.c. XXX
186 */
187 sc = atkbdc_get_softc(unit);
188 if (sc == NULL)
189 return ENOMEM;
190 }
191
192 rid = 0;
193 sc->port0 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1,
194 RF_ACTIVE);
195 if (sc->port0 == NULL)
196 return ENXIO;
197 rid = 1;
198 sc->port1 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1,
199 RF_ACTIVE);
200 if (sc->port1 == NULL) {
201 bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port0);
202 return ENXIO;
203 }
204
205 error = atkbdc_attach_unit(unit, sc, sc->port0, sc->port1);
206 if (error) {
207 bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port0);
208 bus_release_resource(dev, SYS_RES_IOPORT, 1, sc->port1);
209 return error;
210 }
211 *(atkbdc_softc_t **)device_get_softc(dev) = sc;
212
213 /*
214 * Add all devices configured to be attached to atkbdc0.
215 */
216 for (i = resource_query_string(-1, "at", device_get_nameunit(dev));
217 i != -1;
218 i = resource_query_string(i, "at", device_get_nameunit(dev))) {
219 atkbdc_add_device(dev, resource_query_name(i),
220 resource_query_unit(i));
221 }
222
223 /*
224 * and atkbdc?
225 */
226 for (i = resource_query_string(-1, "at", device_get_name(dev));
227 i != -1;
228 i = resource_query_string(i, "at", device_get_name(dev))) {
229 atkbdc_add_device(dev, resource_query_name(i),
230 resource_query_unit(i));
231 }
232
233 bus_generic_attach(dev);
234
235 return 0;
236 }
237
238 static int
239 atkbdc_print_child(device_t bus, device_t dev)
240 {
241 atkbdc_device_t *kbdcdev;
242 int retval = 0;
243
244 kbdcdev = (atkbdc_device_t *)device_get_ivars(dev);
245
246 retval += bus_print_child_header(bus, dev);
247 if (kbdcdev->flags != 0)
248 retval += printf(" flags 0x%x", kbdcdev->flags);
249 if (kbdcdev->irq != -1)
250 retval += printf(" irq %d", kbdcdev->irq);
251 retval += bus_print_child_footer(bus, dev);
252
253 return (retval);
254 }
255
256 static int
257 atkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val)
258 {
259 atkbdc_device_t *ivar;
260
261 ivar = (atkbdc_device_t *)device_get_ivars(dev);
262 switch (index) {
263 case KBDC_IVAR_IRQ:
264 *val = (u_long)ivar->irq;
265 break;
266 case KBDC_IVAR_FLAGS:
267 *val = (u_long)ivar->flags;
268 break;
269 case KBDC_IVAR_VENDORID:
270 *val = (u_long)ivar->vendorid;
271 break;
272 case KBDC_IVAR_SERIAL:
273 *val = (u_long)ivar->serial;
274 break;
275 case KBDC_IVAR_LOGICALID:
276 *val = (u_long)ivar->logicalid;
277 break;
278 case KBDC_IVAR_COMPATID:
279 *val = (u_long)ivar->compatid;
280 break;
281 default:
282 return ENOENT;
283 }
284 return 0;
285 }
286
287 static int
288 atkbdc_write_ivar(device_t bus, device_t dev, int index, u_long val)
289 {
290 atkbdc_device_t *ivar;
291
292 ivar = (atkbdc_device_t *)device_get_ivars(dev);
293 switch (index) {
294 case KBDC_IVAR_IRQ:
295 ivar->irq = (int)val;
296 break;
297 case KBDC_IVAR_FLAGS:
298 ivar->flags = (int)val;
299 break;
300 case KBDC_IVAR_VENDORID:
301 ivar->vendorid = (u_int32_t)val;
302 break;
303 case KBDC_IVAR_SERIAL:
304 ivar->serial = (u_int32_t)val;
305 break;
306 case KBDC_IVAR_LOGICALID:
307 ivar->logicalid = (u_int32_t)val;
308 break;
309 case KBDC_IVAR_COMPATID:
310 ivar->compatid = (u_int32_t)val;
311 break;
312 default:
313 return ENOENT;
314 }
315 return 0;
316 }
317
318 DRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0);
Cache object: ca28660b6de7dd79a9fc74df6b2483b3
|