Input: wacom - streamline 2-finger touch support

Clean up 2-finger touch support. This still needs to be converted to
proper multi-touch protocol.

Signed-off-by: Ping Cheng <pingc@wacom.com>
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
This commit is contained in:
Ping Cheng 2010-04-05 23:07:41 -07:00 committed by Dmitry Torokhov
parent 252f77698f
commit ab687b18aa
2 changed files with 80 additions and 73 deletions

View File

@ -236,13 +236,12 @@ static int wacom_graphire_irq(struct wacom_wac *wacom)
rw = ((data[7] & 0x18) >> 3) - ((data[7] & 0x20) >> 3); rw = ((data[7] & 0x18) >> 3) - ((data[7] & 0x20) >> 3);
input_report_rel(input, REL_WHEEL, rw); input_report_rel(input, REL_WHEEL, rw);
input_report_key(input, BTN_TOOL_FINGER, 0xf0); input_report_key(input, BTN_TOOL_FINGER, 0xf0);
input_report_abs(input, ABS_MISC, wacom->id[1]);
if (!prox) if (!prox)
wacom->id[1] = 0; wacom->id[1] = 0;
input_report_abs(input, ABS_MISC, wacom->id[1]); input_report_abs(input, ABS_MISC, wacom->id[1]);
input_event(input, EV_MSC, MSC_SERIAL, 0xf0); input_event(input, EV_MSC, MSC_SERIAL, 0xf0);
retval = 1;
} }
retval = 1;
break; break;
case WACOM_MO: case WACOM_MO:
@ -616,43 +615,59 @@ static int wacom_intuos_irq(struct wacom_wac *wacom)
static void wacom_tpc_finger_in(struct wacom_wac *wacom, char *data, int idx) static void wacom_tpc_finger_in(struct wacom_wac *wacom, char *data, int idx)
{ {
struct input_dev *input = wacom->input; struct input_dev *input = wacom->input;
int finger = idx + 1;
int x = le16_to_cpup((__le16 *)&data[finger * 2]) & 0x7fff;
int y = le16_to_cpup((__le16 *)&data[4 + finger * 2]) & 0x7fff;
input_report_abs(input, ABS_X, /*
data[2 + idx * 2] | ((data[3 + idx * 2] & 0x7f) << 8)); * Work around input core suppressing "duplicate" events since
input_report_abs(input, ABS_Y, * we are abusing ABS_X/ABS_Y to transmit multi-finger data.
data[6 + idx * 2] | ((data[7 + idx * 2] & 0x7f) << 8)); * This should go away once we switch to true multitouch
* protocol.
*/
if (wacom->last_finger != finger) {
if (x == input->abs[ABS_X])
x++;
if (y == input->abs[ABS_Y])
y++;
}
input_report_abs(input, ABS_X, x);
input_report_abs(input, ABS_Y, y);
input_report_abs(input, ABS_MISC, wacom->id[0]); input_report_abs(input, ABS_MISC, wacom->id[0]);
input_report_key(input, wacom->tool[idx], 1); input_report_key(input, wacom->tool[finger], 1);
if (idx) if (!idx)
input_event(input, EV_MSC, MSC_SERIAL, 0xf0);
else
input_report_key(input, BTN_TOUCH, 1); input_report_key(input, BTN_TOUCH, 1);
input_event(input, EV_MSC, MSC_SERIAL, finger);
input_sync(wacom->input);
wacom->last_finger = finger;
} }
static void wacom_tpc_touch_out(struct wacom_wac *wacom, int idx) static void wacom_tpc_touch_out(struct wacom_wac *wacom, int idx)
{ {
struct input_dev *input = wacom->input; struct input_dev *input = wacom->input;
int finger = idx + 1;
input_report_abs(input, ABS_X, 0); input_report_abs(input, ABS_X, 0);
input_report_abs(input, ABS_Y, 0); input_report_abs(input, ABS_Y, 0);
input_report_abs(input, ABS_MISC, 0); input_report_abs(input, ABS_MISC, 0);
input_report_key(input, wacom->tool[idx], 0); input_report_key(input, wacom->tool[finger], 0);
if (idx) if (!idx)
input_event(input, EV_MSC, MSC_SERIAL, 0xf0);
else
input_report_key(input, BTN_TOUCH, 0); input_report_key(input, BTN_TOUCH, 0);
input_event(input, EV_MSC, MSC_SERIAL, finger);
input_sync(input);
} }
static void wacom_tpc_touch_in(struct wacom_wac *wacom, size_t len) static void wacom_tpc_touch_in(struct wacom_wac *wacom, size_t len)
{ {
char *data = wacom->data; char *data = wacom->data;
struct input_dev *input = wacom->input; struct input_dev *input = wacom->input;
static int firstFinger = 0;
static int secondFinger = 0;
wacom->tool[0] = BTN_TOOL_DOUBLETAP; wacom->tool[1] = BTN_TOOL_DOUBLETAP;
wacom->id[0] = TOUCH_DEVICE_ID; wacom->id[0] = TOUCH_DEVICE_ID;
wacom->tool[1] = BTN_TOOL_TRIPLETAP; wacom->tool[2] = BTN_TOOL_TRIPLETAP;
if (len != WACOM_PKGLEN_TPC1FG) { if (len != WACOM_PKGLEN_TPC1FG) {
@ -664,45 +679,29 @@ static void wacom_tpc_touch_in(struct wacom_wac *wacom, size_t len)
input_report_abs(input, ABS_PRESSURE, le16_to_cpup((__le16 *)&data[6])); input_report_abs(input, ABS_PRESSURE, le16_to_cpup((__le16 *)&data[6]));
input_report_key(input, BTN_TOUCH, le16_to_cpup((__le16 *)&data[6])); input_report_key(input, BTN_TOUCH, le16_to_cpup((__le16 *)&data[6]));
input_report_abs(input, ABS_MISC, wacom->id[0]); input_report_abs(input, ABS_MISC, wacom->id[0]);
input_report_key(input, wacom->tool[0], 1); input_report_key(input, wacom->tool[1], 1);
input_sync(input);
break; break;
case WACOM_REPORT_TPC2FG: case WACOM_REPORT_TPC2FG:
/* keep this byte to send proper out-prox event */ if (data[1] & 0x01)
wacom->id[1] = data[1] & 0x03;
if (data[1] & 0x01) {
wacom_tpc_finger_in(wacom, data, 0); wacom_tpc_finger_in(wacom, data, 0);
firstFinger = 1; else if (wacom->id[1] & 0x01)
} else if (firstFinger) {
wacom_tpc_touch_out(wacom, 0); wacom_tpc_touch_out(wacom, 0);
}
if (data[1] & 0x02) {
/* sync first finger data */
if (firstFinger)
input_sync(input);
if (data[1] & 0x02)
wacom_tpc_finger_in(wacom, data, 1); wacom_tpc_finger_in(wacom, data, 1);
secondFinger = 1; else if (wacom->id[1] & 0x02)
} else if (secondFinger) {
/* sync first finger data */
if (firstFinger)
input_sync(input);
wacom_tpc_touch_out(wacom, 1); wacom_tpc_touch_out(wacom, 1);
secondFinger = 0;
}
if (!(data[1] & 0x01))
firstFinger = 0;
break; break;
} }
} else { } else {
input_report_abs(input, ABS_X, get_unaligned_le16(&data[1])); input_report_abs(input, ABS_X, get_unaligned_le16(&data[1]));
input_report_abs(input, ABS_Y, get_unaligned_le16(&data[3])); input_report_abs(input, ABS_Y, get_unaligned_le16(&data[3]));
input_report_key(input, BTN_TOUCH, 1); input_report_key(input, BTN_TOUCH, 1);
input_report_abs(input, ABS_MISC, wacom->id[0]); input_report_abs(input, ABS_MISC, wacom->id[1]);
input_report_key(input, wacom->tool[0], 1); input_report_key(input, wacom->tool[1], 1);
input_sync(input);
} }
} }
@ -711,13 +710,26 @@ static int wacom_tpc_irq(struct wacom_wac *wacom, size_t len)
struct wacom_features *features = &wacom->features; struct wacom_features *features = &wacom->features;
char *data = wacom->data; char *data = wacom->data;
struct input_dev *input = wacom->input; struct input_dev *input = wacom->input;
int prox = 0, pressure, idx = -1; int prox = 0, pressure;
int retval = 0;
dbg("wacom_tpc_irq: received report #%d", data[0]); dbg("wacom_tpc_irq: received report #%d", data[0]);
if (len == WACOM_PKGLEN_TPC1FG || /* single touch */ if (len == WACOM_PKGLEN_TPC1FG || /* single touch */
data[0] == WACOM_REPORT_TPC1FG || /* single touch */ data[0] == WACOM_REPORT_TPC1FG || /* single touch */
data[0] == WACOM_REPORT_TPC2FG) { /* 2FG touch */ data[0] == WACOM_REPORT_TPC2FG) { /* 2FG touch */
if (wacom->shared->stylus_in_proximity) {
if (wacom->id[1] & 0x01)
wacom_tpc_touch_out(wacom, 0);
if (wacom->id[1] & 0x02)
wacom_tpc_touch_out(wacom, 1);
wacom->id[1] = 0;
return 0;
}
if (len == WACOM_PKGLEN_TPC1FG) { /* with touch */ if (len == WACOM_PKGLEN_TPC1FG) { /* with touch */
prox = data[0] & 0x01; prox = data[0] & 0x01;
} else { /* with capacity */ } else { /* with capacity */
@ -729,36 +741,30 @@ static int wacom_tpc_irq(struct wacom_wac *wacom, size_t len)
prox = data[1] & 0x03; prox = data[1] & 0x03;
} }
if (!wacom->shared->stylus_in_proximity) { if (prox) {
if (prox) { if (!wacom->id[1])
wacom_tpc_touch_in(wacom, len); wacom->last_finger = 1;
} else { wacom_tpc_touch_in(wacom, len);
if (data[0] == WACOM_REPORT_TPC2FG) { } else {
/* 2FGT out-prox */ if (data[0] == WACOM_REPORT_TPC2FG) {
idx = (wacom->id[1] & 0x01) - 1; /* 2FGT out-prox */
if (idx == 0) { if (wacom->id[1] & 0x01)
wacom_tpc_touch_out(wacom, idx);
/* sync first finger event */
if (wacom->id[1] & 0x02)
input_sync(input);
}
idx = (wacom->id[1] & 0x02) - 1;
if (idx == 1)
wacom_tpc_touch_out(wacom, idx);
} else {
/* one finger touch */
wacom_tpc_touch_out(wacom, 0); wacom_tpc_touch_out(wacom, 0);
}
wacom->id[0] = 0; if (wacom->id[1] & 0x02)
} wacom_tpc_touch_out(wacom, 1);
} else if (wacom->id[0]) { /* force touch out-prox */ } else
wacom_tpc_touch_out(wacom, 0); /* one finger touch */
wacom_tpc_touch_out(wacom, 0);
wacom->id[0] = 0;
} }
return 1; /* keep prox bit to send proper out-prox event */
wacom->id[1] = prox;
} else if (data[0] == WACOM_REPORT_PENABLED) { /* Penabled */ } else if (data[0] == WACOM_REPORT_PENABLED) { /* Penabled */
prox = data[1] & 0x20; prox = data[1] & 0x20;
if (!wacom->id[0]) { /* first in prox */ if (!wacom->shared->stylus_in_proximity) { /* first in prox */
/* Going into proximity select tool */ /* Going into proximity select tool */
wacom->tool[0] = (data[1] & 0x0c) ? BTN_TOOL_RUBBER : BTN_TOOL_PEN; wacom->tool[0] = (data[1] & 0x0c) ? BTN_TOOL_RUBBER : BTN_TOOL_PEN;
if (wacom->tool[0] == BTN_TOOL_PEN) if (wacom->tool[0] == BTN_TOOL_PEN)
@ -783,9 +789,9 @@ static int wacom_tpc_irq(struct wacom_wac *wacom, size_t len)
} }
input_report_key(input, wacom->tool[0], prox); input_report_key(input, wacom->tool[0], prox);
input_report_abs(input, ABS_MISC, wacom->id[0]); input_report_abs(input, ABS_MISC, wacom->id[0]);
return 1; retval = 1;
} }
return 0; return retval;
} }
void wacom_wac_irq(struct wacom_wac *wacom_wac, size_t len) void wacom_wac_irq(struct wacom_wac *wacom_wac, size_t len)

View File

@ -80,9 +80,10 @@ struct wacom_shared {
struct wacom_wac { struct wacom_wac {
char name[64]; char name[64];
unsigned char *data; unsigned char *data;
int tool[2]; int tool[3];
int id[2]; int id[3];
__u32 serial[2]; __u32 serial[2];
int last_finger;
struct wacom_features features; struct wacom_features features;
struct wacom_shared *shared; struct wacom_shared *shared;
struct input_dev *input; struct input_dev *input;