mms.c revision 1.29 1 1.29 mycroft /* $NetBSD: mms.c,v 1.29 1997/10/19 20:31:32 mycroft Exp $ */
2 1.13 cgd
3 1.1 andrew /*-
4 1.8 mycroft * Copyright (c) 1993, 1994 Charles 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.1 andrew
26 1.7 mycroft #include <sys/param.h>
27 1.7 mycroft #include <sys/kernel.h>
28 1.7 mycroft #include <sys/systm.h>
29 1.7 mycroft #include <sys/buf.h>
30 1.7 mycroft #include <sys/malloc.h>
31 1.7 mycroft #include <sys/ioctl.h>
32 1.7 mycroft #include <sys/tty.h>
33 1.7 mycroft #include <sys/file.h>
34 1.7 mycroft #include <sys/select.h>
35 1.7 mycroft #include <sys/proc.h>
36 1.7 mycroft #include <sys/vnode.h>
37 1.8 mycroft #include <sys/device.h>
38 1.25 mycroft #include <sys/poll.h>
39 1.7 mycroft
40 1.8 mycroft #include <machine/cpu.h>
41 1.24 mycroft #include <machine/intr.h>
42 1.28 thorpej #include <machine/bus.h>
43 1.7 mycroft #include <machine/mouse.h>
44 1.23 christos #include <machine/conf.h>
45 1.1 andrew
46 1.18 cgd #include <dev/isa/isavar.h>
47 1.1 andrew
48 1.8 mycroft #define MMS_ADDR 0 /* offset for register select */
49 1.8 mycroft #define MMS_DATA 1 /* offset for InPort data */
50 1.8 mycroft #define MMS_IDENT 2 /* offset for identification register */
51 1.8 mycroft #define MMS_NPORTS 4
52 1.8 mycroft
53 1.8 mycroft #define MMS_CHUNK 128 /* chunk size for read */
54 1.8 mycroft #define MMS_BSIZE 1020 /* buffer size */
55 1.8 mycroft
56 1.8 mycroft struct mms_softc { /* driver status information */
57 1.8 mycroft struct device sc_dev;
58 1.18 cgd void *sc_ih;
59 1.8 mycroft
60 1.28 thorpej bus_space_tag_t sc_iot;
61 1.28 thorpej bus_space_handle_t sc_ioh;
62 1.28 thorpej
63 1.8 mycroft struct clist sc_q;
64 1.8 mycroft struct selinfo sc_rsel;
65 1.8 mycroft u_char sc_state; /* mouse driver state */
66 1.8 mycroft #define MMS_OPEN 0x01 /* device is open */
67 1.8 mycroft #define MMS_ASLP 0x02 /* waiting for mouse data */
68 1.8 mycroft u_char sc_status; /* mouse button status */
69 1.8 mycroft int sc_x, sc_y; /* accumulated motion in the X,Y axis */
70 1.9 mycroft };
71 1.1 andrew
72 1.15 mycroft int mmsprobe __P((struct device *, void *, void *));
73 1.15 mycroft void mmsattach __P((struct device *, struct device *, void *));
74 1.18 cgd int mmsintr __P((void *));
75 1.1 andrew
76 1.21 thorpej struct cfattach mms_ca = {
77 1.21 thorpej sizeof(struct mms_softc), mmsprobe, mmsattach
78 1.21 thorpej };
79 1.21 thorpej
80 1.21 thorpej struct cfdriver mms_cd = {
81 1.21 thorpej NULL, "mms", DV_TTY
82 1.9 mycroft };
83 1.1 andrew
84 1.8 mycroft #define MMSUNIT(dev) (minor(dev))
85 1.8 mycroft
86 1.8 mycroft int
87 1.15 mycroft mmsprobe(parent, match, aux)
88 1.15 mycroft struct device *parent;
89 1.15 mycroft void *match, *aux;
90 1.1 andrew {
91 1.9 mycroft struct isa_attach_args *ia = aux;
92 1.28 thorpej bus_space_tag_t iot = ia->ia_iot;
93 1.28 thorpej bus_space_handle_t ioh;
94 1.29 mycroft int rv;
95 1.28 thorpej
96 1.28 thorpej /* Disallow wildcarded i/o address. */
97 1.28 thorpej if (ia->ia_iobase == ISACF_PORT_DEFAULT)
98 1.28 thorpej return 0;
99 1.28 thorpej
100 1.29 mycroft /* Map the i/o space. */
101 1.28 thorpej if (bus_space_map(iot, ia->ia_iobase, MMS_NPORTS, 0, &ioh))
102 1.28 thorpej return 0;
103 1.1 andrew
104 1.29 mycroft rv = 0;
105 1.29 mycroft
106 1.1 andrew /* Read identification register to see if present */
107 1.28 thorpej if (bus_space_read_1(iot, ioh, MMS_IDENT) != 0xde)
108 1.28 thorpej goto out;
109 1.1 andrew
110 1.8 mycroft /* Seems it was there; reset. */
111 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x87);
112 1.1 andrew
113 1.28 thorpej rv = 1;
114 1.9 mycroft ia->ia_iosize = MMS_NPORTS;
115 1.9 mycroft ia->ia_msize = 0;
116 1.29 mycroft
117 1.29 mycroft out:
118 1.28 thorpej bus_space_unmap(iot, ioh, MMS_NPORTS);
119 1.28 thorpej return rv;
120 1.1 andrew }
121 1.1 andrew
122 1.9 mycroft void
123 1.9 mycroft mmsattach(parent, self, aux)
124 1.9 mycroft struct device *parent, *self;
125 1.9 mycroft void *aux;
126 1.1 andrew {
127 1.9 mycroft struct mms_softc *sc = (void *)self;
128 1.9 mycroft struct isa_attach_args *ia = aux;
129 1.28 thorpej bus_space_tag_t iot = ia->ia_iot;
130 1.28 thorpej bus_space_handle_t ioh;
131 1.10 mycroft
132 1.27 christos printf("\n");
133 1.1 andrew
134 1.28 thorpej if (bus_space_map(iot, ia->ia_iobase, MMS_NPORTS, 0, &ioh)) {
135 1.28 thorpej printf("%s: can't map i/o space\n", sc->sc_dev.dv_xname);
136 1.28 thorpej return;
137 1.28 thorpej }
138 1.28 thorpej
139 1.8 mycroft /* Other initialization was done by mmsprobe. */
140 1.28 thorpej sc->sc_iot = iot;
141 1.28 thorpej sc->sc_ioh = ioh;
142 1.8 mycroft sc->sc_state = 0;
143 1.11 mycroft
144 1.22 cgd sc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq, IST_PULSE,
145 1.22 cgd IPL_TTY, mmsintr, sc);
146 1.1 andrew }
147 1.1 andrew
148 1.8 mycroft int
149 1.23 christos mmsopen(dev, flag, mode, p)
150 1.8 mycroft dev_t dev;
151 1.8 mycroft int flag;
152 1.23 christos int mode;
153 1.23 christos struct proc *p;
154 1.1 andrew {
155 1.2 andrew int unit = MMSUNIT(dev);
156 1.2 andrew struct mms_softc *sc;
157 1.1 andrew
158 1.21 thorpej if (unit >= mms_cd.cd_ndevs)
159 1.8 mycroft return ENXIO;
160 1.21 thorpej sc = mms_cd.cd_devs[unit];
161 1.9 mycroft if (!sc)
162 1.8 mycroft return ENXIO;
163 1.1 andrew
164 1.8 mycroft if (sc->sc_state & MMS_OPEN)
165 1.8 mycroft return EBUSY;
166 1.1 andrew
167 1.8 mycroft if (clalloc(&sc->sc_q, MMS_BSIZE, 0) == -1)
168 1.8 mycroft return ENOMEM;
169 1.1 andrew
170 1.8 mycroft sc->sc_state |= MMS_OPEN;
171 1.8 mycroft sc->sc_status = 0;
172 1.8 mycroft sc->sc_x = sc->sc_y = 0;
173 1.1 andrew
174 1.8 mycroft /* Enable interrupts. */
175 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x07);
176 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_DATA, 0x09);
177 1.1 andrew
178 1.8 mycroft return 0;
179 1.1 andrew }
180 1.1 andrew
181 1.8 mycroft int
182 1.23 christos mmsclose(dev, flag, mode, p)
183 1.8 mycroft dev_t dev;
184 1.8 mycroft int flag;
185 1.23 christos int mode;
186 1.23 christos struct proc *p;
187 1.1 andrew {
188 1.21 thorpej struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
189 1.1 andrew
190 1.8 mycroft /* Disable interrupts. */
191 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x87);
192 1.1 andrew
193 1.8 mycroft sc->sc_state &= ~MMS_OPEN;
194 1.1 andrew
195 1.8 mycroft clfree(&sc->sc_q);
196 1.1 andrew
197 1.8 mycroft return 0;
198 1.1 andrew }
199 1.1 andrew
200 1.8 mycroft int
201 1.8 mycroft mmsread(dev, uio, flag)
202 1.8 mycroft dev_t dev;
203 1.8 mycroft struct uio *uio;
204 1.8 mycroft int flag;
205 1.1 andrew {
206 1.21 thorpej struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
207 1.8 mycroft int s;
208 1.23 christos int error = 0;
209 1.8 mycroft size_t length;
210 1.8 mycroft u_char buffer[MMS_CHUNK];
211 1.1 andrew
212 1.8 mycroft /* Block until mouse activity occured. */
213 1.1 andrew
214 1.1 andrew s = spltty();
215 1.8 mycroft while (sc->sc_q.c_cc == 0) {
216 1.8 mycroft if (flag & IO_NDELAY) {
217 1.1 andrew splx(s);
218 1.8 mycroft return EWOULDBLOCK;
219 1.1 andrew }
220 1.8 mycroft sc->sc_state |= MMS_ASLP;
221 1.23 christos error = tsleep((caddr_t)sc, PZERO | PCATCH, "mmsrea", 0);
222 1.23 christos if (error) {
223 1.8 mycroft sc->sc_state &= ~MMS_ASLP;
224 1.1 andrew splx(s);
225 1.8 mycroft return error;
226 1.1 andrew }
227 1.1 andrew }
228 1.8 mycroft splx(s);
229 1.1 andrew
230 1.8 mycroft /* Transfer as many chunks as possible. */
231 1.1 andrew
232 1.8 mycroft while (sc->sc_q.c_cc > 0 && uio->uio_resid > 0) {
233 1.8 mycroft length = min(sc->sc_q.c_cc, uio->uio_resid);
234 1.1 andrew if (length > sizeof(buffer))
235 1.1 andrew length = sizeof(buffer);
236 1.1 andrew
237 1.8 mycroft /* Remove a small chunk from the input queue. */
238 1.8 mycroft (void) q_to_b(&sc->sc_q, buffer, length);
239 1.1 andrew
240 1.8 mycroft /* Copy the data to the user process. */
241 1.23 christos if ((error = uiomove(buffer, length, uio)) != 0)
242 1.1 andrew break;
243 1.1 andrew }
244 1.1 andrew
245 1.8 mycroft return error;
246 1.1 andrew }
247 1.1 andrew
248 1.8 mycroft int
249 1.23 christos mmsioctl(dev, cmd, addr, flag, p)
250 1.8 mycroft dev_t dev;
251 1.14 cgd u_long cmd;
252 1.8 mycroft caddr_t addr;
253 1.8 mycroft int flag;
254 1.23 christos struct proc *p;
255 1.1 andrew {
256 1.21 thorpej struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
257 1.1 andrew struct mouseinfo info;
258 1.8 mycroft int s;
259 1.8 mycroft int error;
260 1.1 andrew
261 1.1 andrew switch (cmd) {
262 1.1 andrew case MOUSEIOCREAD:
263 1.1 andrew s = spltty();
264 1.1 andrew
265 1.8 mycroft info.status = sc->sc_status;
266 1.8 mycroft if (sc->sc_x || sc->sc_y)
267 1.1 andrew info.status |= MOVEMENT;
268 1.1 andrew
269 1.8 mycroft if (sc->sc_x > 127)
270 1.1 andrew info.xmotion = 127;
271 1.8 mycroft else if (sc->sc_x < -127)
272 1.8 mycroft /* Bounding at -127 avoids a bug in XFree86. */
273 1.8 mycroft info.xmotion = -127;
274 1.1 andrew else
275 1.8 mycroft info.xmotion = sc->sc_x;
276 1.1 andrew
277 1.8 mycroft if (sc->sc_y > 127)
278 1.1 andrew info.ymotion = 127;
279 1.8 mycroft else if (sc->sc_y < -127)
280 1.8 mycroft info.ymotion = -127;
281 1.1 andrew else
282 1.8 mycroft info.ymotion = sc->sc_y;
283 1.1 andrew
284 1.8 mycroft /* Reset historical information. */
285 1.8 mycroft sc->sc_x = sc->sc_y = 0;
286 1.8 mycroft sc->sc_status &= ~BUTCHNGMASK;
287 1.12 cgd ndflush(&sc->sc_q, sc->sc_q.c_cc);
288 1.1 andrew
289 1.1 andrew splx(s);
290 1.1 andrew error = copyout(&info, addr, sizeof(struct mouseinfo));
291 1.1 andrew break;
292 1.1 andrew
293 1.1 andrew default:
294 1.1 andrew error = EINVAL;
295 1.1 andrew break;
296 1.8 mycroft }
297 1.1 andrew
298 1.8 mycroft return error;
299 1.1 andrew }
300 1.1 andrew
301 1.8 mycroft int
302 1.18 cgd mmsintr(arg)
303 1.18 cgd void *arg;
304 1.1 andrew {
305 1.18 cgd struct mms_softc *sc = arg;
306 1.29 mycroft bus_space_tag_t iot = sc->sc_iot;
307 1.29 mycroft bus_space_handle_t ioh = sc->sc_ioh;
308 1.8 mycroft u_char buttons, changed, status;
309 1.8 mycroft char dx, dy;
310 1.8 mycroft u_char buffer[5];
311 1.8 mycroft
312 1.8 mycroft if ((sc->sc_state & MMS_OPEN) == 0)
313 1.8 mycroft /* Interrupts are not expected. */
314 1.8 mycroft return 0;
315 1.8 mycroft
316 1.8 mycroft /* Freeze InPort registers (disabling interrupts). */
317 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
318 1.28 thorpej bus_space_write_1(iot, ioh, MMS_DATA, 0x29);
319 1.1 andrew
320 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x00);
321 1.28 thorpej status = bus_space_read_1(iot, ioh, MMS_DATA);
322 1.1 andrew
323 1.1 andrew if (status & 0x40) {
324 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 1);
325 1.28 thorpej dx = bus_space_read_1(iot, ioh, MMS_DATA);
326 1.8 mycroft dx = (dx == -128) ? -127 : dx;
327 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 2);
328 1.28 thorpej dy = bus_space_read_1(iot, ioh, MMS_DATA);
329 1.1 andrew dy = (dy == -128) ? 127 : -dy;
330 1.8 mycroft } else
331 1.1 andrew dx = dy = 0;
332 1.1 andrew
333 1.8 mycroft /* Unfreeze InPort registers (reenabling interrupts). */
334 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
335 1.28 thorpej bus_space_write_1(iot, ioh, MMS_DATA, 0x09);
336 1.8 mycroft
337 1.8 mycroft buttons = status & BUTSTATMASK;
338 1.8 mycroft changed = status & BUTCHNGMASK;
339 1.8 mycroft sc->sc_status = buttons | (sc->sc_status & ~BUTSTATMASK) | changed;
340 1.8 mycroft
341 1.8 mycroft if (dx || dy || changed) {
342 1.8 mycroft /* Update accumulated movements. */
343 1.8 mycroft sc->sc_x += dx;
344 1.8 mycroft sc->sc_y += dy;
345 1.8 mycroft
346 1.8 mycroft /* Add this event to the queue. */
347 1.8 mycroft buffer[0] = 0x80 | (buttons ^ BUTSTATMASK);
348 1.8 mycroft buffer[1] = dx;
349 1.8 mycroft buffer[2] = dy;
350 1.8 mycroft buffer[3] = buffer[4] = 0;
351 1.8 mycroft (void) b_to_q(buffer, sizeof buffer, &sc->sc_q);
352 1.1 andrew
353 1.8 mycroft if (sc->sc_state & MMS_ASLP) {
354 1.8 mycroft sc->sc_state &= ~MMS_ASLP;
355 1.5 andrew wakeup((caddr_t)sc);
356 1.1 andrew }
357 1.8 mycroft selwakeup(&sc->sc_rsel);
358 1.8 mycroft }
359 1.8 mycroft
360 1.11 mycroft return -1;
361 1.1 andrew }
362 1.1 andrew
363 1.8 mycroft int
364 1.25 mycroft mmspoll(dev, events, p)
365 1.8 mycroft dev_t dev;
366 1.25 mycroft int events;
367 1.8 mycroft struct proc *p;
368 1.1 andrew {
369 1.21 thorpej struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
370 1.25 mycroft int revents = 0;
371 1.25 mycroft int s = spltty();
372 1.1 andrew
373 1.25 mycroft if (events & (POLLIN | POLLRDNORM))
374 1.25 mycroft if (sc->sc_q.c_cc > 0)
375 1.25 mycroft revents |= events & (POLLIN | POLLRDNORM);
376 1.25 mycroft else
377 1.25 mycroft selrecord(p, &sc->sc_rsel);
378 1.1 andrew
379 1.1 andrew splx(s);
380 1.25 mycroft return (revents);
381 1.1 andrew }
382