| // SPDX-License-Identifier: GPL-2.0-only | 
| /* | 
|  * BYD TouchPad PS/2 mouse driver | 
|  * | 
|  * Copyright (C) 2015 Chris Diamand <chris@diamand.org> | 
|  * Copyright (C) 2015 Richard Pospesel | 
|  * Copyright (C) 2015 Tai Chi Minh Ralph Eastwood | 
|  * Copyright (C) 2015 Martin Wimpress | 
|  * Copyright (C) 2015 Jay Kuri | 
|  */ | 
|   | 
| #include <linux/delay.h> | 
| #include <linux/input.h> | 
| #include <linux/libps2.h> | 
| #include <linux/serio.h> | 
| #include <linux/slab.h> | 
|   | 
| #include "psmouse.h" | 
| #include "byd.h" | 
|   | 
| /* PS2 Bits */ | 
| #define PS2_Y_OVERFLOW    BIT_MASK(7) | 
| #define PS2_X_OVERFLOW    BIT_MASK(6) | 
| #define PS2_Y_SIGN    BIT_MASK(5) | 
| #define PS2_X_SIGN    BIT_MASK(4) | 
| #define PS2_ALWAYS_1    BIT_MASK(3) | 
| #define PS2_MIDDLE    BIT_MASK(2) | 
| #define PS2_RIGHT    BIT_MASK(1) | 
| #define PS2_LEFT    BIT_MASK(0) | 
|   | 
| /* | 
|  * BYD pad constants | 
|  */ | 
|   | 
| /* | 
|  * True device resolution is unknown, however experiments show the | 
|  * resolution is about 111 units/mm. | 
|  * Absolute coordinate packets are in the range 0-255 for both X and Y | 
|  * we pick ABS_X/ABS_Y dimensions which are multiples of 256 and in | 
|  * the right ballpark given the touchpad's physical dimensions and estimate | 
|  * resolution per spec sheet, device active area dimensions are | 
|  * 101.6 x 60.1 mm. | 
|  */ | 
| #define BYD_PAD_WIDTH        11264 | 
| #define BYD_PAD_HEIGHT        6656 | 
| #define BYD_PAD_RESOLUTION    111 | 
|   | 
| /* | 
|  * Given the above dimensions, relative packets velocity is in multiples of | 
|  * 1 unit / 11 milliseconds.  We use this dt to estimate distance traveled | 
|  */ | 
| #define BYD_DT            11 | 
| /* Time in jiffies used to timeout various touch events (64 ms) */ | 
| #define BYD_TOUCH_TIMEOUT    msecs_to_jiffies(64) | 
|   | 
| /* BYD commands reverse engineered from windows driver */ | 
|   | 
| /* | 
|  * Swipe gesture from off-pad to on-pad | 
|  *  0 : disable | 
|  *  1 : enable | 
|  */ | 
| #define BYD_CMD_SET_OFFSCREEN_SWIPE        0x10cc | 
| /* | 
|  * Tap and drag delay time | 
|  *  0 : disable | 
|  *  1 - 8 : least to most delay | 
|  */ | 
| #define BYD_CMD_SET_TAP_DRAG_DELAY_TIME        0x10cf | 
| /* | 
|  * Physical buttons function mapping | 
|  *  0 : enable | 
|  *  4 : normal | 
|  *  5 : left button custom command | 
|  *  6 : right button custom command | 
|  *  8 : disable | 
|  */ | 
| #define BYD_CMD_SET_PHYSICAL_BUTTONS        0x10d0 | 
| /* | 
|  * Absolute mode (1 byte X/Y resolution) | 
|  *  0 : disable | 
|  *  2 : enable | 
|  */ | 
| #define BYD_CMD_SET_ABSOLUTE_MODE        0x10d1 | 
| /* | 
|  * Two finger scrolling | 
|  *  1 : vertical | 
|  *  2 : horizontal | 
|  *  3 : vertical + horizontal | 
|  *  4 : disable | 
|  */ | 
| #define BYD_CMD_SET_TWO_FINGER_SCROLL        0x10d2 | 
| /* | 
|  * Handedness | 
|  *  1 : right handed | 
|  *  2 : left handed | 
|  */ | 
| #define BYD_CMD_SET_HANDEDNESS            0x10d3 | 
| /* | 
|  * Tap to click | 
|  *  1 : enable | 
|  *  2 : disable | 
|  */ | 
| #define BYD_CMD_SET_TAP                0x10d4 | 
| /* | 
|  * Tap and drag | 
|  *  1 : tap and hold to drag | 
|  *  2 : tap and hold to drag + lock | 
|  *  3 : disable | 
|  */ | 
| #define BYD_CMD_SET_TAP_DRAG            0x10d5 | 
| /* | 
|  * Touch sensitivity | 
|  *  1 - 7 : least to most sensitive | 
|  */ | 
| #define BYD_CMD_SET_TOUCH_SENSITIVITY        0x10d6 | 
| /* | 
|  * One finger scrolling | 
|  *  1 : vertical | 
|  *  2 : horizontal | 
|  *  3 : vertical + horizontal | 
|  *  4 : disable | 
|  */ | 
| #define BYD_CMD_SET_ONE_FINGER_SCROLL        0x10d7 | 
| /* | 
|  * One finger scrolling function | 
|  *  1 : free scrolling | 
|  *  2 : edge motion | 
|  *  3 : free scrolling + edge motion | 
|  *  4 : disable | 
|  */ | 
| #define BYD_CMD_SET_ONE_FINGER_SCROLL_FUNC    0x10d8 | 
| /* | 
|  * Sliding speed | 
|  *  1 - 5 : slowest to fastest | 
|  */ | 
| #define BYD_CMD_SET_SLIDING_SPEED        0x10da | 
| /* | 
|  * Edge motion | 
|  *  1 : disable | 
|  *  2 : enable when dragging | 
|  *  3 : enable when dragging and pointing | 
|  */ | 
| #define BYD_CMD_SET_EDGE_MOTION            0x10db | 
| /* | 
|  * Left edge region size | 
|  *  0 - 7 : smallest to largest width | 
|  */ | 
| #define BYD_CMD_SET_LEFT_EDGE_REGION        0x10dc | 
| /* | 
|  * Top edge region size | 
|  *  0 - 9 : smallest to largest height | 
|  */ | 
| #define BYD_CMD_SET_TOP_EDGE_REGION        0x10dd | 
| /* | 
|  * Disregard palm press as clicks | 
|  *  1 - 6 : smallest to largest | 
|  */ | 
| #define BYD_CMD_SET_PALM_CHECK            0x10de | 
| /* | 
|  * Right edge region size | 
|  *  0 - 7 : smallest to largest width | 
|  */ | 
| #define BYD_CMD_SET_RIGHT_EDGE_REGION        0x10df | 
| /* | 
|  * Bottom edge region size | 
|  *  0 - 9 : smallest to largest height | 
|  */ | 
| #define BYD_CMD_SET_BOTTOM_EDGE_REGION        0x10e1 | 
| /* | 
|  * Multitouch gestures | 
|  *  1 : enable | 
|  *  2 : disable | 
|  */ | 
| #define BYD_CMD_SET_MULTITOUCH            0x10e3 | 
| /* | 
|  * Edge motion speed | 
|  *  0 : control with finger pressure | 
|  *  1 - 9 : slowest to fastest | 
|  */ | 
| #define BYD_CMD_SET_EDGE_MOTION_SPEED        0x10e4 | 
| /* | 
|  * Two finger scolling function | 
|  *  0 : free scrolling | 
|  *  1 : free scrolling (with momentum) | 
|  *  2 : edge motion | 
|  *  3 : free scrolling (with momentum) + edge motion | 
|  *  4 : disable | 
|  */ | 
| #define BYD_CMD_SET_TWO_FINGER_SCROLL_FUNC    0x10e5 | 
|   | 
| /* | 
|  * The touchpad generates a mixture of absolute and relative packets, indicated | 
|  * by the the last byte of each packet being set to one of the following: | 
|  */ | 
| #define BYD_PACKET_ABSOLUTE            0xf8 | 
| #define BYD_PACKET_RELATIVE            0x00 | 
| /* Multitouch gesture packets */ | 
| #define BYD_PACKET_PINCH_IN            0xd8 | 
| #define BYD_PACKET_PINCH_OUT            0x28 | 
| #define BYD_PACKET_ROTATE_CLOCKWISE        0x29 | 
| #define BYD_PACKET_ROTATE_ANTICLOCKWISE        0xd7 | 
| #define BYD_PACKET_TWO_FINGER_SCROLL_RIGHT    0x2a | 
| #define BYD_PACKET_TWO_FINGER_SCROLL_DOWN    0x2b | 
| #define BYD_PACKET_TWO_FINGER_SCROLL_UP        0xd5 | 
| #define BYD_PACKET_TWO_FINGER_SCROLL_LEFT    0xd6 | 
| #define BYD_PACKET_THREE_FINGER_SWIPE_RIGHT    0x2c | 
| #define BYD_PACKET_THREE_FINGER_SWIPE_DOWN    0x2d | 
| #define BYD_PACKET_THREE_FINGER_SWIPE_UP    0xd3 | 
| #define BYD_PACKET_THREE_FINGER_SWIPE_LEFT    0xd4 | 
| #define BYD_PACKET_FOUR_FINGER_DOWN        0x33 | 
| #define BYD_PACKET_FOUR_FINGER_UP        0xcd | 
| #define BYD_PACKET_REGION_SCROLL_RIGHT        0x35 | 
| #define BYD_PACKET_REGION_SCROLL_DOWN        0x36 | 
| #define BYD_PACKET_REGION_SCROLL_UP        0xca | 
| #define BYD_PACKET_REGION_SCROLL_LEFT        0xcb | 
| #define BYD_PACKET_RIGHT_CORNER_CLICK        0xd2 | 
| #define BYD_PACKET_LEFT_CORNER_CLICK        0x2e | 
| #define BYD_PACKET_LEFT_AND_RIGHT_CORNER_CLICK    0x2f | 
| #define BYD_PACKET_ONTO_PAD_SWIPE_RIGHT        0x37 | 
| #define BYD_PACKET_ONTO_PAD_SWIPE_DOWN        0x30 | 
| #define BYD_PACKET_ONTO_PAD_SWIPE_UP        0xd0 | 
| #define BYD_PACKET_ONTO_PAD_SWIPE_LEFT        0xc9 | 
|   | 
| struct byd_data { | 
|     struct timer_list timer; | 
|     struct psmouse *psmouse; | 
|     s32 abs_x; | 
|     s32 abs_y; | 
|     typeof(jiffies) last_touch_time; | 
|     bool btn_left; | 
|     bool btn_right; | 
|     bool touch; | 
| }; | 
|   | 
| static void byd_report_input(struct psmouse *psmouse) | 
| { | 
|     struct byd_data *priv = psmouse->private; | 
|     struct input_dev *dev = psmouse->dev; | 
|   | 
|     input_report_key(dev, BTN_TOUCH, priv->touch); | 
|     input_report_key(dev, BTN_TOOL_FINGER, priv->touch); | 
|   | 
|     input_report_abs(dev, ABS_X, priv->abs_x); | 
|     input_report_abs(dev, ABS_Y, priv->abs_y); | 
|     input_report_key(dev, BTN_LEFT, priv->btn_left); | 
|     input_report_key(dev, BTN_RIGHT, priv->btn_right); | 
|   | 
|     input_sync(dev); | 
| } | 
|   | 
| static void byd_clear_touch(struct timer_list *t) | 
| { | 
|     struct byd_data *priv = from_timer(priv, t, timer); | 
|     struct psmouse *psmouse = priv->psmouse; | 
|   | 
|     serio_pause_rx(psmouse->ps2dev.serio); | 
|     priv->touch = false; | 
|   | 
|     byd_report_input(psmouse); | 
|   | 
|     serio_continue_rx(psmouse->ps2dev.serio); | 
|   | 
|     /* | 
|      * Move cursor back to center of pad when we lose touch - this | 
|      * specifically improves user experience when moving cursor with one | 
|      * finger, and pressing a button with another. | 
|      */ | 
|     priv->abs_x = BYD_PAD_WIDTH / 2; | 
|     priv->abs_y = BYD_PAD_HEIGHT / 2; | 
| } | 
|   | 
| static psmouse_ret_t byd_process_byte(struct psmouse *psmouse) | 
| { | 
|     struct byd_data *priv = psmouse->private; | 
|     u8 *pkt = psmouse->packet; | 
|   | 
|     if (psmouse->pktcnt > 0 && !(pkt[0] & PS2_ALWAYS_1)) { | 
|         psmouse_warn(psmouse, "Always_1 bit not 1. pkt[0] = %02x\n", | 
|                  pkt[0]); | 
|         return PSMOUSE_BAD_DATA; | 
|     } | 
|   | 
|     if (psmouse->pktcnt < psmouse->pktsize) | 
|         return PSMOUSE_GOOD_DATA; | 
|   | 
|     /* Otherwise, a full packet has been received */ | 
|     switch (pkt[3]) { | 
|     case BYD_PACKET_ABSOLUTE: | 
|         /* Only use absolute packets for the start of movement. */ | 
|         if (!priv->touch) { | 
|             /* needed to detect tap */ | 
|             typeof(jiffies) tap_time = | 
|                 priv->last_touch_time + BYD_TOUCH_TIMEOUT; | 
|             priv->touch = time_after(jiffies, tap_time); | 
|   | 
|             /* init abs position */ | 
|             priv->abs_x = pkt[1] * (BYD_PAD_WIDTH / 256); | 
|             priv->abs_y = (255 - pkt[2]) * (BYD_PAD_HEIGHT / 256); | 
|         } | 
|         break; | 
|     case BYD_PACKET_RELATIVE: { | 
|         /* Standard packet */ | 
|         /* Sign-extend if a sign bit is set. */ | 
|         u32 signx = pkt[0] & PS2_X_SIGN ? ~0xFF : 0; | 
|         u32 signy = pkt[0] & PS2_Y_SIGN ? ~0xFF : 0; | 
|         s32 dx = signx | (int) pkt[1]; | 
|         s32 dy = signy | (int) pkt[2]; | 
|   | 
|         /* Update position based on velocity */ | 
|         priv->abs_x += dx * BYD_DT; | 
|         priv->abs_y -= dy * BYD_DT; | 
|   | 
|         priv->touch = true; | 
|         break; | 
|     } | 
|     default: | 
|         psmouse_warn(psmouse, | 
|                  "Unrecognized Z: pkt = %02x %02x %02x %02x\n", | 
|                  psmouse->packet[0], psmouse->packet[1], | 
|                  psmouse->packet[2], psmouse->packet[3]); | 
|         return PSMOUSE_BAD_DATA; | 
|     } | 
|   | 
|     priv->btn_left = pkt[0] & PS2_LEFT; | 
|     priv->btn_right = pkt[0] & PS2_RIGHT; | 
|   | 
|     byd_report_input(psmouse); | 
|   | 
|     /* Reset time since last touch. */ | 
|     if (priv->touch) { | 
|         priv->last_touch_time = jiffies; | 
|         mod_timer(&priv->timer, jiffies + BYD_TOUCH_TIMEOUT); | 
|     } | 
|   | 
|     return PSMOUSE_FULL_PACKET; | 
| } | 
|   | 
| static int byd_reset_touchpad(struct psmouse *psmouse) | 
| { | 
|     struct ps2dev *ps2dev = &psmouse->ps2dev; | 
|     u8 param[4]; | 
|     size_t i; | 
|   | 
|     static const struct { | 
|         u16 command; | 
|         u8 arg; | 
|     } seq[] = { | 
|         /* | 
|          * Intellimouse initialization sequence, to get 4-byte instead | 
|          * of 3-byte packets. | 
|          */ | 
|         { PSMOUSE_CMD_SETRATE, 0xC8 }, | 
|         { PSMOUSE_CMD_SETRATE, 0x64 }, | 
|         { PSMOUSE_CMD_SETRATE, 0x50 }, | 
|         { PSMOUSE_CMD_GETID, 0 }, | 
|         { PSMOUSE_CMD_ENABLE, 0 }, | 
|         /* | 
|          * BYD-specific initialization, which enables absolute mode and | 
|          * (if desired), the touchpad's built-in gesture detection. | 
|          */ | 
|         { 0x10E2, 0x00 }, | 
|         { 0x10E0, 0x02 }, | 
|         /* The touchpad should reply with 4 seemingly-random bytes */ | 
|         { 0x14E0, 0x01 }, | 
|         /* Pairs of parameters and values. */ | 
|         { BYD_CMD_SET_HANDEDNESS, 0x01 }, | 
|         { BYD_CMD_SET_PHYSICAL_BUTTONS, 0x04 }, | 
|         { BYD_CMD_SET_TAP, 0x02 }, | 
|         { BYD_CMD_SET_ONE_FINGER_SCROLL, 0x04 }, | 
|         { BYD_CMD_SET_ONE_FINGER_SCROLL_FUNC, 0x04 }, | 
|         { BYD_CMD_SET_EDGE_MOTION, 0x01 }, | 
|         { BYD_CMD_SET_PALM_CHECK, 0x00 }, | 
|         { BYD_CMD_SET_MULTITOUCH, 0x02 }, | 
|         { BYD_CMD_SET_TWO_FINGER_SCROLL, 0x04 }, | 
|         { BYD_CMD_SET_TWO_FINGER_SCROLL_FUNC, 0x04 }, | 
|         { BYD_CMD_SET_LEFT_EDGE_REGION, 0x00 }, | 
|         { BYD_CMD_SET_TOP_EDGE_REGION, 0x00 }, | 
|         { BYD_CMD_SET_RIGHT_EDGE_REGION, 0x00 }, | 
|         { BYD_CMD_SET_BOTTOM_EDGE_REGION, 0x00 }, | 
|         { BYD_CMD_SET_ABSOLUTE_MODE, 0x02 }, | 
|         /* Finalize initialization. */ | 
|         { 0x10E0, 0x00 }, | 
|         { 0x10E2, 0x01 }, | 
|     }; | 
|   | 
|     for (i = 0; i < ARRAY_SIZE(seq); ++i) { | 
|         memset(param, 0, sizeof(param)); | 
|         param[0] = seq[i].arg; | 
|         if (ps2_command(ps2dev, param, seq[i].command)) | 
|             return -EIO; | 
|     } | 
|   | 
|     psmouse_set_state(psmouse, PSMOUSE_ACTIVATED); | 
|     return 0; | 
| } | 
|   | 
| static int byd_reconnect(struct psmouse *psmouse) | 
| { | 
|     int retry = 0, error = 0; | 
|   | 
|     psmouse_dbg(psmouse, "Reconnect\n"); | 
|     do { | 
|         psmouse_reset(psmouse); | 
|         if (retry) | 
|             ssleep(1); | 
|         error = byd_detect(psmouse, 0); | 
|     } while (error && ++retry < 3); | 
|   | 
|     if (error) | 
|         return error; | 
|   | 
|     psmouse_dbg(psmouse, "Reconnected after %d attempts\n", retry); | 
|   | 
|     error = byd_reset_touchpad(psmouse); | 
|     if (error) { | 
|         psmouse_err(psmouse, "Unable to initialize device\n"); | 
|         return error; | 
|     } | 
|   | 
|     return 0; | 
| } | 
|   | 
| static void byd_disconnect(struct psmouse *psmouse) | 
| { | 
|     struct byd_data *priv = psmouse->private; | 
|   | 
|     if (priv) { | 
|         del_timer(&priv->timer); | 
|         kfree(psmouse->private); | 
|         psmouse->private = NULL; | 
|     } | 
| } | 
|   | 
| int byd_detect(struct psmouse *psmouse, bool set_properties) | 
| { | 
|     struct ps2dev *ps2dev = &psmouse->ps2dev; | 
|     u8 param[4] = {0x03, 0x00, 0x00, 0x00}; | 
|   | 
|     if (ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES)) | 
|         return -1; | 
|     if (ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES)) | 
|         return -1; | 
|     if (ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES)) | 
|         return -1; | 
|     if (ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES)) | 
|         return -1; | 
|     if (ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO)) | 
|         return -1; | 
|   | 
|     if (param[1] != 0x03 || param[2] != 0x64) | 
|         return -ENODEV; | 
|   | 
|     psmouse_dbg(psmouse, "BYD touchpad detected\n"); | 
|   | 
|     if (set_properties) { | 
|         psmouse->vendor = "BYD"; | 
|         psmouse->name = "TouchPad"; | 
|     } | 
|   | 
|     return 0; | 
| } | 
|   | 
| int byd_init(struct psmouse *psmouse) | 
| { | 
|     struct input_dev *dev = psmouse->dev; | 
|     struct byd_data *priv; | 
|   | 
|     if (psmouse_reset(psmouse)) | 
|         return -EIO; | 
|   | 
|     if (byd_reset_touchpad(psmouse)) | 
|         return -EIO; | 
|   | 
|     priv = kzalloc(sizeof(*priv), GFP_KERNEL); | 
|     if (!priv) | 
|         return -ENOMEM; | 
|   | 
|     priv->psmouse = psmouse; | 
|     timer_setup(&priv->timer, byd_clear_touch, 0); | 
|   | 
|     psmouse->private = priv; | 
|     psmouse->disconnect = byd_disconnect; | 
|     psmouse->reconnect = byd_reconnect; | 
|     psmouse->protocol_handler = byd_process_byte; | 
|     psmouse->pktsize = 4; | 
|     psmouse->resync_time = 0; | 
|   | 
|     __set_bit(INPUT_PROP_POINTER, dev->propbit); | 
|     /* Touchpad */ | 
|     __set_bit(BTN_TOUCH, dev->keybit); | 
|     __set_bit(BTN_TOOL_FINGER, dev->keybit); | 
|     /* Buttons */ | 
|     __set_bit(BTN_LEFT, dev->keybit); | 
|     __set_bit(BTN_RIGHT, dev->keybit); | 
|     __clear_bit(BTN_MIDDLE, dev->keybit); | 
|   | 
|     /* Absolute position */ | 
|     __set_bit(EV_ABS, dev->evbit); | 
|     input_set_abs_params(dev, ABS_X, 0, BYD_PAD_WIDTH, 0, 0); | 
|     input_set_abs_params(dev, ABS_Y, 0, BYD_PAD_HEIGHT, 0, 0); | 
|     input_abs_set_res(dev, ABS_X, BYD_PAD_RESOLUTION); | 
|     input_abs_set_res(dev, ABS_Y, BYD_PAD_RESOLUTION); | 
|     /* No relative support */ | 
|     __clear_bit(EV_REL, dev->evbit); | 
|     __clear_bit(REL_X, dev->relbit); | 
|     __clear_bit(REL_Y, dev->relbit); | 
|   | 
|     return 0; | 
| } |