1bf21cd93STycho Nightingale /*-
2*32640292SAndy Fiddaman * SPDX-License-Identifier: BSD-2-Clause
34c87aefeSPatrick Mooney *
4bf21cd93STycho Nightingale * Copyright (c) 2015 Tycho Nightingale <tycho.nightingale@pluribusnetworks.com>
5bf21cd93STycho Nightingale * Copyright (c) 2015 Nahanni Systems Inc.
6bf21cd93STycho Nightingale * All rights reserved.
7bf21cd93STycho Nightingale *
8bf21cd93STycho Nightingale * Redistribution and use in source and binary forms, with or without
9bf21cd93STycho Nightingale * modification, are permitted provided that the following conditions
10bf21cd93STycho Nightingale * are met:
11bf21cd93STycho Nightingale * 1. Redistributions of source code must retain the above copyright
12bf21cd93STycho Nightingale * notice, this list of conditions and the following disclaimer.
13bf21cd93STycho Nightingale * 2. Redistributions in binary form must reproduce the above copyright
14bf21cd93STycho Nightingale * notice, this list of conditions and the following disclaimer in the
15bf21cd93STycho Nightingale * documentation and/or other materials provided with the distribution.
16bf21cd93STycho Nightingale *
17bf21cd93STycho Nightingale * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND
18bf21cd93STycho Nightingale * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19bf21cd93STycho Nightingale * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20bf21cd93STycho Nightingale * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21bf21cd93STycho Nightingale * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22bf21cd93STycho Nightingale * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23bf21cd93STycho Nightingale * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24bf21cd93STycho Nightingale * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25bf21cd93STycho Nightingale * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26bf21cd93STycho Nightingale * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27bf21cd93STycho Nightingale * SUCH DAMAGE.
28bf21cd93STycho Nightingale */
29bf21cd93STycho Nightingale
30bf21cd93STycho Nightingale #include <sys/cdefs.h>
31bf21cd93STycho Nightingale
32bf21cd93STycho Nightingale #include <sys/types.h>
33bf21cd93STycho Nightingale
34bf21cd93STycho Nightingale #include <assert.h>
35bf21cd93STycho Nightingale #include <stdbool.h>
36bf21cd93STycho Nightingale #include <stdio.h>
37bf21cd93STycho Nightingale #include <stdlib.h>
38bf21cd93STycho Nightingale #include <strings.h>
39bf21cd93STycho Nightingale #include <pthread.h>
40bf21cd93STycho Nightingale #include <pthread_np.h>
41bf21cd93STycho Nightingale
42bf21cd93STycho Nightingale #include "atkbdc.h"
43bf21cd93STycho Nightingale #include "console.h"
4459d65d31SAndy Fiddaman #include "debug.h"
4559d65d31SAndy Fiddaman #include "ps2mouse.h"
46bf21cd93STycho Nightingale
47bf21cd93STycho Nightingale /* mouse device commands */
48bf21cd93STycho Nightingale #define PS2MC_RESET_DEV 0xff
49bf21cd93STycho Nightingale #define PS2MC_SET_DEFAULTS 0xf6
50bf21cd93STycho Nightingale #define PS2MC_DISABLE 0xf5
51bf21cd93STycho Nightingale #define PS2MC_ENABLE 0xf4
52bf21cd93STycho Nightingale #define PS2MC_SET_SAMPLING_RATE 0xf3
53bf21cd93STycho Nightingale #define PS2MC_SEND_DEV_ID 0xf2
54bf21cd93STycho Nightingale #define PS2MC_SET_REMOTE_MODE 0xf0
55bf21cd93STycho Nightingale #define PS2MC_SEND_DEV_DATA 0xeb
56bf21cd93STycho Nightingale #define PS2MC_SET_STREAM_MODE 0xea
57bf21cd93STycho Nightingale #define PS2MC_SEND_DEV_STATUS 0xe9
58bf21cd93STycho Nightingale #define PS2MC_SET_RESOLUTION 0xe8
59bf21cd93STycho Nightingale #define PS2MC_SET_SCALING1 0xe7
60bf21cd93STycho Nightingale #define PS2MC_SET_SCALING2 0xe6
61bf21cd93STycho Nightingale
62bf21cd93STycho Nightingale #define PS2MC_BAT_SUCCESS 0xaa
63bf21cd93STycho Nightingale #define PS2MC_ACK 0xfa
64bf21cd93STycho Nightingale
65bf21cd93STycho Nightingale /* mouse device id */
66bf21cd93STycho Nightingale #define PS2MOUSE_DEV_ID 0x0
67bf21cd93STycho Nightingale
684c87aefeSPatrick Mooney /* mouse data bits */
694c87aefeSPatrick Mooney #define PS2M_DATA_Y_OFLOW 0x80
704c87aefeSPatrick Mooney #define PS2M_DATA_X_OFLOW 0x40
714c87aefeSPatrick Mooney #define PS2M_DATA_Y_SIGN 0x20
724c87aefeSPatrick Mooney #define PS2M_DATA_X_SIGN 0x10
734c87aefeSPatrick Mooney #define PS2M_DATA_AONE 0x08
744c87aefeSPatrick Mooney #define PS2M_DATA_MID_BUTTON 0x04
754c87aefeSPatrick Mooney #define PS2M_DATA_RIGHT_BUTTON 0x02
764c87aefeSPatrick Mooney #define PS2M_DATA_LEFT_BUTTON 0x01
774c87aefeSPatrick Mooney
78bf21cd93STycho Nightingale /* mouse status bits */
79bf21cd93STycho Nightingale #define PS2M_STS_REMOTE_MODE 0x40
80bf21cd93STycho Nightingale #define PS2M_STS_ENABLE_DEV 0x20
81bf21cd93STycho Nightingale #define PS2M_STS_SCALING_21 0x10
82bf21cd93STycho Nightingale #define PS2M_STS_MID_BUTTON 0x04
83bf21cd93STycho Nightingale #define PS2M_STS_RIGHT_BUTTON 0x02
84bf21cd93STycho Nightingale #define PS2M_STS_LEFT_BUTTON 0x01
85bf21cd93STycho Nightingale
86bf21cd93STycho Nightingale #define PS2MOUSE_FIFOSZ 16
87bf21cd93STycho Nightingale
88bf21cd93STycho Nightingale struct fifo {
89bf21cd93STycho Nightingale uint8_t buf[PS2MOUSE_FIFOSZ];
90bf21cd93STycho Nightingale int rindex; /* index to read from */
91bf21cd93STycho Nightingale int windex; /* index to write to */
92bf21cd93STycho Nightingale int num; /* number of bytes in the fifo */
93bf21cd93STycho Nightingale int size; /* size of the fifo */
94bf21cd93STycho Nightingale };
95bf21cd93STycho Nightingale
96bf21cd93STycho Nightingale struct ps2mouse_softc {
97bf21cd93STycho Nightingale struct atkbdc_softc *atkbdc_sc;
98bf21cd93STycho Nightingale pthread_mutex_t mtx;
99bf21cd93STycho Nightingale
100bf21cd93STycho Nightingale uint8_t status;
101bf21cd93STycho Nightingale uint8_t resolution;
102bf21cd93STycho Nightingale uint8_t sampling_rate;
1034c87aefeSPatrick Mooney int ctrlenable;
104bf21cd93STycho Nightingale struct fifo fifo;
105bf21cd93STycho Nightingale
106bf21cd93STycho Nightingale uint8_t curcmd; /* current command for next byte */
107bf21cd93STycho Nightingale
108bf21cd93STycho Nightingale int cur_x, cur_y;
109bf21cd93STycho Nightingale int delta_x, delta_y;
110bf21cd93STycho Nightingale };
111bf21cd93STycho Nightingale
112bf21cd93STycho Nightingale static void
fifo_init(struct ps2mouse_softc * sc)113bf21cd93STycho Nightingale fifo_init(struct ps2mouse_softc *sc)
114bf21cd93STycho Nightingale {
115bf21cd93STycho Nightingale struct fifo *fifo;
116bf21cd93STycho Nightingale
117bf21cd93STycho Nightingale fifo = &sc->fifo;
118bf21cd93STycho Nightingale fifo->size = sizeof(((struct fifo *)0)->buf);
119bf21cd93STycho Nightingale }
120bf21cd93STycho Nightingale
121bf21cd93STycho Nightingale static void
fifo_reset(struct ps2mouse_softc * sc)122bf21cd93STycho Nightingale fifo_reset(struct ps2mouse_softc *sc)
123bf21cd93STycho Nightingale {
124bf21cd93STycho Nightingale struct fifo *fifo;
125bf21cd93STycho Nightingale
126bf21cd93STycho Nightingale fifo = &sc->fifo;
127bf21cd93STycho Nightingale bzero(fifo, sizeof(struct fifo));
128bf21cd93STycho Nightingale fifo->size = sizeof(((struct fifo *)0)->buf);
129bf21cd93STycho Nightingale }
130bf21cd93STycho Nightingale
131bf21cd93STycho Nightingale static void
fifo_put(struct ps2mouse_softc * sc,uint8_t val)132bf21cd93STycho Nightingale fifo_put(struct ps2mouse_softc *sc, uint8_t val)
133bf21cd93STycho Nightingale {
134bf21cd93STycho Nightingale struct fifo *fifo;
135bf21cd93STycho Nightingale
136bf21cd93STycho Nightingale fifo = &sc->fifo;
137bf21cd93STycho Nightingale if (fifo->num < fifo->size) {
138bf21cd93STycho Nightingale fifo->buf[fifo->windex] = val;
139bf21cd93STycho Nightingale fifo->windex = (fifo->windex + 1) % fifo->size;
140bf21cd93STycho Nightingale fifo->num++;
141bf21cd93STycho Nightingale }
142bf21cd93STycho Nightingale }
143bf21cd93STycho Nightingale
144bf21cd93STycho Nightingale static int
fifo_get(struct ps2mouse_softc * sc,uint8_t * val)145bf21cd93STycho Nightingale fifo_get(struct ps2mouse_softc *sc, uint8_t *val)
146bf21cd93STycho Nightingale {
147bf21cd93STycho Nightingale struct fifo *fifo;
148bf21cd93STycho Nightingale
149bf21cd93STycho Nightingale fifo = &sc->fifo;
150bf21cd93STycho Nightingale if (fifo->num > 0) {
151bf21cd93STycho Nightingale *val = fifo->buf[fifo->rindex];
152bf21cd93STycho Nightingale fifo->rindex = (fifo->rindex + 1) % fifo->size;
153bf21cd93STycho Nightingale fifo->num--;
154bf21cd93STycho Nightingale return (0);
155bf21cd93STycho Nightingale }
156bf21cd93STycho Nightingale
157bf21cd93STycho Nightingale return (-1);
158bf21cd93STycho Nightingale }
159bf21cd93STycho Nightingale
160bf21cd93STycho Nightingale static void
movement_reset(struct ps2mouse_softc * sc)161bf21cd93STycho Nightingale movement_reset(struct ps2mouse_softc *sc)
162bf21cd93STycho Nightingale {
163bf21cd93STycho Nightingale assert(pthread_mutex_isowned_np(&sc->mtx));
164bf21cd93STycho Nightingale
165bf21cd93STycho Nightingale sc->delta_x = 0;
166bf21cd93STycho Nightingale sc->delta_y = 0;
167bf21cd93STycho Nightingale }
168bf21cd93STycho Nightingale
169bf21cd93STycho Nightingale static void
movement_update(struct ps2mouse_softc * sc,int x,int y)170bf21cd93STycho Nightingale movement_update(struct ps2mouse_softc *sc, int x, int y)
171bf21cd93STycho Nightingale {
172bf21cd93STycho Nightingale sc->delta_x += x - sc->cur_x;
173bf21cd93STycho Nightingale sc->delta_y += sc->cur_y - y;
174bf21cd93STycho Nightingale sc->cur_x = x;
175bf21cd93STycho Nightingale sc->cur_y = y;
176bf21cd93STycho Nightingale }
177bf21cd93STycho Nightingale
178bf21cd93STycho Nightingale static void
movement_get(struct ps2mouse_softc * sc)179bf21cd93STycho Nightingale movement_get(struct ps2mouse_softc *sc)
180bf21cd93STycho Nightingale {
181bf21cd93STycho Nightingale uint8_t val0, val1, val2;
182bf21cd93STycho Nightingale
183bf21cd93STycho Nightingale assert(pthread_mutex_isowned_np(&sc->mtx));
184bf21cd93STycho Nightingale
1854c87aefeSPatrick Mooney val0 = PS2M_DATA_AONE;
1864c87aefeSPatrick Mooney val0 |= sc->status & (PS2M_DATA_LEFT_BUTTON |
1874c87aefeSPatrick Mooney PS2M_DATA_RIGHT_BUTTON | PS2M_DATA_MID_BUTTON);
188bf21cd93STycho Nightingale
189bf21cd93STycho Nightingale if (sc->delta_x >= 0) {
190bf21cd93STycho Nightingale if (sc->delta_x > 255) {
1914c87aefeSPatrick Mooney val0 |= PS2M_DATA_X_OFLOW;
192bf21cd93STycho Nightingale val1 = 255;
193bf21cd93STycho Nightingale } else
194bf21cd93STycho Nightingale val1 = sc->delta_x;
195bf21cd93STycho Nightingale } else {
1964c87aefeSPatrick Mooney val0 |= PS2M_DATA_X_SIGN;
197bf21cd93STycho Nightingale if (sc->delta_x < -255) {
1984c87aefeSPatrick Mooney val0 |= PS2M_DATA_X_OFLOW;
199bf21cd93STycho Nightingale val1 = 255;
200bf21cd93STycho Nightingale } else
201bf21cd93STycho Nightingale val1 = sc->delta_x;
202bf21cd93STycho Nightingale }
203bf21cd93STycho Nightingale sc->delta_x = 0;
204bf21cd93STycho Nightingale
205bf21cd93STycho Nightingale if (sc->delta_y >= 0) {
206bf21cd93STycho Nightingale if (sc->delta_y > 255) {
2074c87aefeSPatrick Mooney val0 |= PS2M_DATA_Y_OFLOW;
208bf21cd93STycho Nightingale val2 = 255;
209bf21cd93STycho Nightingale } else
210bf21cd93STycho Nightingale val2 = sc->delta_y;
211bf21cd93STycho Nightingale } else {
2124c87aefeSPatrick Mooney val0 |= PS2M_DATA_Y_SIGN;
213bf21cd93STycho Nightingale if (sc->delta_y < -255) {
2144c87aefeSPatrick Mooney val0 |= PS2M_DATA_Y_OFLOW;
215bf21cd93STycho Nightingale val2 = 255;
216bf21cd93STycho Nightingale } else
217bf21cd93STycho Nightingale val2 = sc->delta_y;
218bf21cd93STycho Nightingale }
219bf21cd93STycho Nightingale sc->delta_y = 0;
220bf21cd93STycho Nightingale
2214c87aefeSPatrick Mooney if (sc->fifo.num < (sc->fifo.size - 3)) {
2224c87aefeSPatrick Mooney fifo_put(sc, val0);
2234c87aefeSPatrick Mooney fifo_put(sc, val1);
2244c87aefeSPatrick Mooney fifo_put(sc, val2);
2254c87aefeSPatrick Mooney }
226bf21cd93STycho Nightingale }
227bf21cd93STycho Nightingale
228bf21cd93STycho Nightingale static void
ps2mouse_reset(struct ps2mouse_softc * sc)229bf21cd93STycho Nightingale ps2mouse_reset(struct ps2mouse_softc *sc)
230bf21cd93STycho Nightingale {
231bf21cd93STycho Nightingale assert(pthread_mutex_isowned_np(&sc->mtx));
232bf21cd93STycho Nightingale fifo_reset(sc);
233bf21cd93STycho Nightingale movement_reset(sc);
2344c87aefeSPatrick Mooney sc->status = PS2M_STS_ENABLE_DEV;
235bf21cd93STycho Nightingale sc->resolution = 4;
236bf21cd93STycho Nightingale sc->sampling_rate = 100;
237bf21cd93STycho Nightingale
238bf21cd93STycho Nightingale sc->cur_x = 0;
239bf21cd93STycho Nightingale sc->cur_y = 0;
240bf21cd93STycho Nightingale sc->delta_x = 0;
241bf21cd93STycho Nightingale sc->delta_y = 0;
242bf21cd93STycho Nightingale }
243bf21cd93STycho Nightingale
244bf21cd93STycho Nightingale int
ps2mouse_read(struct ps2mouse_softc * sc,uint8_t * val)245bf21cd93STycho Nightingale ps2mouse_read(struct ps2mouse_softc *sc, uint8_t *val)
246bf21cd93STycho Nightingale {
247bf21cd93STycho Nightingale int retval;
248bf21cd93STycho Nightingale
249bf21cd93STycho Nightingale pthread_mutex_lock(&sc->mtx);
250bf21cd93STycho Nightingale retval = fifo_get(sc, val);
251bf21cd93STycho Nightingale pthread_mutex_unlock(&sc->mtx);
252bf21cd93STycho Nightingale
253bf21cd93STycho Nightingale return (retval);
254bf21cd93STycho Nightingale }
255bf21cd93STycho Nightingale
2564c87aefeSPatrick Mooney int
ps2mouse_fifocnt(struct ps2mouse_softc * sc)2574c87aefeSPatrick Mooney ps2mouse_fifocnt(struct ps2mouse_softc *sc)
2584c87aefeSPatrick Mooney {
2594c87aefeSPatrick Mooney return (sc->fifo.num);
2604c87aefeSPatrick Mooney }
2614c87aefeSPatrick Mooney
262bf21cd93STycho Nightingale void
ps2mouse_toggle(struct ps2mouse_softc * sc,int enable)2634c87aefeSPatrick Mooney ps2mouse_toggle(struct ps2mouse_softc *sc, int enable)
264bf21cd93STycho Nightingale {
265bf21cd93STycho Nightingale pthread_mutex_lock(&sc->mtx);
2664c87aefeSPatrick Mooney if (enable)
2674c87aefeSPatrick Mooney sc->ctrlenable = 1;
2684c87aefeSPatrick Mooney else {
2694c87aefeSPatrick Mooney sc->ctrlenable = 0;
2704c87aefeSPatrick Mooney sc->fifo.rindex = 0;
2714c87aefeSPatrick Mooney sc->fifo.windex = 0;
2724c87aefeSPatrick Mooney sc->fifo.num = 0;
2734c87aefeSPatrick Mooney }
2744c87aefeSPatrick Mooney pthread_mutex_unlock(&sc->mtx);
2754c87aefeSPatrick Mooney }
2764c87aefeSPatrick Mooney
2774c87aefeSPatrick Mooney void
ps2mouse_write(struct ps2mouse_softc * sc,uint8_t val,int insert)2784c87aefeSPatrick Mooney ps2mouse_write(struct ps2mouse_softc *sc, uint8_t val, int insert)
2794c87aefeSPatrick Mooney {
2804c87aefeSPatrick Mooney pthread_mutex_lock(&sc->mtx);
2814c87aefeSPatrick Mooney fifo_reset(sc);
282bf21cd93STycho Nightingale if (sc->curcmd) {
283bf21cd93STycho Nightingale switch (sc->curcmd) {
284bf21cd93STycho Nightingale case PS2MC_SET_SAMPLING_RATE:
285bf21cd93STycho Nightingale sc->sampling_rate = val;
286bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
287bf21cd93STycho Nightingale break;
288bf21cd93STycho Nightingale case PS2MC_SET_RESOLUTION:
289bf21cd93STycho Nightingale sc->resolution = val;
290bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
291bf21cd93STycho Nightingale break;
292bf21cd93STycho Nightingale default:
293154972afSPatrick Mooney EPRINTLN("Unhandled ps2 mouse current "
294154972afSPatrick Mooney "command byte 0x%02x", val);
295bf21cd93STycho Nightingale break;
296bf21cd93STycho Nightingale }
297bf21cd93STycho Nightingale sc->curcmd = 0;
2984c87aefeSPatrick Mooney
2994c87aefeSPatrick Mooney } else if (insert) {
3004c87aefeSPatrick Mooney fifo_put(sc, val);
301bf21cd93STycho Nightingale } else {
302bf21cd93STycho Nightingale switch (val) {
3034c87aefeSPatrick Mooney case 0x00:
3044c87aefeSPatrick Mooney fifo_put(sc, PS2MC_ACK);
3054c87aefeSPatrick Mooney break;
306bf21cd93STycho Nightingale case PS2MC_RESET_DEV:
307bf21cd93STycho Nightingale ps2mouse_reset(sc);
308bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
309bf21cd93STycho Nightingale fifo_put(sc, PS2MC_BAT_SUCCESS);
310bf21cd93STycho Nightingale fifo_put(sc, PS2MOUSE_DEV_ID);
311bf21cd93STycho Nightingale break;
312bf21cd93STycho Nightingale case PS2MC_SET_DEFAULTS:
313bf21cd93STycho Nightingale ps2mouse_reset(sc);
314bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
315bf21cd93STycho Nightingale break;
316bf21cd93STycho Nightingale case PS2MC_DISABLE:
317bf21cd93STycho Nightingale fifo_reset(sc);
318bf21cd93STycho Nightingale sc->status &= ~PS2M_STS_ENABLE_DEV;
319bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
320bf21cd93STycho Nightingale break;
321bf21cd93STycho Nightingale case PS2MC_ENABLE:
322bf21cd93STycho Nightingale fifo_reset(sc);
323bf21cd93STycho Nightingale sc->status |= PS2M_STS_ENABLE_DEV;
324bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
325bf21cd93STycho Nightingale break;
326bf21cd93STycho Nightingale case PS2MC_SET_SAMPLING_RATE:
327bf21cd93STycho Nightingale sc->curcmd = val;
328bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
329bf21cd93STycho Nightingale break;
330bf21cd93STycho Nightingale case PS2MC_SEND_DEV_ID:
331bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
332bf21cd93STycho Nightingale fifo_put(sc, PS2MOUSE_DEV_ID);
333bf21cd93STycho Nightingale break;
334bf21cd93STycho Nightingale case PS2MC_SET_REMOTE_MODE:
335bf21cd93STycho Nightingale sc->status |= PS2M_STS_REMOTE_MODE;
336bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
337bf21cd93STycho Nightingale break;
338bf21cd93STycho Nightingale case PS2MC_SEND_DEV_DATA:
339bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
340bf21cd93STycho Nightingale movement_get(sc);
341bf21cd93STycho Nightingale break;
342bf21cd93STycho Nightingale case PS2MC_SET_STREAM_MODE:
343bf21cd93STycho Nightingale sc->status &= ~PS2M_STS_REMOTE_MODE;
344bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
345bf21cd93STycho Nightingale break;
346bf21cd93STycho Nightingale case PS2MC_SEND_DEV_STATUS:
347bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
348bf21cd93STycho Nightingale fifo_put(sc, sc->status);
349bf21cd93STycho Nightingale fifo_put(sc, sc->resolution);
350bf21cd93STycho Nightingale fifo_put(sc, sc->sampling_rate);
351bf21cd93STycho Nightingale break;
352bf21cd93STycho Nightingale case PS2MC_SET_RESOLUTION:
353bf21cd93STycho Nightingale sc->curcmd = val;
354bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
355bf21cd93STycho Nightingale break;
356bf21cd93STycho Nightingale case PS2MC_SET_SCALING1:
357bf21cd93STycho Nightingale case PS2MC_SET_SCALING2:
358bf21cd93STycho Nightingale fifo_put(sc, PS2MC_ACK);
359bf21cd93STycho Nightingale break;
360bf21cd93STycho Nightingale default:
3614c87aefeSPatrick Mooney fifo_put(sc, PS2MC_ACK);
362154972afSPatrick Mooney EPRINTLN("Unhandled ps2 mouse command "
363154972afSPatrick Mooney "0x%02x", val);
364bf21cd93STycho Nightingale break;
365bf21cd93STycho Nightingale }
366bf21cd93STycho Nightingale }
367bf21cd93STycho Nightingale pthread_mutex_unlock(&sc->mtx);
368bf21cd93STycho Nightingale }
369bf21cd93STycho Nightingale
370bf21cd93STycho Nightingale static void
ps2mouse_event(uint8_t button,int x,int y,void * arg)371bf21cd93STycho Nightingale ps2mouse_event(uint8_t button, int x, int y, void *arg)
372bf21cd93STycho Nightingale {
373bf21cd93STycho Nightingale struct ps2mouse_softc *sc = arg;
374bf21cd93STycho Nightingale
375bf21cd93STycho Nightingale pthread_mutex_lock(&sc->mtx);
376bf21cd93STycho Nightingale movement_update(sc, x, y);
377bf21cd93STycho Nightingale
378bf21cd93STycho Nightingale sc->status &= ~(PS2M_STS_LEFT_BUTTON |
379bf21cd93STycho Nightingale PS2M_STS_RIGHT_BUTTON | PS2M_STS_MID_BUTTON);
380bf21cd93STycho Nightingale if (button & (1 << 0))
381bf21cd93STycho Nightingale sc->status |= PS2M_STS_LEFT_BUTTON;
382bf21cd93STycho Nightingale if (button & (1 << 1))
383bf21cd93STycho Nightingale sc->status |= PS2M_STS_MID_BUTTON;
384bf21cd93STycho Nightingale if (button & (1 << 2))
385bf21cd93STycho Nightingale sc->status |= PS2M_STS_RIGHT_BUTTON;
386bf21cd93STycho Nightingale
3874c87aefeSPatrick Mooney if ((sc->status & PS2M_STS_ENABLE_DEV) == 0 || !sc->ctrlenable) {
388bf21cd93STycho Nightingale /* no data reporting */
389bf21cd93STycho Nightingale pthread_mutex_unlock(&sc->mtx);
390bf21cd93STycho Nightingale return;
391bf21cd93STycho Nightingale }
392bf21cd93STycho Nightingale
393bf21cd93STycho Nightingale movement_get(sc);
394bf21cd93STycho Nightingale pthread_mutex_unlock(&sc->mtx);
395bf21cd93STycho Nightingale
3964c87aefeSPatrick Mooney if (sc->fifo.num > 0)
3974c87aefeSPatrick Mooney atkbdc_event(sc->atkbdc_sc, 0);
398bf21cd93STycho Nightingale }
399bf21cd93STycho Nightingale
400bf21cd93STycho Nightingale struct ps2mouse_softc *
ps2mouse_init(struct atkbdc_softc * atkbdc_sc)401bf21cd93STycho Nightingale ps2mouse_init(struct atkbdc_softc *atkbdc_sc)
402bf21cd93STycho Nightingale {
403bf21cd93STycho Nightingale struct ps2mouse_softc *sc;
404bf21cd93STycho Nightingale
405bf21cd93STycho Nightingale sc = calloc(1, sizeof (struct ps2mouse_softc));
406bf21cd93STycho Nightingale pthread_mutex_init(&sc->mtx, NULL);
407bf21cd93STycho Nightingale fifo_init(sc);
408bf21cd93STycho Nightingale sc->atkbdc_sc = atkbdc_sc;
409bf21cd93STycho Nightingale
410bf21cd93STycho Nightingale pthread_mutex_lock(&sc->mtx);
411bf21cd93STycho Nightingale ps2mouse_reset(sc);
412bf21cd93STycho Nightingale pthread_mutex_unlock(&sc->mtx);
413bf21cd93STycho Nightingale
4144c87aefeSPatrick Mooney console_ptr_register(ps2mouse_event, sc, 1);
415bf21cd93STycho Nightingale
416bf21cd93STycho Nightingale return (sc);
417bf21cd93STycho Nightingale }
418bf21cd93STycho Nightingale
4194c87aefeSPatrick Mooney
420