Tested on Dell 7720. Works fine. Signed-off-by: Valyushkov Ivan <ktopisal@xxxxxxxxx> --- drivers/input/mouse/alps.c | 464 +++++++++++++++++++++++++++++++++++++++++--- drivers/input/mouse/alps.h | 2 + 2 files changed, 443 insertions(+), 23 deletions(-) diff --git a/drivers/input/mouse/alps.c b/drivers/input/mouse/alps.c index e229fa3..38361bc 100644 --- a/drivers/input/mouse/alps.c +++ b/drivers/input/mouse/alps.c @@ -15,6 +15,8 @@ * the Free Software Foundation. */ +#define DEBUG + #include <linux/slab.h> #include <linux/input.h> #include <linux/input/mt.h> @@ -30,9 +32,6 @@ #define ALPS_V3_X_MAX 2000 #define ALPS_V3_Y_MAX 1400 -#define ALPS_BITMAP_X_BITS 15 -#define ALPS_BITMAP_Y_BITS 11 - #define ALPS_CMD_NIBBLE_10 0x01f2 static const struct alps_nibble_commands alps_v3_nibble_commands[] = { @@ -84,6 +83,12 @@ static const struct alps_nibble_commands alps_v4_nibble_commands[] = { #define ALPS_PS2_INTERLEAVED 0x80 /* 3-byte PS/2 packet interleaved with 6-byte ALPS packet */ +/* Set these based upon protocol version */ +static int ALPS_X_MAX; /* right edge */ +static int ALPS_Y_MAX; /* bottom edge */ +static int ALPS_BITMAP_X_BITS; /* mt number of x bits */ +static int ALPS_BITMAP_Y_BITS; /* mt number of y bits */ + static const struct alps_model_info alps_model_data[] = { { { 0x32, 0x02, 0x14 }, 0x00, ALPS_PROTO_V2, 0xf8, 0xf8, ALPS_PASS | ALPS_DUALPOINT }, /* Toshiba Salellite Pro M10 */ { { 0x33, 0x02, 0x0a }, 0x00, ALPS_PROTO_V1, 0x88, 0xf8, 0 }, /* UMAX-530T */ @@ -112,6 +117,9 @@ static const struct alps_model_info alps_model_data[] = { { { 0x73, 0x02, 0x64 }, 0x9b, ALPS_PROTO_V3, 0x8f, 0x8f, ALPS_DUALPOINT }, { { 0x73, 0x02, 0x64 }, 0x9d, ALPS_PROTO_V3, 0x8f, 0x8f, ALPS_DUALPOINT }, { { 0x73, 0x02, 0x64 }, 0x8a, ALPS_PROTO_V4, 0x8f, 0x8f, 0 }, + { { 0x73, 0x03, 0x0a }, 0x1d, ALPS_PROTO_V5, 0x8f, 0x8f, ALPS_DUALPOINT }, /* Dell Latitude E6430 */ + { { 0x73, 0x03, 0x50 }, 0x0d, ALPS_PROTO_V6, 0xc8, 0xc8, 0 }, /* Dell Inspiron N5110 */ + { { 0x73, 0x03, 0x50 }, 0x02, ALPS_PROTO_V6, 0xc8, 0xc8, 0 } /* Dell Inspiron 17R 7720 */ }; /* @@ -355,9 +363,9 @@ static int alps_process_bitmap(unsigned int x_map, unsigned int y_map, } } - *x1 = (ALPS_V3_X_MAX * (2 * x_low.start_bit + x_low.num_bits - 1)) / + *x1 = (ALPS_X_MAX * (2 * x_low.start_bit + x_low.num_bits - 1)) / (2 * (ALPS_BITMAP_X_BITS - 1)); - *y1 = (ALPS_V3_Y_MAX * (2 * y_low.start_bit + y_low.num_bits - 1)) / + *y1 = (ALPS_Y_MAX * (2 * y_low.start_bit + y_low.num_bits - 1)) / (2 * (ALPS_BITMAP_Y_BITS - 1)); if (fingers > 1) { @@ -388,7 +396,7 @@ static void alps_report_semi_mt_data(struct input_dev *dev, int num_fingers, alps_set_slot(dev, 1, num_fingers == 2, x2, y2); } -static void alps_process_trackstick_packet_v3(struct psmouse *psmouse) +static void alps_process_trackstick_packet_v3_v5(struct psmouse *psmouse) { struct alps_data *priv = psmouse->private; unsigned char *packet = psmouse->packet; @@ -448,7 +456,7 @@ static void alps_process_trackstick_packet_v3(struct psmouse *psmouse) return; } -static void alps_process_touchpad_packet_v3(struct psmouse *psmouse) +static void alps_process_touchpad_packet_v3_v5(struct psmouse *psmouse) { struct alps_data *priv = psmouse->private; unsigned char *packet = psmouse->packet; @@ -579,7 +587,7 @@ static void alps_process_touchpad_packet_v3(struct psmouse *psmouse) } } -static void alps_process_packet_v3(struct psmouse *psmouse) +static void alps_process_packet_v3_v5(struct psmouse *psmouse) { unsigned char *packet = psmouse->packet; @@ -592,11 +600,11 @@ static void alps_process_packet_v3(struct psmouse *psmouse) * of packets. */ if (packet[5] == 0x3f) { - alps_process_trackstick_packet_v3(psmouse); + alps_process_trackstick_packet_v3_v5(psmouse); return; } - alps_process_touchpad_packet_v3(psmouse); + alps_process_touchpad_packet_v3_v5(psmouse); } static void alps_process_packet_v4(struct psmouse *psmouse) @@ -696,6 +704,91 @@ static void alps_process_packet_v4(struct psmouse *psmouse) input_sync(dev); } +/* This is similar logic to alps_process_touchpad_packet_v3_v5. The + bitfield positions are different. +*/ +static void alps_process_packet_v6(struct psmouse *psmouse) +{ + struct alps_data *priv = psmouse->private; + unsigned char *packet = psmouse->packet; + struct input_dev *dev = psmouse->dev; + int x, y, z; + int left, right, middle; + int x1 = 0, y1 = 0, x2 = 0, y2 = 0; + int fingers = 0; + unsigned long int x_bitmap, y_bitmap; + + /* multitouch packet */ + if (priv->multi_packet) { + if (packet[0] & 0x20) { + fingers = ((packet[0] & 0x6) >> 1 | + (packet[0] & 0x10) >> 2); + x_bitmap = ((packet[2] & 0x60) >> 5) | + ((packet[4] & 0x7f) << 2) | + ((packet[5] & 0x7f) << 9) | + ((packet[3] & 0x07) << 16) | + ((packet[3] & 0x70) << 15) | + ((packet[0] & 0x01) << 22); + y_bitmap = (packet[1] & 0x7f) | + ((packet[2] & 0x1f) << 7); + alps_process_bitmap(x_bitmap, y_bitmap, + &x1, &y1, &x2, &y2); + packet = priv->multi_data; + } else { + priv->multi_packet = 0; + } + } + + if (packet[0] & 0x20) + return; + + if (!priv->multi_packet && (packet[0] & 0x2)) { + priv->multi_packet = 1; + memcpy(priv->multi_data, packet, sizeof(priv->multi_data)); + return; + } + priv->multi_packet = 0; + + left = packet[3] & 0x1; + right = packet[3] & 0x2; + middle = packet[3] & 0x4; + + x = ((packet[1] & 0x7f) | ((packet[4] & 0x0f) << 7)); + y = ((packet[2] & 0x7f) | ((packet[4] & 0xf0) << 3)); + z = (packet[0] & 4) ? 0 : packet[5] & 0x7f; + + if (x && y && !z) + return; + + if (!fingers) { + x1 = x; + y1 = y; + fingers = z > 0 ? 1 : 0; + } + + if (z > 64) + input_report_key(dev, BTN_TOUCH, 1); + else + input_report_key(dev, BTN_TOUCH, 0); + + alps_report_semi_mt_data(dev, fingers, x1, y1, x2, y2); + + input_mt_report_finger_count(dev, fingers); + + input_report_key(dev, BTN_LEFT, left); + input_report_key(dev, BTN_RIGHT, right); + input_report_key(dev, BTN_MIDDLE, middle); + + if (z > 0) { + input_report_abs(dev, ABS_X, x); + input_report_abs(dev, ABS_Y, y); + } + input_report_abs(dev, ABS_PRESSURE, z); + + input_sync(dev); +} + + static void alps_process_packet(struct psmouse *psmouse) { struct alps_data *priv = psmouse->private; @@ -707,11 +800,17 @@ static void alps_process_packet(struct psmouse *psmouse) alps_process_packet_v1_v2(psmouse); break; case ALPS_PROTO_V3: - alps_process_packet_v3(psmouse); + alps_process_packet_v3_v5(psmouse); break; case ALPS_PROTO_V4: alps_process_packet_v4(psmouse); break; + case ALPS_PROTO_V5: + alps_process_packet_v3_v5(psmouse); + break; + case ALPS_PROTO_V6: + alps_process_packet_v6(psmouse); + break; } } @@ -731,6 +830,12 @@ static void alps_report_bare_ps2_packet(struct psmouse *psmouse, input_report_rel(dev2, REL_Y, packet[2] ? ((packet[0] << 3) & 0x100) - packet[2] : 0); + /* log buttons, REL_X, REL_Y */ + psmouse_dbg(psmouse, "bare_ps2_packet: %x %d %d\n", + packet[0]&7, + packet[1] - ((packet[0]<<4)&0x100), + ((packet[0] << 3) & 0x100) - packet[2]); + input_sync(dev2); } @@ -767,8 +872,9 @@ static psmouse_ret_t alps_handle_interleaved_ps2(struct psmouse *psmouse) psmouse->packet[5]) & 0x80) || (!alps_is_valid_first_byte(priv->i, psmouse->packet[6]))) { psmouse_dbg(psmouse, - "refusing packet %4ph (suspected interleaved ps/2)\n", - psmouse->packet + 3); + "refusing packet %x %x %x %x (suspected interleaved ps/2)\n", + psmouse->packet[3], psmouse->packet[4], + psmouse->packet[5], psmouse->packet[6]); return PSMOUSE_BAD_DATA; } @@ -830,8 +936,9 @@ static void alps_flush_packet(unsigned long data) psmouse->packet[4] | psmouse->packet[5]) & 0x80) { psmouse_dbg(psmouse, - "refusing packet %3ph (suspected interleaved ps/2)\n", - psmouse->packet + 3); + "refusing packet %x %x %x (suspected interleaved ps/2)\n", + psmouse->packet[3], psmouse->packet[4], + psmouse->packet[5]); } else { alps_process_packet(psmouse); } @@ -870,12 +977,18 @@ static psmouse_ret_t alps_process_byte(struct psmouse *psmouse) } /* Bytes 2 - pktsize should have 0 in the highest bit */ - if (psmouse->pktcnt >= 2 && psmouse->pktcnt <= psmouse->pktsize && - (psmouse->packet[psmouse->pktcnt - 1] & 0x80)) { - psmouse_dbg(psmouse, "refusing packet[%i] = %x\n", - psmouse->pktcnt - 1, - psmouse->packet[psmouse->pktcnt - 1]); - return PSMOUSE_BAD_DATA; + + /* This test is not valid for V6 multi-touch mode! + Need to restructure this code down the road */ + if (model->proto_version != ALPS_PROTO_V6) { + + if (psmouse->pktcnt >= 2 && psmouse->pktcnt <= psmouse->pktsize && + (psmouse->packet[psmouse->pktcnt - 1] & 0x80)) { + psmouse_dbg(psmouse, "refusing packet[%i] = %x\n", + psmouse->pktcnt - 1, + psmouse->packet[psmouse->pktcnt - 1]); + return PSMOUSE_BAD_DATA; + } } if (psmouse->pktcnt == psmouse->pktsize) { @@ -981,7 +1094,11 @@ static int alps_enter_command_mode(struct psmouse *psmouse, return -1; } - if (param[0] != 0x88 && param[1] != 0x07) { + /* Warning - cannot determine model yet because some devices have same + E7 response but are differentiated by the command mode response + */ + if ((param[0] != 0x88 && param[1] != 0x07) /* For V1-V5 */ + && (param[0] != 0x73 && param[1] != 0x01)) { /* For V6 */ psmouse_dbg(psmouse, "unknown response while entering command mode: %2.2x %2.2x %2.2x\n", param[0], param[1], param[2]); @@ -1088,6 +1205,10 @@ static const struct alps_model_info *alps_get_model(struct psmouse *psmouse, int psmouse_dbg(psmouse, "Unknown command mode response %2.2x\n", param[0]); + else + psmouse_dbg(psmouse, + "Model=%d, proto_version=%d\n", + i, model->proto_version); } } @@ -1517,6 +1638,261 @@ error: return -1; } +static int alps_hw_init_v5(struct psmouse *psmouse) +{ + struct ps2dev *ps2dev = &psmouse->ps2dev; + unsigned char param[4]; + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_BAT); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_BAT); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + param[0] = 0x64; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + param[0] = 0x64; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_DIS); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + param[0] = 0xc8; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + param[0] = 0x14; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + param[0] = 0x64; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + param[0] = 0x64; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + param[0] = 0x14; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + param[0] = 0xc8; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + param[0] = 0x00; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + param[0] = 0x01; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); + param[0] = 0x64; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + + param[0] = 0x64; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + param[0] = 0x64; + ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, param, PSMOUSE_CMD_ENABLE); + + return 0; +} + +static int alps_hw_init_v6(struct psmouse *psmouse) +{ + struct alps_data *priv = psmouse->private; + struct ps2dev *ps2dev = &psmouse->ps2dev; + unsigned char param[4]; + + /* Doesn't seem to be necessary but we keep here in case + registers need to be used */ + priv->nibble_commands = alps_v3_nibble_commands; + + priv->addr_command = PSMOUSE_CMD_RESET_WRAP; + ps2_command(ps2dev, param, PSMOUSE_CMD_RESET_BAT); + if (param[0] != PSMOUSE_RET_BAT && param[1] != PSMOUSE_RET_ID) + psmouse_dbg(psmouse, "Bad reset %2.2x %2.2x", param[0], param[1]); + + ps2_command(ps2dev, param, PSMOUSE_CMD_RESET_BAT); + if (param[0] != PSMOUSE_RET_BAT && param[1] != PSMOUSE_RET_ID) + psmouse_dbg(psmouse, "Bad reset %2.2x %2.2x", param[0], param[1]); + + ps2_command(ps2dev, param, PSMOUSE_CMD_GETID); + + /* E6 report */ + param[0] = 0; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRES); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + + /* ?? */ + param[0] = 0x03; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRES); + + /* Set 9-byte to 8-byte */ + param[0] = 0xc8; + param[1] = 0x64; + param[2] = 0x50; + if (ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE) || + ps2_command(ps2dev, ¶m[1], PSMOUSE_CMD_SETRATE) || + ps2_command(ps2dev, ¶m[2], PSMOUSE_CMD_SETRATE) || + ps2_command(ps2dev, param, PSMOUSE_CMD_GETID)) + return -1; + + /* Set rate and enable data reporting? */ + param[0] = 0xc8; + param[1] = 0x50; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, ¶m[1], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_GETID); + + param[0] = 0x64; + param[1] = 0x03; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, ¶m[1], PSMOUSE_CMD_SETRES); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_ENABLE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_DISABLE); + + ps2_command(ps2dev, param, PSMOUSE_CMD_RESET_BAT); + if (param[0] != PSMOUSE_RET_BAT && param[1] != PSMOUSE_RET_ID) + psmouse_dbg(psmouse, "Bad reset %2.2x %2.2x", param[0], param[1]); + + /* E7 report */ + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + + /* Enter command mode */ + alps_enter_command_mode(psmouse, param); + + /* exit command mode */ + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + /* param should be bf 1a 04 */ + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); + /* param should be 89 95 84 */ + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + param[0] = 0x28; + param[1] = 0x50; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, ¶m[1], PSMOUSE_CMD_SETRATE); + + /* Enter command mode */ + alps_enter_command_mode(psmouse, param); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_DIS); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + + param[0] = 0x64; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21); + param[0] = 0x64; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETPOLL); + + /* out of cmd mode? */ + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_DISABLE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + + param[0] = 0x64; + param[1] = 0x28; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, ¶m[1], PSMOUSE_CMD_SETRATE); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + + param[0] = 0x50; + param[1] = 0x0a; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, ¶m[1], PSMOUSE_CMD_SETRATE); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); + + param[0] = 0x50; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE); + ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); + + param[0] = 0x03; + ps2_command(ps2dev, ¶m[0], PSMOUSE_CMD_SETRES); + + ps2_command(ps2dev, NULL, PSMOUSE_CMD_ENABLE); + + return 0; +} + + static int alps_hw_init(struct psmouse *psmouse) { struct alps_data *priv = psmouse->private; @@ -1534,6 +1910,12 @@ static int alps_hw_init(struct psmouse *psmouse) case ALPS_PROTO_V4: ret = alps_hw_init_v4(psmouse); break; + case ALPS_PROTO_V5: + ret = alps_hs_init_v5(psmouse); + break; + case ALPS_PROTO_V6: + ret = alps_hw_init_v6(psmouse); + break; } return ret; @@ -1618,7 +2000,7 @@ int alps_init(struct psmouse *psmouse) case ALPS_PROTO_V3: case ALPS_PROTO_V4: set_bit(INPUT_PROP_SEMI_MT, dev1->propbit); - input_mt_init_slots(dev1, 2, 0); + input_mt_init_slots(dev1, 2); input_set_abs_params(dev1, ABS_MT_POSITION_X, 0, ALPS_V3_X_MAX, 0, 0); input_set_abs_params(dev1, ABS_MT_POSITION_Y, 0, ALPS_V3_Y_MAX, 0, 0); @@ -1629,6 +2011,42 @@ int alps_init(struct psmouse *psmouse) input_set_abs_params(dev1, ABS_X, 0, ALPS_V3_X_MAX, 0, 0); input_set_abs_params(dev1, ABS_Y, 0, ALPS_V3_Y_MAX, 0, 0); break; + case ALPS_PROTO_V5: + set_bit(INPUT_PROP_SEMI_MT, dev1->propbit); + input_mt_init_slots(dev1, 2); + ALPS_BITMAP_X_BITS = 15; + ALPS_BITMAP_Y_BITS = 11; + ALPS_X_MAX = 2000; + ALPS_Y_MAX = 1400; + input_set_abs_params(dev1, ABS_MT_POSITION_X, 0, ALPS_X_MAX, 0, 0); + input_set_abs_params(dev1, ABS_MT_POSITION_Y, 0, ALPS_Y_MAX, 0, 0); + + set_bit(BTN_TOOL_DOUBLETAP, dev1->keybit); + set_bit(BTN_TOOL_TRIPLETAP, dev1->keybit); + set_bit(BTN_TOOL_QUADTAP, dev1->keybit); + + input_set_abs_params(dev1, ABS_X, 0, ALPS_X_MAX, 0, 0); + input_set_abs_params(dev1, ABS_Y, 0, ALPS_Y_MAX, 0, 0); + break; + case ALPS_PROTO_V6: + set_bit(INPUT_PROP_SEMI_MT, dev1->propbit); + ALPS_BITMAP_X_BITS = 23; + ALPS_BITMAP_Y_BITS = 12; + ALPS_X_MAX = 1360; + ALPS_Y_MAX = 660; + + input_mt_init_slots(dev1, 2); + input_set_abs_params(dev1, ABS_MT_POSITION_X, 0, ALPS_X_MAX, 0, 0); + input_set_abs_params(dev1, ABS_MT_POSITION_Y, 0, ALPS_Y_MAX, 0, 0); + + set_bit(BTN_TOOL_DOUBLETAP, dev1->keybit); + set_bit(BTN_TOOL_TRIPLETAP, dev1->keybit); + set_bit(BTN_TOOL_QUADTAP, dev1->keybit); + + input_set_abs_params(dev1, ABS_X, 0, ALPS_X_MAX, 0, 0); + input_set_abs_params(dev1, ABS_Y, 0, ALPS_Y_MAX, 0, 0); + + break; } input_set_abs_params(dev1, ABS_PRESSURE, 0, 127, 0, 0); diff --git a/drivers/input/mouse/alps.h b/drivers/input/mouse/alps.h index ae1ac35..75a06af 100644 --- a/drivers/input/mouse/alps.h +++ b/drivers/input/mouse/alps.h @@ -16,6 +16,8 @@ #define ALPS_PROTO_V2 1 #define ALPS_PROTO_V3 2 #define ALPS_PROTO_V4 3 +#define ALPS_PROTO_V5 4 +#define ALPS_PROTO_V6 5 struct alps_model_info { unsigned char signature[3]; -- 1.7.7.6 -- To unsubscribe from this list: send the line "unsubscribe linux-input" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html