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