root/usr/src/uts/common/io/vuidmice/vuidm3p.c
/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (the "License").
 * You may not use this file except in compliance with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

/*
 * 3-Byte Mouse Protocol
 */

#include <sys/param.h>
#include <sys/stream.h>
#include <sys/strsun.h>
#include <sys/vuid_event.h>
#include "vuidmice.h"

#define VUID_BUT(b)             BUT((b*2)+1)

/*
 * VUID_BUT(0)  BUT(1)          LEFT  BUTTON
 * VUID_BUT(1)  BUT(3)          RIGHT BUTTON
 */

#define MOUSE_BUTTON_L          (uchar_t)(0x20) /* Left button pressed  */
#define MOUSE_BUTTON_R          (uchar_t)(0x10) /* Right button pressed */

#define MOUSE_START_CODE        (uchar_t)(0x40) /* Start code in char   */

#define MOUSE_START             0               /* Beginning of packet  */
#define MOUSE_BUTTON            1               /* Got button status    */
#define MOUSE_DELTA_X           2               /* got delta X          */

extern void VUID_PUTNEXT(queue_t *const, uchar_t, uchar_t, uchar_t, int);

int
VUID_OPEN(queue_t *const qp)
{
        STATEP->nbuttons = 2;

        return (0);
}

static void
vuidm3p_sendButtonEvent(queue_t *const qp)
{
        int b;

        if ((STATEP->buttons == 0x30) && (!STATEP->oldbuttons)) {
                /*
                 * both buttons going down simultaneously means button
                 * two going down
                 */
                vuidm3p_putnext(qp, (uchar_t)MS_MIDDLE, FE_PAIR_NONE, 0, 1);
                return;
        } else if ((!STATEP->buttons) && (STATEP->oldbuttons == 0x30)) {
                /*
                 * both buttons going up simultaneously means button
                 * two going up
                 */
                vuidm3p_putnext(qp, (uchar_t)MS_MIDDLE, FE_PAIR_NONE, 0, 0);
                return;
        }

        /*
         * for each button, see if it has changed
         */
        for (b = 0; b < 2; b++) {
                uchar_t mask = 0x20 >> b;

                if ((STATEP->buttons & mask) != (STATEP->oldbuttons & mask))
                        VUID_PUTNEXT(qp, VUID_BUT(b), FE_PAIR_NONE, 0,
                            (STATEP->buttons & mask ? 1 : 0));
        }
}

void
vuidm3p(queue_t *const qp, mblk_t *mp)
{
        int r, code;
        uchar_t *bufp;

        bufp = mp->b_rptr;
        r = MBLKL(mp);

        for (r--; r >= 0; r--) {
                code = *bufp++;

                /* strip the high-order bit (mouse sends 7-bit data) */
                code &= 0x7f;

                switch (STATEP->state) {

                /*
                 * Start state. We stay here if the start code is not
                 * received thus forcing us back into sync. When we
                 * get a start code the button mask comes with it
                 * forcing us to the next state.
                 */

                default:
                case MOUSE_START:
start_code:
                        STATEP->deltax = STATEP->deltay = 0;

                        /* look for sync */
                        if ((code & MOUSE_START_CODE) == 0)
                                break;

                        STATEP->buttons = code & 0x30;

                        if (STATEP->buttons != STATEP->oldbuttons) {
                                vuidm3p_sendButtonEvent(qp);
                                /*
                                 * remember state
                                 */
                                STATEP->oldbuttons = STATEP->buttons;
                        }

                        /*
                         * bits 0 & 1 are bits 6 & 7 of X value
                         * (Sign extend them with the cast.)
                         */
                        STATEP->deltax = (signed char)((code & 0x03) << 6);

                        /*
                         * bits 2 & 3 are bits 6 & 7 of Y value
                         * (Sign extend them with the cast.)
                         */
                        STATEP->deltay = (signed char)((code & 0x0c) << 4);

                        /*
                         * go to the next state
                         */
                        STATEP->state = MOUSE_BUTTON;
                        break;

                        /*
                         * We receive the remaining 6 bits of delta x, forcing
                         * us to the next state. We just piece the value of
                         * delta x together.
                         */
                case MOUSE_BUTTON:
                        if (code & MOUSE_START_CODE) {
                                STATEP->state = MOUSE_START;
                                goto start_code;        /* restart */
                        }

                        STATEP->deltax |= code & 0x3f;
                        STATEP->state = MOUSE_DELTA_X;
                        break;

                        /*
                         * The last part of delta Y, and the packet
                         * *may be* complete
                         */
                case MOUSE_DELTA_X:
                        if (code & MOUSE_START_CODE) {
                                STATEP->state = MOUSE_START;
                                goto start_code;        /* restart */
                        }

                        STATEP->deltay |= code & 0x3f;

                        /*
                         * generate motion Event
                         */
                        if (STATEP->deltax)
                                VUID_PUTNEXT(qp, (uchar_t)LOC_X_DELTA,
                                    FE_PAIR_ABSOLUTE, (uchar_t)LOC_X_ABSOLUTE,
                                    STATEP->deltax);

                        if (STATEP->deltay)
                                VUID_PUTNEXT(qp, (uchar_t)LOC_Y_DELTA,
                                    FE_PAIR_ABSOLUTE, (uchar_t)LOC_Y_ABSOLUTE,
                                    -STATEP->deltay);

                        STATEP->deltax = STATEP->deltay = 0;
                        break;
                }
        }

        freemsg(mp);
}