mms.c revision 1.42 1 1.42 drochner /* $NetBSD: mms.c,v 1.42 2004/09/14 20:25:05 drochner Exp $ */
2 1.13 cgd
3 1.1 andrew /*-
4 1.32 mycroft * Copyright (c) 1993, 1994 Charles M. Hannum.
5 1.1 andrew * Copyright (c) 1992, 1993 Erik Forsberg.
6 1.1 andrew * All rights reserved.
7 1.1 andrew *
8 1.1 andrew * Redistribution and use in source and binary forms, with or without
9 1.1 andrew * modification, are permitted provided that the following conditions
10 1.1 andrew * are met:
11 1.1 andrew * 1. Redistributions of source code must retain the above copyright
12 1.1 andrew * notice, this list of conditions and the following disclaimer.
13 1.1 andrew *
14 1.1 andrew * THIS SOFTWARE IS PROVIDED BY ``AS IS'' AND ANY EXPRESS OR IMPLIED
15 1.1 andrew * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
16 1.1 andrew * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
17 1.1 andrew * NO EVENT SHALL I BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
18 1.1 andrew * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
19 1.1 andrew * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
20 1.1 andrew * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
21 1.1 andrew * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
22 1.1 andrew * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
23 1.1 andrew * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24 1.1 andrew */
25 1.36 lukem
26 1.36 lukem #include <sys/cdefs.h>
27 1.42 drochner __KERNEL_RCSID(0, "$NetBSD: mms.c,v 1.42 2004/09/14 20:25:05 drochner Exp $");
28 1.1 andrew
29 1.7 mycroft #include <sys/param.h>
30 1.7 mycroft #include <sys/systm.h>
31 1.7 mycroft #include <sys/ioctl.h>
32 1.8 mycroft #include <sys/device.h>
33 1.7 mycroft
34 1.24 mycroft #include <machine/intr.h>
35 1.28 thorpej #include <machine/bus.h>
36 1.1 andrew
37 1.18 cgd #include <dev/isa/isavar.h>
38 1.1 andrew
39 1.34 drochner #include <dev/wscons/wsconsio.h>
40 1.34 drochner #include <dev/wscons/wsmousevar.h>
41 1.34 drochner
42 1.8 mycroft #define MMS_ADDR 0 /* offset for register select */
43 1.8 mycroft #define MMS_DATA 1 /* offset for InPort data */
44 1.8 mycroft #define MMS_IDENT 2 /* offset for identification register */
45 1.8 mycroft #define MMS_NPORTS 4
46 1.8 mycroft
47 1.8 mycroft struct mms_softc { /* driver status information */
48 1.8 mycroft struct device sc_dev;
49 1.18 cgd void *sc_ih;
50 1.8 mycroft
51 1.28 thorpej bus_space_tag_t sc_iot;
52 1.28 thorpej bus_space_handle_t sc_ioh;
53 1.28 thorpej
54 1.34 drochner int sc_enabled; /* device is open */
55 1.34 drochner
56 1.34 drochner struct device *sc_wsmousedev;
57 1.9 mycroft };
58 1.1 andrew
59 1.31 drochner int mmsprobe __P((struct device *, struct cfdata *, void *));
60 1.15 mycroft void mmsattach __P((struct device *, struct device *, void *));
61 1.18 cgd int mmsintr __P((void *));
62 1.1 andrew
63 1.41 thorpej CFATTACH_DECL(mms, sizeof(struct mms_softc),
64 1.41 thorpej mmsprobe, mmsattach, NULL, NULL);
65 1.21 thorpej
66 1.34 drochner int mms_enable __P((void *));
67 1.34 drochner int mms_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
68 1.34 drochner void mms_disable __P((void *));
69 1.34 drochner
70 1.34 drochner const struct wsmouse_accessops mms_accessops = {
71 1.34 drochner mms_enable,
72 1.34 drochner mms_ioctl,
73 1.34 drochner mms_disable,
74 1.34 drochner };
75 1.8 mycroft
76 1.8 mycroft int
77 1.15 mycroft mmsprobe(parent, match, aux)
78 1.15 mycroft struct device *parent;
79 1.31 drochner struct cfdata *match;
80 1.31 drochner void *aux;
81 1.1 andrew {
82 1.9 mycroft struct isa_attach_args *ia = aux;
83 1.28 thorpej bus_space_tag_t iot = ia->ia_iot;
84 1.28 thorpej bus_space_handle_t ioh;
85 1.29 mycroft int rv;
86 1.28 thorpej
87 1.37 thorpej if (ia->ia_nio < 1)
88 1.37 thorpej return (0);
89 1.37 thorpej if (ia->ia_nirq < 1)
90 1.37 thorpej return (0);
91 1.37 thorpej
92 1.37 thorpej if (ISA_DIRECT_CONFIG(ia))
93 1.37 thorpej return (0);
94 1.37 thorpej
95 1.28 thorpej /* Disallow wildcarded i/o address. */
96 1.42 drochner if (ia->ia_io[0].ir_addr == ISA_UNKNOWN_PORT)
97 1.37 thorpej return 0;
98 1.37 thorpej
99 1.42 drochner if (ia->ia_irq[0].ir_irq == ISA_UNKNOWN_IRQ)
100 1.28 thorpej return 0;
101 1.28 thorpej
102 1.29 mycroft /* Map the i/o space. */
103 1.37 thorpej if (bus_space_map(iot, ia->ia_io[0].ir_addr, MMS_NPORTS, 0, &ioh))
104 1.28 thorpej return 0;
105 1.1 andrew
106 1.29 mycroft rv = 0;
107 1.29 mycroft
108 1.1 andrew /* Read identification register to see if present */
109 1.28 thorpej if (bus_space_read_1(iot, ioh, MMS_IDENT) != 0xde)
110 1.28 thorpej goto out;
111 1.1 andrew
112 1.8 mycroft /* Seems it was there; reset. */
113 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x87);
114 1.1 andrew
115 1.28 thorpej rv = 1;
116 1.37 thorpej
117 1.37 thorpej ia->ia_nio = 1;
118 1.37 thorpej ia->ia_io[0].ir_size = MMS_NPORTS;
119 1.37 thorpej
120 1.37 thorpej ia->ia_nirq = 1;
121 1.37 thorpej
122 1.37 thorpej ia->ia_niomem = 0;
123 1.37 thorpej ia->ia_ndrq = 0;
124 1.29 mycroft
125 1.29 mycroft out:
126 1.28 thorpej bus_space_unmap(iot, ioh, MMS_NPORTS);
127 1.28 thorpej return rv;
128 1.1 andrew }
129 1.1 andrew
130 1.9 mycroft void
131 1.9 mycroft mmsattach(parent, self, aux)
132 1.9 mycroft struct device *parent, *self;
133 1.9 mycroft void *aux;
134 1.1 andrew {
135 1.9 mycroft struct mms_softc *sc = (void *)self;
136 1.9 mycroft struct isa_attach_args *ia = aux;
137 1.28 thorpej bus_space_tag_t iot = ia->ia_iot;
138 1.28 thorpej bus_space_handle_t ioh;
139 1.34 drochner struct wsmousedev_attach_args a;
140 1.10 mycroft
141 1.27 christos printf("\n");
142 1.1 andrew
143 1.37 thorpej if (bus_space_map(iot, ia->ia_io[0].ir_addr, MMS_NPORTS, 0, &ioh)) {
144 1.28 thorpej printf("%s: can't map i/o space\n", sc->sc_dev.dv_xname);
145 1.28 thorpej return;
146 1.28 thorpej }
147 1.28 thorpej
148 1.8 mycroft /* Other initialization was done by mmsprobe. */
149 1.28 thorpej sc->sc_iot = iot;
150 1.28 thorpej sc->sc_ioh = ioh;
151 1.34 drochner sc->sc_enabled = 0;
152 1.11 mycroft
153 1.37 thorpej sc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq[0].ir_irq,
154 1.37 thorpej IST_PULSE, IPL_TTY, mmsintr, sc);
155 1.34 drochner
156 1.34 drochner a.accessops = &mms_accessops;
157 1.34 drochner a.accesscookie = sc;
158 1.34 drochner
159 1.34 drochner /*
160 1.34 drochner * Attach the wsmouse, saving a handle to it.
161 1.34 drochner * Note that we don't need to check this pointer against NULL
162 1.34 drochner * here or in psmintr, because if this fails lms_enable() will
163 1.34 drochner * never be called, so lmsintr() will never be called.
164 1.34 drochner */
165 1.34 drochner sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
166 1.1 andrew }
167 1.1 andrew
168 1.8 mycroft int
169 1.34 drochner mms_enable(v)
170 1.34 drochner void *v;
171 1.1 andrew {
172 1.34 drochner struct mms_softc *sc = v;
173 1.1 andrew
174 1.34 drochner if (sc->sc_enabled)
175 1.8 mycroft return EBUSY;
176 1.1 andrew
177 1.34 drochner sc->sc_enabled = 1;
178 1.1 andrew
179 1.8 mycroft /* Enable interrupts. */
180 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x07);
181 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_DATA, 0x09);
182 1.1 andrew
183 1.8 mycroft return 0;
184 1.1 andrew }
185 1.1 andrew
186 1.34 drochner void
187 1.34 drochner mms_disable(v)
188 1.34 drochner void *v;
189 1.1 andrew {
190 1.34 drochner struct mms_softc *sc = v;
191 1.1 andrew
192 1.8 mycroft /* Disable interrupts. */
193 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x87);
194 1.1 andrew
195 1.34 drochner sc->sc_enabled = 0;
196 1.1 andrew }
197 1.1 andrew
198 1.8 mycroft int
199 1.34 drochner mms_ioctl(v, cmd, data, flag, p)
200 1.34 drochner void *v;
201 1.14 cgd u_long cmd;
202 1.34 drochner caddr_t data;
203 1.8 mycroft int flag;
204 1.23 christos struct proc *p;
205 1.1 andrew {
206 1.34 drochner #if 0
207 1.34 drochner struct mms_softc *sc = v;
208 1.34 drochner #endif
209 1.1 andrew
210 1.1 andrew switch (cmd) {
211 1.34 drochner case WSMOUSEIO_GTYPE:
212 1.34 drochner *(u_int *)data = WSMOUSE_TYPE_MMS;
213 1.34 drochner return (0);
214 1.8 mycroft }
215 1.38 atatat return (EPASSTHROUGH);
216 1.1 andrew }
217 1.1 andrew
218 1.8 mycroft int
219 1.18 cgd mmsintr(arg)
220 1.18 cgd void *arg;
221 1.1 andrew {
222 1.18 cgd struct mms_softc *sc = arg;
223 1.29 mycroft bus_space_tag_t iot = sc->sc_iot;
224 1.29 mycroft bus_space_handle_t ioh = sc->sc_ioh;
225 1.34 drochner u_char status;
226 1.34 drochner signed char dx, dy;
227 1.34 drochner u_int buttons;
228 1.34 drochner int changed;
229 1.8 mycroft
230 1.34 drochner if (!sc->sc_enabled)
231 1.8 mycroft /* Interrupts are not expected. */
232 1.8 mycroft return 0;
233 1.8 mycroft
234 1.8 mycroft /* Freeze InPort registers (disabling interrupts). */
235 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
236 1.28 thorpej bus_space_write_1(iot, ioh, MMS_DATA, 0x29);
237 1.1 andrew
238 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x00);
239 1.28 thorpej status = bus_space_read_1(iot, ioh, MMS_DATA);
240 1.1 andrew
241 1.1 andrew if (status & 0x40) {
242 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 1);
243 1.28 thorpej dx = bus_space_read_1(iot, ioh, MMS_DATA);
244 1.34 drochner /* Bounding at -127 avoids a bug in XFree86. */
245 1.8 mycroft dx = (dx == -128) ? -127 : dx;
246 1.34 drochner
247 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 2);
248 1.28 thorpej dy = bus_space_read_1(iot, ioh, MMS_DATA);
249 1.1 andrew dy = (dy == -128) ? 127 : -dy;
250 1.8 mycroft } else
251 1.1 andrew dx = dy = 0;
252 1.1 andrew
253 1.8 mycroft /* Unfreeze InPort registers (reenabling interrupts). */
254 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
255 1.28 thorpej bus_space_write_1(iot, ioh, MMS_DATA, 0x09);
256 1.8 mycroft
257 1.34 drochner buttons = ((status & 0x04) ? 0x1 : 0) |
258 1.34 drochner ((status & 0x02) ? 0x2 : 0) |
259 1.34 drochner ((status & 0x01) ? 0x4 : 0);
260 1.34 drochner changed = status & 0x38;
261 1.34 drochner
262 1.34 drochner if (dx || dy || changed)
263 1.34 drochner wsmouse_input(sc->sc_wsmousedev,
264 1.35 takemura buttons, dx, dy, 0, WSMOUSE_INPUT_DELTA);
265 1.8 mycroft
266 1.11 mycroft return -1;
267 1.1 andrew }
268