xref: /linux-6.15/drivers/input/mouse/logips2pp.c (revision 58057b9e)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * Logitech PS/2++ mouse driver
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  * Copyright (c) 1999-2003 Vojtech Pavlik <[email protected]>
51da177e4SLinus Torvalds  * Copyright (c) 2003 Eric Wong <[email protected]>
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  * This program is free software; you can redistribute it and/or modify it
81da177e4SLinus Torvalds  * under the terms of the GNU General Public License version 2 as published by
91da177e4SLinus Torvalds  * the Free Software Foundation.
101da177e4SLinus Torvalds  */
111da177e4SLinus Torvalds 
121da177e4SLinus Torvalds #include <linux/input.h>
131da177e4SLinus Torvalds #include <linux/serio.h>
141da177e4SLinus Torvalds #include <linux/libps2.h>
151da177e4SLinus Torvalds #include "psmouse.h"
161da177e4SLinus Torvalds #include "logips2pp.h"
171da177e4SLinus Torvalds 
181da177e4SLinus Torvalds /* Logitech mouse types */
191da177e4SLinus Torvalds #define PS2PP_KIND_WHEEL	1
201da177e4SLinus Torvalds #define PS2PP_KIND_MX		2
211da177e4SLinus Torvalds #define PS2PP_KIND_TP3		3
221da177e4SLinus Torvalds 
231da177e4SLinus Torvalds /* Logitech mouse features */
241da177e4SLinus Torvalds #define PS2PP_WHEEL		0x01
251da177e4SLinus Torvalds #define PS2PP_HWHEEL		0x02
261da177e4SLinus Torvalds #define PS2PP_SIDE_BTN		0x04
271da177e4SLinus Torvalds #define PS2PP_EXTRA_BTN		0x08
281da177e4SLinus Torvalds #define PS2PP_TASK_BTN		0x10
291da177e4SLinus Torvalds #define PS2PP_NAV_BTN		0x20
301da177e4SLinus Torvalds 
311da177e4SLinus Torvalds struct ps2pp_info {
321da177e4SLinus Torvalds 	const int model;
331da177e4SLinus Torvalds 	unsigned const int kind;
341da177e4SLinus Torvalds 	unsigned const int features;
351da177e4SLinus Torvalds };
361da177e4SLinus Torvalds 
371da177e4SLinus Torvalds /*
381da177e4SLinus Torvalds  * Process a PS2++ or PS2T++ packet.
391da177e4SLinus Torvalds  */
401da177e4SLinus Torvalds 
411da177e4SLinus Torvalds static psmouse_ret_t ps2pp_process_byte(struct psmouse *psmouse, struct pt_regs *regs)
421da177e4SLinus Torvalds {
432e5b636bSDmitry Torokhov 	struct input_dev *dev = psmouse->dev;
441da177e4SLinus Torvalds 	unsigned char *packet = psmouse->packet;
451da177e4SLinus Torvalds 
461da177e4SLinus Torvalds 	if (psmouse->pktcnt < 3)
471da177e4SLinus Torvalds 		return PSMOUSE_GOOD_DATA;
481da177e4SLinus Torvalds 
491da177e4SLinus Torvalds /*
501da177e4SLinus Torvalds  * Full packet accumulated, process it
511da177e4SLinus Torvalds  */
521da177e4SLinus Torvalds 
531da177e4SLinus Torvalds 	input_regs(dev, regs);
541da177e4SLinus Torvalds 
551da177e4SLinus Torvalds 	if ((packet[0] & 0x48) == 0x48 && (packet[1] & 0x02) == 0x02) {
561da177e4SLinus Torvalds 
571da177e4SLinus Torvalds 		/* Logitech extended packet */
581da177e4SLinus Torvalds 		switch ((packet[1] >> 4) | (packet[0] & 0x30)) {
591da177e4SLinus Torvalds 
601da177e4SLinus Torvalds 			case 0x0d: /* Mouse extra info */
611da177e4SLinus Torvalds 
621da177e4SLinus Torvalds 				input_report_rel(dev, packet[2] & 0x80 ? REL_HWHEEL : REL_WHEEL,
631da177e4SLinus Torvalds 					(int) (packet[2] & 8) - (int) (packet[2] & 7));
641da177e4SLinus Torvalds 				input_report_key(dev, BTN_SIDE, (packet[2] >> 4) & 1);
651da177e4SLinus Torvalds 				input_report_key(dev, BTN_EXTRA, (packet[2] >> 5) & 1);
661da177e4SLinus Torvalds 
671da177e4SLinus Torvalds 				break;
681da177e4SLinus Torvalds 
691da177e4SLinus Torvalds 			case 0x0e: /* buttons 4, 5, 6, 7, 8, 9, 10 info */
701da177e4SLinus Torvalds 
711da177e4SLinus Torvalds 				input_report_key(dev, BTN_SIDE, (packet[2]) & 1);
721da177e4SLinus Torvalds 				input_report_key(dev, BTN_EXTRA, (packet[2] >> 1) & 1);
731da177e4SLinus Torvalds 				input_report_key(dev, BTN_BACK, (packet[2] >> 3) & 1);
741da177e4SLinus Torvalds 				input_report_key(dev, BTN_FORWARD, (packet[2] >> 4) & 1);
751da177e4SLinus Torvalds 				input_report_key(dev, BTN_TASK, (packet[2] >> 2) & 1);
761da177e4SLinus Torvalds 
771da177e4SLinus Torvalds 				break;
781da177e4SLinus Torvalds 
791da177e4SLinus Torvalds 			case 0x0f: /* TouchPad extra info */
801da177e4SLinus Torvalds 
811da177e4SLinus Torvalds 				input_report_rel(dev, packet[2] & 0x08 ? REL_HWHEEL : REL_WHEEL,
821da177e4SLinus Torvalds 					(int) ((packet[2] >> 4) & 8) - (int) ((packet[2] >> 4) & 7));
831da177e4SLinus Torvalds 				packet[0] = packet[2] | 0x08;
841da177e4SLinus Torvalds 				break;
851da177e4SLinus Torvalds 
861da177e4SLinus Torvalds #ifdef DEBUG
871da177e4SLinus Torvalds 			default:
881da177e4SLinus Torvalds 				printk(KERN_WARNING "psmouse.c: Received PS2++ packet #%x, but don't know how to handle.\n",
891da177e4SLinus Torvalds 					(packet[1] >> 4) | (packet[0] & 0x30));
901da177e4SLinus Torvalds #endif
911da177e4SLinus Torvalds 		}
921da177e4SLinus Torvalds 	} else {
931da177e4SLinus Torvalds 		/* Standard PS/2 motion data */
941da177e4SLinus Torvalds 		input_report_rel(dev, REL_X, packet[1] ? (int) packet[1] - (int) ((packet[0] << 4) & 0x100) : 0);
951da177e4SLinus Torvalds 		input_report_rel(dev, REL_Y, packet[2] ? (int) ((packet[0] << 3) & 0x100) - (int) packet[2] : 0);
961da177e4SLinus Torvalds 	}
971da177e4SLinus Torvalds 
981da177e4SLinus Torvalds 	input_report_key(dev, BTN_LEFT,    packet[0]       & 1);
991da177e4SLinus Torvalds 	input_report_key(dev, BTN_MIDDLE, (packet[0] >> 2) & 1);
1001da177e4SLinus Torvalds 	input_report_key(dev, BTN_RIGHT,  (packet[0] >> 1) & 1);
1011da177e4SLinus Torvalds 
1021da177e4SLinus Torvalds 	input_sync(dev);
1031da177e4SLinus Torvalds 
1041da177e4SLinus Torvalds 	return PSMOUSE_FULL_PACKET;
1051da177e4SLinus Torvalds 
1061da177e4SLinus Torvalds }
1071da177e4SLinus Torvalds 
1081da177e4SLinus Torvalds /*
1091da177e4SLinus Torvalds  * ps2pp_cmd() sends a PS2++ command, sliced into two bit
1101da177e4SLinus Torvalds  * pieces through the SETRES command. This is needed to send extended
1111da177e4SLinus Torvalds  * commands to mice on notebooks that try to understand the PS/2 protocol
1121da177e4SLinus Torvalds  * Ugly.
1131da177e4SLinus Torvalds  */
1141da177e4SLinus Torvalds 
1151da177e4SLinus Torvalds static int ps2pp_cmd(struct psmouse *psmouse, unsigned char *param, unsigned char command)
1161da177e4SLinus Torvalds {
1171da177e4SLinus Torvalds 	if (psmouse_sliced_command(psmouse, command))
1181da177e4SLinus Torvalds 		return -1;
1191da177e4SLinus Torvalds 
1201da177e4SLinus Torvalds 	if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_POLL))
1211da177e4SLinus Torvalds 		return -1;
1221da177e4SLinus Torvalds 
1231da177e4SLinus Torvalds 	return 0;
1241da177e4SLinus Torvalds }
1251da177e4SLinus Torvalds 
1261da177e4SLinus Torvalds /*
1271da177e4SLinus Torvalds  * SmartScroll / CruiseControl for some newer Logitech mice Defaults to
1281da177e4SLinus Torvalds  * enabled if we do nothing to it. Of course I put this in because I want it
1291da177e4SLinus Torvalds  * disabled :P
1301da177e4SLinus Torvalds  * 1 - enabled (if previously disabled, also default)
1311da177e4SLinus Torvalds  * 0 - disabled
1321da177e4SLinus Torvalds  */
1331da177e4SLinus Torvalds 
1341da177e4SLinus Torvalds static void ps2pp_set_smartscroll(struct psmouse *psmouse, unsigned int smartscroll)
1351da177e4SLinus Torvalds {
1361da177e4SLinus Torvalds 	struct ps2dev *ps2dev = &psmouse->ps2dev;
1371da177e4SLinus Torvalds 	unsigned char param[4];
1381da177e4SLinus Torvalds 
1391da177e4SLinus Torvalds 	if (smartscroll > 1)
1401da177e4SLinus Torvalds 		smartscroll = 1;
1411da177e4SLinus Torvalds 
1421da177e4SLinus Torvalds 	ps2pp_cmd(psmouse, param, 0x32);
1431da177e4SLinus Torvalds 
1441da177e4SLinus Torvalds 	param[0] = 0;
1451da177e4SLinus Torvalds 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
1461da177e4SLinus Torvalds 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
1471da177e4SLinus Torvalds 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
1481da177e4SLinus Torvalds 
1491da177e4SLinus Torvalds 	param[0] = smartscroll;
1501da177e4SLinus Torvalds 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
1511da177e4SLinus Torvalds }
1521da177e4SLinus Torvalds 
153cfe9e888SDmitry Torokhov static ssize_t ps2pp_attr_show_smartscroll(struct psmouse *psmouse, void *data, char *buf)
1541da177e4SLinus Torvalds {
1551da177e4SLinus Torvalds 	return sprintf(buf, "%d\n", psmouse->smartscroll ? 1 : 0);
1561da177e4SLinus Torvalds }
1571da177e4SLinus Torvalds 
158cfe9e888SDmitry Torokhov static ssize_t ps2pp_attr_set_smartscroll(struct psmouse *psmouse, void *data, const char *buf, size_t count)
1591da177e4SLinus Torvalds {
1601da177e4SLinus Torvalds 	unsigned long value;
1611da177e4SLinus Torvalds 	char *rest;
1621da177e4SLinus Torvalds 
1631da177e4SLinus Torvalds 	value = simple_strtoul(buf, &rest, 10);
1641da177e4SLinus Torvalds 	if (*rest || value > 1)
1651da177e4SLinus Torvalds 		return -EINVAL;
1661da177e4SLinus Torvalds 
1671da177e4SLinus Torvalds 	ps2pp_set_smartscroll(psmouse, value);
1681da177e4SLinus Torvalds 	psmouse->smartscroll = value;
1691da177e4SLinus Torvalds 	return count;
1701da177e4SLinus Torvalds }
1711da177e4SLinus Torvalds 
172cfe9e888SDmitry Torokhov PSMOUSE_DEFINE_ATTR(smartscroll, S_IWUSR | S_IRUGO, NULL,
173cfe9e888SDmitry Torokhov 			ps2pp_attr_show_smartscroll, ps2pp_attr_set_smartscroll);
1741da177e4SLinus Torvalds 
1751da177e4SLinus Torvalds /*
1761da177e4SLinus Torvalds  * Support 800 dpi resolution _only_ if the user wants it (there are good
1771da177e4SLinus Torvalds  * reasons to not use it even if the mouse supports it, and of course there are
1781da177e4SLinus Torvalds  * also good reasons to use it, let the user decide).
1791da177e4SLinus Torvalds  */
1801da177e4SLinus Torvalds 
1811da177e4SLinus Torvalds static void ps2pp_set_resolution(struct psmouse *psmouse, unsigned int resolution)
1821da177e4SLinus Torvalds {
1831da177e4SLinus Torvalds 	if (resolution > 400) {
1841da177e4SLinus Torvalds 		struct ps2dev *ps2dev = &psmouse->ps2dev;
1851da177e4SLinus Torvalds 		unsigned char param = 3;
1861da177e4SLinus Torvalds 
1871da177e4SLinus Torvalds 		ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
1881da177e4SLinus Torvalds 		ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
1891da177e4SLinus Torvalds 		ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
1901da177e4SLinus Torvalds 		ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
1911da177e4SLinus Torvalds 		psmouse->resolution = 800;
1921da177e4SLinus Torvalds 	} else
1931da177e4SLinus Torvalds 		psmouse_set_resolution(psmouse, resolution);
1941da177e4SLinus Torvalds }
1951da177e4SLinus Torvalds 
1961da177e4SLinus Torvalds static void ps2pp_disconnect(struct psmouse *psmouse)
1971da177e4SLinus Torvalds {
198cfe9e888SDmitry Torokhov 	device_remove_file(&psmouse->ps2dev.serio->dev, &psmouse_attr_smartscroll.dattr);
1991da177e4SLinus Torvalds }
2001da177e4SLinus Torvalds 
2011da177e4SLinus Torvalds static struct ps2pp_info *get_model_info(unsigned char model)
2021da177e4SLinus Torvalds {
2031da177e4SLinus Torvalds 	static struct ps2pp_info ps2pp_list[] = {
2041da177e4SLinus Torvalds 		{ 12,	0,			PS2PP_SIDE_BTN},
2051da177e4SLinus Torvalds 		{ 13,	0,			0 },
2061da177e4SLinus Torvalds 		{ 15,	PS2PP_KIND_MX,					/* MX1000 */
2071da177e4SLinus Torvalds 				PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
2081da177e4SLinus Torvalds 				PS2PP_EXTRA_BTN | PS2PP_NAV_BTN | PS2PP_HWHEEL },
2091da177e4SLinus Torvalds 		{ 40,	0,			PS2PP_SIDE_BTN },
2101da177e4SLinus Torvalds 		{ 41,	0,			PS2PP_SIDE_BTN },
2111da177e4SLinus Torvalds 		{ 42,	0,			PS2PP_SIDE_BTN },
2121da177e4SLinus Torvalds 		{ 43,	0,			PS2PP_SIDE_BTN },
2131da177e4SLinus Torvalds 		{ 50,	0,			0 },
2141da177e4SLinus Torvalds 		{ 51,	0,			0 },
2151da177e4SLinus Torvalds 		{ 52,	PS2PP_KIND_WHEEL,	PS2PP_SIDE_BTN | PS2PP_WHEEL },
2161da177e4SLinus Torvalds 		{ 53,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
2171da177e4SLinus Torvalds 		{ 61,	PS2PP_KIND_MX,					/* MX700 */
2181da177e4SLinus Torvalds 				PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
2191da177e4SLinus Torvalds 				PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
22014a48b44SMirco Macrelli 		{ 66,	PS2PP_KIND_MX,					/* MX3100 reciver */
22114a48b44SMirco Macrelli 				PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
22214a48b44SMirco Macrelli 				PS2PP_EXTRA_BTN | PS2PP_NAV_BTN | PS2PP_HWHEEL },
2231da177e4SLinus Torvalds 		{ 73,	0,			PS2PP_SIDE_BTN },
2241da177e4SLinus Torvalds 		{ 75,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
2251da177e4SLinus Torvalds 		{ 76,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
2261da177e4SLinus Torvalds 		{ 80,	PS2PP_KIND_WHEEL,	PS2PP_SIDE_BTN | PS2PP_WHEEL },
2271da177e4SLinus Torvalds 		{ 81,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
2281da177e4SLinus Torvalds 		{ 83,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
229*58057b9eSJasper Spaans 		{ 85,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
230d2b5ffcaSVojtech Pavlik 		{ 86,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
2311da177e4SLinus Torvalds 		{ 88,	PS2PP_KIND_WHEEL,	PS2PP_WHEEL },
2321da177e4SLinus Torvalds 		{ 96,	0,			0 },
2331da177e4SLinus Torvalds 		{ 97,	PS2PP_KIND_TP3,		PS2PP_WHEEL | PS2PP_HWHEEL },
2341da177e4SLinus Torvalds 		{ 100,	PS2PP_KIND_MX,					/* MX510 */
2351da177e4SLinus Torvalds 				PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
2361da177e4SLinus Torvalds 				PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
2371da177e4SLinus Torvalds 		{ 111,  PS2PP_KIND_MX,					/* MX300 */
2381da177e4SLinus Torvalds 				PS2PP_WHEEL | PS2PP_EXTRA_BTN | PS2PP_TASK_BTN },
2391da177e4SLinus Torvalds 		{ 112,	PS2PP_KIND_MX,					/* MX500 */
2401da177e4SLinus Torvalds 				PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
2411da177e4SLinus Torvalds 				PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
2421da177e4SLinus Torvalds 		{ 114,	PS2PP_KIND_MX,					/* MX310 */
2431da177e4SLinus Torvalds 				PS2PP_WHEEL | PS2PP_SIDE_BTN |
2441da177e4SLinus Torvalds 				PS2PP_TASK_BTN | PS2PP_EXTRA_BTN },
2451da177e4SLinus Torvalds 		{ }
2461da177e4SLinus Torvalds 	};
2471da177e4SLinus Torvalds 	int i;
2481da177e4SLinus Torvalds 
2491da177e4SLinus Torvalds 	for (i = 0; ps2pp_list[i].model; i++)
2501da177e4SLinus Torvalds 		if (model == ps2pp_list[i].model)
2511da177e4SLinus Torvalds 			return &ps2pp_list[i];
2521da177e4SLinus Torvalds 
2531da177e4SLinus Torvalds 	printk(KERN_WARNING "logips2pp: Detected unknown logitech mouse model %d\n", model);
2541da177e4SLinus Torvalds 	return NULL;
2551da177e4SLinus Torvalds }
2561da177e4SLinus Torvalds 
2571da177e4SLinus Torvalds /*
2581da177e4SLinus Torvalds  * Set up input device's properties based on the detected mouse model.
2591da177e4SLinus Torvalds  */
2601da177e4SLinus Torvalds 
2611da177e4SLinus Torvalds static void ps2pp_set_model_properties(struct psmouse *psmouse, struct ps2pp_info *model_info,
2621da177e4SLinus Torvalds 				       int using_ps2pp)
2631da177e4SLinus Torvalds {
2642e5b636bSDmitry Torokhov 	struct input_dev *input_dev = psmouse->dev;
2652e5b636bSDmitry Torokhov 
2661da177e4SLinus Torvalds 	if (model_info->features & PS2PP_SIDE_BTN)
2672e5b636bSDmitry Torokhov 		set_bit(BTN_SIDE, input_dev->keybit);
2681da177e4SLinus Torvalds 
2691da177e4SLinus Torvalds 	if (model_info->features & PS2PP_EXTRA_BTN)
2702e5b636bSDmitry Torokhov 		set_bit(BTN_EXTRA, input_dev->keybit);
2711da177e4SLinus Torvalds 
2721da177e4SLinus Torvalds 	if (model_info->features & PS2PP_TASK_BTN)
2732e5b636bSDmitry Torokhov 		set_bit(BTN_TASK, input_dev->keybit);
2741da177e4SLinus Torvalds 
2751da177e4SLinus Torvalds 	if (model_info->features & PS2PP_NAV_BTN) {
2762e5b636bSDmitry Torokhov 		set_bit(BTN_FORWARD, input_dev->keybit);
2772e5b636bSDmitry Torokhov 		set_bit(BTN_BACK, input_dev->keybit);
2781da177e4SLinus Torvalds 	}
2791da177e4SLinus Torvalds 
2801da177e4SLinus Torvalds 	if (model_info->features & PS2PP_WHEEL)
2812e5b636bSDmitry Torokhov 		set_bit(REL_WHEEL, input_dev->relbit);
2821da177e4SLinus Torvalds 
2831da177e4SLinus Torvalds 	if (model_info->features & PS2PP_HWHEEL)
2842e5b636bSDmitry Torokhov 		set_bit(REL_HWHEEL, input_dev->relbit);
2851da177e4SLinus Torvalds 
2861da177e4SLinus Torvalds 	switch (model_info->kind) {
2871da177e4SLinus Torvalds 		case PS2PP_KIND_WHEEL:
2881da177e4SLinus Torvalds 			psmouse->name = "Wheel Mouse";
2891da177e4SLinus Torvalds 			break;
2901da177e4SLinus Torvalds 
2911da177e4SLinus Torvalds 		case PS2PP_KIND_MX:
2921da177e4SLinus Torvalds 			psmouse->name = "MX Mouse";
2931da177e4SLinus Torvalds 			break;
2941da177e4SLinus Torvalds 
2951da177e4SLinus Torvalds 		case PS2PP_KIND_TP3:
2961da177e4SLinus Torvalds 			psmouse->name = "TouchPad 3";
2971da177e4SLinus Torvalds 			break;
2981da177e4SLinus Torvalds 
2991da177e4SLinus Torvalds 		default:
3001da177e4SLinus Torvalds 			/*
3011da177e4SLinus Torvalds 			 * Set name to "Mouse" only when using PS2++,
3021da177e4SLinus Torvalds 			 * otherwise let other protocols define suitable
3031da177e4SLinus Torvalds 			 * name
3041da177e4SLinus Torvalds 			 */
3051da177e4SLinus Torvalds 			if (using_ps2pp)
3061da177e4SLinus Torvalds 				psmouse->name = "Mouse";
3071da177e4SLinus Torvalds 			break;
3081da177e4SLinus Torvalds 	}
3091da177e4SLinus Torvalds }
3101da177e4SLinus Torvalds 
3111da177e4SLinus Torvalds 
3121da177e4SLinus Torvalds /*
3131da177e4SLinus Torvalds  * Logitech magic init. Detect whether the mouse is a Logitech one
3141da177e4SLinus Torvalds  * and its exact model and try turning on extended protocol for ones
3151da177e4SLinus Torvalds  * that support it.
3161da177e4SLinus Torvalds  */
3171da177e4SLinus Torvalds 
3181da177e4SLinus Torvalds int ps2pp_init(struct psmouse *psmouse, int set_properties)
3191da177e4SLinus Torvalds {
3201da177e4SLinus Torvalds 	struct ps2dev *ps2dev = &psmouse->ps2dev;
3211da177e4SLinus Torvalds 	unsigned char param[4];
3221da177e4SLinus Torvalds 	unsigned char model, buttons;
3231da177e4SLinus Torvalds 	struct ps2pp_info *model_info;
3241da177e4SLinus Torvalds 	int use_ps2pp = 0;
3251da177e4SLinus Torvalds 
3261da177e4SLinus Torvalds 	param[0] = 0;
3271da177e4SLinus Torvalds 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
3281da177e4SLinus Torvalds 	ps2_command(ps2dev,  NULL, PSMOUSE_CMD_SETSCALE11);
3291da177e4SLinus Torvalds 	ps2_command(ps2dev,  NULL, PSMOUSE_CMD_SETSCALE11);
3301da177e4SLinus Torvalds 	ps2_command(ps2dev,  NULL, PSMOUSE_CMD_SETSCALE11);
3311da177e4SLinus Torvalds 	param[1] = 0;
3321da177e4SLinus Torvalds 	ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
3331da177e4SLinus Torvalds 
3341da177e4SLinus Torvalds 	if (!param[1])
3351da177e4SLinus Torvalds 		return -1;
3361da177e4SLinus Torvalds 
3371da177e4SLinus Torvalds 	model = ((param[0] >> 4) & 0x07) | ((param[0] << 3) & 0x78);
3381da177e4SLinus Torvalds 	buttons = param[1];
3391da177e4SLinus Torvalds 
3401da177e4SLinus Torvalds 	if ((model_info = get_model_info(model)) != NULL) {
3411da177e4SLinus Torvalds 
3421da177e4SLinus Torvalds /*
3431da177e4SLinus Torvalds  * Do Logitech PS2++ / PS2T++ magic init.
3441da177e4SLinus Torvalds  */
3451da177e4SLinus Torvalds 		if (model == 97) { /* Touch Pad 3 */
3461da177e4SLinus Torvalds 
3471da177e4SLinus Torvalds 			/* Unprotect RAM */
3481da177e4SLinus Torvalds 			param[0] = 0x11; param[1] = 0x04; param[2] = 0x68;
3491da177e4SLinus Torvalds 			ps2_command(ps2dev, param, 0x30d1);
3501da177e4SLinus Torvalds 			/* Enable features */
3511da177e4SLinus Torvalds 			param[0] = 0x11; param[1] = 0x05; param[2] = 0x0b;
3521da177e4SLinus Torvalds 			ps2_command(ps2dev, param, 0x30d1);
3531da177e4SLinus Torvalds 			/* Enable PS2++ */
3541da177e4SLinus Torvalds 			param[0] = 0x11; param[1] = 0x09; param[2] = 0xc3;
3551da177e4SLinus Torvalds 			ps2_command(ps2dev, param, 0x30d1);
3561da177e4SLinus Torvalds 
3571da177e4SLinus Torvalds 			param[0] = 0;
3581da177e4SLinus Torvalds 			if (!ps2_command(ps2dev, param, 0x13d1) &&
3591da177e4SLinus Torvalds 			    param[0] == 0x06 && param[1] == 0x00 && param[2] == 0x14) {
3601da177e4SLinus Torvalds 				use_ps2pp = 1;
3611da177e4SLinus Torvalds 			}
3621da177e4SLinus Torvalds 
3631da177e4SLinus Torvalds 		} else {
3641da177e4SLinus Torvalds 
3651da177e4SLinus Torvalds 			param[0] = param[1] = param[2] = 0;
3661da177e4SLinus Torvalds 			ps2pp_cmd(psmouse, param, 0x39); /* Magic knock */
3671da177e4SLinus Torvalds 			ps2pp_cmd(psmouse, param, 0xDB);
3681da177e4SLinus Torvalds 
3691da177e4SLinus Torvalds 			if ((param[0] & 0x78) == 0x48 &&
3701da177e4SLinus Torvalds 			    (param[1] & 0xf3) == 0xc2 &&
3711da177e4SLinus Torvalds 			    (param[2] & 0x03) == ((param[1] >> 2) & 3)) {
3721da177e4SLinus Torvalds 				ps2pp_set_smartscroll(psmouse, psmouse->smartscroll);
3731da177e4SLinus Torvalds 				use_ps2pp = 1;
3741da177e4SLinus Torvalds 			}
3751da177e4SLinus Torvalds 		}
3761da177e4SLinus Torvalds 	}
3771da177e4SLinus Torvalds 
3781da177e4SLinus Torvalds 	if (set_properties) {
3791da177e4SLinus Torvalds 		psmouse->vendor = "Logitech";
3801da177e4SLinus Torvalds 		psmouse->model = model;
3811da177e4SLinus Torvalds 
3821da177e4SLinus Torvalds 		if (use_ps2pp) {
3831da177e4SLinus Torvalds 			psmouse->protocol_handler = ps2pp_process_byte;
3841da177e4SLinus Torvalds 			psmouse->pktsize = 3;
3851da177e4SLinus Torvalds 
3861da177e4SLinus Torvalds 			if (model_info->kind != PS2PP_KIND_TP3) {
3871da177e4SLinus Torvalds 				psmouse->set_resolution = ps2pp_set_resolution;
3881da177e4SLinus Torvalds 				psmouse->disconnect = ps2pp_disconnect;
3891da177e4SLinus Torvalds 
390cfe9e888SDmitry Torokhov 				device_create_file(&psmouse->ps2dev.serio->dev,
391cfe9e888SDmitry Torokhov 						   &psmouse_attr_smartscroll.dattr);
3921da177e4SLinus Torvalds 			}
3931da177e4SLinus Torvalds 		}
3941da177e4SLinus Torvalds 
3951da177e4SLinus Torvalds 		if (buttons < 3)
3962e5b636bSDmitry Torokhov 			clear_bit(BTN_MIDDLE, psmouse->dev->keybit);
3971da177e4SLinus Torvalds 
3981da177e4SLinus Torvalds 		if (model_info)
3991da177e4SLinus Torvalds 			ps2pp_set_model_properties(psmouse, model_info, use_ps2pp);
4001da177e4SLinus Torvalds 	}
4011da177e4SLinus Torvalds 
4021da177e4SLinus Torvalds 	return use_ps2pp ? 0 : -1;
4031da177e4SLinus Torvalds }
4041da177e4SLinus Torvalds 
405