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 * $Id: atkbdc_isa.c,v 1.4 1999/05/08 21:59:29 dfr Exp $
| 26 * $Id: atkbdc_isa.c,v 1.5 1999/05/09 20:45:53 peter Exp $
|
27 */
28
29#include "atkbdc.h"
30#include "opt_kbd.h"
31
32#if NATKBDC > 0
33
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/kernel.h>
37#include <sys/bus.h>
38#include <sys/malloc.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 void 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),
| 27 */
28
29#include "atkbdc.h"
30#include "opt_kbd.h"
31
32#if NATKBDC > 0
33
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/kernel.h>
37#include <sys/bus.h>
38#include <sys/malloc.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 void 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),
|
68
69 DEVMETHOD(bus_print_child, atkbdc_print_child),
70 DEVMETHOD(bus_read_ivar, atkbdc_read_ivar),
71 DEVMETHOD(bus_write_ivar, atkbdc_write_ivar),
72 DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource),
73 DEVMETHOD(bus_release_resource, bus_generic_release_resource),
74 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
75 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
76 DEVMETHOD(bus_setup_intr, bus_generic_setup_intr),
77 DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr),
78
79 { 0, 0 }
80};
81
82static driver_t atkbdc_driver = {
83 ATKBDC_DRIVER_NAME,
84 atkbdc_methods,
85 sizeof(atkbdc_softc_t *),
86};
87
88static int
89atkbdc_probe(device_t dev)
90{
| 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{
|
91 atkbdc_softc_t *sc;
92 int unit;
| |
93 int error;
94
| 93 int error;
94
|
95 unit = device_get_unit(dev);
96 sc = *(atkbdc_softc_t **)device_get_softc(dev);
97 if (sc == NULL) {
98 /*
99 * We have to maintain two copies of the kbdc_softc struct,
100 * as the low-level console needs to have access to the
101 * keyboard controller before kbdc is probed and attached.
102 * kbdc_soft[] contains the default entry for that purpose.
103 * See atkbdc.c. XXX
104 */
105 sc = atkbdc_get_softc(unit);
106 if (sc == NULL)
107 return ENOMEM;
108 }
109
| |
110 device_set_desc(dev, "keyboard controller (i8042)");
| 95 device_set_desc(dev, "keyboard controller (i8042)");
|
111
112 error = atkbdc_probe_unit(sc, unit, isa_get_port(dev));
| 96 error = atkbdc_probe_unit(device_get_unit(dev), isa_get_port(dev));
|
113 if (error == 0)
| 97 if (error == 0)
|
114 *(atkbdc_softc_t **)device_get_softc(dev) = sc;
115
| 98 isa_set_portsize(dev, IO_KBDSIZE);
|
116 return error;
117}
118
119static void
120atkbdc_add_device(device_t dev, const char *name, int unit)
121{
122 atkbdc_softc_t *sc = *(atkbdc_softc_t **)device_get_softc(dev);
123 atkbdc_device_t *kdev;
124 device_t child;
125 int t;
126
127 kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT);
128 if (!kdev)
129 return;
130 bzero(kdev, sizeof *kdev);
131
132 kdev->port = sc->port;
133
134 if (resource_int_value(name, unit, "irq", &t) == 0)
135 kdev->irq = t;
136 else
137 kdev->irq = -1;
138
139 if (resource_int_value(name, unit, "flags", &t) == 0)
140 kdev->flags = t;
141 else
142 kdev->flags = 0;
143
144 child = device_add_child(dev, name, unit, kdev);
145}
146
147static int
148atkbdc_attach(device_t dev)
149{
150 atkbdc_softc_t *sc;
| 99 return error;
100}
101
102static void
103atkbdc_add_device(device_t dev, const char *name, int unit)
104{
105 atkbdc_softc_t *sc = *(atkbdc_softc_t **)device_get_softc(dev);
106 atkbdc_device_t *kdev;
107 device_t child;
108 int t;
109
110 kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT);
111 if (!kdev)
112 return;
113 bzero(kdev, sizeof *kdev);
114
115 kdev->port = sc->port;
116
117 if (resource_int_value(name, unit, "irq", &t) == 0)
118 kdev->irq = t;
119 else
120 kdev->irq = -1;
121
122 if (resource_int_value(name, unit, "flags", &t) == 0)
123 kdev->flags = t;
124 else
125 kdev->flags = 0;
126
127 child = device_add_child(dev, name, unit, kdev);
128}
129
130static int
131atkbdc_attach(device_t dev)
132{
133 atkbdc_softc_t *sc;
|
| 134 int unit;
135 int error;
|
151 int i;
152
| 136 int i;
137
|
| 138 unit = device_get_unit(dev);
|
153 sc = *(atkbdc_softc_t **)device_get_softc(dev);
| 139 sc = *(atkbdc_softc_t **)device_get_softc(dev);
|
154 if ((sc == NULL) || (sc->port <= 0))
155 return ENXIO;
| 140 if (sc == NULL) {
141 /*
142 * We have to maintain two copies of the kbdc_softc struct,
143 * as the low-level console needs to have access to the
144 * keyboard controller before kbdc is probed and attached.
145 * kbdc_soft[] contains the default entry for that purpose.
146 * See atkbdc.c. XXX
147 */
148 sc = atkbdc_get_softc(unit);
149 if (sc == NULL)
150 return ENOMEM;
151 }
|
156
| 152
|
| 153 error = atkbdc_attach_unit(unit, sc, isa_get_port(dev));
154 if (error)
155 return error;
156 *(atkbdc_softc_t **)device_get_softc(dev) = sc;
157
|
157 /*
158 * Add all devices configured to be attached to atkbdc0.
159 */
160 for (i = resource_query_string(-1, "at", "atkbdc0");
161 i != -1;
162 i = resource_query_string(i, "at", "atkbdc0")) {
163 atkbdc_add_device(dev, resource_query_name(i),
164 resource_query_unit(i));
165 }
166
167 /*
168 * and atkbdc?
169 */
170 for (i = resource_query_string(-1, "at", "atkbdc");
171 i != -1;
172 i = resource_query_string(i, "at", "atkbdc")) {
173 atkbdc_add_device(dev, resource_query_name(i),
174 resource_query_unit(i));
175 }
176
177 bus_generic_attach(dev);
178
179 return 0;
180}
181
182static void
183atkbdc_print_child(device_t bus, device_t dev)
184{
185 atkbdc_device_t *kbdcdev;
186
187 kbdcdev = (atkbdc_device_t *)device_get_ivars(dev);
188
189 if (kbdcdev->flags != 0)
190 printf(" flags 0x%x", kbdcdev->flags);
191 if (kbdcdev->irq != -1)
192 printf(" irq %d", kbdcdev->irq);
193
194 printf(" on %s%d", device_get_name(bus), device_get_unit(bus));
195}
196
197static int
198atkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val)
199{
200 atkbdc_device_t *ivar;
201
202 ivar = (atkbdc_device_t *)device_get_ivars(dev);
203 switch (index) {
204 case KBDC_IVAR_PORT:
205 *val = (u_long)ivar->port;
206 break;
207 case KBDC_IVAR_IRQ:
208 *val = (u_long)ivar->irq;
209 break;
210 case KBDC_IVAR_FLAGS:
211 *val = (u_long)ivar->flags;
212 break;
213 default:
214 return ENOENT;
215 }
216 return 0;
217}
218
219static int
220atkbdc_write_ivar(device_t bus, device_t dev, int index, u_long val)
221{
222 atkbdc_device_t *ivar;
223
224 ivar = (atkbdc_device_t *)device_get_ivars(dev);
225 switch (index) {
226 case KBDC_IVAR_PORT:
227 ivar->port = (int)val;
228 break;
229 case KBDC_IVAR_IRQ:
230 ivar->irq = (int)val;
231 break;
232 case KBDC_IVAR_FLAGS:
233 ivar->flags = (int)val;
234 break;
235 default:
236 return ENOENT;
237 }
238 return 0;
239}
240
241DRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0);
242
243#endif /* NATKBDC > 0 */
| 158 /*
159 * Add all devices configured to be attached to atkbdc0.
160 */
161 for (i = resource_query_string(-1, "at", "atkbdc0");
162 i != -1;
163 i = resource_query_string(i, "at", "atkbdc0")) {
164 atkbdc_add_device(dev, resource_query_name(i),
165 resource_query_unit(i));
166 }
167
168 /*
169 * and atkbdc?
170 */
171 for (i = resource_query_string(-1, "at", "atkbdc");
172 i != -1;
173 i = resource_query_string(i, "at", "atkbdc")) {
174 atkbdc_add_device(dev, resource_query_name(i),
175 resource_query_unit(i));
176 }
177
178 bus_generic_attach(dev);
179
180 return 0;
181}
182
183static void
184atkbdc_print_child(device_t bus, device_t dev)
185{
186 atkbdc_device_t *kbdcdev;
187
188 kbdcdev = (atkbdc_device_t *)device_get_ivars(dev);
189
190 if (kbdcdev->flags != 0)
191 printf(" flags 0x%x", kbdcdev->flags);
192 if (kbdcdev->irq != -1)
193 printf(" irq %d", kbdcdev->irq);
194
195 printf(" on %s%d", device_get_name(bus), device_get_unit(bus));
196}
197
198static int
199atkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val)
200{
201 atkbdc_device_t *ivar;
202
203 ivar = (atkbdc_device_t *)device_get_ivars(dev);
204 switch (index) {
205 case KBDC_IVAR_PORT:
206 *val = (u_long)ivar->port;
207 break;
208 case KBDC_IVAR_IRQ:
209 *val = (u_long)ivar->irq;
210 break;
211 case KBDC_IVAR_FLAGS:
212 *val = (u_long)ivar->flags;
213 break;
214 default:
215 return ENOENT;
216 }
217 return 0;
218}
219
220static int
221atkbdc_write_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 ivar->port = (int)val;
229 break;
230 case KBDC_IVAR_IRQ:
231 ivar->irq = (int)val;
232 break;
233 case KBDC_IVAR_FLAGS:
234 ivar->flags = (int)val;
235 break;
236 default:
237 return ENOENT;
238 }
239 return 0;
240}
241
242DRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0);
243
244#endif /* NATKBDC > 0 */
|