Deleted Added
sdiff udiff text old ( 114293 ) new ( 116181 )
full compact
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/atkbd_atkbdc.c 114293 2003-04-30 12:57:40Z markm $
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
36#include <machine/bus.h>
37#include <machine/resource.h>
38#include <sys/rman.h>
39
40#include <sys/kbio.h>
41#include <dev/kbd/kbdreg.h>
42#include <dev/kbd/atkbdreg.h>
43#include <dev/kbd/atkbdcreg.h>
44
45#include <isa/isareg.h>
46#include <isa/isavar.h>
47
48typedef struct {
49 struct resource *intr;
50 void *ih;
51} atkbd_softc_t;
52
53static devclass_t atkbd_devclass;
54
55static void atkbdidentify(driver_t *driver, device_t dev);
56static int atkbdprobe(device_t dev);
57static int atkbdattach(device_t dev);
58static int atkbdresume(device_t dev);
59static void atkbd_isa_intr(void *arg);
60
61static device_method_t atkbd_methods[] = {
62 DEVMETHOD(device_identify, atkbdidentify),
63 DEVMETHOD(device_probe, atkbdprobe),
64 DEVMETHOD(device_attach, atkbdattach),
65 DEVMETHOD(device_resume, atkbdresume),
66 { 0, 0 }
67};
68
69static driver_t atkbd_driver = {
70 ATKBD_DRIVER_NAME,
71 atkbd_methods,
72 sizeof(atkbd_softc_t),
73};
74
75static void
76atkbdidentify(driver_t *driver, device_t parent)
77{
78
79 /* always add at least one child */
80 BUS_ADD_CHILD(parent, KBDC_RID_KBD, driver->name, device_get_unit(parent));
81}
82
83static int
84atkbdprobe(device_t dev)
85{
86 struct resource *res;
87 u_long irq;
88 int flags;
89 int rid;
90
91 device_set_desc(dev, "AT Keyboard");
92
93 /* obtain parameters */
94 flags = device_get_flags(dev);
95
96 /* see if IRQ is available */
97 rid = KBDC_RID_KBD;
98 res = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1,
99 RF_SHAREABLE | RF_ACTIVE);
100 if (res == NULL) {
101 if (bootverbose)
102 device_printf(dev, "unable to allocate IRQ\n");
103 return ENXIO;
104 }
105 irq = rman_get_start(res);
106 bus_release_resource(dev, SYS_RES_IRQ, rid, res);
107
108 /* probe the device */
109 return atkbd_probe_unit(device_get_unit(dev),
110 device_get_unit(device_get_parent(dev)),
111 irq, flags);
112}
113
114static int
115atkbdattach(device_t dev)
116{
117 atkbd_softc_t *sc;
118 keyboard_t *kbd;
119 u_long irq;
120 int flags;
121 int rid;
122 int error;
123
124 sc = device_get_softc(dev);
125
126 rid = KBDC_RID_KBD;
127 irq = bus_get_resource_start(dev, SYS_RES_IRQ, rid);
128 flags = device_get_flags(dev);
129 error = atkbd_attach_unit(device_get_unit(dev), &kbd,
130 device_get_unit(device_get_parent(dev)),
131 irq, flags);
132 if (error)
133 return error;
134
135 /* declare our interrupt handler */
136 sc->intr = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1,
137 RF_SHAREABLE | RF_ACTIVE);
138 if (sc->intr == NULL)
139 return ENXIO;
140 error = bus_setup_intr(dev, sc->intr, INTR_TYPE_TTY, atkbd_isa_intr,
141 kbd, &sc->ih);
142 if (error)
143 bus_release_resource(dev, SYS_RES_IRQ, rid, sc->intr);
144
145 return error;
146}
147
148static int
149atkbdresume(device_t dev)
150{
151 atkbd_softc_t *sc;
152 keyboard_t *kbd;
153 int args[2];
154
155 sc = device_get_softc(dev);
156 kbd = kbd_get_keyboard(kbd_find_keyboard(ATKBD_DRIVER_NAME,
157 device_get_unit(dev)));
158 if (kbd) {
159 kbd->kb_flags &= ~KB_INITIALIZED;
160 args[0] = device_get_unit(device_get_parent(dev));
161 args[1] = rman_get_start(sc->intr);
162 (*kbdsw[kbd->kb_index]->init)(device_get_unit(dev), &kbd,
163 args, device_get_flags(dev));
164 (*kbdsw[kbd->kb_index]->clear_state)(kbd);
165 }
166 return 0;
167}
168
169static void
170atkbd_isa_intr(void *arg)
171{
172 keyboard_t *kbd;
173
174 kbd = (keyboard_t *)arg;
175 (*kbdsw[kbd->kb_index]->intr)(kbd, NULL);
176}
177
178DRIVER_MODULE(atkbd, atkbdc, atkbd_driver, atkbd_devclass, 0, 0);