optpoint.c revision 1.9 1 1.9 thorpej /* $NetBSD: optpoint.c,v 1.9 2021/08/07 16:18:54 thorpej Exp $ */
2 1.1 hamajima
3 1.1 hamajima /*-
4 1.1 hamajima * Copyright (c) 2005 HAMAJIMA Katsuomi. All rights reserved.
5 1.1 hamajima *
6 1.1 hamajima * Redistribution and use in source and binary forms, with or without
7 1.1 hamajima * modification, are permitted provided that the following conditions
8 1.1 hamajima * are met:
9 1.1 hamajima * 1. Redistributions of source code must retain the above copyright
10 1.1 hamajima * notice, this list of conditions and the following disclaimer.
11 1.1 hamajima * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 hamajima * notice, this list of conditions and the following disclaimer in the
13 1.1 hamajima * documentation and/or other materials provided with the distribution.
14 1.1 hamajima *
15 1.1 hamajima * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 1.1 hamajima * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 1.1 hamajima * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 1.1 hamajima * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 1.1 hamajima * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 1.1 hamajima * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 1.1 hamajima * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 1.1 hamajima * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 1.1 hamajima * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 1.1 hamajima * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 1.1 hamajima * SUCH DAMAGE.
26 1.1 hamajima */
27 1.1 hamajima
28 1.1 hamajima /*
29 1.1 hamajima * OptOpint on Telios HC-AJ2
30 1.1 hamajima */
31 1.1 hamajima
32 1.1 hamajima #include <sys/cdefs.h>
33 1.1 hamajima
34 1.9 thorpej __KERNEL_RCSID(0, "$NetBSD: optpoint.c,v 1.9 2021/08/07 16:18:54 thorpej Exp $");
35 1.1 hamajima
36 1.1 hamajima #include <sys/param.h>
37 1.1 hamajima #include <sys/systm.h>
38 1.1 hamajima #include <sys/device.h>
39 1.1 hamajima #include <machine/bus.h>
40 1.2 hamajima #include <machine/config_hook.h>
41 1.1 hamajima #include <dev/hpc/hpciovar.h>
42 1.1 hamajima #include <dev/wscons/wsconsio.h>
43 1.1 hamajima #include <dev/wscons/wsmousevar.h>
44 1.1 hamajima #include <hpcmips/tx/tx39var.h>
45 1.1 hamajima #include <hpcmips/tx/tx39spivar.h>
46 1.1 hamajima #include <hpcmips/tx/tx39icureg.h>
47 1.1 hamajima
48 1.1 hamajima #undef OPTPOINTDEBUG
49 1.1 hamajima
50 1.1 hamajima #ifdef OPTPOINTDEBUG
51 1.1 hamajima #define DPRINTF(arg) printf arg
52 1.1 hamajima #else
53 1.1 hamajima #define DPRINTF(arg)
54 1.1 hamajima #endif
55 1.1 hamajima
56 1.1 hamajima struct optpoint_softc {
57 1.7 chs device_t sc_dev;
58 1.1 hamajima tx_chipset_tag_t sc_tc;
59 1.1 hamajima struct tx39spi_softc *sc_spi;
60 1.1 hamajima struct hpcio_chip *sc_hc;
61 1.7 chs device_t sc_wsmousedev;
62 1.2 hamajima void *sc_powerhook; /* power management hook */
63 1.1 hamajima char packet[4];
64 1.1 hamajima int index; /* number of bytes received for this packet */
65 1.1 hamajima u_int buttons; /* mouse button status */
66 1.1 hamajima int enabled;
67 1.1 hamajima };
68 1.1 hamajima
69 1.7 chs static int optpoint_match(device_t, cfdata_t, void *);
70 1.7 chs static void optpoint_attach(device_t, device_t, void *);
71 1.1 hamajima static int optpoint_intr(void *);
72 1.1 hamajima static int optpoint_enable(void *);
73 1.1 hamajima static void optpoint_disable(void *);
74 1.6 christos static int optpoint_ioctl(void *, u_long, void *, int, struct lwp *);
75 1.1 hamajima static int optpoint_initialize(void *);
76 1.1 hamajima static void optpoint_send(struct optpoint_softc *, int);
77 1.1 hamajima static int optpoint_recv(struct optpoint_softc *);
78 1.2 hamajima static int optpoint_power(void *, int, long, void *);
79 1.1 hamajima
80 1.1 hamajima #define LBUTMASK 0x01
81 1.1 hamajima #define RBUTMASK 0x02
82 1.1 hamajima
83 1.1 hamajima #define TX39_INTRSTATUS4_OPTPOINTINT TX39_INTRSTATUS4_CARDIORDNEGINT
84 1.1 hamajima #define TX39_IO_MFIO_CARDREG 11
85 1.1 hamajima #define TX39_IO_MFIO_CARDIOWR 10
86 1.1 hamajima #define TX39_IO_MFIO_CARDIORD 9
87 1.1 hamajima #define TELIOS_MFIO_OPTP_T_RDY TX39_IO_MFIO_CARDREG
88 1.1 hamajima #define TELIOS_MFIO_OPTP_C_REQ TX39_IO_MFIO_CARDIOWR
89 1.1 hamajima #define TELIOS_MFIO_OPTP_S_ENB_N TX39_IO_MFIO_CARDIORD
90 1.1 hamajima
91 1.7 chs CFATTACH_DECL_NEW(optpoint, sizeof(struct optpoint_softc),
92 1.1 hamajima optpoint_match, optpoint_attach, NULL, NULL);
93 1.1 hamajima
94 1.1 hamajima const struct wsmouse_accessops optpoint_accessops = {
95 1.1 hamajima optpoint_enable,
96 1.1 hamajima optpoint_ioctl,
97 1.1 hamajima optpoint_disable,
98 1.1 hamajima };
99 1.1 hamajima
100 1.1 hamajima int
101 1.7 chs optpoint_match(device_t parent, cfdata_t cf, void *aux)
102 1.1 hamajima {
103 1.1 hamajima return (ATTACH_NORMAL);
104 1.1 hamajima }
105 1.1 hamajima
106 1.1 hamajima void
107 1.7 chs optpoint_attach(device_t parent, device_t self, void *aux)
108 1.1 hamajima {
109 1.1 hamajima struct txspi_attach_args *ta = aux;
110 1.7 chs struct optpoint_softc *sc = device_private(self);
111 1.7 chs struct tx39spi_softc *spi = sc->sc_spi = device_private(parent);
112 1.1 hamajima tx_chipset_tag_t tc = sc->sc_tc = ta->sa_tc;
113 1.1 hamajima struct wsmousedev_attach_args wsmaa;
114 1.1 hamajima
115 1.7 chs sc->sc_dev = self;
116 1.1 hamajima sc->sc_hc = tc->tc_iochip[MFIO];
117 1.1 hamajima sc->enabled = 0;
118 1.1 hamajima
119 1.1 hamajima /* Specific SPI settings for OptPoint of HC-AJ2 */
120 1.1 hamajima tx39spi_delayval(spi, 0);
121 1.1 hamajima tx39spi_baudrate(spi, 4); /* SPICLK Rate = 737.3 kHz */
122 1.1 hamajima tx39spi_word(spi, 0); /* Use 8bits of data */
123 1.1 hamajima tx39spi_phapol(spi, 0);
124 1.1 hamajima tx39spi_clkpol(spi, 1);
125 1.1 hamajima tx39spi_lsb(spi, 0); /* MSB first */
126 1.1 hamajima
127 1.1 hamajima optpoint_enable(sc);
128 1.1 hamajima printf("\n");
129 1.1 hamajima
130 1.1 hamajima wsmaa.accessops = &optpoint_accessops;
131 1.1 hamajima wsmaa.accesscookie = sc;
132 1.1 hamajima /* attach the wsmouse */
133 1.8 thorpej sc->sc_wsmousedev = config_found(self, &wsmaa, wsmousedevprint,
134 1.9 thorpej CFARGS_NONE);
135 1.2 hamajima
136 1.2 hamajima /* Add a hard power hook to power saving */
137 1.2 hamajima sc->sc_powerhook = config_hook(CONFIG_HOOK_PMEVENT,
138 1.2 hamajima CONFIG_HOOK_PMEVENT_HARDPOWER,
139 1.2 hamajima CONFIG_HOOK_SHARE,
140 1.2 hamajima optpoint_power, sc);
141 1.2 hamajima #ifdef DIAGNOSTIC
142 1.2 hamajima if (sc->sc_powerhook == 0)
143 1.2 hamajima printf("%s: unable to establish hard power hook",
144 1.7 chs device_xname(sc->sc_dev));
145 1.2 hamajima #endif
146 1.1 hamajima }
147 1.1 hamajima
148 1.1 hamajima int
149 1.7 chs optpoint_intr(void *arg)
150 1.1 hamajima {
151 1.7 chs struct optpoint_softc *sc = arg;
152 1.1 hamajima tx_chipset_tag_t tc = sc->sc_tc;
153 1.1 hamajima char data = optpoint_recv(sc) & 0xff;
154 1.1 hamajima
155 1.1 hamajima #ifdef DIAGNOSTIC
156 1.1 hamajima if (sc->index >= 3){
157 1.7 chs printf("%s: Receive buffer overflow\n", device_xname(sc->sc_dev));
158 1.1 hamajima sc->index = 0;
159 1.1 hamajima memset(sc->packet, 0, 3);
160 1.1 hamajima }
161 1.1 hamajima #endif
162 1.1 hamajima if ((sc->index == 1) && (data & 0xcc) != 0x08){
163 1.1 hamajima DPRINTF(("%s: Bad second byte (0x%02x)\n",
164 1.7 chs device_xname(sc->sc_dev), data));
165 1.1 hamajima tx_conf_write(tc, TX39_INTRCLEAR4_REG,
166 1.1 hamajima TX39_INTRSTATUS4_OPTPOINTINT);
167 1.1 hamajima return 0;
168 1.1 hamajima }
169 1.1 hamajima
170 1.1 hamajima sc->packet[sc->index++] = data;
171 1.1 hamajima if (sc->index >= 3){
172 1.2 hamajima u_int newbuttons = ((sc->packet[1] & LBUTMASK) ? 0x1 : 0)
173 1.2 hamajima | ((sc->packet[1] & RBUTMASK) ? 0x2 : 0);
174 1.1 hamajima int dx = sc->packet[2];
175 1.1 hamajima int dy = sc->packet[0];
176 1.1 hamajima u_int changed = (sc->buttons ^ newbuttons);
177 1.1 hamajima
178 1.1 hamajima if (dx || dy || changed){
179 1.2 hamajima DPRINTF(("%s: buttons=0x%x, dx=%d, dy=%d\n",
180 1.7 chs device_xname(sc->sc_dev), newbuttons, dx, dy));
181 1.5 plunky wsmouse_input(sc->sc_wsmousedev,
182 1.5 plunky newbuttons,
183 1.5 plunky dx, dy, 0, 0,
184 1.5 plunky WSMOUSE_INPUT_DELTA);
185 1.1 hamajima }
186 1.1 hamajima sc->buttons = newbuttons;
187 1.1 hamajima sc->index = 0;
188 1.1 hamajima memset(sc->packet, 0, 3);
189 1.1 hamajima }
190 1.1 hamajima tx_conf_write(tc, TX39_INTRCLEAR4_REG, TX39_INTRSTATUS4_OPTPOINTINT);
191 1.1 hamajima
192 1.1 hamajima return 0;
193 1.1 hamajima }
194 1.1 hamajima
195 1.1 hamajima int
196 1.7 chs optpoint_enable(void *arg)
197 1.1 hamajima {
198 1.7 chs struct optpoint_softc *sc = arg;
199 1.1 hamajima
200 1.1 hamajima if (!sc->enabled){
201 1.1 hamajima tx_chipset_tag_t tc = sc->sc_tc;
202 1.1 hamajima struct hpcio_chip *hc = sc->sc_hc;
203 1.1 hamajima int s = spltty();
204 1.1 hamajima
205 1.7 chs DPRINTF(("%s: enable\n", device_xname(sc->sc_dev)));
206 1.2 hamajima
207 1.1 hamajima sc->enabled = 1;
208 1.1 hamajima sc->index = 0;
209 1.1 hamajima sc->buttons = 0;
210 1.1 hamajima sc->packet[0] = 0xf5; /* Disable */
211 1.1 hamajima sc->packet[1] = 0xf2; /* Set Stream Mode */
212 1.1 hamajima sc->packet[2] = 0xf8; /* Stanby */
213 1.1 hamajima sc->packet[3] = 0xf4; /* Enable */
214 1.1 hamajima
215 1.1 hamajima tx39spi_enable(sc->sc_spi, 1);
216 1.1 hamajima tx_intr_establish(tc, MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT),
217 1.1 hamajima IST_EDGE, IPL_TTY, optpoint_initialize, sc);
218 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 1);
219 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 1);
220 1.1 hamajima splx(s);
221 1.1 hamajima }
222 1.1 hamajima
223 1.1 hamajima return 0;
224 1.1 hamajima }
225 1.1 hamajima
226 1.1 hamajima void
227 1.7 chs optpoint_disable(void *arg)
228 1.1 hamajima {
229 1.7 chs struct optpoint_softc *sc = arg;
230 1.1 hamajima
231 1.1 hamajima if (sc->enabled){
232 1.1 hamajima tx_chipset_tag_t tc = sc->sc_tc;
233 1.1 hamajima struct hpcio_chip *hc = sc->sc_hc;
234 1.1 hamajima int s = spltty();
235 1.1 hamajima
236 1.7 chs DPRINTF(("%s: disable\n", device_xname(sc->sc_dev)));
237 1.2 hamajima
238 1.1 hamajima sc->enabled = 0;
239 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 0);
240 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 0);
241 1.1 hamajima tx_intr_disestablish(tc,
242 1.1 hamajima (void *)MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT));
243 1.1 hamajima tx39spi_enable(sc->sc_spi, 0);
244 1.1 hamajima splx(s);
245 1.1 hamajima }
246 1.1 hamajima }
247 1.1 hamajima
248 1.1 hamajima int
249 1.7 chs optpoint_ioctl(void *cookie, u_long cmd, void *data, int flag, struct lwp *l)
250 1.1 hamajima {
251 1.1 hamajima switch (cmd) {
252 1.1 hamajima case WSMOUSEIO_GTYPE:
253 1.1 hamajima *(u_int *)data = WSMOUSE_TYPE_PS2;
254 1.1 hamajima break;
255 1.1 hamajima
256 1.1 hamajima default:
257 1.1 hamajima return (EPASSTHROUGH);
258 1.1 hamajima }
259 1.1 hamajima return 0;
260 1.1 hamajima }
261 1.1 hamajima
262 1.1 hamajima int
263 1.7 chs optpoint_initialize(void *arg)
264 1.1 hamajima {
265 1.7 chs struct optpoint_softc *sc = arg;
266 1.1 hamajima struct hpcio_chip *hc = sc->sc_hc;
267 1.1 hamajima tx_chipset_tag_t tc = sc->sc_tc;
268 1.1 hamajima
269 1.1 hamajima if (sc->index < 4){
270 1.1 hamajima optpoint_send(sc, sc->packet[sc->index++]);
271 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 1);
272 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 1);
273 1.1 hamajima } else {
274 1.1 hamajima tx_intr_disestablish(tc,
275 1.1 hamajima (void *)MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT));
276 1.1 hamajima sc->index = 0;
277 1.1 hamajima memset(sc->packet, 0, 3);
278 1.1 hamajima tx_intr_establish(tc,
279 1.1 hamajima MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT),
280 1.1 hamajima IST_EDGE, IPL_TTY, optpoint_intr, sc);
281 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 0);
282 1.1 hamajima (*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 1);
283 1.1 hamajima }
284 1.1 hamajima tx_conf_write(tc, TX39_INTRCLEAR4_REG, TX39_INTRSTATUS4_OPTPOINTINT);
285 1.1 hamajima
286 1.1 hamajima return 0;
287 1.1 hamajima }
288 1.1 hamajima
289 1.1 hamajima void
290 1.1 hamajima optpoint_send(struct optpoint_softc *sc, int data)
291 1.1 hamajima {
292 1.1 hamajima struct hpcio_chip *hc = sc->sc_hc;
293 1.1 hamajima
294 1.1 hamajima while ((*hc->hc_portread)(hc, TELIOS_MFIO_OPTP_S_ENB_N))
295 1.1 hamajima ;
296 1.1 hamajima tx39spi_put_word(sc->sc_spi, data & 0xff);
297 1.1 hamajima }
298 1.1 hamajima
299 1.1 hamajima int
300 1.1 hamajima optpoint_recv(struct optpoint_softc *sc)
301 1.1 hamajima {
302 1.1 hamajima struct hpcio_chip *hc = sc->sc_hc;
303 1.1 hamajima
304 1.1 hamajima optpoint_send(sc, 0x00);
305 1.1 hamajima while ((*hc->hc_portread)(hc, TELIOS_MFIO_OPTP_S_ENB_N))
306 1.1 hamajima ;
307 1.1 hamajima return tx39spi_get_word(sc->sc_spi) & 0xff;
308 1.1 hamajima }
309 1.2 hamajima
310 1.2 hamajima int
311 1.7 chs optpoint_power(void *arg, int type, long id, void *msg)
312 1.2 hamajima {
313 1.7 chs struct optpoint_softc *sc = arg;
314 1.2 hamajima int why = (int)msg;
315 1.2 hamajima
316 1.2 hamajima switch (why) {
317 1.2 hamajima case PWR_RESUME:
318 1.2 hamajima /* power on */
319 1.2 hamajima optpoint_enable(sc);
320 1.2 hamajima break;
321 1.2 hamajima case PWR_SUSPEND:
322 1.2 hamajima /* FALLTHROUGH */
323 1.2 hamajima case PWR_STANDBY:
324 1.2 hamajima /* power off */
325 1.2 hamajima optpoint_disable(sc);
326 1.2 hamajima break;
327 1.2 hamajima }
328 1.2 hamajima
329 1.2 hamajima return 0;
330 1.2 hamajima }
331