1*0Sstevel@tonic-gate /*
2*0Sstevel@tonic-gate * CDDL HEADER START
3*0Sstevel@tonic-gate *
4*0Sstevel@tonic-gate * The contents of this file are subject to the terms of the
5*0Sstevel@tonic-gate * Common Development and Distribution License, Version 1.0 only
6*0Sstevel@tonic-gate * (the "License"). You may not use this file except in compliance
7*0Sstevel@tonic-gate * with the License.
8*0Sstevel@tonic-gate *
9*0Sstevel@tonic-gate * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10*0Sstevel@tonic-gate * or http://www.opensolaris.org/os/licensing.
11*0Sstevel@tonic-gate * See the License for the specific language governing permissions
12*0Sstevel@tonic-gate * and limitations under the License.
13*0Sstevel@tonic-gate *
14*0Sstevel@tonic-gate * When distributing Covered Code, include this CDDL HEADER in each
15*0Sstevel@tonic-gate * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16*0Sstevel@tonic-gate * If applicable, add the following below this CDDL HEADER, with the
17*0Sstevel@tonic-gate * fields enclosed by brackets "[]" replaced with your own identifying
18*0Sstevel@tonic-gate * information: Portions Copyright [yyyy] [name of copyright owner]
19*0Sstevel@tonic-gate *
20*0Sstevel@tonic-gate * CDDL HEADER END
21*0Sstevel@tonic-gate */
22*0Sstevel@tonic-gate /*
23*0Sstevel@tonic-gate * Copyright 2003 Sun Microsystems, Inc. All rights reserved.
24*0Sstevel@tonic-gate * Use is subject to license terms.
25*0Sstevel@tonic-gate */
26*0Sstevel@tonic-gate
27*0Sstevel@tonic-gate #pragma ident "%Z%%M% %I% %E% SMI"
28*0Sstevel@tonic-gate
29*0Sstevel@tonic-gate /*
30*0Sstevel@tonic-gate * Mouse streams module.
31*0Sstevel@tonic-gate */
32*0Sstevel@tonic-gate
33*0Sstevel@tonic-gate #include <sys/types.h>
34*0Sstevel@tonic-gate #include <sys/param.h>
35*0Sstevel@tonic-gate #include <sys/sysmacros.h>
36*0Sstevel@tonic-gate #include <sys/signal.h>
37*0Sstevel@tonic-gate #include <sys/termios.h>
38*0Sstevel@tonic-gate #include <sys/termio.h>
39*0Sstevel@tonic-gate #include <sys/stream.h>
40*0Sstevel@tonic-gate #include <sys/stropts.h>
41*0Sstevel@tonic-gate #include <sys/strsun.h>
42*0Sstevel@tonic-gate #include <sys/tty.h>
43*0Sstevel@tonic-gate #include <sys/strtty.h>
44*0Sstevel@tonic-gate #include <sys/time.h>
45*0Sstevel@tonic-gate #include <sys/kmem.h>
46*0Sstevel@tonic-gate #include <sys/file.h>
47*0Sstevel@tonic-gate #include <sys/uio.h>
48*0Sstevel@tonic-gate #include <sys/errno.h>
49*0Sstevel@tonic-gate #include <sys/debug.h>
50*0Sstevel@tonic-gate
51*0Sstevel@tonic-gate #include <sys/vuid_event.h>
52*0Sstevel@tonic-gate #include <sys/msreg.h>
53*0Sstevel@tonic-gate #include <sys/msio.h>
54*0Sstevel@tonic-gate #include <sys/ddi.h>
55*0Sstevel@tonic-gate #include <sys/sunddi.h>
56*0Sstevel@tonic-gate
57*0Sstevel@tonic-gate #include <sys/modctl.h>
58*0Sstevel@tonic-gate
59*0Sstevel@tonic-gate
60*0Sstevel@tonic-gate /*
61*0Sstevel@tonic-gate * This is the loadable module wrapper.
62*0Sstevel@tonic-gate */
63*0Sstevel@tonic-gate
64*0Sstevel@tonic-gate static struct streamtab ms_info;
65*0Sstevel@tonic-gate
66*0Sstevel@tonic-gate static struct fmodsw fsw = {
67*0Sstevel@tonic-gate "ms",
68*0Sstevel@tonic-gate &ms_info,
69*0Sstevel@tonic-gate D_MP | D_MTPERMOD
70*0Sstevel@tonic-gate };
71*0Sstevel@tonic-gate
72*0Sstevel@tonic-gate /*
73*0Sstevel@tonic-gate * Module linkage information for the kernel.
74*0Sstevel@tonic-gate */
75*0Sstevel@tonic-gate
76*0Sstevel@tonic-gate static struct modlstrmod modlstrmod = {
77*0Sstevel@tonic-gate &mod_strmodops, "streams module for mouse", &fsw
78*0Sstevel@tonic-gate };
79*0Sstevel@tonic-gate
80*0Sstevel@tonic-gate static struct modlinkage modlinkage = {
81*0Sstevel@tonic-gate MODREV_1, &modlstrmod, NULL
82*0Sstevel@tonic-gate };
83*0Sstevel@tonic-gate
84*0Sstevel@tonic-gate
85*0Sstevel@tonic-gate int
_init(void)86*0Sstevel@tonic-gate _init(void)
87*0Sstevel@tonic-gate {
88*0Sstevel@tonic-gate return (mod_install(&modlinkage));
89*0Sstevel@tonic-gate }
90*0Sstevel@tonic-gate
91*0Sstevel@tonic-gate int
_fini(void)92*0Sstevel@tonic-gate _fini(void)
93*0Sstevel@tonic-gate {
94*0Sstevel@tonic-gate return (EBUSY);
95*0Sstevel@tonic-gate }
96*0Sstevel@tonic-gate
97*0Sstevel@tonic-gate int
_info(struct modinfo * modinfop)98*0Sstevel@tonic-gate _info(struct modinfo *modinfop)
99*0Sstevel@tonic-gate {
100*0Sstevel@tonic-gate return (mod_info(&modlinkage, modinfop));
101*0Sstevel@tonic-gate }
102*0Sstevel@tonic-gate
103*0Sstevel@tonic-gate #define BYTECLIP(x) (char)((x) > 127 ? 127 : ((x) < -128 ? -128 : (x)))
104*0Sstevel@tonic-gate
105*0Sstevel@tonic-gate struct msdata {
106*0Sstevel@tonic-gate struct ms_softc msd_softc;
107*0Sstevel@tonic-gate queue_t *msd_readq; /* upstream read queue */
108*0Sstevel@tonic-gate mblk_t *msd_iocpending; /* "ioctl" awaiting buffer */
109*0Sstevel@tonic-gate int msd_flags; /* random flags */
110*0Sstevel@tonic-gate int msd_iocid; /* ID of "ioctl" being waited for */
111*0Sstevel@tonic-gate int msd_iocerror; /* error return from "ioctl" */
112*0Sstevel@tonic-gate char msd_oldbutt; /* button state at last sample */
113*0Sstevel@tonic-gate short msd_state; /* state counter for input routine */
114*0Sstevel@tonic-gate short msd_jitter;
115*0Sstevel@tonic-gate timeout_id_t msd_timeout_id; /* id returned by timeout() */
116*0Sstevel@tonic-gate bufcall_id_t msd_reioctl_id; /* id returned by bufcall() */
117*0Sstevel@tonic-gate bufcall_id_t msd_resched_id; /* id returned by bufcall() */
118*0Sstevel@tonic-gate int msd_baud_rate; /* mouse baud rate */
119*0Sstevel@tonic-gate int msd_rcnt_baud_chng; /* baud changed recently */
120*0Sstevel@tonic-gate int msd_data_pkt_cnt; /* no of packets since last baud change */
121*0Sstevel@tonic-gate int msd_qenable_more; /* enable msrserv if baud changed recently */
122*0Sstevel@tonic-gate int msd_hold_baud_stup; /* # of packets to wait for baud setup */
123*0Sstevel@tonic-gate };
124*0Sstevel@tonic-gate
125*0Sstevel@tonic-gate #define MS_OPEN 0x00000001 /* mouse is open for business */
126*0Sstevel@tonic-gate #define MS_IOCWAIT 0x00000002 /* "open" waiting for ioctl to finish */
127*0Sstevel@tonic-gate #define MS_IOCTOSS 0x00000004 /* Toss ioctl returns */
128*0Sstevel@tonic-gate
129*0Sstevel@tonic-gate /*
130*0Sstevel@tonic-gate * Input routine states. See msinput().
131*0Sstevel@tonic-gate */
132*0Sstevel@tonic-gate #define MS_WAIT_BUTN 0
133*0Sstevel@tonic-gate #define MS_WAIT_X 1
134*0Sstevel@tonic-gate #define MS_WAIT_Y 2
135*0Sstevel@tonic-gate #define MS_WAIT_X2 3
136*0Sstevel@tonic-gate #define MS_WAIT_Y2 4
137*0Sstevel@tonic-gate #define MS_PKT_SZ 5
138*0Sstevel@tonic-gate
139*0Sstevel@tonic-gate /*
140*0Sstevel@tonic-gate * This module supports mice runing at 1200, 4800 and 9600 baud rates.
141*0Sstevel@tonic-gate *
142*0Sstevel@tonic-gate * If there was a baud change recently, then we want to wait
143*0Sstevel@tonic-gate * for some time to make sure that no other baud change is on its way.
144*0Sstevel@tonic-gate * If the second baud rate change is done then the packets between
145*0Sstevel@tonic-gate * changes are garbage and are thrown away during the baud change.
146*0Sstevel@tonic-gate */
147*0Sstevel@tonic-gate /*
148*0Sstevel@tonic-gate * The following #defines were tuned by experimentations.
149*0Sstevel@tonic-gate */
150*0Sstevel@tonic-gate #define MS_HOLD_BAUD_STUP 48
151*0Sstevel@tonic-gate #define MS_CNT_TOB1200 7
152*0Sstevel@tonic-gate
153*0Sstevel@tonic-gate
154*0Sstevel@tonic-gate static int ms_overrun_msg; /* Message when overrun circular buffer */
155*0Sstevel@tonic-gate static int ms_overrun_cnt; /* Increment when overrun circular buffer */
156*0Sstevel@tonic-gate
157*0Sstevel@tonic-gate /*
158*0Sstevel@tonic-gate * Max pixel delta of jitter controlled. As this number increases the jumpiness
159*0Sstevel@tonic-gate * of the ms increases, i.e., the coarser the motion for medium speeds.
160*0Sstevel@tonic-gate */
161*0Sstevel@tonic-gate static int ms_jitter_thresh = 0;
162*0Sstevel@tonic-gate
163*0Sstevel@tonic-gate /*
164*0Sstevel@tonic-gate * ms_jitter_thresh is the maximum number of jitters suppressed. Thus,
165*0Sstevel@tonic-gate * hz/ms_jitter_thresh is the maximum interval of jitters suppressed. As
166*0Sstevel@tonic-gate * ms_jitter_thresh increases, a wider range of jitter is suppressed. However,
167*0Sstevel@tonic-gate * the more inertia the mouse seems to have, i.e., the slower the mouse is to
168*0Sstevel@tonic-gate * react.
169*0Sstevel@tonic-gate */
170*0Sstevel@tonic-gate
171*0Sstevel@tonic-gate /*
172*0Sstevel@tonic-gate * Measure how many (ms_speed_count) ms deltas exceed threshold
173*0Sstevel@tonic-gate * (ms_speedlimit). If ms_speedlaw then throw away deltas over ms_speedlimit.
174*0Sstevel@tonic-gate * This is to keep really bad mice that jump around from getting too far.
175*0Sstevel@tonic-gate */
176*0Sstevel@tonic-gate static int ms_speedlimit = 48;
177*0Sstevel@tonic-gate static int ms_speedlaw = 0;
178*0Sstevel@tonic-gate static int ms_speed_count;
179*0Sstevel@tonic-gate static int msjitterrate = 12;
180*0Sstevel@tonic-gate
181*0Sstevel@tonic-gate #define JITTER_TIMEOUT (hz/msjitterrate)
182*0Sstevel@tonic-gate
183*0Sstevel@tonic-gate static clock_t msjittertimeout; /* Timeout used when mstimeout in effect */
184*0Sstevel@tonic-gate
185*0Sstevel@tonic-gate /*
186*0Sstevel@tonic-gate * Mouse buffer size in bytes. Place here as variable so that one could
187*0Sstevel@tonic-gate * massage it using adb if it turns out to be too small.
188*0Sstevel@tonic-gate */
189*0Sstevel@tonic-gate static int MS_BUF_BYTES = 4096;
190*0Sstevel@tonic-gate
191*0Sstevel@tonic-gate
192*0Sstevel@tonic-gate static int MS_DEBUG;
193*0Sstevel@tonic-gate
194*0Sstevel@tonic-gate
195*0Sstevel@tonic-gate /*
196*0Sstevel@tonic-gate * Most of these should be "void", but the people who defined the "streams"
197*0Sstevel@tonic-gate * data structures for S5 didn't understand data types.
198*0Sstevel@tonic-gate */
199*0Sstevel@tonic-gate static int msopen(queue_t *q, dev_t *devp, int oflag, int sflag,
200*0Sstevel@tonic-gate cred_t *credp);
201*0Sstevel@tonic-gate static int msclose(queue_t *q, int flag, cred_t *credp);
202*0Sstevel@tonic-gate static void mswput(queue_t *q, mblk_t *mp);
203*0Sstevel@tonic-gate static void msrput(queue_t *q, mblk_t *mp);
204*0Sstevel@tonic-gate static void msrserv(queue_t *q);
205*0Sstevel@tonic-gate
206*0Sstevel@tonic-gate static struct module_info msmiinfo = {
207*0Sstevel@tonic-gate 0,
208*0Sstevel@tonic-gate "ms",
209*0Sstevel@tonic-gate 0,
210*0Sstevel@tonic-gate INFPSZ,
211*0Sstevel@tonic-gate 2048,
212*0Sstevel@tonic-gate 128
213*0Sstevel@tonic-gate };
214*0Sstevel@tonic-gate
215*0Sstevel@tonic-gate static struct qinit msrinit = {
216*0Sstevel@tonic-gate (int (*)())msrput,
217*0Sstevel@tonic-gate (int (*)())msrserv,
218*0Sstevel@tonic-gate msopen,
219*0Sstevel@tonic-gate msclose,
220*0Sstevel@tonic-gate (int (*)())NULL,
221*0Sstevel@tonic-gate &msmiinfo
222*0Sstevel@tonic-gate };
223*0Sstevel@tonic-gate
224*0Sstevel@tonic-gate static struct module_info msmoinfo = {
225*0Sstevel@tonic-gate 0,
226*0Sstevel@tonic-gate "ms",
227*0Sstevel@tonic-gate 0,
228*0Sstevel@tonic-gate INFPSZ,
229*0Sstevel@tonic-gate 2048,
230*0Sstevel@tonic-gate 128
231*0Sstevel@tonic-gate };
232*0Sstevel@tonic-gate
233*0Sstevel@tonic-gate static struct qinit mswinit = {
234*0Sstevel@tonic-gate (int (*)())mswput,
235*0Sstevel@tonic-gate (int (*)())NULL,
236*0Sstevel@tonic-gate msopen,
237*0Sstevel@tonic-gate msclose,
238*0Sstevel@tonic-gate (int (*)())NULL,
239*0Sstevel@tonic-gate &msmoinfo
240*0Sstevel@tonic-gate };
241*0Sstevel@tonic-gate
242*0Sstevel@tonic-gate static struct streamtab ms_info = {
243*0Sstevel@tonic-gate &msrinit,
244*0Sstevel@tonic-gate &mswinit,
245*0Sstevel@tonic-gate NULL,
246*0Sstevel@tonic-gate NULL,
247*0Sstevel@tonic-gate };
248*0Sstevel@tonic-gate
249*0Sstevel@tonic-gate static void msresched(void *);
250*0Sstevel@tonic-gate static void msreioctl(void *);
251*0Sstevel@tonic-gate static void msioctl(queue_t *q, mblk_t *mp);
252*0Sstevel@tonic-gate static int ms_getparms(register Ms_parms *data);
253*0Sstevel@tonic-gate static int ms_setparms(register Ms_parms *data);
254*0Sstevel@tonic-gate static void msflush(struct msdata *msd);
255*0Sstevel@tonic-gate static void msinput(/* struct msdata *msd, char c */); /* XXX */
256*0Sstevel@tonic-gate static void msincr(void *);
257*0Sstevel@tonic-gate
258*0Sstevel@tonic-gate /*
259*0Sstevel@tonic-gate * Dummy qbufcall callback routine used by open and close.
260*0Sstevel@tonic-gate * The framework will wake up qwait_sig when we return from
261*0Sstevel@tonic-gate * this routine (as part of leaving the perimeters.)
262*0Sstevel@tonic-gate * (The framework enters the perimeters before calling the qbufcall() callback
263*0Sstevel@tonic-gate * and leaves the perimeters after the callback routine has executed. The
264*0Sstevel@tonic-gate * framework performs an implicit wakeup of any thread in qwait/qwait_sig
265*0Sstevel@tonic-gate * when it leaves the perimeter. See qwait(9E).)
266*0Sstevel@tonic-gate */
267*0Sstevel@tonic-gate /* ARGSUSED */
268*0Sstevel@tonic-gate static void
dummy_callback(void * arg)269*0Sstevel@tonic-gate dummy_callback(void *arg)
270*0Sstevel@tonic-gate {}
271*0Sstevel@tonic-gate
272*0Sstevel@tonic-gate /*
273*0Sstevel@tonic-gate * Open a mouse.
274*0Sstevel@tonic-gate */
275*0Sstevel@tonic-gate /*ARGSUSED*/
276*0Sstevel@tonic-gate static int
msopen(q,devp,oflag,sflag,credp)277*0Sstevel@tonic-gate msopen(q, devp, oflag, sflag, credp)
278*0Sstevel@tonic-gate queue_t *q;
279*0Sstevel@tonic-gate dev_t *devp;
280*0Sstevel@tonic-gate int oflag, sflag;
281*0Sstevel@tonic-gate cred_t *credp;
282*0Sstevel@tonic-gate {
283*0Sstevel@tonic-gate register struct mousebuf *b;
284*0Sstevel@tonic-gate register struct ms_softc *ms;
285*0Sstevel@tonic-gate register struct msdata *msd;
286*0Sstevel@tonic-gate mblk_t *mp;
287*0Sstevel@tonic-gate mblk_t *datap;
288*0Sstevel@tonic-gate register struct iocblk *iocb;
289*0Sstevel@tonic-gate register struct termios *cb;
290*0Sstevel@tonic-gate int error = 0;
291*0Sstevel@tonic-gate
292*0Sstevel@tonic-gate if (q->q_ptr != NULL)
293*0Sstevel@tonic-gate return (0); /* already attached */
294*0Sstevel@tonic-gate
295*0Sstevel@tonic-gate if (sflag != MODOPEN)
296*0Sstevel@tonic-gate return (EINVAL);
297*0Sstevel@tonic-gate
298*0Sstevel@tonic-gate /*
299*0Sstevel@tonic-gate * Allocate an msdata structure.
300*0Sstevel@tonic-gate */
301*0Sstevel@tonic-gate msd = kmem_zalloc(sizeof (struct msdata), KM_SLEEP);
302*0Sstevel@tonic-gate
303*0Sstevel@tonic-gate /*
304*0Sstevel@tonic-gate * Set up queue pointers, so that the "put" procedure will accept
305*0Sstevel@tonic-gate * the reply to the "ioctl" message we send down.
306*0Sstevel@tonic-gate */
307*0Sstevel@tonic-gate q->q_ptr = msd;
308*0Sstevel@tonic-gate WR(q)->q_ptr = msd;
309*0Sstevel@tonic-gate
310*0Sstevel@tonic-gate qprocson(q);
311*0Sstevel@tonic-gate
312*0Sstevel@tonic-gate /*
313*0Sstevel@tonic-gate * Setup tty modes.
314*0Sstevel@tonic-gate */
315*0Sstevel@tonic-gate while ((mp = mkiocb(TCSETSF)) == NULL) {
316*0Sstevel@tonic-gate bufcall_id_t id = qbufcall(q, sizeof (struct iocblk),
317*0Sstevel@tonic-gate BPRI_HI, dummy_callback, NULL);
318*0Sstevel@tonic-gate if (!qwait_sig(q)) {
319*0Sstevel@tonic-gate qunbufcall(q, id);
320*0Sstevel@tonic-gate kmem_free(msd, sizeof (struct msdata));
321*0Sstevel@tonic-gate qprocsoff(q);
322*0Sstevel@tonic-gate
323*0Sstevel@tonic-gate return (EINTR);
324*0Sstevel@tonic-gate }
325*0Sstevel@tonic-gate }
326*0Sstevel@tonic-gate while ((datap = allocb(sizeof (struct termios), BPRI_HI)) == NULL) {
327*0Sstevel@tonic-gate bufcall_id_t id = qbufcall(q, sizeof (struct termios),
328*0Sstevel@tonic-gate BPRI_HI, dummy_callback, NULL);
329*0Sstevel@tonic-gate if (!qwait_sig(q)) {
330*0Sstevel@tonic-gate qunbufcall(q, id);
331*0Sstevel@tonic-gate freemsg(mp);
332*0Sstevel@tonic-gate kmem_free(msd, sizeof (struct msdata));
333*0Sstevel@tonic-gate qprocsoff(q);
334*0Sstevel@tonic-gate
335*0Sstevel@tonic-gate return (EINTR);
336*0Sstevel@tonic-gate }
337*0Sstevel@tonic-gate }
338*0Sstevel@tonic-gate
339*0Sstevel@tonic-gate
340*0Sstevel@tonic-gate iocb = (struct iocblk *)mp->b_rptr;
341*0Sstevel@tonic-gate iocb->ioc_count = sizeof (struct termios);
342*0Sstevel@tonic-gate
343*0Sstevel@tonic-gate cb = (struct termios *)datap->b_wptr;
344*0Sstevel@tonic-gate cb->c_iflag = 0;
345*0Sstevel@tonic-gate cb->c_oflag = 0;
346*0Sstevel@tonic-gate cb->c_cflag = CREAD|CS8|B9600;
347*0Sstevel@tonic-gate cb->c_lflag = 0;
348*0Sstevel@tonic-gate bzero(cb->c_cc, NCCS);
349*0Sstevel@tonic-gate
350*0Sstevel@tonic-gate datap->b_wptr += sizeof (*cb);
351*0Sstevel@tonic-gate datap->b_datap->db_type = M_DATA;
352*0Sstevel@tonic-gate mp->b_cont = datap;
353*0Sstevel@tonic-gate
354*0Sstevel@tonic-gate msd->msd_flags |= MS_IOCWAIT; /* indicate that we're waiting for */
355*0Sstevel@tonic-gate msd->msd_iocid = iocb->ioc_id; /* this response */
356*0Sstevel@tonic-gate msd->msd_baud_rate = B9600;
357*0Sstevel@tonic-gate msd->msd_rcnt_baud_chng = 1;
358*0Sstevel@tonic-gate msd->msd_data_pkt_cnt = 0;
359*0Sstevel@tonic-gate msd->msd_qenable_more = 0;
360*0Sstevel@tonic-gate msd->msd_hold_baud_stup = MS_HOLD_BAUD_STUP;
361*0Sstevel@tonic-gate putnext(WR(q), mp);
362*0Sstevel@tonic-gate
363*0Sstevel@tonic-gate ms = &msd->msd_softc;
364*0Sstevel@tonic-gate /*
365*0Sstevel@tonic-gate * Now wait for it. Let our read queue put routine wake us up
366*0Sstevel@tonic-gate * when it arrives.
367*0Sstevel@tonic-gate */
368*0Sstevel@tonic-gate while (msd->msd_flags & MS_IOCWAIT) {
369*0Sstevel@tonic-gate if (!qwait_sig(q)) {
370*0Sstevel@tonic-gate error = EINTR;
371*0Sstevel@tonic-gate goto error;
372*0Sstevel@tonic-gate }
373*0Sstevel@tonic-gate }
374*0Sstevel@tonic-gate if ((error = msd->msd_iocerror) != 0)
375*0Sstevel@tonic-gate goto error;
376*0Sstevel@tonic-gate
377*0Sstevel@tonic-gate /*
378*0Sstevel@tonic-gate * Set up private data.
379*0Sstevel@tonic-gate */
380*0Sstevel@tonic-gate msd->msd_state = MS_WAIT_BUTN;
381*0Sstevel@tonic-gate msd->msd_readq = q;
382*0Sstevel@tonic-gate msd->msd_iocpending = NULL;
383*0Sstevel@tonic-gate
384*0Sstevel@tonic-gate /*
385*0Sstevel@tonic-gate * Allocate buffer and initialize data.
386*0Sstevel@tonic-gate */
387*0Sstevel@tonic-gate if (ms->ms_buf == 0) {
388*0Sstevel@tonic-gate ms->ms_bufbytes = MS_BUF_BYTES;
389*0Sstevel@tonic-gate b = kmem_zalloc((uint_t)ms->ms_bufbytes, KM_SLEEP);
390*0Sstevel@tonic-gate b->mb_size = 1 + (ms->ms_bufbytes - sizeof (struct mousebuf))
391*0Sstevel@tonic-gate / sizeof (struct mouseinfo);
392*0Sstevel@tonic-gate ms->ms_buf = b;
393*0Sstevel@tonic-gate ms->ms_vuidaddr = VKEY_FIRST;
394*0Sstevel@tonic-gate msjittertimeout = JITTER_TIMEOUT;
395*0Sstevel@tonic-gate msflush(msd);
396*0Sstevel@tonic-gate }
397*0Sstevel@tonic-gate
398*0Sstevel@tonic-gate msd->msd_flags = MS_OPEN;
399*0Sstevel@tonic-gate
400*0Sstevel@tonic-gate /*
401*0Sstevel@tonic-gate * Tell the module below us that it should return input immediately.
402*0Sstevel@tonic-gate */
403*0Sstevel@tonic-gate (void) putnextctl1(WR(q), M_CTL, MC_SERVICEIMM);
404*0Sstevel@tonic-gate
405*0Sstevel@tonic-gate return (0);
406*0Sstevel@tonic-gate
407*0Sstevel@tonic-gate error:
408*0Sstevel@tonic-gate qprocsoff(q);
409*0Sstevel@tonic-gate kmem_free(msd, sizeof (struct msdata));
410*0Sstevel@tonic-gate
411*0Sstevel@tonic-gate return (error);
412*0Sstevel@tonic-gate }
413*0Sstevel@tonic-gate
414*0Sstevel@tonic-gate /*
415*0Sstevel@tonic-gate * Close the mouse
416*0Sstevel@tonic-gate */
417*0Sstevel@tonic-gate /* ARGSUSED1 */
418*0Sstevel@tonic-gate static int
msclose(q,flag,credp)419*0Sstevel@tonic-gate msclose(q, flag, credp)
420*0Sstevel@tonic-gate queue_t *q;
421*0Sstevel@tonic-gate int flag;
422*0Sstevel@tonic-gate cred_t *credp;
423*0Sstevel@tonic-gate {
424*0Sstevel@tonic-gate register struct msdata *msd = (struct msdata *)q->q_ptr;
425*0Sstevel@tonic-gate register struct ms_softc *ms;
426*0Sstevel@tonic-gate
427*0Sstevel@tonic-gate /*
428*0Sstevel@tonic-gate * Tell the module below us that it need not return input immediately.
429*0Sstevel@tonic-gate */
430*0Sstevel@tonic-gate (void) putnextctl1(q, M_CTL, MC_SERVICEDEF);
431*0Sstevel@tonic-gate
432*0Sstevel@tonic-gate qprocsoff(q);
433*0Sstevel@tonic-gate /*
434*0Sstevel@tonic-gate * Since we're about to destroy our private data, turn off
435*0Sstevel@tonic-gate * our open flag first, so we don't accept any more input
436*0Sstevel@tonic-gate * and try to use that data.
437*0Sstevel@tonic-gate */
438*0Sstevel@tonic-gate msd->msd_flags = 0;
439*0Sstevel@tonic-gate
440*0Sstevel@tonic-gate if (msd->msd_jitter) {
441*0Sstevel@tonic-gate (void) quntimeout(q, msd->msd_timeout_id);
442*0Sstevel@tonic-gate msd->msd_jitter = 0;
443*0Sstevel@tonic-gate }
444*0Sstevel@tonic-gate if (msd->msd_reioctl_id) {
445*0Sstevel@tonic-gate qunbufcall(q, msd->msd_reioctl_id);
446*0Sstevel@tonic-gate msd->msd_reioctl_id = 0;
447*0Sstevel@tonic-gate }
448*0Sstevel@tonic-gate if (msd->msd_resched_id) {
449*0Sstevel@tonic-gate qunbufcall(q, msd->msd_resched_id);
450*0Sstevel@tonic-gate msd->msd_resched_id = 0;
451*0Sstevel@tonic-gate }
452*0Sstevel@tonic-gate if (msd->msd_iocpending != NULL) {
453*0Sstevel@tonic-gate /*
454*0Sstevel@tonic-gate * We were holding an "ioctl" response pending the
455*0Sstevel@tonic-gate * availability of an "mblk" to hold data to be passed up;
456*0Sstevel@tonic-gate * another "ioctl" came through, which means that "ioctl"
457*0Sstevel@tonic-gate * must have timed out or been aborted.
458*0Sstevel@tonic-gate */
459*0Sstevel@tonic-gate freemsg(msd->msd_iocpending);
460*0Sstevel@tonic-gate msd->msd_iocpending = NULL;
461*0Sstevel@tonic-gate }
462*0Sstevel@tonic-gate ms = &msd->msd_softc;
463*0Sstevel@tonic-gate /* Free mouse buffer */
464*0Sstevel@tonic-gate if (ms->ms_buf != NULL)
465*0Sstevel@tonic-gate kmem_free(ms->ms_buf, (uint_t)ms->ms_bufbytes);
466*0Sstevel@tonic-gate /* Free msdata structure */
467*0Sstevel@tonic-gate kmem_free((void *)msd, sizeof (*msd));
468*0Sstevel@tonic-gate return (0);
469*0Sstevel@tonic-gate }
470*0Sstevel@tonic-gate
471*0Sstevel@tonic-gate /*
472*0Sstevel@tonic-gate * Read queue service routine.
473*0Sstevel@tonic-gate * Turn buffered mouse events into stream messages.
474*0Sstevel@tonic-gate */
475*0Sstevel@tonic-gate static void
msrserv(q)476*0Sstevel@tonic-gate msrserv(q)
477*0Sstevel@tonic-gate register queue_t *q;
478*0Sstevel@tonic-gate {
479*0Sstevel@tonic-gate struct msdata *msd = (struct msdata *)q->q_ptr;
480*0Sstevel@tonic-gate register struct ms_softc *ms;
481*0Sstevel@tonic-gate register struct mousebuf *b;
482*0Sstevel@tonic-gate register struct mouseinfo *mi;
483*0Sstevel@tonic-gate register int button_number;
484*0Sstevel@tonic-gate register int hwbit;
485*0Sstevel@tonic-gate mblk_t *bp;
486*0Sstevel@tonic-gate
487*0Sstevel@tonic-gate /*
488*0Sstevel@tonic-gate * Handle the case of a queue which is backenabled before
489*0Sstevel@tonic-gate * initialization is complete.
490*0Sstevel@tonic-gate */
491*0Sstevel@tonic-gate if (!(msd->msd_flags & MS_OPEN)) {
492*0Sstevel@tonic-gate return;
493*0Sstevel@tonic-gate }
494*0Sstevel@tonic-gate
495*0Sstevel@tonic-gate ms = &msd->msd_softc;
496*0Sstevel@tonic-gate b = ms->ms_buf;
497*0Sstevel@tonic-gate if (msd->msd_rcnt_baud_chng && ms->ms_oldoff != b->mb_off) {
498*0Sstevel@tonic-gate int no_pkt = b->mb_off - ms->ms_oldoff;
499*0Sstevel@tonic-gate int i;
500*0Sstevel@tonic-gate no_pkt = no_pkt > 0 ? no_pkt : (b->mb_size - no_pkt);
501*0Sstevel@tonic-gate if (no_pkt < msd->msd_hold_baud_stup) {
502*0Sstevel@tonic-gate msd->msd_qenable_more = 1;
503*0Sstevel@tonic-gate return;
504*0Sstevel@tonic-gate } else {
505*0Sstevel@tonic-gate /*
506*0Sstevel@tonic-gate * throw away packets in beginning (mostly garbage)
507*0Sstevel@tonic-gate */
508*0Sstevel@tonic-gate for (i = 0; i < msd->msd_hold_baud_stup; i++) {
509*0Sstevel@tonic-gate ms->ms_oldoff++; /* next event */
510*0Sstevel@tonic-gate /* circular buffer wraparound */
511*0Sstevel@tonic-gate if (ms->ms_oldoff >= b->mb_size)
512*0Sstevel@tonic-gate ms->ms_oldoff = 0;
513*0Sstevel@tonic-gate }
514*0Sstevel@tonic-gate msd->msd_rcnt_baud_chng = 0;
515*0Sstevel@tonic-gate msd->msd_data_pkt_cnt = 0;
516*0Sstevel@tonic-gate msd->msd_qenable_more = 0;
517*0Sstevel@tonic-gate }
518*0Sstevel@tonic-gate }
519*0Sstevel@tonic-gate while (canputnext(q) && ms->ms_oldoff != b->mb_off) {
520*0Sstevel@tonic-gate mi = &b->mb_info[ms->ms_oldoff];
521*0Sstevel@tonic-gate switch (ms->ms_readformat) {
522*0Sstevel@tonic-gate
523*0Sstevel@tonic-gate case MS_3BYTE_FORMAT: {
524*0Sstevel@tonic-gate register char *cp;
525*0Sstevel@tonic-gate
526*0Sstevel@tonic-gate if ((bp = allocb(3, BPRI_HI)) != NULL) {
527*0Sstevel@tonic-gate cp = (char *)bp->b_wptr;
528*0Sstevel@tonic-gate
529*0Sstevel@tonic-gate *cp++ = 0x80 | mi->mi_buttons;
530*0Sstevel@tonic-gate /* Update read buttons */
531*0Sstevel@tonic-gate ms->ms_prevbuttons = mi->mi_buttons;
532*0Sstevel@tonic-gate
533*0Sstevel@tonic-gate *cp++ = mi->mi_x;
534*0Sstevel@tonic-gate *cp++ = -mi->mi_y;
535*0Sstevel@tonic-gate /* lower pri to avoid mouse droppings */
536*0Sstevel@tonic-gate bp->b_wptr = (uchar_t *)cp;
537*0Sstevel@tonic-gate putnext(q, bp);
538*0Sstevel@tonic-gate } else {
539*0Sstevel@tonic-gate if (msd->msd_resched_id)
540*0Sstevel@tonic-gate qunbufcall(q, msd->msd_resched_id);
541*0Sstevel@tonic-gate msd->msd_resched_id = qbufcall(q, 3, BPRI_HI,
542*0Sstevel@tonic-gate msresched, msd);
543*0Sstevel@tonic-gate if (msd->msd_resched_id == 0)
544*0Sstevel@tonic-gate return; /* try again later */
545*0Sstevel@tonic-gate /* bufcall failed; just pitch this event */
546*0Sstevel@tonic-gate /* or maybe flush queue? */
547*0Sstevel@tonic-gate }
548*0Sstevel@tonic-gate ms->ms_oldoff++; /* next event */
549*0Sstevel@tonic-gate
550*0Sstevel@tonic-gate /* circular buffer wraparound */
551*0Sstevel@tonic-gate if (ms->ms_oldoff >= b->mb_size)
552*0Sstevel@tonic-gate ms->ms_oldoff = 0;
553*0Sstevel@tonic-gate break;
554*0Sstevel@tonic-gate }
555*0Sstevel@tonic-gate
556*0Sstevel@tonic-gate case MS_VUID_FORMAT: {
557*0Sstevel@tonic-gate register Firm_event *fep;
558*0Sstevel@tonic-gate
559*0Sstevel@tonic-gate bp = NULL;
560*0Sstevel@tonic-gate switch (ms->ms_eventstate) {
561*0Sstevel@tonic-gate
562*0Sstevel@tonic-gate case EVENT_BUT3:
563*0Sstevel@tonic-gate case EVENT_BUT2:
564*0Sstevel@tonic-gate case EVENT_BUT1:
565*0Sstevel@tonic-gate /* Test the button. Send an event if it changed. */
566*0Sstevel@tonic-gate button_number = ms->ms_eventstate - EVENT_BUT1;
567*0Sstevel@tonic-gate hwbit = MS_HW_BUT1 >> button_number;
568*0Sstevel@tonic-gate if ((ms->ms_prevbuttons & hwbit) !=
569*0Sstevel@tonic-gate (mi->mi_buttons & hwbit)) {
570*0Sstevel@tonic-gate if ((bp = allocb(sizeof (Firm_event),
571*0Sstevel@tonic-gate BPRI_HI)) != NULL) {
572*0Sstevel@tonic-gate fep = (Firm_event *)bp->b_wptr;
573*0Sstevel@tonic-gate fep->id = vuid_id_addr(ms->ms_vuidaddr) |
574*0Sstevel@tonic-gate vuid_id_offset(BUT(1) + button_number);
575*0Sstevel@tonic-gate fep->pair_type = FE_PAIR_NONE;
576*0Sstevel@tonic-gate fep->pair = 0;
577*0Sstevel@tonic-gate /* Update read buttons and set value */
578*0Sstevel@tonic-gate if (mi->mi_buttons & hwbit) {
579*0Sstevel@tonic-gate fep->value = 0;
580*0Sstevel@tonic-gate ms->ms_prevbuttons |= hwbit;
581*0Sstevel@tonic-gate } else {
582*0Sstevel@tonic-gate fep->value = 1;
583*0Sstevel@tonic-gate ms->ms_prevbuttons &= ~hwbit;
584*0Sstevel@tonic-gate }
585*0Sstevel@tonic-gate fep->time = mi->mi_time;
586*0Sstevel@tonic-gate
587*0Sstevel@tonic-gate } else {
588*0Sstevel@tonic-gate if (msd->msd_resched_id)
589*0Sstevel@tonic-gate qunbufcall(q, msd->msd_resched_id);
590*0Sstevel@tonic-gate msd->msd_resched_id = qbufcall(q,
591*0Sstevel@tonic-gate sizeof (Firm_event),
592*0Sstevel@tonic-gate BPRI_HI, msresched, msd);
593*0Sstevel@tonic-gate if (msd->msd_resched_id == 0)
594*0Sstevel@tonic-gate return; /* try again later */
595*0Sstevel@tonic-gate /* bufcall failed; just pitch this event */
596*0Sstevel@tonic-gate /* or maybe flush queue? */
597*0Sstevel@tonic-gate ms->ms_eventstate = EVENT_X;
598*0Sstevel@tonic-gate }
599*0Sstevel@tonic-gate }
600*0Sstevel@tonic-gate break;
601*0Sstevel@tonic-gate
602*0Sstevel@tonic-gate case EVENT_Y:
603*0Sstevel@tonic-gate /* Send y if changed. */
604*0Sstevel@tonic-gate if (mi->mi_y != 0) {
605*0Sstevel@tonic-gate
606*0Sstevel@tonic-gate if ((bp = allocb(sizeof (Firm_event),
607*0Sstevel@tonic-gate BPRI_HI)) != NULL) {
608*0Sstevel@tonic-gate fep = (Firm_event *)bp->b_wptr;
609*0Sstevel@tonic-gate fep->id = vuid_id_addr(ms->ms_vuidaddr) |
610*0Sstevel@tonic-gate vuid_id_offset(LOC_Y_DELTA);
611*0Sstevel@tonic-gate fep->pair_type = FE_PAIR_ABSOLUTE;
612*0Sstevel@tonic-gate fep->pair = (uchar_t)LOC_Y_ABSOLUTE;
613*0Sstevel@tonic-gate fep->value = -mi->mi_y;
614*0Sstevel@tonic-gate fep->time = mi->mi_time;
615*0Sstevel@tonic-gate } else {
616*0Sstevel@tonic-gate if (msd->msd_resched_id)
617*0Sstevel@tonic-gate qunbufcall(q, msd->msd_resched_id);
618*0Sstevel@tonic-gate msd->msd_resched_id = qbufcall(q,
619*0Sstevel@tonic-gate sizeof (Firm_event),
620*0Sstevel@tonic-gate BPRI_HI, msresched, msd);
621*0Sstevel@tonic-gate if (msd->msd_resched_id == 0)
622*0Sstevel@tonic-gate return; /* try again later */
623*0Sstevel@tonic-gate /* bufcall failed; just pitch this event */
624*0Sstevel@tonic-gate /* or maybe flush queue? */
625*0Sstevel@tonic-gate ms->ms_eventstate = EVENT_X;
626*0Sstevel@tonic-gate }
627*0Sstevel@tonic-gate }
628*0Sstevel@tonic-gate break;
629*0Sstevel@tonic-gate
630*0Sstevel@tonic-gate case EVENT_X:
631*0Sstevel@tonic-gate /* Send x if changed. */
632*0Sstevel@tonic-gate if (mi->mi_x != 0) {
633*0Sstevel@tonic-gate if ((bp = allocb(sizeof (Firm_event),
634*0Sstevel@tonic-gate BPRI_HI)) != NULL) {
635*0Sstevel@tonic-gate fep = (Firm_event *)bp->b_wptr;
636*0Sstevel@tonic-gate fep->id = vuid_id_addr(ms->ms_vuidaddr) |
637*0Sstevel@tonic-gate vuid_id_offset(LOC_X_DELTA);
638*0Sstevel@tonic-gate fep->pair_type = FE_PAIR_ABSOLUTE;
639*0Sstevel@tonic-gate fep->pair = (uchar_t)LOC_X_ABSOLUTE;
640*0Sstevel@tonic-gate fep->value = mi->mi_x;
641*0Sstevel@tonic-gate fep->time = mi->mi_time;
642*0Sstevel@tonic-gate } else {
643*0Sstevel@tonic-gate if (msd->msd_resched_id)
644*0Sstevel@tonic-gate qunbufcall(q, msd->msd_resched_id);
645*0Sstevel@tonic-gate msd->msd_resched_id = qbufcall(q,
646*0Sstevel@tonic-gate sizeof (Firm_event),
647*0Sstevel@tonic-gate BPRI_HI, msresched, msd);
648*0Sstevel@tonic-gate if (msd->msd_resched_id == 0)
649*0Sstevel@tonic-gate return; /* try again later */
650*0Sstevel@tonic-gate /* bufcall failed; just pitch this event */
651*0Sstevel@tonic-gate /* or maybe flush queue? */
652*0Sstevel@tonic-gate ms->ms_eventstate = EVENT_X;
653*0Sstevel@tonic-gate }
654*0Sstevel@tonic-gate }
655*0Sstevel@tonic-gate break;
656*0Sstevel@tonic-gate
657*0Sstevel@tonic-gate }
658*0Sstevel@tonic-gate if (bp != NULL) {
659*0Sstevel@tonic-gate /* lower pri to avoid mouse droppings */
660*0Sstevel@tonic-gate bp->b_wptr += sizeof (Firm_event);
661*0Sstevel@tonic-gate putnext(q, bp);
662*0Sstevel@tonic-gate }
663*0Sstevel@tonic-gate if (ms->ms_eventstate == EVENT_X) {
664*0Sstevel@tonic-gate ms->ms_eventstate = EVENT_BUT3;
665*0Sstevel@tonic-gate ms->ms_oldoff++; /* next event */
666*0Sstevel@tonic-gate
667*0Sstevel@tonic-gate /* circular buffer wraparound */
668*0Sstevel@tonic-gate if (ms->ms_oldoff >= b->mb_size)
669*0Sstevel@tonic-gate ms->ms_oldoff = 0;
670*0Sstevel@tonic-gate } else
671*0Sstevel@tonic-gate ms->ms_eventstate--;
672*0Sstevel@tonic-gate }
673*0Sstevel@tonic-gate }
674*0Sstevel@tonic-gate }
675*0Sstevel@tonic-gate }
676*0Sstevel@tonic-gate
677*0Sstevel@tonic-gate static void
msresched(void * msdptr)678*0Sstevel@tonic-gate msresched(void *msdptr)
679*0Sstevel@tonic-gate {
680*0Sstevel@tonic-gate queue_t *q;
681*0Sstevel@tonic-gate struct msdata *msd = msdptr;
682*0Sstevel@tonic-gate
683*0Sstevel@tonic-gate msd->msd_resched_id = 0;
684*0Sstevel@tonic-gate if ((q = msd->msd_readq) != 0)
685*0Sstevel@tonic-gate qenable(q); /* run the service procedure */
686*0Sstevel@tonic-gate }
687*0Sstevel@tonic-gate
688*0Sstevel@tonic-gate /*
689*0Sstevel@tonic-gate * Line discipline output queue put procedure: handles M_IOCTL
690*0Sstevel@tonic-gate * messages.
691*0Sstevel@tonic-gate */
692*0Sstevel@tonic-gate static void
mswput(q,mp)693*0Sstevel@tonic-gate mswput(q, mp)
694*0Sstevel@tonic-gate register queue_t *q;
695*0Sstevel@tonic-gate register mblk_t *mp;
696*0Sstevel@tonic-gate {
697*0Sstevel@tonic-gate
698*0Sstevel@tonic-gate /*
699*0Sstevel@tonic-gate * Process M_FLUSH, and some M_IOCTL, messages here; pass
700*0Sstevel@tonic-gate * everything else down.
701*0Sstevel@tonic-gate */
702*0Sstevel@tonic-gate switch (mp->b_datap->db_type) {
703*0Sstevel@tonic-gate
704*0Sstevel@tonic-gate case M_FLUSH:
705*0Sstevel@tonic-gate if (*mp->b_rptr & FLUSHW)
706*0Sstevel@tonic-gate flushq(q, FLUSHDATA);
707*0Sstevel@tonic-gate if (*mp->b_rptr & FLUSHR)
708*0Sstevel@tonic-gate flushq(RD(q), FLUSHDATA);
709*0Sstevel@tonic-gate
710*0Sstevel@tonic-gate default:
711*0Sstevel@tonic-gate putnext(q, mp); /* pass it down the line */
712*0Sstevel@tonic-gate break;
713*0Sstevel@tonic-gate
714*0Sstevel@tonic-gate case M_IOCTL:
715*0Sstevel@tonic-gate msioctl(q, mp);
716*0Sstevel@tonic-gate break;
717*0Sstevel@tonic-gate }
718*0Sstevel@tonic-gate }
719*0Sstevel@tonic-gate
720*0Sstevel@tonic-gate static void
msreioctl(void * msdptr)721*0Sstevel@tonic-gate msreioctl(void *msdptr)
722*0Sstevel@tonic-gate {
723*0Sstevel@tonic-gate struct msdata *msd = msdptr;
724*0Sstevel@tonic-gate queue_t *q;
725*0Sstevel@tonic-gate mblk_t *mp;
726*0Sstevel@tonic-gate
727*0Sstevel@tonic-gate msd->msd_reioctl_id = 0;
728*0Sstevel@tonic-gate q = msd->msd_readq;
729*0Sstevel@tonic-gate if ((mp = msd->msd_iocpending) != NULL) {
730*0Sstevel@tonic-gate msd->msd_iocpending = NULL; /* not pending any more */
731*0Sstevel@tonic-gate msioctl(WR(q), mp);
732*0Sstevel@tonic-gate }
733*0Sstevel@tonic-gate }
734*0Sstevel@tonic-gate
735*0Sstevel@tonic-gate static void
msioctl(q,mp)736*0Sstevel@tonic-gate msioctl(q, mp)
737*0Sstevel@tonic-gate register queue_t *q;
738*0Sstevel@tonic-gate register mblk_t *mp;
739*0Sstevel@tonic-gate {
740*0Sstevel@tonic-gate struct msdata *msd;
741*0Sstevel@tonic-gate register struct ms_softc *ms;
742*0Sstevel@tonic-gate register struct iocblk *iocp;
743*0Sstevel@tonic-gate Vuid_addr_probe *addr_probe;
744*0Sstevel@tonic-gate uint_t ioctlrespsize;
745*0Sstevel@tonic-gate int err = 0;
746*0Sstevel@tonic-gate mblk_t *datap;
747*0Sstevel@tonic-gate
748*0Sstevel@tonic-gate msd = (struct msdata *)q->q_ptr;
749*0Sstevel@tonic-gate if (msd == NULL) {
750*0Sstevel@tonic-gate err = EINVAL;
751*0Sstevel@tonic-gate goto out;
752*0Sstevel@tonic-gate }
753*0Sstevel@tonic-gate ms = &msd->msd_softc;
754*0Sstevel@tonic-gate
755*0Sstevel@tonic-gate iocp = (struct iocblk *)mp->b_rptr;
756*0Sstevel@tonic-gate
757*0Sstevel@tonic-gate if (MS_DEBUG)
758*0Sstevel@tonic-gate printf("mswput(M_IOCTL,%x)\n", iocp->ioc_cmd);
759*0Sstevel@tonic-gate
760*0Sstevel@tonic-gate switch (iocp->ioc_cmd) {
761*0Sstevel@tonic-gate case VUIDSFORMAT:
762*0Sstevel@tonic-gate err = miocpullup(mp, sizeof (int));
763*0Sstevel@tonic-gate if (err != 0)
764*0Sstevel@tonic-gate break;
765*0Sstevel@tonic-gate if (*(int *)mp->b_cont->b_rptr == ms->ms_readformat)
766*0Sstevel@tonic-gate break;
767*0Sstevel@tonic-gate ms->ms_readformat = *(int *)mp->b_cont->b_rptr;
768*0Sstevel@tonic-gate /*
769*0Sstevel@tonic-gate * Flush mouse buffer because the messages upstream of us
770*0Sstevel@tonic-gate * are in the old format.
771*0Sstevel@tonic-gate */
772*0Sstevel@tonic-gate msflush(msd);
773*0Sstevel@tonic-gate break;
774*0Sstevel@tonic-gate
775*0Sstevel@tonic-gate case VUIDGFORMAT:
776*0Sstevel@tonic-gate if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
777*0Sstevel@tonic-gate ioctlrespsize = sizeof (int);
778*0Sstevel@tonic-gate goto allocfailure;
779*0Sstevel@tonic-gate }
780*0Sstevel@tonic-gate *(int *)datap->b_wptr = ms->ms_readformat;
781*0Sstevel@tonic-gate datap->b_wptr += sizeof (int);
782*0Sstevel@tonic-gate if (mp->b_cont != NULL)
783*0Sstevel@tonic-gate freemsg(mp->b_cont);
784*0Sstevel@tonic-gate mp->b_cont = datap;
785*0Sstevel@tonic-gate iocp->ioc_count = sizeof (int);
786*0Sstevel@tonic-gate break;
787*0Sstevel@tonic-gate
788*0Sstevel@tonic-gate case VUIDSADDR:
789*0Sstevel@tonic-gate case VUIDGADDR:
790*0Sstevel@tonic-gate err = miocpullup(mp, sizeof (Vuid_addr_probe));
791*0Sstevel@tonic-gate if (err != 0)
792*0Sstevel@tonic-gate break;
793*0Sstevel@tonic-gate addr_probe = (Vuid_addr_probe *)mp->b_cont->b_rptr;
794*0Sstevel@tonic-gate if (addr_probe->base != VKEY_FIRST) {
795*0Sstevel@tonic-gate err = ENODEV;
796*0Sstevel@tonic-gate break;
797*0Sstevel@tonic-gate }
798*0Sstevel@tonic-gate if (iocp->ioc_cmd == VUIDSADDR)
799*0Sstevel@tonic-gate ms->ms_vuidaddr = addr_probe->data.next;
800*0Sstevel@tonic-gate else
801*0Sstevel@tonic-gate addr_probe->data.current = ms->ms_vuidaddr;
802*0Sstevel@tonic-gate break;
803*0Sstevel@tonic-gate
804*0Sstevel@tonic-gate case MSIOGETPARMS:
805*0Sstevel@tonic-gate if (MS_DEBUG)
806*0Sstevel@tonic-gate printf("ms_getparms\n");
807*0Sstevel@tonic-gate
808*0Sstevel@tonic-gate if ((datap = allocb(sizeof (Ms_parms), BPRI_HI)) == NULL) {
809*0Sstevel@tonic-gate ioctlrespsize = sizeof (Ms_parms);
810*0Sstevel@tonic-gate goto allocfailure;
811*0Sstevel@tonic-gate }
812*0Sstevel@tonic-gate err = ms_getparms((Ms_parms *)datap->b_wptr);
813*0Sstevel@tonic-gate datap->b_wptr += sizeof (Ms_parms);
814*0Sstevel@tonic-gate if (mp->b_cont != NULL)
815*0Sstevel@tonic-gate freemsg(mp->b_cont);
816*0Sstevel@tonic-gate mp->b_cont = datap;
817*0Sstevel@tonic-gate iocp->ioc_count = sizeof (Ms_parms);
818*0Sstevel@tonic-gate break;
819*0Sstevel@tonic-gate
820*0Sstevel@tonic-gate case MSIOSETPARMS:
821*0Sstevel@tonic-gate if (MS_DEBUG)
822*0Sstevel@tonic-gate printf("ms_setparms\n");
823*0Sstevel@tonic-gate
824*0Sstevel@tonic-gate err = miocpullup(mp, sizeof (Ms_parms));
825*0Sstevel@tonic-gate if (err != 0)
826*0Sstevel@tonic-gate break;
827*0Sstevel@tonic-gate err = ms_setparms((Ms_parms *)mp->b_cont->b_rptr);
828*0Sstevel@tonic-gate break;
829*0Sstevel@tonic-gate
830*0Sstevel@tonic-gate default:
831*0Sstevel@tonic-gate putnext(q, mp); /* pass it down the line */
832*0Sstevel@tonic-gate return;
833*0Sstevel@tonic-gate }
834*0Sstevel@tonic-gate
835*0Sstevel@tonic-gate out:
836*0Sstevel@tonic-gate if (err != 0)
837*0Sstevel@tonic-gate miocnak(q, mp, 0, err);
838*0Sstevel@tonic-gate else {
839*0Sstevel@tonic-gate iocp->ioc_rval = 0;
840*0Sstevel@tonic-gate iocp->ioc_error = 0; /* brain rot */
841*0Sstevel@tonic-gate mp->b_datap->db_type = M_IOCACK;
842*0Sstevel@tonic-gate qreply(q, mp);
843*0Sstevel@tonic-gate }
844*0Sstevel@tonic-gate return;
845*0Sstevel@tonic-gate
846*0Sstevel@tonic-gate allocfailure:
847*0Sstevel@tonic-gate /*
848*0Sstevel@tonic-gate * We needed to allocate something to handle this "ioctl", but
849*0Sstevel@tonic-gate * couldn't; save this "ioctl" and arrange to get called back when
850*0Sstevel@tonic-gate * it's more likely that we can get what we need.
851*0Sstevel@tonic-gate * If there's already one being saved, throw it out, since it
852*0Sstevel@tonic-gate * must have timed out.
853*0Sstevel@tonic-gate */
854*0Sstevel@tonic-gate if (msd->msd_iocpending != NULL)
855*0Sstevel@tonic-gate freemsg(msd->msd_iocpending);
856*0Sstevel@tonic-gate msd->msd_iocpending = mp;
857*0Sstevel@tonic-gate if (msd->msd_reioctl_id)
858*0Sstevel@tonic-gate qunbufcall(q, msd->msd_reioctl_id);
859*0Sstevel@tonic-gate msd->msd_reioctl_id = qbufcall(q, ioctlrespsize, BPRI_HI,
860*0Sstevel@tonic-gate msreioctl, msd);
861*0Sstevel@tonic-gate }
862*0Sstevel@tonic-gate
863*0Sstevel@tonic-gate static int
ms_getparms(data)864*0Sstevel@tonic-gate ms_getparms(data)
865*0Sstevel@tonic-gate register Ms_parms *data;
866*0Sstevel@tonic-gate {
867*0Sstevel@tonic-gate data->jitter_thresh = ms_jitter_thresh;
868*0Sstevel@tonic-gate data->speed_law = ms_speedlaw;
869*0Sstevel@tonic-gate data->speed_limit = ms_speedlimit;
870*0Sstevel@tonic-gate return (0);
871*0Sstevel@tonic-gate }
872*0Sstevel@tonic-gate
873*0Sstevel@tonic-gate static int
ms_setparms(data)874*0Sstevel@tonic-gate ms_setparms(data)
875*0Sstevel@tonic-gate register Ms_parms *data;
876*0Sstevel@tonic-gate {
877*0Sstevel@tonic-gate ms_jitter_thresh = data->jitter_thresh;
878*0Sstevel@tonic-gate ms_speedlaw = data->speed_law;
879*0Sstevel@tonic-gate ms_speedlimit = data->speed_limit;
880*0Sstevel@tonic-gate return (0);
881*0Sstevel@tonic-gate }
882*0Sstevel@tonic-gate
883*0Sstevel@tonic-gate static void
msflush(msd)884*0Sstevel@tonic-gate msflush(msd)
885*0Sstevel@tonic-gate register struct msdata *msd;
886*0Sstevel@tonic-gate {
887*0Sstevel@tonic-gate register struct ms_softc *ms = &msd->msd_softc;
888*0Sstevel@tonic-gate register queue_t *q;
889*0Sstevel@tonic-gate
890*0Sstevel@tonic-gate ms->ms_oldoff = 0;
891*0Sstevel@tonic-gate ms->ms_eventstate = EVENT_BUT3;
892*0Sstevel@tonic-gate ms->ms_buf->mb_off = 0;
893*0Sstevel@tonic-gate ms->ms_prevbuttons = MS_HW_BUT1 | MS_HW_BUT2 | MS_HW_BUT3;
894*0Sstevel@tonic-gate msd->msd_oldbutt = ms->ms_prevbuttons;
895*0Sstevel@tonic-gate if ((q = msd->msd_readq) != NULL && q->q_next != NULL)
896*0Sstevel@tonic-gate (void) putnextctl1(q, M_FLUSH, FLUSHR);
897*0Sstevel@tonic-gate }
898*0Sstevel@tonic-gate
899*0Sstevel@tonic-gate
900*0Sstevel@tonic-gate /*
901*0Sstevel@tonic-gate * Mouse read queue put procedure.
902*0Sstevel@tonic-gate */
903*0Sstevel@tonic-gate static void
msrput(q,mp)904*0Sstevel@tonic-gate msrput(q, mp)
905*0Sstevel@tonic-gate register queue_t *q;
906*0Sstevel@tonic-gate register mblk_t *mp;
907*0Sstevel@tonic-gate {
908*0Sstevel@tonic-gate register struct msdata *msd = (struct msdata *)q->q_ptr;
909*0Sstevel@tonic-gate register mblk_t *bp;
910*0Sstevel@tonic-gate register char *readp;
911*0Sstevel@tonic-gate register mblk_t *imp;
912*0Sstevel@tonic-gate register mblk_t *datap;
913*0Sstevel@tonic-gate register struct iocblk *iocb;
914*0Sstevel@tonic-gate register struct termios *cb;
915*0Sstevel@tonic-gate struct iocblk *iocp;
916*0Sstevel@tonic-gate
917*0Sstevel@tonic-gate if (msd == 0)
918*0Sstevel@tonic-gate return;
919*0Sstevel@tonic-gate
920*0Sstevel@tonic-gate switch (mp->b_datap->db_type) {
921*0Sstevel@tonic-gate
922*0Sstevel@tonic-gate case M_FLUSH:
923*0Sstevel@tonic-gate if (*mp->b_rptr & FLUSHW)
924*0Sstevel@tonic-gate flushq(WR(q), FLUSHDATA);
925*0Sstevel@tonic-gate if (*mp->b_rptr & FLUSHR)
926*0Sstevel@tonic-gate flushq(q, FLUSHDATA);
927*0Sstevel@tonic-gate
928*0Sstevel@tonic-gate default:
929*0Sstevel@tonic-gate putnext(q, mp);
930*0Sstevel@tonic-gate return;
931*0Sstevel@tonic-gate
932*0Sstevel@tonic-gate case M_BREAK:
933*0Sstevel@tonic-gate if (msd->msd_flags & MS_IOCTOSS) {
934*0Sstevel@tonic-gate freemsg(mp);
935*0Sstevel@tonic-gate return;
936*0Sstevel@tonic-gate }
937*0Sstevel@tonic-gate
938*0Sstevel@tonic-gate if (msd->msd_rcnt_baud_chng && msd->msd_data_pkt_cnt == 0) {
939*0Sstevel@tonic-gate freemsg(mp);
940*0Sstevel@tonic-gate return;
941*0Sstevel@tonic-gate }
942*0Sstevel@tonic-gate
943*0Sstevel@tonic-gate /*
944*0Sstevel@tonic-gate * If we are sampling a 4800 baud mouse at 9600,
945*0Sstevel@tonic-gate * we want to wait for long time because there is no
946*0Sstevel@tonic-gate * fixed timeframe for receiving break. If we are sampling
947*0Sstevel@tonic-gate * a 1200 baud mouse at 4800 or 9600 baud rate then
948*0Sstevel@tonic-gate * it is guaranteed that break will be received very soon.
949*0Sstevel@tonic-gate */
950*0Sstevel@tonic-gate if (msd->msd_rcnt_baud_chng) {
951*0Sstevel@tonic-gate switch (msd->msd_baud_rate) {
952*0Sstevel@tonic-gate case B9600:
953*0Sstevel@tonic-gate msd->msd_hold_baud_stup = MS_HOLD_BAUD_STUP/2;
954*0Sstevel@tonic-gate msd->msd_baud_rate = B4800;
955*0Sstevel@tonic-gate break;
956*0Sstevel@tonic-gate
957*0Sstevel@tonic-gate case B4800:
958*0Sstevel@tonic-gate if (msd->msd_data_pkt_cnt <= MS_CNT_TOB1200) {
959*0Sstevel@tonic-gate msd->msd_hold_baud_stup =
960*0Sstevel@tonic-gate MS_HOLD_BAUD_STUP/6;
961*0Sstevel@tonic-gate msd->msd_baud_rate = B1200;
962*0Sstevel@tonic-gate } else {
963*0Sstevel@tonic-gate msd->msd_hold_baud_stup =
964*0Sstevel@tonic-gate MS_HOLD_BAUD_STUP;
965*0Sstevel@tonic-gate msd->msd_baud_rate = B9600;
966*0Sstevel@tonic-gate }
967*0Sstevel@tonic-gate break;
968*0Sstevel@tonic-gate
969*0Sstevel@tonic-gate case B1200:
970*0Sstevel@tonic-gate default:
971*0Sstevel@tonic-gate msd->msd_hold_baud_stup = MS_HOLD_BAUD_STUP;
972*0Sstevel@tonic-gate msd->msd_baud_rate = B9600;
973*0Sstevel@tonic-gate break;
974*0Sstevel@tonic-gate }
975*0Sstevel@tonic-gate } else {
976*0Sstevel@tonic-gate msd->msd_hold_baud_stup = MS_HOLD_BAUD_STUP;
977*0Sstevel@tonic-gate msd->msd_baud_rate = B9600;
978*0Sstevel@tonic-gate }
979*0Sstevel@tonic-gate
980*0Sstevel@tonic-gate /*
981*0Sstevel@tonic-gate * Change baud rate.
982*0Sstevel@tonic-gate */
983*0Sstevel@tonic-gate if ((imp = mkiocb(TCSETSF)) == NULL) {
984*0Sstevel@tonic-gate return;
985*0Sstevel@tonic-gate }
986*0Sstevel@tonic-gate if ((datap = allocb(sizeof (struct termios),
987*0Sstevel@tonic-gate BPRI_HI)) == NULL) {
988*0Sstevel@tonic-gate freemsg(imp);
989*0Sstevel@tonic-gate return;
990*0Sstevel@tonic-gate }
991*0Sstevel@tonic-gate
992*0Sstevel@tonic-gate iocb = (struct iocblk *)imp->b_rptr;
993*0Sstevel@tonic-gate iocb->ioc_count = sizeof (struct termios);
994*0Sstevel@tonic-gate
995*0Sstevel@tonic-gate cb = (struct termios *)datap->b_rptr;
996*0Sstevel@tonic-gate cb->c_iflag = 0;
997*0Sstevel@tonic-gate cb->c_oflag = 0;
998*0Sstevel@tonic-gate cb->c_cflag = CREAD|CS8|msd->msd_baud_rate;
999*0Sstevel@tonic-gate cb->c_lflag = 0;
1000*0Sstevel@tonic-gate bzero(cb->c_cc, NCCS);
1001*0Sstevel@tonic-gate
1002*0Sstevel@tonic-gate datap->b_wptr += sizeof (*cb);
1003*0Sstevel@tonic-gate datap->b_datap->db_type = M_DATA;
1004*0Sstevel@tonic-gate imp->b_cont = datap;
1005*0Sstevel@tonic-gate
1006*0Sstevel@tonic-gate msd->msd_flags |= MS_IOCTOSS|MS_IOCWAIT;
1007*0Sstevel@tonic-gate msd->msd_iocid = iocb->ioc_id;
1008*0Sstevel@tonic-gate msflush(msd);
1009*0Sstevel@tonic-gate flushq(q, FLUSHALL);
1010*0Sstevel@tonic-gate putnext(WR(q), imp);
1011*0Sstevel@tonic-gate freemsg(mp);
1012*0Sstevel@tonic-gate msd->msd_rcnt_baud_chng = 1;
1013*0Sstevel@tonic-gate msd->msd_data_pkt_cnt = 0;
1014*0Sstevel@tonic-gate if (MS_DEBUG)
1015*0Sstevel@tonic-gate printf("baud %x\n", msd->msd_baud_rate);
1016*0Sstevel@tonic-gate return;
1017*0Sstevel@tonic-gate
1018*0Sstevel@tonic-gate case M_IOCACK:
1019*0Sstevel@tonic-gate case M_IOCNAK:
1020*0Sstevel@tonic-gate /*
1021*0Sstevel@tonic-gate * If we are doing an "ioctl" ourselves, check if this
1022*0Sstevel@tonic-gate * is the reply to that code. If so, wake up the
1023*0Sstevel@tonic-gate * "open" routine, and toss the reply, otherwise just
1024*0Sstevel@tonic-gate * pass it up.
1025*0Sstevel@tonic-gate */
1026*0Sstevel@tonic-gate iocp = (struct iocblk *)mp->b_rptr;
1027*0Sstevel@tonic-gate if (!(msd->msd_flags & MS_IOCWAIT) ||
1028*0Sstevel@tonic-gate iocp->ioc_id != msd->msd_iocid) {
1029*0Sstevel@tonic-gate /*
1030*0Sstevel@tonic-gate * This isn't the reply we're looking for. Move along.
1031*0Sstevel@tonic-gate */
1032*0Sstevel@tonic-gate putnext(q, mp);
1033*0Sstevel@tonic-gate } else {
1034*0Sstevel@tonic-gate msd->msd_flags &= ~MS_IOCWAIT;
1035*0Sstevel@tonic-gate msd->msd_iocerror = iocp->ioc_error;
1036*0Sstevel@tonic-gate /*
1037*0Sstevel@tonic-gate * If we sent down a request to change the baud rate.
1038*0Sstevel@tonic-gate * This is the reply. Just ignore it.
1039*0Sstevel@tonic-gate */
1040*0Sstevel@tonic-gate if (msd->msd_flags & MS_IOCTOSS) {
1041*0Sstevel@tonic-gate msd->msd_flags &= ~MS_IOCTOSS;
1042*0Sstevel@tonic-gate msflush(msd);
1043*0Sstevel@tonic-gate flushq(q, FLUSHALL);
1044*0Sstevel@tonic-gate }
1045*0Sstevel@tonic-gate freemsg(mp);
1046*0Sstevel@tonic-gate }
1047*0Sstevel@tonic-gate return;
1048*0Sstevel@tonic-gate
1049*0Sstevel@tonic-gate case M_DATA:
1050*0Sstevel@tonic-gate if ((msd->msd_flags & MS_IOCTOSS) ||
1051*0Sstevel@tonic-gate !(msd->msd_flags & MS_OPEN)) {
1052*0Sstevel@tonic-gate freemsg(mp);
1053*0Sstevel@tonic-gate return;
1054*0Sstevel@tonic-gate }
1055*0Sstevel@tonic-gate break;
1056*0Sstevel@tonic-gate }
1057*0Sstevel@tonic-gate
1058*0Sstevel@tonic-gate /*
1059*0Sstevel@tonic-gate * A data message, consisting of bytes from the mouse.
1060*0Sstevel@tonic-gate * Hand each byte to our input routine.
1061*0Sstevel@tonic-gate */
1062*0Sstevel@tonic-gate bp = mp;
1063*0Sstevel@tonic-gate
1064*0Sstevel@tonic-gate do {
1065*0Sstevel@tonic-gate readp = (char *)bp->b_rptr;
1066*0Sstevel@tonic-gate while (readp < (char *)bp->b_wptr) {
1067*0Sstevel@tonic-gate if (msd->msd_rcnt_baud_chng)
1068*0Sstevel@tonic-gate msd->msd_data_pkt_cnt++;
1069*0Sstevel@tonic-gate msinput(msd, *readp++);
1070*0Sstevel@tonic-gate }
1071*0Sstevel@tonic-gate bp->b_rptr = (unsigned char *)readp;
1072*0Sstevel@tonic-gate } while ((bp = bp->b_cont) != NULL); /* next block, if any */
1073*0Sstevel@tonic-gate
1074*0Sstevel@tonic-gate freemsg(mp);
1075*0Sstevel@tonic-gate }
1076*0Sstevel@tonic-gate
1077*0Sstevel@tonic-gate /*
1078*0Sstevel@tonic-gate * Mouse input routine; process a byte received from a mouse and
1079*0Sstevel@tonic-gate * assemble into a mouseinfo message for the window system.
1080*0Sstevel@tonic-gate *
1081*0Sstevel@tonic-gate * The MSC mice send a five-byte packet organized as
1082*0Sstevel@tonic-gate * button, dx, dy, dx, dy
1083*0Sstevel@tonic-gate * where dx and dy can be any signed byte value. The mouseinfo message
1084*0Sstevel@tonic-gate * is organized as
1085*0Sstevel@tonic-gate * dx, dy, button, timestamp
1086*0Sstevel@tonic-gate * Our strategy is to add up the 2 dx and the 2 dy in the five-byte
1087*0Sstevel@tonic-gate * packet, then send the mouseinfo message up.
1088*0Sstevel@tonic-gate *
1089*0Sstevel@tonic-gate * Basic algorithm: throw away bytes until we get a [potential]
1090*0Sstevel@tonic-gate * button byte. Collect button; Collect dx1; Collect dy1; Collect dx2
1091*0Sstevel@tonic-gate * and add it to dx1; Collect dy2 and add it to dy1; Send button,
1092*0Sstevel@tonic-gate * dx, dy, timestamp.
1093*0Sstevel@tonic-gate *
1094*0Sstevel@tonic-gate * Watch out for overflow!
1095*0Sstevel@tonic-gate */
1096*0Sstevel@tonic-gate
1097*0Sstevel@tonic-gate static void
msinput(msd,c)1098*0Sstevel@tonic-gate msinput(msd, c)
1099*0Sstevel@tonic-gate register struct msdata *msd;
1100*0Sstevel@tonic-gate char c;
1101*0Sstevel@tonic-gate {
1102*0Sstevel@tonic-gate register struct ms_softc *ms;
1103*0Sstevel@tonic-gate register struct mousebuf *b;
1104*0Sstevel@tonic-gate register struct mouseinfo *mi;
1105*0Sstevel@tonic-gate register int jitter_radius;
1106*0Sstevel@tonic-gate register int temp;
1107*0Sstevel@tonic-gate
1108*0Sstevel@tonic-gate ms = &msd->msd_softc;
1109*0Sstevel@tonic-gate b = ms->ms_buf;
1110*0Sstevel@tonic-gate if (b == NULL)
1111*0Sstevel@tonic-gate return;
1112*0Sstevel@tonic-gate
1113*0Sstevel@tonic-gate mi = &b->mb_info[b->mb_off];
1114*0Sstevel@tonic-gate
1115*0Sstevel@tonic-gate switch (msd->msd_state) {
1116*0Sstevel@tonic-gate
1117*0Sstevel@tonic-gate case MS_WAIT_BUTN:
1118*0Sstevel@tonic-gate if ((c & 0xf8) != 0x80) {
1119*0Sstevel@tonic-gate if (MS_DEBUG)
1120*0Sstevel@tonic-gate printf("Mouse input char %x discarded\n",
1121*0Sstevel@tonic-gate (int)c & 0xff);
1122*0Sstevel@tonic-gate if (msd->msd_rcnt_baud_chng) {
1123*0Sstevel@tonic-gate msflush(msd);
1124*0Sstevel@tonic-gate flushq(msd->msd_readq, FLUSHALL);
1125*0Sstevel@tonic-gate msd->msd_hold_baud_stup++;
1126*0Sstevel@tonic-gate }
1127*0Sstevel@tonic-gate return;
1128*0Sstevel@tonic-gate }
1129*0Sstevel@tonic-gate
1130*0Sstevel@tonic-gate /*
1131*0Sstevel@tonic-gate * Probably a button byte.
1132*0Sstevel@tonic-gate * Lower 3 bits are left, middle, right.
1133*0Sstevel@tonic-gate */
1134*0Sstevel@tonic-gate mi->mi_buttons = c & (MS_HW_BUT1 | MS_HW_BUT2 | MS_HW_BUT3);
1135*0Sstevel@tonic-gate break;
1136*0Sstevel@tonic-gate
1137*0Sstevel@tonic-gate case MS_WAIT_X:
1138*0Sstevel@tonic-gate /*
1139*0Sstevel@tonic-gate * Delta X byte. Add the delta X from this sample to
1140*0Sstevel@tonic-gate * the delta X we're accumulating in the current event.
1141*0Sstevel@tonic-gate */
1142*0Sstevel@tonic-gate temp = (int)(mi->mi_x + c);
1143*0Sstevel@tonic-gate mi->mi_x = BYTECLIP(temp);
1144*0Sstevel@tonic-gate uniqtime32(&mi->mi_time); /* record time when sample arrived */
1145*0Sstevel@tonic-gate break;
1146*0Sstevel@tonic-gate
1147*0Sstevel@tonic-gate case MS_WAIT_Y:
1148*0Sstevel@tonic-gate /*
1149*0Sstevel@tonic-gate * Delta Y byte. Add the delta Y from this sample to
1150*0Sstevel@tonic-gate * the delta Y we're accumulating in the current event.
1151*0Sstevel@tonic-gate * (Subtract, actually, because the mouse reports
1152*0Sstevel@tonic-gate * increasing Y up the screen.)
1153*0Sstevel@tonic-gate */
1154*0Sstevel@tonic-gate temp = (int)(mi->mi_y - c);
1155*0Sstevel@tonic-gate mi->mi_y = BYTECLIP(temp);
1156*0Sstevel@tonic-gate break;
1157*0Sstevel@tonic-gate
1158*0Sstevel@tonic-gate case MS_WAIT_X2:
1159*0Sstevel@tonic-gate /*
1160*0Sstevel@tonic-gate * Second delta X byte.
1161*0Sstevel@tonic-gate */
1162*0Sstevel@tonic-gate temp = (int)(mi->mi_x + c);
1163*0Sstevel@tonic-gate mi->mi_x = BYTECLIP(temp);
1164*0Sstevel@tonic-gate uniqtime32(&mi->mi_time);
1165*0Sstevel@tonic-gate break;
1166*0Sstevel@tonic-gate
1167*0Sstevel@tonic-gate case MS_WAIT_Y2:
1168*0Sstevel@tonic-gate /*
1169*0Sstevel@tonic-gate * Second delta Y byte.
1170*0Sstevel@tonic-gate */
1171*0Sstevel@tonic-gate temp = (int)(mi->mi_y - c);
1172*0Sstevel@tonic-gate mi->mi_y = BYTECLIP(temp);
1173*0Sstevel@tonic-gate break;
1174*0Sstevel@tonic-gate
1175*0Sstevel@tonic-gate }
1176*0Sstevel@tonic-gate
1177*0Sstevel@tonic-gate /*
1178*0Sstevel@tonic-gate * Done yet?
1179*0Sstevel@tonic-gate */
1180*0Sstevel@tonic-gate if (msd->msd_state == MS_WAIT_Y2)
1181*0Sstevel@tonic-gate msd->msd_state = MS_WAIT_BUTN; /* BONG. Start again. */
1182*0Sstevel@tonic-gate else {
1183*0Sstevel@tonic-gate msd->msd_state += 1;
1184*0Sstevel@tonic-gate return;
1185*0Sstevel@tonic-gate }
1186*0Sstevel@tonic-gate
1187*0Sstevel@tonic-gate if (msd->msd_jitter) {
1188*0Sstevel@tonic-gate (void) quntimeout(msd->msd_readq, msd->msd_timeout_id);
1189*0Sstevel@tonic-gate msd->msd_jitter = 0;
1190*0Sstevel@tonic-gate }
1191*0Sstevel@tonic-gate
1192*0Sstevel@tonic-gate if (mi->mi_buttons == msd->msd_oldbutt) {
1193*0Sstevel@tonic-gate /*
1194*0Sstevel@tonic-gate * Buttons did not change; did position?
1195*0Sstevel@tonic-gate */
1196*0Sstevel@tonic-gate if (mi->mi_x == 0 && mi->mi_y == 0) {
1197*0Sstevel@tonic-gate /* no, position did not change - boring event */
1198*0Sstevel@tonic-gate return;
1199*0Sstevel@tonic-gate }
1200*0Sstevel@tonic-gate
1201*0Sstevel@tonic-gate /*
1202*0Sstevel@tonic-gate * Did the mouse move more than the jitter threshhold?
1203*0Sstevel@tonic-gate */
1204*0Sstevel@tonic-gate jitter_radius = ms_jitter_thresh;
1205*0Sstevel@tonic-gate if (ABS((int)mi->mi_x) <= jitter_radius &&
1206*0Sstevel@tonic-gate ABS((int)mi->mi_y) <= jitter_radius) {
1207*0Sstevel@tonic-gate /*
1208*0Sstevel@tonic-gate * Mouse moved less than the jitter threshhold.
1209*0Sstevel@tonic-gate * Don't indicate an event; keep accumulating motions.
1210*0Sstevel@tonic-gate * After "msjittertimeout" ticks expire, treat
1211*0Sstevel@tonic-gate * the accumulated delta as the real delta.
1212*0Sstevel@tonic-gate */
1213*0Sstevel@tonic-gate msd->msd_jitter = 1;
1214*0Sstevel@tonic-gate msd->msd_timeout_id = qtimeout(msd->msd_readq,
1215*0Sstevel@tonic-gate msincr, msd, msjittertimeout);
1216*0Sstevel@tonic-gate return;
1217*0Sstevel@tonic-gate }
1218*0Sstevel@tonic-gate }
1219*0Sstevel@tonic-gate msd->msd_oldbutt = mi->mi_buttons;
1220*0Sstevel@tonic-gate msincr(msd);
1221*0Sstevel@tonic-gate }
1222*0Sstevel@tonic-gate
1223*0Sstevel@tonic-gate /*
1224*0Sstevel@tonic-gate * Increment the mouse sample pointer.
1225*0Sstevel@tonic-gate * Called either immediately after a sample or after a jitter timeout.
1226*0Sstevel@tonic-gate */
1227*0Sstevel@tonic-gate static void
msincr(void * arg)1228*0Sstevel@tonic-gate msincr(void *arg)
1229*0Sstevel@tonic-gate {
1230*0Sstevel@tonic-gate struct msdata *msd = arg;
1231*0Sstevel@tonic-gate register struct ms_softc *ms = &msd->msd_softc;
1232*0Sstevel@tonic-gate register struct mousebuf *b;
1233*0Sstevel@tonic-gate register struct mouseinfo *mi;
1234*0Sstevel@tonic-gate char oldbutt;
1235*0Sstevel@tonic-gate register short xc, yc;
1236*0Sstevel@tonic-gate register int wake;
1237*0Sstevel@tonic-gate register int speedlimit = ms_speedlimit;
1238*0Sstevel@tonic-gate register int xabs, yabs;
1239*0Sstevel@tonic-gate
1240*0Sstevel@tonic-gate /*
1241*0Sstevel@tonic-gate * No longer waiting for jitter timeout
1242*0Sstevel@tonic-gate */
1243*0Sstevel@tonic-gate msd->msd_jitter = 0;
1244*0Sstevel@tonic-gate
1245*0Sstevel@tonic-gate b = ms->ms_buf;
1246*0Sstevel@tonic-gate if (b == NULL)
1247*0Sstevel@tonic-gate return;
1248*0Sstevel@tonic-gate mi = &b->mb_info[b->mb_off];
1249*0Sstevel@tonic-gate
1250*0Sstevel@tonic-gate if (ms_speedlaw) {
1251*0Sstevel@tonic-gate xabs = ABS((int)mi->mi_x);
1252*0Sstevel@tonic-gate yabs = ABS((int)mi->mi_y);
1253*0Sstevel@tonic-gate if (xabs > speedlimit || yabs > speedlimit)
1254*0Sstevel@tonic-gate ms_speed_count++;
1255*0Sstevel@tonic-gate if (xabs > speedlimit)
1256*0Sstevel@tonic-gate mi->mi_x = 0;
1257*0Sstevel@tonic-gate if (yabs > speedlimit)
1258*0Sstevel@tonic-gate mi->mi_y = 0;
1259*0Sstevel@tonic-gate }
1260*0Sstevel@tonic-gate
1261*0Sstevel@tonic-gate oldbutt = mi->mi_buttons;
1262*0Sstevel@tonic-gate
1263*0Sstevel@tonic-gate xc = yc = 0;
1264*0Sstevel@tonic-gate
1265*0Sstevel@tonic-gate /* See if we need to wake up anyone waiting for input */
1266*0Sstevel@tonic-gate wake = b->mb_off == ms->ms_oldoff;
1267*0Sstevel@tonic-gate
1268*0Sstevel@tonic-gate /* Adjust circular buffer pointer */
1269*0Sstevel@tonic-gate if (++b->mb_off >= b->mb_size) {
1270*0Sstevel@tonic-gate b->mb_off = 0;
1271*0Sstevel@tonic-gate mi = b->mb_info;
1272*0Sstevel@tonic-gate } else {
1273*0Sstevel@tonic-gate mi++;
1274*0Sstevel@tonic-gate }
1275*0Sstevel@tonic-gate
1276*0Sstevel@tonic-gate /*
1277*0Sstevel@tonic-gate * If over-took read index then flush buffer so that mouse state
1278*0Sstevel@tonic-gate * is consistent.
1279*0Sstevel@tonic-gate */
1280*0Sstevel@tonic-gate if (b->mb_off == ms->ms_oldoff) {
1281*0Sstevel@tonic-gate if (ms_overrun_msg)
1282*0Sstevel@tonic-gate cmn_err(CE_WARN,
1283*0Sstevel@tonic-gate "Mouse buffer flushed when overrun.\n");
1284*0Sstevel@tonic-gate msflush(msd);
1285*0Sstevel@tonic-gate ms_overrun_cnt++;
1286*0Sstevel@tonic-gate mi = b->mb_info;
1287*0Sstevel@tonic-gate }
1288*0Sstevel@tonic-gate
1289*0Sstevel@tonic-gate /* Remember current buttons and fractional part of x & y */
1290*0Sstevel@tonic-gate mi->mi_buttons = oldbutt;
1291*0Sstevel@tonic-gate mi->mi_x = (char)xc;
1292*0Sstevel@tonic-gate mi->mi_y = (char)yc;
1293*0Sstevel@tonic-gate if (wake || msd->msd_qenable_more)
1294*0Sstevel@tonic-gate qenable(msd->msd_readq); /* run the service procedure */
1295*0Sstevel@tonic-gate }
1296