mms.c revision 1.40 1 1.39 thorpej /* $NetBSD: mms.c,v 1.40 2002/10/01 12:57:12 fvdl 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.39 thorpej __KERNEL_RCSID(0, "$NetBSD: mms.c,v 1.40 2002/10/01 12:57:12 fvdl 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.40 fvdl CFATTACH_DECL(mms, sizeof(struct mms_softc), mmsprobe, mmsattach, NULL, NULL)
64 1.21 thorpej
65 1.34 drochner int mms_enable __P((void *));
66 1.34 drochner int mms_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
67 1.34 drochner void mms_disable __P((void *));
68 1.34 drochner
69 1.34 drochner const struct wsmouse_accessops mms_accessops = {
70 1.34 drochner mms_enable,
71 1.34 drochner mms_ioctl,
72 1.34 drochner mms_disable,
73 1.34 drochner };
74 1.8 mycroft
75 1.8 mycroft int
76 1.15 mycroft mmsprobe(parent, match, aux)
77 1.15 mycroft struct device *parent;
78 1.31 drochner struct cfdata *match;
79 1.31 drochner void *aux;
80 1.1 andrew {
81 1.9 mycroft struct isa_attach_args *ia = aux;
82 1.28 thorpej bus_space_tag_t iot = ia->ia_iot;
83 1.28 thorpej bus_space_handle_t ioh;
84 1.29 mycroft int rv;
85 1.28 thorpej
86 1.37 thorpej if (ia->ia_nio < 1)
87 1.37 thorpej return (0);
88 1.37 thorpej if (ia->ia_nirq < 1)
89 1.37 thorpej return (0);
90 1.37 thorpej
91 1.37 thorpej if (ISA_DIRECT_CONFIG(ia))
92 1.37 thorpej return (0);
93 1.37 thorpej
94 1.28 thorpej /* Disallow wildcarded i/o address. */
95 1.37 thorpej if (ia->ia_io[0].ir_addr == ISACF_PORT_DEFAULT)
96 1.37 thorpej return 0;
97 1.37 thorpej
98 1.37 thorpej if (ia->ia_irq[0].ir_irq == ISACF_IRQ_DEFAULT)
99 1.28 thorpej return 0;
100 1.28 thorpej
101 1.29 mycroft /* Map the i/o space. */
102 1.37 thorpej if (bus_space_map(iot, ia->ia_io[0].ir_addr, MMS_NPORTS, 0, &ioh))
103 1.28 thorpej return 0;
104 1.1 andrew
105 1.29 mycroft rv = 0;
106 1.29 mycroft
107 1.1 andrew /* Read identification register to see if present */
108 1.28 thorpej if (bus_space_read_1(iot, ioh, MMS_IDENT) != 0xde)
109 1.28 thorpej goto out;
110 1.1 andrew
111 1.8 mycroft /* Seems it was there; reset. */
112 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x87);
113 1.1 andrew
114 1.28 thorpej rv = 1;
115 1.37 thorpej
116 1.37 thorpej ia->ia_nio = 1;
117 1.37 thorpej ia->ia_io[0].ir_size = MMS_NPORTS;
118 1.37 thorpej
119 1.37 thorpej ia->ia_nirq = 1;
120 1.37 thorpej
121 1.37 thorpej ia->ia_niomem = 0;
122 1.37 thorpej ia->ia_ndrq = 0;
123 1.29 mycroft
124 1.29 mycroft out:
125 1.28 thorpej bus_space_unmap(iot, ioh, MMS_NPORTS);
126 1.28 thorpej return rv;
127 1.1 andrew }
128 1.1 andrew
129 1.9 mycroft void
130 1.9 mycroft mmsattach(parent, self, aux)
131 1.9 mycroft struct device *parent, *self;
132 1.9 mycroft void *aux;
133 1.1 andrew {
134 1.9 mycroft struct mms_softc *sc = (void *)self;
135 1.9 mycroft struct isa_attach_args *ia = aux;
136 1.28 thorpej bus_space_tag_t iot = ia->ia_iot;
137 1.28 thorpej bus_space_handle_t ioh;
138 1.34 drochner struct wsmousedev_attach_args a;
139 1.10 mycroft
140 1.27 christos printf("\n");
141 1.1 andrew
142 1.37 thorpej if (bus_space_map(iot, ia->ia_io[0].ir_addr, MMS_NPORTS, 0, &ioh)) {
143 1.28 thorpej printf("%s: can't map i/o space\n", sc->sc_dev.dv_xname);
144 1.28 thorpej return;
145 1.28 thorpej }
146 1.28 thorpej
147 1.8 mycroft /* Other initialization was done by mmsprobe. */
148 1.28 thorpej sc->sc_iot = iot;
149 1.28 thorpej sc->sc_ioh = ioh;
150 1.34 drochner sc->sc_enabled = 0;
151 1.11 mycroft
152 1.37 thorpej sc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq[0].ir_irq,
153 1.37 thorpej IST_PULSE, IPL_TTY, mmsintr, sc);
154 1.34 drochner
155 1.34 drochner a.accessops = &mms_accessops;
156 1.34 drochner a.accesscookie = sc;
157 1.34 drochner
158 1.34 drochner /*
159 1.34 drochner * Attach the wsmouse, saving a handle to it.
160 1.34 drochner * Note that we don't need to check this pointer against NULL
161 1.34 drochner * here or in psmintr, because if this fails lms_enable() will
162 1.34 drochner * never be called, so lmsintr() will never be called.
163 1.34 drochner */
164 1.34 drochner sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
165 1.1 andrew }
166 1.1 andrew
167 1.8 mycroft int
168 1.34 drochner mms_enable(v)
169 1.34 drochner void *v;
170 1.1 andrew {
171 1.34 drochner struct mms_softc *sc = v;
172 1.1 andrew
173 1.34 drochner if (sc->sc_enabled)
174 1.8 mycroft return EBUSY;
175 1.1 andrew
176 1.34 drochner sc->sc_enabled = 1;
177 1.1 andrew
178 1.8 mycroft /* Enable interrupts. */
179 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x07);
180 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_DATA, 0x09);
181 1.1 andrew
182 1.8 mycroft return 0;
183 1.1 andrew }
184 1.1 andrew
185 1.34 drochner void
186 1.34 drochner mms_disable(v)
187 1.34 drochner void *v;
188 1.1 andrew {
189 1.34 drochner struct mms_softc *sc = v;
190 1.1 andrew
191 1.8 mycroft /* Disable interrupts. */
192 1.28 thorpej bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x87);
193 1.1 andrew
194 1.34 drochner sc->sc_enabled = 0;
195 1.1 andrew }
196 1.1 andrew
197 1.8 mycroft int
198 1.34 drochner mms_ioctl(v, cmd, data, flag, p)
199 1.34 drochner void *v;
200 1.14 cgd u_long cmd;
201 1.34 drochner caddr_t data;
202 1.8 mycroft int flag;
203 1.23 christos struct proc *p;
204 1.1 andrew {
205 1.34 drochner #if 0
206 1.34 drochner struct mms_softc *sc = v;
207 1.34 drochner #endif
208 1.1 andrew
209 1.1 andrew switch (cmd) {
210 1.34 drochner case WSMOUSEIO_GTYPE:
211 1.34 drochner *(u_int *)data = WSMOUSE_TYPE_MMS;
212 1.34 drochner return (0);
213 1.8 mycroft }
214 1.38 atatat return (EPASSTHROUGH);
215 1.1 andrew }
216 1.1 andrew
217 1.8 mycroft int
218 1.18 cgd mmsintr(arg)
219 1.18 cgd void *arg;
220 1.1 andrew {
221 1.18 cgd struct mms_softc *sc = arg;
222 1.29 mycroft bus_space_tag_t iot = sc->sc_iot;
223 1.29 mycroft bus_space_handle_t ioh = sc->sc_ioh;
224 1.34 drochner u_char status;
225 1.34 drochner signed char dx, dy;
226 1.34 drochner u_int buttons;
227 1.34 drochner int changed;
228 1.8 mycroft
229 1.34 drochner if (!sc->sc_enabled)
230 1.8 mycroft /* Interrupts are not expected. */
231 1.8 mycroft return 0;
232 1.8 mycroft
233 1.8 mycroft /* Freeze InPort registers (disabling interrupts). */
234 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
235 1.28 thorpej bus_space_write_1(iot, ioh, MMS_DATA, 0x29);
236 1.1 andrew
237 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x00);
238 1.28 thorpej status = bus_space_read_1(iot, ioh, MMS_DATA);
239 1.1 andrew
240 1.1 andrew if (status & 0x40) {
241 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 1);
242 1.28 thorpej dx = bus_space_read_1(iot, ioh, MMS_DATA);
243 1.34 drochner /* Bounding at -127 avoids a bug in XFree86. */
244 1.8 mycroft dx = (dx == -128) ? -127 : dx;
245 1.34 drochner
246 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 2);
247 1.28 thorpej dy = bus_space_read_1(iot, ioh, MMS_DATA);
248 1.1 andrew dy = (dy == -128) ? 127 : -dy;
249 1.8 mycroft } else
250 1.1 andrew dx = dy = 0;
251 1.1 andrew
252 1.8 mycroft /* Unfreeze InPort registers (reenabling interrupts). */
253 1.28 thorpej bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
254 1.28 thorpej bus_space_write_1(iot, ioh, MMS_DATA, 0x09);
255 1.8 mycroft
256 1.34 drochner buttons = ((status & 0x04) ? 0x1 : 0) |
257 1.34 drochner ((status & 0x02) ? 0x2 : 0) |
258 1.34 drochner ((status & 0x01) ? 0x4 : 0);
259 1.34 drochner changed = status & 0x38;
260 1.34 drochner
261 1.34 drochner if (dx || dy || changed)
262 1.34 drochner wsmouse_input(sc->sc_wsmousedev,
263 1.35 takemura buttons, dx, dy, 0, WSMOUSE_INPUT_DELTA);
264 1.8 mycroft
265 1.11 mycroft return -1;
266 1.1 andrew }
267