]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/dev/atkbdc/atkbd_atkbdc.c
MFV r328251: 8652 Tautological comparisons with ZPROP_INVAL
[FreeBSD/FreeBSD.git] / sys / dev / atkbdc / atkbd_atkbdc.c
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer as
12  *    the first lines of this file unmodified.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20  * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27  */
28
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31
32 #include "opt_kbd.h"
33 #include "opt_evdev.h"
34
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/kernel.h>
38 #include <sys/module.h>
39 #include <sys/bus.h>
40
41 #include <machine/bus.h>
42 #include <machine/resource.h>
43 #include <sys/rman.h>
44
45 #include <sys/kbio.h>
46 #include <dev/kbd/kbdreg.h>
47 #include <dev/atkbdc/atkbdreg.h>
48 #include <dev/atkbdc/atkbdcreg.h>
49
50 typedef struct {
51         struct resource *intr;
52         void            *ih;
53 } atkbd_softc_t;
54
55 static devclass_t       atkbd_devclass;
56
57 static void     atkbdidentify(driver_t *driver, device_t dev);
58 static int      atkbdprobe(device_t dev);
59 static int      atkbdattach(device_t dev);
60 static int      atkbdresume(device_t dev);
61 static void     atkbdintr(void *arg);
62
63 static device_method_t atkbd_methods[] = {
64         DEVMETHOD(device_identify,      atkbdidentify),
65         DEVMETHOD(device_probe,         atkbdprobe),
66         DEVMETHOD(device_attach,        atkbdattach),
67         DEVMETHOD(device_resume,        atkbdresume),
68         { 0, 0 }
69 };
70
71 static driver_t atkbd_driver = {
72         ATKBD_DRIVER_NAME,
73         atkbd_methods,
74         sizeof(atkbd_softc_t),
75 };
76
77 static void
78 atkbdidentify(driver_t *driver, device_t parent)
79 {
80
81         /* always add at least one child */
82         BUS_ADD_CHILD(parent, KBDC_RID_KBD, driver->name, device_get_unit(parent));
83 }
84
85 static int
86 atkbdprobe(device_t dev)
87 {
88         struct resource *res;
89         u_long irq;
90         int flags;
91         int rid;
92
93         device_set_desc(dev, "AT Keyboard");
94
95         /* obtain parameters */
96         flags = device_get_flags(dev);
97
98         /* see if IRQ is available */
99         rid = KBDC_RID_KBD;
100         res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 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(dev, irq, flags);
111 }
112
113 static int
114 atkbdattach(device_t dev)
115 {
116         atkbd_softc_t *sc;
117         keyboard_t *kbd;
118         u_long irq;
119         int flags;
120         int rid;
121         int error;
122
123         sc = device_get_softc(dev);
124
125         rid = KBDC_RID_KBD;
126         irq = bus_get_resource_start(dev, SYS_RES_IRQ, rid);
127         flags = device_get_flags(dev);
128         error = atkbd_attach_unit(dev, &kbd, irq, flags);
129         if (error)
130                 return error;
131
132         /* declare our interrupt handler */
133         sc->intr = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, RF_ACTIVE);
134         if (sc->intr == NULL)
135                 return ENXIO;
136         error = bus_setup_intr(dev, sc->intr, INTR_TYPE_TTY, NULL, atkbdintr,
137                                kbd, &sc->ih);
138         if (error)
139                 bus_release_resource(dev, SYS_RES_IRQ, rid, sc->intr);
140
141         return error;
142 }
143
144 static int
145 atkbdresume(device_t dev)
146 {
147         atkbd_softc_t *sc;
148         keyboard_t *kbd;
149         int args[2];
150
151         sc = device_get_softc(dev);
152         kbd = kbd_get_keyboard(kbd_find_keyboard(ATKBD_DRIVER_NAME,
153                                                  device_get_unit(dev)));
154         if (kbd) {
155                 kbd->kb_flags &= ~KB_INITIALIZED;
156                 args[0] = device_get_unit(device_get_parent(dev));
157                 args[1] = rman_get_start(sc->intr);
158                 kbdd_init(kbd, device_get_unit(dev), &kbd, args,
159                     device_get_flags(dev));
160                 kbdd_clear_state(kbd);
161         }
162         return 0;
163 }
164
165 static void
166 atkbdintr(void *arg)
167 {
168         keyboard_t *kbd;
169
170         kbd = (keyboard_t *)arg;
171         kbdd_intr(kbd, NULL);
172 }
173
174 DRIVER_MODULE(atkbd, atkbdc, atkbd_driver, atkbd_devclass, 0, 0);
175 #ifdef EVDEV_SUPPORT
176 MODULE_DEPEND(atkbd, evdev, 1, 1, 1);
177 #endif