Commit 3b7e09fa authored by George Pantalos's avatar George Pantalos Committed by Dmitry Torokhov
Browse files

Input: ALPS - add semi-MT support for v4 protocol 



This patch adds semi-MT support for ALPS v4 protocol touchpads.
It is based on the work by Seth Forshee for ALPS v3 and v4 protocol
support. Three packets are required to assemble and process the MT
data. ST events are reported at once to avoid latency. If there
were two contacts or more, report MT data instead of ST events.

Thanks to Seth Forshee for providing most of the code, guidance
and insight for producing this patch.

Signed-off-by: default avatarGeorge Pantalos <gpantalos@gmail.com>
Acked-by: default avatarSeth Forshee <seth.forshee@canonical.com>
Signed-off-by: default avatarDmitry Torokhov <dtor@mail.ru>
parent ae99ea56

drivers/input/mouse/alps.c

+73 −6
Original line number Diff line number Diff line
@@ -604,10 +604,54 @@ static void alps_process_packet_v3(struct psmouse *psmouse) 


static void alps_process_packet_v4(struct psmouse *psmouse)

{

	struct alps_data *priv = psmouse->private;

	unsigned char *packet = psmouse->packet;

	struct input_dev *dev = psmouse->dev;

	int offset;

	int x, y, z;

	int left, right;

	int x1, y1, x2, y2;

	int fingers = 0;

	unsigned int x_bitmap, y_bitmap;



	/*

	 * v4 has a 6-byte encoding for bitmap data, but this data is

	 * broken up between 3 normal packets. Use priv->multi_packet to

	 * track our position in the bitmap packet.

	 */

	if (packet[6] & 0x40) {

		/* sync, reset position */

		priv->multi_packet = 0;

	}



	if (WARN_ON_ONCE(priv->multi_packet > 2))

		return;



	offset = 2 * priv->multi_packet;

	priv->multi_data[offset] = packet[6];

	priv->multi_data[offset + 1] = packet[7];



	if (++priv->multi_packet > 2) {

		priv->multi_packet = 0;



		x_bitmap = ((priv->multi_data[2] & 0x1f) << 10) |

			   ((priv->multi_data[3] & 0x60) << 3) |

			   ((priv->multi_data[0] & 0x3f) << 2) |

			   ((priv->multi_data[1] & 0x60) >> 5);

		y_bitmap = ((priv->multi_data[5] & 0x01) << 10) |

			   ((priv->multi_data[3] & 0x1f) << 5) |

			    (priv->multi_data[1] & 0x1f);



		fingers = alps_process_bitmap(x_bitmap, y_bitmap,

					      &x1, &y1, &x2, &y2);



		/* Store MT data.*/

		priv->fingers = fingers;

		priv->x1 = x1;

		priv->x2 = x2;

		priv->y1 = y1;

		priv->y2 = y2;

	}



	left = packet[4] & 0x01;

	right = packet[4] & 0x02;
@@ -617,21 +661,44 @@ static void alps_process_packet_v4(struct psmouse *psmouse) 
	y = ((packet[2] & 0x7f) << 4) | (packet[3] & 0x0f);

	z = packet[5] & 0x7f;



	/*

	 * If there were no contacts in the bitmap, use ST

	 * points in MT reports.

	 * If there were two contacts or more, report MT data.

	 */

	if (priv->fingers < 2) {

		x1 = x;

		y1 = y;

		fingers = z > 0 ? 1 : 0;

	} else {

		fingers = priv->fingers;

		x1 = priv->x1;

		x2 = priv->x2;

		y1 = priv->y1;

		y2 = priv->y2;

	}



	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_report_key(dev, BTN_TOOL_FINGER, fingers == 1);

	input_report_key(dev, BTN_TOOL_DOUBLETAP, fingers == 2);

	input_report_key(dev, BTN_TOOL_TRIPLETAP, fingers == 3);

	input_report_key(dev, BTN_TOOL_QUADTAP, fingers == 4);



	input_report_key(dev, BTN_LEFT, left);

	input_report_key(dev, BTN_RIGHT, right);



	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_report_key(dev, BTN_TOOL_FINGER, z > 0);

	input_report_key(dev, BTN_LEFT, left);

	input_report_key(dev, BTN_RIGHT, right);



	input_sync(dev);

}
@@ -1557,6 +1624,7 @@ int alps_init(struct psmouse *psmouse) 
		input_set_abs_params(dev1, ABS_Y, 0, 767, 0, 0);

		break;

	case ALPS_PROTO_V3:

	case ALPS_PROTO_V4:

		set_bit(INPUT_PROP_SEMI_MT, dev1->propbit);

		input_mt_init_slots(dev1, 2);

		input_set_abs_params(dev1, ABS_MT_POSITION_X, 0, ALPS_V3_X_MAX, 0, 0);
@@ -1565,8 +1633,7 @@ int alps_init(struct psmouse *psmouse) 
		set_bit(BTN_TOOL_DOUBLETAP, dev1->keybit);

		set_bit(BTN_TOOL_TRIPLETAP, dev1->keybit);

		set_bit(BTN_TOOL_QUADTAP, dev1->keybit);

		/* fall through */

	case ALPS_PROTO_V4:



		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;

drivers/input/mouse/alps.h

+2 −0
Original line number Diff line number Diff line
@@ -39,6 +39,8 @@ struct alps_data { 
	int prev_fin;			/* Finger bit from previous packet */

	int multi_packet;		/* Multi-packet data in progress */

	unsigned char multi_data[6];	/* Saved multi-packet data */

	int x1, x2, y1, y2;		/* Coordinates from last MT report */

	int fingers;			/* Number of fingers from MT report */

	u8 quirks;

	struct timer_list timer;

};

CRA Git | Maintained and supported by SUSTech CRA and CCSE