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 *
| 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: head/sys/dev/atkbdc/atkbdc_subr.c 56836 2000-01-29 15:08:56Z peter $
| 26 * $FreeBSD: head/sys/dev/atkbdc/atkbdc_subr.c 57481 2000-02-25 11:40:31Z yokota $
|
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.h>
37#include <machine/resource.h>
38#include <sys/rman.h>
39
40#include <dev/kbd/atkbdcreg.h>
41
42#include <isa/isareg.h>
43#include <isa/isavar.h>
44
45MALLOC_DEFINE(M_ATKBDDEV, "atkbddev", "AT Keyboard device");
46
47/* children */
48typedef struct atkbdc_device {
49 int flags; /* configuration flags */
50 int port; /* port number (same as the controller's) */
51 int irq; /* ISA IRQ mask */
52} atkbdc_device_t;
53
54/* kbdc */
55devclass_t atkbdc_devclass;
56
57static int atkbdc_probe(device_t dev);
58static int atkbdc_attach(device_t dev);
59static int atkbdc_print_child(device_t bus, device_t dev);
60static int atkbdc_read_ivar(device_t bus, device_t dev, int index,
61 u_long *val);
62static int atkbdc_write_ivar(device_t bus, device_t dev, int index,
63 u_long val);
64
65static device_method_t atkbdc_methods[] = {
66 DEVMETHOD(device_probe, atkbdc_probe),
67 DEVMETHOD(device_attach, atkbdc_attach),
68 DEVMETHOD(device_suspend, bus_generic_suspend),
69 DEVMETHOD(device_resume, bus_generic_resume),
70
71 DEVMETHOD(bus_print_child, atkbdc_print_child),
72 DEVMETHOD(bus_read_ivar, atkbdc_read_ivar),
73 DEVMETHOD(bus_write_ivar, atkbdc_write_ivar),
74 DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource),
75 DEVMETHOD(bus_release_resource, bus_generic_release_resource),
76 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
77 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
78 DEVMETHOD(bus_setup_intr, bus_generic_setup_intr),
79 DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr),
80
81 { 0, 0 }
82};
83
84static driver_t atkbdc_driver = {
85 ATKBDC_DRIVER_NAME,
86 atkbdc_methods,
87 sizeof(atkbdc_softc_t *),
88};
89
90static int
91atkbdc_probe(device_t dev)
92{
93 int error;
94 int rid;
95 struct resource *port;
96
97 /* Check isapnp ids */
98 if (isa_get_vendorid(dev))
99 return (ENXIO);
100
101 device_set_desc(dev, "keyboard controller (i8042)");
102 rid = 0;
103 port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
104 0, ~0, IO_KBDSIZE, RF_ACTIVE);
105 if (!port)
106 return ENXIO;
107 error = atkbdc_probe_unit(device_get_unit(dev), rman_get_start(port));
108 bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
109 return error;
110}
111
112static void
113atkbdc_add_device(device_t dev, const char *name, int unit)
114{
115 atkbdc_softc_t *sc = *(atkbdc_softc_t **)device_get_softc(dev);
116 atkbdc_device_t *kdev;
117 device_t child;
118 int t;
119
| 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.h>
37#include <machine/resource.h>
38#include <sys/rman.h>
39
40#include <dev/kbd/atkbdcreg.h>
41
42#include <isa/isareg.h>
43#include <isa/isavar.h>
44
45MALLOC_DEFINE(M_ATKBDDEV, "atkbddev", "AT Keyboard device");
46
47/* children */
48typedef struct atkbdc_device {
49 int flags; /* configuration flags */
50 int port; /* port number (same as the controller's) */
51 int irq; /* ISA IRQ mask */
52} atkbdc_device_t;
53
54/* kbdc */
55devclass_t atkbdc_devclass;
56
57static int atkbdc_probe(device_t dev);
58static int atkbdc_attach(device_t dev);
59static int atkbdc_print_child(device_t bus, device_t dev);
60static int atkbdc_read_ivar(device_t bus, device_t dev, int index,
61 u_long *val);
62static int atkbdc_write_ivar(device_t bus, device_t dev, int index,
63 u_long val);
64
65static device_method_t atkbdc_methods[] = {
66 DEVMETHOD(device_probe, atkbdc_probe),
67 DEVMETHOD(device_attach, atkbdc_attach),
68 DEVMETHOD(device_suspend, bus_generic_suspend),
69 DEVMETHOD(device_resume, bus_generic_resume),
70
71 DEVMETHOD(bus_print_child, atkbdc_print_child),
72 DEVMETHOD(bus_read_ivar, atkbdc_read_ivar),
73 DEVMETHOD(bus_write_ivar, atkbdc_write_ivar),
74 DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource),
75 DEVMETHOD(bus_release_resource, bus_generic_release_resource),
76 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
77 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
78 DEVMETHOD(bus_setup_intr, bus_generic_setup_intr),
79 DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr),
80
81 { 0, 0 }
82};
83
84static driver_t atkbdc_driver = {
85 ATKBDC_DRIVER_NAME,
86 atkbdc_methods,
87 sizeof(atkbdc_softc_t *),
88};
89
90static int
91atkbdc_probe(device_t dev)
92{
93 int error;
94 int rid;
95 struct resource *port;
96
97 /* Check isapnp ids */
98 if (isa_get_vendorid(dev))
99 return (ENXIO);
100
101 device_set_desc(dev, "keyboard controller (i8042)");
102 rid = 0;
103 port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
104 0, ~0, IO_KBDSIZE, RF_ACTIVE);
105 if (!port)
106 return ENXIO;
107 error = atkbdc_probe_unit(device_get_unit(dev), rman_get_start(port));
108 bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
109 return error;
110}
111
112static void
113atkbdc_add_device(device_t dev, const char *name, int unit)
114{
115 atkbdc_softc_t *sc = *(atkbdc_softc_t **)device_get_softc(dev);
116 atkbdc_device_t *kdev;
117 device_t child;
118 int t;
119
|
| 120 if (resource_int_value(name, unit, "disabled", &t) == 0 && t != 0)
121 return;
122
|
120 kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT);
121 if (!kdev)
122 return;
123 bzero(kdev, sizeof *kdev);
124
125 kdev->port = sc->port;
126
127 if (resource_int_value(name, unit, "irq", &t) == 0)
128 kdev->irq = t;
129 else
130 kdev->irq = -1;
131
132 if (resource_int_value(name, unit, "flags", &t) == 0)
133 kdev->flags = t;
134 else
135 kdev->flags = 0;
136
137 child = device_add_child(dev, name, unit);
138 device_set_ivars(child, kdev);
139}
140
141static int
142atkbdc_attach(device_t dev)
143{
144 atkbdc_softc_t *sc;
145 struct resource *port;
146 int unit;
147 int error;
148 int rid;
149 int i;
150
151 unit = device_get_unit(dev);
152 sc = *(atkbdc_softc_t **)device_get_softc(dev);
153 if (sc == NULL) {
154 /*
155 * We have to maintain two copies of the kbdc_softc struct,
156 * as the low-level console needs to have access to the
157 * keyboard controller before kbdc is probed and attached.
158 * kbdc_soft[] contains the default entry for that purpose.
159 * See atkbdc.c. XXX
160 */
161 sc = atkbdc_get_softc(unit);
162 if (sc == NULL)
163 return ENOMEM;
164 }
165
166 /* XXX should track resource in softc */
167 rid = 0;
168 port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
169 0, ~0, IO_KBDSIZE, RF_ACTIVE);
170 if (!port)
171 return ENXIO;
172 error = atkbdc_attach_unit(unit, sc, rman_get_start(port));
173 if (error)
174 return error;
175 *(atkbdc_softc_t **)device_get_softc(dev) = sc;
176
177 /*
178 * Add all devices configured to be attached to atkbdc0.
179 */
180 for (i = resource_query_string(-1, "at", "atkbdc0");
181 i != -1;
182 i = resource_query_string(i, "at", "atkbdc0")) {
183 atkbdc_add_device(dev, resource_query_name(i),
184 resource_query_unit(i));
185 }
186
187 /*
188 * and atkbdc?
189 */
190 for (i = resource_query_string(-1, "at", "atkbdc");
191 i != -1;
192 i = resource_query_string(i, "at", "atkbdc")) {
193 atkbdc_add_device(dev, resource_query_name(i),
194 resource_query_unit(i));
195 }
196
197 bus_generic_attach(dev);
198
199 return 0;
200}
201
202static int
203atkbdc_print_child(device_t bus, device_t dev)
204{
205 atkbdc_device_t *kbdcdev;
206 int retval = 0;
207
208 kbdcdev = (atkbdc_device_t *)device_get_ivars(dev);
209
210 retval += bus_print_child_header(bus, dev);
211 if (kbdcdev->flags != 0)
212 retval += printf(" flags 0x%x", kbdcdev->flags);
213 if (kbdcdev->irq != -1)
214 retval += printf(" irq %d", kbdcdev->irq);
215 retval += bus_print_child_footer(bus, dev);
216
217 return (retval);
218}
219
220static int
221atkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val)
222{
223 atkbdc_device_t *ivar;
224
225 ivar = (atkbdc_device_t *)device_get_ivars(dev);
226 switch (index) {
227 case KBDC_IVAR_PORT:
228 *val = (u_long)ivar->port;
229 break;
230 case KBDC_IVAR_IRQ:
231 *val = (u_long)ivar->irq;
232 break;
233 case KBDC_IVAR_FLAGS:
234 *val = (u_long)ivar->flags;
235 break;
236 default:
237 return ENOENT;
238 }
239 return 0;
240}
241
242static int
243atkbdc_write_ivar(device_t bus, device_t dev, int index, u_long val)
244{
245 atkbdc_device_t *ivar;
246
247 ivar = (atkbdc_device_t *)device_get_ivars(dev);
248 switch (index) {
249 case KBDC_IVAR_PORT:
250 ivar->port = (int)val;
251 break;
252 case KBDC_IVAR_IRQ:
253 ivar->irq = (int)val;
254 break;
255 case KBDC_IVAR_FLAGS:
256 ivar->flags = (int)val;
257 break;
258 default:
259 return ENOENT;
260 }
261 return 0;
262}
263
264DRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0);
| 123 kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT);
124 if (!kdev)
125 return;
126 bzero(kdev, sizeof *kdev);
127
128 kdev->port = sc->port;
129
130 if (resource_int_value(name, unit, "irq", &t) == 0)
131 kdev->irq = t;
132 else
133 kdev->irq = -1;
134
135 if (resource_int_value(name, unit, "flags", &t) == 0)
136 kdev->flags = t;
137 else
138 kdev->flags = 0;
139
140 child = device_add_child(dev, name, unit);
141 device_set_ivars(child, kdev);
142}
143
144static int
145atkbdc_attach(device_t dev)
146{
147 atkbdc_softc_t *sc;
148 struct resource *port;
149 int unit;
150 int error;
151 int rid;
152 int i;
153
154 unit = device_get_unit(dev);
155 sc = *(atkbdc_softc_t **)device_get_softc(dev);
156 if (sc == NULL) {
157 /*
158 * We have to maintain two copies of the kbdc_softc struct,
159 * as the low-level console needs to have access to the
160 * keyboard controller before kbdc is probed and attached.
161 * kbdc_soft[] contains the default entry for that purpose.
162 * See atkbdc.c. XXX
163 */
164 sc = atkbdc_get_softc(unit);
165 if (sc == NULL)
166 return ENOMEM;
167 }
168
169 /* XXX should track resource in softc */
170 rid = 0;
171 port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
172 0, ~0, IO_KBDSIZE, RF_ACTIVE);
173 if (!port)
174 return ENXIO;
175 error = atkbdc_attach_unit(unit, sc, rman_get_start(port));
176 if (error)
177 return error;
178 *(atkbdc_softc_t **)device_get_softc(dev) = sc;
179
180 /*
181 * Add all devices configured to be attached to atkbdc0.
182 */
183 for (i = resource_query_string(-1, "at", "atkbdc0");
184 i != -1;
185 i = resource_query_string(i, "at", "atkbdc0")) {
186 atkbdc_add_device(dev, resource_query_name(i),
187 resource_query_unit(i));
188 }
189
190 /*
191 * and atkbdc?
192 */
193 for (i = resource_query_string(-1, "at", "atkbdc");
194 i != -1;
195 i = resource_query_string(i, "at", "atkbdc")) {
196 atkbdc_add_device(dev, resource_query_name(i),
197 resource_query_unit(i));
198 }
199
200 bus_generic_attach(dev);
201
202 return 0;
203}
204
205static int
206atkbdc_print_child(device_t bus, device_t dev)
207{
208 atkbdc_device_t *kbdcdev;
209 int retval = 0;
210
211 kbdcdev = (atkbdc_device_t *)device_get_ivars(dev);
212
213 retval += bus_print_child_header(bus, dev);
214 if (kbdcdev->flags != 0)
215 retval += printf(" flags 0x%x", kbdcdev->flags);
216 if (kbdcdev->irq != -1)
217 retval += printf(" irq %d", kbdcdev->irq);
218 retval += bus_print_child_footer(bus, dev);
219
220 return (retval);
221}
222
223static int
224atkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val)
225{
226 atkbdc_device_t *ivar;
227
228 ivar = (atkbdc_device_t *)device_get_ivars(dev);
229 switch (index) {
230 case KBDC_IVAR_PORT:
231 *val = (u_long)ivar->port;
232 break;
233 case KBDC_IVAR_IRQ:
234 *val = (u_long)ivar->irq;
235 break;
236 case KBDC_IVAR_FLAGS:
237 *val = (u_long)ivar->flags;
238 break;
239 default:
240 return ENOENT;
241 }
242 return 0;
243}
244
245static int
246atkbdc_write_ivar(device_t bus, device_t dev, int index, u_long val)
247{
248 atkbdc_device_t *ivar;
249
250 ivar = (atkbdc_device_t *)device_get_ivars(dev);
251 switch (index) {
252 case KBDC_IVAR_PORT:
253 ivar->port = (int)val;
254 break;
255 case KBDC_IVAR_IRQ:
256 ivar->irq = (int)val;
257 break;
258 case KBDC_IVAR_FLAGS:
259 ivar->flags = (int)val;
260 break;
261 default:
262 return ENOENT;
263 }
264 return 0;
265}
266
267DRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0);
|