Lines Matching refs:psmouse
248 static void alps_process_packet_v1_v2(struct psmouse *psmouse) in alps_process_packet_v1_v2() argument
250 struct alps_data *priv = psmouse->private; in alps_process_packet_v1_v2()
251 unsigned char *packet = psmouse->packet; in alps_process_packet_v1_v2()
252 struct input_dev *dev = psmouse->dev; in alps_process_packet_v1_v2()
510 static void alps_report_mt_data(struct psmouse *psmouse, int n) in alps_report_mt_data() argument
512 struct alps_data *priv = psmouse->private; in alps_report_mt_data()
513 struct input_dev *dev = psmouse->dev; in alps_report_mt_data()
524 static void alps_report_semi_mt_data(struct psmouse *psmouse, int fingers) in alps_report_semi_mt_data() argument
526 struct alps_data *priv = psmouse->private; in alps_report_semi_mt_data()
527 struct input_dev *dev = psmouse->dev; in alps_report_semi_mt_data()
555 static void alps_process_trackstick_packet_v3(struct psmouse *psmouse) in alps_process_trackstick_packet_v3() argument
557 struct alps_data *priv = psmouse->private; in alps_process_trackstick_packet_v3()
558 unsigned char *packet = psmouse->packet; in alps_process_trackstick_packet_v3()
564 psmouse_warn(psmouse, in alps_process_trackstick_packet_v3()
571 psmouse_dbg(psmouse, "Bad trackstick packet, discarding\n"); in alps_process_trackstick_packet_v3()
635 struct psmouse *psmouse) in alps_decode_pinnacle() argument
661 struct psmouse *psmouse) in alps_decode_rushmore() argument
689 struct psmouse *psmouse) in alps_decode_dolphin() argument
692 struct alps_data *priv = psmouse->private; in alps_decode_dolphin()
725 static void alps_process_touchpad_packet_v3_v5(struct psmouse *psmouse) in alps_process_touchpad_packet_v3_v5() argument
727 struct alps_data *priv = psmouse->private; in alps_process_touchpad_packet_v3_v5()
728 unsigned char *packet = psmouse->packet; in alps_process_touchpad_packet_v3_v5()
735 priv->decode_fields(f, packet, psmouse); in alps_process_touchpad_packet_v3_v5()
756 priv->decode_fields(f, priv->multi_data, psmouse); in alps_process_touchpad_packet_v3_v5()
792 alps_report_semi_mt_data(psmouse, fingers); in alps_process_touchpad_packet_v3_v5()
803 static void alps_process_packet_v3(struct psmouse *psmouse) in alps_process_packet_v3() argument
805 unsigned char *packet = psmouse->packet; in alps_process_packet_v3()
816 alps_process_trackstick_packet_v3(psmouse); in alps_process_packet_v3()
820 alps_process_touchpad_packet_v3_v5(psmouse); in alps_process_packet_v3()
823 static void alps_process_packet_v6(struct psmouse *psmouse) in alps_process_packet_v6() argument
825 struct alps_data *priv = psmouse->private; in alps_process_packet_v6()
826 unsigned char *packet = psmouse->packet; in alps_process_packet_v6()
827 struct input_dev *dev = psmouse->dev; in alps_process_packet_v6()
840 psmouse_warn(psmouse, in alps_process_packet_v6()
889 static void alps_process_packet_v4(struct psmouse *psmouse) in alps_process_packet_v4() argument
891 struct alps_data *priv = psmouse->private; in alps_process_packet_v4()
892 unsigned char *packet = psmouse->packet; in alps_process_packet_v4()
935 alps_report_semi_mt_data(psmouse, f->fingers); in alps_process_packet_v4()
938 static bool alps_is_valid_package_v7(struct psmouse *psmouse) in alps_is_valid_package_v7() argument
940 switch (psmouse->pktcnt) { in alps_is_valid_package_v7()
942 return (psmouse->packet[2] & 0x40) == 0x40; in alps_is_valid_package_v7()
944 return (psmouse->packet[3] & 0x48) == 0x48; in alps_is_valid_package_v7()
946 return (psmouse->packet[5] & 0x40) == 0x00; in alps_is_valid_package_v7()
1028 struct psmouse *psmouse) in alps_decode_packet_v7() argument
1030 struct alps_data *priv = psmouse->private; in alps_decode_packet_v7()
1088 static void alps_process_trackstick_packet_v7(struct psmouse *psmouse) in alps_process_trackstick_packet_v7() argument
1090 struct alps_data *priv = psmouse->private; in alps_process_trackstick_packet_v7()
1091 unsigned char *packet = psmouse->packet; in alps_process_trackstick_packet_v7()
1097 psmouse_warn(psmouse, in alps_process_trackstick_packet_v7()
1116 static void alps_process_touchpad_packet_v7(struct psmouse *psmouse) in alps_process_touchpad_packet_v7() argument
1118 struct alps_data *priv = psmouse->private; in alps_process_touchpad_packet_v7()
1119 struct input_dev *dev = psmouse->dev; in alps_process_touchpad_packet_v7()
1124 if (priv->decode_fields(f, psmouse->packet, psmouse)) in alps_process_touchpad_packet_v7()
1127 alps_report_mt_data(psmouse, alps_get_mt_count(f->mt)); in alps_process_touchpad_packet_v7()
1138 static void alps_process_packet_v7(struct psmouse *psmouse) in alps_process_packet_v7() argument
1140 unsigned char *packet = psmouse->packet; in alps_process_packet_v7()
1143 alps_process_trackstick_packet_v7(psmouse); in alps_process_packet_v7()
1145 alps_process_touchpad_packet_v7(psmouse); in alps_process_packet_v7()
1178 unsigned char *p, struct psmouse *psmouse) in alps_decode_ss4_v2() argument
1180 struct alps_data *priv = psmouse->private; in alps_decode_ss4_v2()
1314 static void alps_process_packet_ss4_v2(struct psmouse *psmouse) in alps_process_packet_ss4_v2() argument
1316 struct alps_data *priv = psmouse->private; in alps_process_packet_ss4_v2()
1317 unsigned char *packet = psmouse->packet; in alps_process_packet_ss4_v2()
1318 struct input_dev *dev = psmouse->dev; in alps_process_packet_ss4_v2()
1323 priv->decode_fields(f, packet, psmouse); in alps_process_packet_ss4_v2()
1333 priv->decode_fields(f, priv->multi_data, psmouse); in alps_process_packet_ss4_v2()
1358 psmouse_warn(psmouse, in alps_process_packet_ss4_v2()
1376 alps_report_mt_data(psmouse, (f->fingers <= 4) ? f->fingers : 4); in alps_process_packet_ss4_v2()
1388 static bool alps_is_valid_package_ss4_v2(struct psmouse *psmouse) in alps_is_valid_package_ss4_v2() argument
1390 if (psmouse->pktcnt == 4 && ((psmouse->packet[3] & 0x08) != 0x08)) in alps_is_valid_package_ss4_v2()
1392 if (psmouse->pktcnt == 6 && ((psmouse->packet[5] & 0x10) != 0x0)) in alps_is_valid_package_ss4_v2()
1401 struct psmouse *psmouse = priv->psmouse; in alps_do_register_bare_ps2_mouse() local
1407 psmouse_err(psmouse, "failed to allocate secondary device\n"); in alps_do_register_bare_ps2_mouse()
1412 psmouse->ps2dev.serio->phys, in alps_do_register_bare_ps2_mouse()
1426 dev3->dev.parent = &psmouse->ps2dev.serio->dev; in alps_do_register_bare_ps2_mouse()
1438 psmouse_err(psmouse, in alps_do_register_bare_ps2_mouse()
1472 static void alps_report_bare_ps2_packet(struct psmouse *psmouse, in alps_report_bare_ps2_packet() argument
1476 struct alps_data *priv = psmouse->private; in alps_report_bare_ps2_packet()
1484 dev2 = psmouse->dev; in alps_report_bare_ps2_packet()
1488 psmouse_queue_work(psmouse, &priv->dev3_register_work, in alps_report_bare_ps2_packet()
1504 static psmouse_ret_t alps_handle_interleaved_ps2(struct psmouse *psmouse) in alps_handle_interleaved_ps2() argument
1506 struct alps_data *priv = psmouse->private; in alps_handle_interleaved_ps2()
1508 if (psmouse->pktcnt < 6) in alps_handle_interleaved_ps2()
1511 if (psmouse->pktcnt == 6) { in alps_handle_interleaved_ps2()
1524 if (psmouse->packet[6] & 0x80) { in alps_handle_interleaved_ps2()
1532 if (((psmouse->packet[3] | in alps_handle_interleaved_ps2()
1533 psmouse->packet[4] | in alps_handle_interleaved_ps2()
1534 psmouse->packet[5]) & 0x80) || in alps_handle_interleaved_ps2()
1535 (!alps_is_valid_first_byte(priv, psmouse->packet[6]))) { in alps_handle_interleaved_ps2()
1536 psmouse_dbg(psmouse, in alps_handle_interleaved_ps2()
1538 psmouse->packet + 3); in alps_handle_interleaved_ps2()
1542 priv->process_packet(psmouse); in alps_handle_interleaved_ps2()
1545 psmouse->packet[0] = psmouse->packet[6]; in alps_handle_interleaved_ps2()
1546 psmouse->pktcnt = 1; in alps_handle_interleaved_ps2()
1566 alps_report_bare_ps2_packet(psmouse, &psmouse->packet[3], in alps_handle_interleaved_ps2()
1576 psmouse->packet[3] = psmouse->packet[6] & 0xf7; in alps_handle_interleaved_ps2()
1577 psmouse->pktcnt = 4; in alps_handle_interleaved_ps2()
1586 struct psmouse *psmouse = priv->psmouse; in alps_flush_packet() local
1588 guard(serio_pause_rx)(psmouse->ps2dev.serio); in alps_flush_packet()
1590 if (psmouse->pktcnt == psmouse->pktsize) { in alps_flush_packet()
1597 if ((psmouse->packet[3] | in alps_flush_packet()
1598 psmouse->packet[4] | in alps_flush_packet()
1599 psmouse->packet[5]) & 0x80) { in alps_flush_packet()
1600 psmouse_dbg(psmouse, in alps_flush_packet()
1602 psmouse->packet + 3); in alps_flush_packet()
1604 priv->process_packet(psmouse); in alps_flush_packet()
1606 psmouse->pktcnt = 0; in alps_flush_packet()
1610 static psmouse_ret_t alps_process_byte(struct psmouse *psmouse) in alps_process_byte() argument
1612 struct alps_data *priv = psmouse->private; in alps_process_byte()
1622 !psmouse->out_of_sync_cnt && in alps_process_byte()
1623 (psmouse->packet[0] & 0xc8) == 0x08) { in alps_process_byte()
1625 if (psmouse->pktcnt == 3) { in alps_process_byte()
1626 alps_report_bare_ps2_packet(psmouse, psmouse->packet, in alps_process_byte()
1636 psmouse->pktcnt >= 4 && (psmouse->packet[3] & 0x0f) == 0x0f) { in alps_process_byte()
1637 return alps_handle_interleaved_ps2(psmouse); in alps_process_byte()
1640 if (!alps_is_valid_first_byte(priv, psmouse->packet[0])) { in alps_process_byte()
1641 psmouse_dbg(psmouse, in alps_process_byte()
1643 psmouse->packet[0], priv->mask0, priv->byte0); in alps_process_byte()
1649 psmouse->pktcnt >= 2 && psmouse->pktcnt <= psmouse->pktsize && in alps_process_byte()
1650 (psmouse->packet[psmouse->pktcnt - 1] & 0x80)) { in alps_process_byte()
1651 psmouse_dbg(psmouse, "refusing packet[%i] = %x\n", in alps_process_byte()
1652 psmouse->pktcnt - 1, in alps_process_byte()
1653 psmouse->packet[psmouse->pktcnt - 1]); in alps_process_byte()
1656 psmouse->pktcnt == psmouse->pktsize) { in alps_process_byte()
1673 !alps_is_valid_package_v7(psmouse)) || in alps_process_byte()
1675 !alps_is_valid_package_ss4_v2(psmouse))) { in alps_process_byte()
1676 psmouse_dbg(psmouse, "refusing packet[%i] = %x\n", in alps_process_byte()
1677 psmouse->pktcnt - 1, in alps_process_byte()
1678 psmouse->packet[psmouse->pktcnt - 1]); in alps_process_byte()
1682 if (psmouse->pktcnt == psmouse->pktsize) { in alps_process_byte()
1683 priv->process_packet(psmouse); in alps_process_byte()
1690 static int alps_command_mode_send_nibble(struct psmouse *psmouse, int nibble) in alps_command_mode_send_nibble() argument
1692 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_command_mode_send_nibble()
1693 struct alps_data *priv = psmouse->private; in alps_command_mode_send_nibble()
1710 static int alps_command_mode_set_addr(struct psmouse *psmouse, int addr) in alps_command_mode_set_addr() argument
1712 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_command_mode_set_addr()
1713 struct alps_data *priv = psmouse->private; in alps_command_mode_set_addr()
1721 if (alps_command_mode_send_nibble(psmouse, nibble)) in alps_command_mode_set_addr()
1728 static int __alps_command_mode_read_reg(struct psmouse *psmouse, int addr) in __alps_command_mode_read_reg() argument
1730 struct ps2dev *ps2dev = &psmouse->ps2dev; in __alps_command_mode_read_reg()
1747 static int alps_command_mode_read_reg(struct psmouse *psmouse, int addr) in alps_command_mode_read_reg() argument
1749 if (alps_command_mode_set_addr(psmouse, addr)) in alps_command_mode_read_reg()
1751 return __alps_command_mode_read_reg(psmouse, addr); in alps_command_mode_read_reg()
1754 static int __alps_command_mode_write_reg(struct psmouse *psmouse, u8 value) in __alps_command_mode_write_reg() argument
1756 if (alps_command_mode_send_nibble(psmouse, (value >> 4) & 0xf)) in __alps_command_mode_write_reg()
1758 if (alps_command_mode_send_nibble(psmouse, value & 0xf)) in __alps_command_mode_write_reg()
1763 static int alps_command_mode_write_reg(struct psmouse *psmouse, int addr, in alps_command_mode_write_reg() argument
1766 if (alps_command_mode_set_addr(psmouse, addr)) in alps_command_mode_write_reg()
1768 return __alps_command_mode_write_reg(psmouse, value); in alps_command_mode_write_reg()
1771 static int alps_rpt_cmd(struct psmouse *psmouse, int init_command, in alps_rpt_cmd() argument
1774 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_rpt_cmd()
1789 psmouse_dbg(psmouse, "%2.2X report: %3ph\n", in alps_rpt_cmd()
1810 static int alps_enter_command_mode(struct psmouse *psmouse) in alps_enter_command_mode() argument
1814 if (alps_rpt_cmd(psmouse, 0, PSMOUSE_CMD_RESET_WRAP, param)) { in alps_enter_command_mode()
1815 psmouse_err(psmouse, "failed to enter command mode\n"); in alps_enter_command_mode()
1820 psmouse_dbg(psmouse, in alps_enter_command_mode()
1827 static inline int alps_exit_command_mode(struct psmouse *psmouse) in alps_exit_command_mode() argument
1829 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_exit_command_mode()
1840 static int alps_passthrough_mode_v2(struct psmouse *psmouse, bool enable) in alps_passthrough_mode_v2() argument
1842 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_passthrough_mode_v2()
1857 static int alps_absolute_mode_v1_v2(struct psmouse *psmouse) in alps_absolute_mode_v1_v2() argument
1859 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_absolute_mode_v1_v2()
1876 static int alps_monitor_mode_send_word(struct psmouse *psmouse, u16 word) in alps_monitor_mode_send_word() argument
1886 if (alps_command_mode_send_nibble(psmouse, nibble)) in alps_monitor_mode_send_word()
1893 static int alps_monitor_mode_write_reg(struct psmouse *psmouse, in alps_monitor_mode_write_reg() argument
1896 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_monitor_mode_write_reg()
1900 alps_monitor_mode_send_word(psmouse, 0x0A0) || in alps_monitor_mode_write_reg()
1901 alps_monitor_mode_send_word(psmouse, addr) || in alps_monitor_mode_write_reg()
1902 alps_monitor_mode_send_word(psmouse, value) || in alps_monitor_mode_write_reg()
1909 static int alps_monitor_mode(struct psmouse *psmouse, bool enable) in alps_monitor_mode() argument
1911 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_monitor_mode()
1933 static int alps_absolute_mode_v6(struct psmouse *psmouse) in alps_absolute_mode_v6() argument
1939 if (alps_monitor_mode(psmouse, true)) in alps_absolute_mode_v6()
1942 ret = alps_monitor_mode_write_reg(psmouse, 0x000, reg_val); in alps_absolute_mode_v6()
1944 if (alps_monitor_mode(psmouse, false)) in alps_absolute_mode_v6()
1950 static int alps_get_status(struct psmouse *psmouse, char *param) in alps_get_status() argument
1953 if (alps_rpt_cmd(psmouse, 0, PSMOUSE_CMD_DISABLE, param)) in alps_get_status()
1968 static int alps_tap_mode(struct psmouse *psmouse, int enable) in alps_tap_mode() argument
1970 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_tap_mode()
1981 if (alps_get_status(psmouse, param)) in alps_tap_mode()
1991 static int alps_poll(struct psmouse *psmouse) in alps_poll() argument
1993 struct alps_data *priv = psmouse->private; in alps_poll()
1994 unsigned char buf[sizeof(psmouse->packet)]; in alps_poll()
1998 alps_passthrough_mode_v2(psmouse, true); in alps_poll()
2000 poll_failed = ps2_command(&psmouse->ps2dev, buf, in alps_poll()
2001 PSMOUSE_CMD_POLL | (psmouse->pktsize << 8)) < 0; in alps_poll()
2004 alps_passthrough_mode_v2(psmouse, false); in alps_poll()
2009 if ((psmouse->badbyte & 0xc8) == 0x08) { in alps_poll()
2013 if (ps2_command(&psmouse->ps2dev, buf, PSMOUSE_CMD_POLL | (3 << 8))) in alps_poll()
2017 memcpy(psmouse->packet, buf, sizeof(buf)); in alps_poll()
2021 static int alps_hw_init_v1_v2(struct psmouse *psmouse) in alps_hw_init_v1_v2() argument
2023 struct alps_data *priv = psmouse->private; in alps_hw_init_v1_v2()
2026 alps_passthrough_mode_v2(psmouse, true)) { in alps_hw_init_v1_v2()
2030 if (alps_tap_mode(psmouse, true)) { in alps_hw_init_v1_v2()
2031 psmouse_warn(psmouse, "Failed to enable hardware tapping\n"); in alps_hw_init_v1_v2()
2035 if (alps_absolute_mode_v1_v2(psmouse)) { in alps_hw_init_v1_v2()
2036 psmouse_err(psmouse, "Failed to enable absolute mode\n"); in alps_hw_init_v1_v2()
2041 alps_passthrough_mode_v2(psmouse, false)) { in alps_hw_init_v1_v2()
2046 if (ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSTREAM)) { in alps_hw_init_v1_v2()
2047 psmouse_err(psmouse, "Failed to enable stream mode\n"); in alps_hw_init_v1_v2()
2055 static int alps_trackstick_enter_extended_mode_v3_v6(struct psmouse *psmouse) in alps_trackstick_enter_extended_mode_v3_v6() argument
2059 if (ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || in alps_trackstick_enter_extended_mode_v3_v6()
2060 ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || in alps_trackstick_enter_extended_mode_v3_v6()
2061 ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || in alps_trackstick_enter_extended_mode_v3_v6()
2062 ps2_command(&psmouse->ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE) || in alps_trackstick_enter_extended_mode_v3_v6()
2063 ps2_command(&psmouse->ps2dev, ¶m[1], PSMOUSE_CMD_SETRATE)) in alps_trackstick_enter_extended_mode_v3_v6()
2069 static int alps_hw_init_v6(struct psmouse *psmouse) in alps_hw_init_v6() argument
2074 if (alps_passthrough_mode_v2(psmouse, true)) in alps_hw_init_v6()
2077 ret = alps_trackstick_enter_extended_mode_v3_v6(psmouse); in alps_hw_init_v6()
2079 if (alps_passthrough_mode_v2(psmouse, false)) in alps_hw_init_v6()
2085 if (alps_absolute_mode_v6(psmouse)) { in alps_hw_init_v6()
2086 psmouse_err(psmouse, "Failed to enable absolute mode\n"); in alps_hw_init_v6()
2096 static int alps_passthrough_mode_v3(struct psmouse *psmouse, in alps_passthrough_mode_v3() argument
2101 if (alps_enter_command_mode(psmouse)) in alps_passthrough_mode_v3()
2104 reg_val = alps_command_mode_read_reg(psmouse, reg_base + 0x0008); in alps_passthrough_mode_v3()
2113 ret = __alps_command_mode_write_reg(psmouse, reg_val); in alps_passthrough_mode_v3()
2116 if (alps_exit_command_mode(psmouse)) in alps_passthrough_mode_v3()
2122 static int alps_absolute_mode_v3(struct psmouse *psmouse) in alps_absolute_mode_v3() argument
2126 reg_val = alps_command_mode_read_reg(psmouse, 0x0004); in alps_absolute_mode_v3()
2131 if (__alps_command_mode_write_reg(psmouse, reg_val)) in alps_absolute_mode_v3()
2137 static int alps_probe_trackstick_v3_v7(struct psmouse *psmouse, int reg_base) in alps_probe_trackstick_v3_v7() argument
2141 if (alps_enter_command_mode(psmouse)) in alps_probe_trackstick_v3_v7()
2144 reg_val = alps_command_mode_read_reg(psmouse, reg_base + 0x08); in alps_probe_trackstick_v3_v7()
2152 alps_exit_command_mode(psmouse); in alps_probe_trackstick_v3_v7()
2156 static int alps_setup_trackstick_v3(struct psmouse *psmouse, int reg_base) in alps_setup_trackstick_v3() argument
2170 if (alps_passthrough_mode_v3(psmouse, reg_base, true)) in alps_setup_trackstick_v3()
2182 if (alps_rpt_cmd(psmouse, 0, PSMOUSE_CMD_SETSCALE21, param)) { in alps_setup_trackstick_v3()
2183 psmouse_warn(psmouse, "Failed to initialize trackstick (E7 report failed)\n"); in alps_setup_trackstick_v3()
2186 psmouse_dbg(psmouse, "trackstick E7 report: %3ph\n", param); in alps_setup_trackstick_v3()
2187 if (alps_trackstick_enter_extended_mode_v3_v6(psmouse)) { in alps_setup_trackstick_v3()
2188 psmouse_err(psmouse, "Failed to enter into trackstick extended mode\n"); in alps_setup_trackstick_v3()
2193 if (alps_passthrough_mode_v3(psmouse, reg_base, false)) in alps_setup_trackstick_v3()
2199 if (alps_enter_command_mode(psmouse)) in alps_setup_trackstick_v3()
2202 reg_val = alps_command_mode_read_reg(psmouse, reg_base + 0x08); in alps_setup_trackstick_v3()
2211 if (__alps_command_mode_write_reg(psmouse, reg_val)) in alps_setup_trackstick_v3()
2215 if (alps_exit_command_mode(psmouse)) in alps_setup_trackstick_v3()
2221 static int alps_hw_init_v3(struct psmouse *psmouse) in alps_hw_init_v3() argument
2223 struct alps_data *priv = psmouse->private; in alps_hw_init_v3()
2224 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_hw_init_v3()
2229 alps_setup_trackstick_v3(psmouse, ALPS_REG_BASE_PINNACLE) == -EIO) in alps_hw_init_v3()
2232 if (alps_enter_command_mode(psmouse) || in alps_hw_init_v3()
2233 alps_absolute_mode_v3(psmouse)) { in alps_hw_init_v3()
2234 psmouse_err(psmouse, "Failed to enter absolute mode\n"); in alps_hw_init_v3()
2238 reg_val = alps_command_mode_read_reg(psmouse, 0x0006); in alps_hw_init_v3()
2241 if (__alps_command_mode_write_reg(psmouse, reg_val | 0x01)) in alps_hw_init_v3()
2244 reg_val = alps_command_mode_read_reg(psmouse, 0x0007); in alps_hw_init_v3()
2247 if (__alps_command_mode_write_reg(psmouse, reg_val | 0x01)) in alps_hw_init_v3()
2250 if (alps_command_mode_read_reg(psmouse, 0x0144) == -1) in alps_hw_init_v3()
2252 if (__alps_command_mode_write_reg(psmouse, 0x04)) in alps_hw_init_v3()
2255 if (alps_command_mode_read_reg(psmouse, 0x0159) == -1) in alps_hw_init_v3()
2257 if (__alps_command_mode_write_reg(psmouse, 0x03)) in alps_hw_init_v3()
2260 if (alps_command_mode_read_reg(psmouse, 0x0163) == -1) in alps_hw_init_v3()
2262 if (alps_command_mode_write_reg(psmouse, 0x0163, 0x03)) in alps_hw_init_v3()
2265 if (alps_command_mode_read_reg(psmouse, 0x0162) == -1) in alps_hw_init_v3()
2267 if (alps_command_mode_write_reg(psmouse, 0x0162, 0x04)) in alps_hw_init_v3()
2270 alps_exit_command_mode(psmouse); in alps_hw_init_v3()
2276 psmouse_err(psmouse, "Failed to enable data reporting\n"); in alps_hw_init_v3()
2288 alps_exit_command_mode(psmouse); in alps_hw_init_v3()
2292 static int alps_get_v3_v7_resolution(struct psmouse *psmouse, int reg_pitch) in alps_get_v3_v7_resolution() argument
2295 struct alps_data *priv = psmouse->private; in alps_get_v3_v7_resolution()
2297 reg = alps_command_mode_read_reg(psmouse, reg_pitch); in alps_get_v3_v7_resolution()
2307 reg = alps_command_mode_read_reg(psmouse, reg_pitch + 1); in alps_get_v3_v7_resolution()
2323 psmouse_dbg(psmouse, in alps_get_v3_v7_resolution()
2331 static int alps_hw_init_rushmore_v3(struct psmouse *psmouse) in alps_hw_init_rushmore_v3() argument
2333 struct alps_data *priv = psmouse->private; in alps_hw_init_rushmore_v3()
2334 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_hw_init_rushmore_v3()
2338 reg_val = alps_setup_trackstick_v3(psmouse, in alps_hw_init_rushmore_v3()
2344 if (alps_enter_command_mode(psmouse) || in alps_hw_init_rushmore_v3()
2345 alps_command_mode_read_reg(psmouse, 0xc2d9) == -1 || in alps_hw_init_rushmore_v3()
2346 alps_command_mode_write_reg(psmouse, 0xc2cb, 0x00)) in alps_hw_init_rushmore_v3()
2349 if (alps_get_v3_v7_resolution(psmouse, 0xc2da)) in alps_hw_init_rushmore_v3()
2352 reg_val = alps_command_mode_read_reg(psmouse, 0xc2c6); in alps_hw_init_rushmore_v3()
2355 if (__alps_command_mode_write_reg(psmouse, reg_val & 0xfd)) in alps_hw_init_rushmore_v3()
2358 if (alps_command_mode_write_reg(psmouse, 0xc2c9, 0x64)) in alps_hw_init_rushmore_v3()
2362 reg_val = alps_command_mode_read_reg(psmouse, 0xc2c4); in alps_hw_init_rushmore_v3()
2365 if (__alps_command_mode_write_reg(psmouse, reg_val | 0x02)) in alps_hw_init_rushmore_v3()
2368 alps_exit_command_mode(psmouse); in alps_hw_init_rushmore_v3()
2372 alps_exit_command_mode(psmouse); in alps_hw_init_rushmore_v3()
2377 static int alps_absolute_mode_v4(struct psmouse *psmouse) in alps_absolute_mode_v4() argument
2381 reg_val = alps_command_mode_read_reg(psmouse, 0x0004); in alps_absolute_mode_v4()
2386 if (__alps_command_mode_write_reg(psmouse, reg_val)) in alps_absolute_mode_v4()
2392 static int alps_hw_init_v4(struct psmouse *psmouse) in alps_hw_init_v4() argument
2394 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_hw_init_v4()
2397 if (alps_enter_command_mode(psmouse)) in alps_hw_init_v4()
2400 if (alps_absolute_mode_v4(psmouse)) { in alps_hw_init_v4()
2401 psmouse_err(psmouse, "Failed to enter absolute mode\n"); in alps_hw_init_v4()
2405 if (alps_command_mode_write_reg(psmouse, 0x0007, 0x8c)) in alps_hw_init_v4()
2408 if (alps_command_mode_write_reg(psmouse, 0x0149, 0x03)) in alps_hw_init_v4()
2411 if (alps_command_mode_write_reg(psmouse, 0x0160, 0x03)) in alps_hw_init_v4()
2414 if (alps_command_mode_write_reg(psmouse, 0x017f, 0x15)) in alps_hw_init_v4()
2417 if (alps_command_mode_write_reg(psmouse, 0x0151, 0x01)) in alps_hw_init_v4()
2420 if (alps_command_mode_write_reg(psmouse, 0x0168, 0x03)) in alps_hw_init_v4()
2423 if (alps_command_mode_write_reg(psmouse, 0x014a, 0x03)) in alps_hw_init_v4()
2426 if (alps_command_mode_write_reg(psmouse, 0x0161, 0x03)) in alps_hw_init_v4()
2429 alps_exit_command_mode(psmouse); in alps_hw_init_v4()
2449 psmouse_err(psmouse, "Failed to enable data reporting\n"); in alps_hw_init_v4()
2461 alps_exit_command_mode(psmouse); in alps_hw_init_v4()
2465 static int alps_get_otp_values_ss4_v2(struct psmouse *psmouse, in alps_get_otp_values_ss4_v2() argument
2468 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_get_otp_values_ss4_v2()
2554 struct psmouse *psmouse) in alps_update_dual_info_ss4_v2() argument
2558 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_update_dual_info_ss4_v2()
2565 if (alps_exit_command_mode(psmouse) == 0 && in alps_update_dual_info_ss4_v2()
2566 alps_enter_command_mode(psmouse) == 0) { in alps_update_dual_info_ss4_v2()
2567 reg_val = alps_command_mode_read_reg(psmouse, in alps_update_dual_info_ss4_v2()
2570 alps_exit_command_mode(psmouse); in alps_update_dual_info_ss4_v2()
2585 static int alps_set_defaults_ss4_v2(struct psmouse *psmouse, in alps_set_defaults_ss4_v2() argument
2592 if (alps_get_otp_values_ss4_v2(psmouse, 1, &otp[1][0]) || in alps_set_defaults_ss4_v2()
2593 alps_get_otp_values_ss4_v2(psmouse, 0, &otp[0][0])) in alps_set_defaults_ss4_v2()
2600 alps_update_dual_info_ss4_v2(otp, priv, psmouse); in alps_set_defaults_ss4_v2()
2605 static int alps_dolphin_get_device_area(struct psmouse *psmouse, in alps_dolphin_get_device_area() argument
2608 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_dolphin_get_device_area()
2612 if (alps_enter_command_mode(psmouse)) in alps_dolphin_get_device_area()
2645 if (alps_exit_command_mode(psmouse)) in alps_dolphin_get_device_area()
2651 static int alps_hw_init_dolphin_v1(struct psmouse *psmouse) in alps_hw_init_dolphin_v1() argument
2653 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_hw_init_dolphin_v1()
2668 static int alps_hw_init_v7(struct psmouse *psmouse) in alps_hw_init_v7() argument
2670 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_hw_init_v7()
2673 if (alps_enter_command_mode(psmouse) || in alps_hw_init_v7()
2674 alps_command_mode_read_reg(psmouse, 0xc2d9) == -1) in alps_hw_init_v7()
2677 if (alps_get_v3_v7_resolution(psmouse, 0xc397)) in alps_hw_init_v7()
2680 if (alps_command_mode_write_reg(psmouse, 0xc2c9, 0x64)) in alps_hw_init_v7()
2683 reg_val = alps_command_mode_read_reg(psmouse, 0xc2c4); in alps_hw_init_v7()
2686 if (__alps_command_mode_write_reg(psmouse, reg_val | 0x02)) in alps_hw_init_v7()
2689 alps_exit_command_mode(psmouse); in alps_hw_init_v7()
2693 alps_exit_command_mode(psmouse); in alps_hw_init_v7()
2697 static int alps_hw_init_ss4_v2(struct psmouse *psmouse) in alps_hw_init_ss4_v2() argument
2699 struct ps2dev *ps2dev = &psmouse->ps2dev; in alps_hw_init_ss4_v2()
2712 if (alps_exit_command_mode(psmouse) || in alps_hw_init_ss4_v2()
2713 alps_enter_command_mode(psmouse) || in alps_hw_init_ss4_v2()
2714 alps_command_mode_write_reg(psmouse, 0x001D, 0x20)) { in alps_hw_init_ss4_v2()
2717 alps_exit_command_mode(psmouse); in alps_hw_init_ss4_v2()
2722 alps_exit_command_mode(psmouse); in alps_hw_init_ss4_v2()
2726 static int alps_set_protocol(struct psmouse *psmouse, in alps_set_protocol() argument
2730 psmouse->private = priv; in alps_set_protocol()
2764 if (alps_probe_trackstick_v3_v7(psmouse, in alps_set_protocol()
2780 if (alps_probe_trackstick_v3_v7(psmouse, in alps_set_protocol()
2804 if (alps_dolphin_get_device_area(psmouse, priv)) in alps_set_protocol()
2831 if (alps_probe_trackstick_v3_v7(psmouse, ALPS_REG_BASE_V7) < 0) in alps_set_protocol()
2844 if (alps_set_defaults_ss4_v2(psmouse, priv)) in alps_set_protocol()
2869 static bool alps_is_cs19_trackpoint(struct psmouse *psmouse) in alps_is_cs19_trackpoint() argument
2873 if (ps2_command(&psmouse->ps2dev, in alps_is_cs19_trackpoint()
2886 static int alps_identify(struct psmouse *psmouse, struct alps_data *priv) in alps_identify() argument
2898 if (alps_rpt_cmd(psmouse, PSMOUSE_CMD_SETRES, in alps_identify()
2909 if (alps_rpt_cmd(psmouse, PSMOUSE_CMD_SETRES, in alps_identify()
2911 alps_rpt_cmd(psmouse, PSMOUSE_CMD_SETRES, in alps_identify()
2913 alps_exit_command_mode(psmouse)) in alps_identify()
2937 psmouse_warn(psmouse, in alps_identify()
2942 psmouse_dbg(psmouse, in alps_identify()
2952 error = alps_set_protocol(psmouse, priv, protocol); in alps_identify()
2960 static int alps_reconnect(struct psmouse *psmouse) in alps_reconnect() argument
2962 struct alps_data *priv = psmouse->private; in alps_reconnect()
2964 psmouse_reset(psmouse); in alps_reconnect()
2966 if (alps_identify(psmouse, priv) < 0) in alps_reconnect()
2969 return priv->hw_init(psmouse); in alps_reconnect()
2972 static void alps_disconnect(struct psmouse *psmouse) in alps_disconnect() argument
2974 struct alps_data *priv = psmouse->private; in alps_disconnect()
2976 psmouse_reset(psmouse); in alps_disconnect()
3042 int alps_init(struct psmouse *psmouse) in alps_init() argument
3044 struct alps_data *priv = psmouse->private; in alps_init()
3045 struct input_dev *dev1 = psmouse->dev; in alps_init()
3048 error = priv->hw_init(psmouse); in alps_init()
3100 psmouse_err(psmouse, in alps_init()
3107 psmouse->ps2dev.serio->phys); in alps_init()
3120 dev2->dev.parent = &psmouse->ps2dev.serio->dev; in alps_init()
3137 psmouse_err(psmouse, in alps_init()
3147 priv->psmouse = psmouse; in alps_init()
3152 psmouse->protocol_handler = alps_process_byte; in alps_init()
3153 psmouse->poll = alps_poll; in alps_init()
3154 psmouse->disconnect = alps_disconnect; in alps_init()
3155 psmouse->reconnect = alps_reconnect; in alps_init()
3156 psmouse->pktsize = priv->proto_version == ALPS_PROTO_V4 ? 8 : 6; in alps_init()
3159 psmouse->resync_time = 0; in alps_init()
3162 psmouse->resetafter = psmouse->pktsize * 2; in alps_init()
3167 psmouse_reset(psmouse); in alps_init()
3172 kfree(psmouse->private); in alps_init()
3173 psmouse->private = NULL; in alps_init()
3177 int alps_detect(struct psmouse *psmouse, bool set_properties) in alps_detect() argument
3182 error = alps_identify(psmouse, NULL); in alps_detect()
3194 if (alps_is_cs19_trackpoint(psmouse)) { in alps_detect()
3195 psmouse_dbg(psmouse, in alps_detect()
3206 psmouse_reset(psmouse); in alps_detect()
3212 error = alps_identify(psmouse, priv); in alps_detect()
3219 psmouse->vendor = "ALPS"; in alps_detect()
3220 psmouse->name = priv->flags & ALPS_DUALPOINT ? in alps_detect()
3222 psmouse->model = priv->proto_version; in alps_detect()
3231 psmouse->private = NULL; in alps_detect()