HID: wacom: Centralize Intuos pen packet decoding
Continue to slim down 'wacom_intuos_irq' by moving all decoding and reporting of pen packet data into the 'wacom_intuos_general' function. Signed-off-by: Jason Gerecke <jason.gerecke@wacom.com> Signed-off-by: Jiri Kosina <jkosina@suse.cz>
This commit is contained in:
parent
c7f0522a1a
commit
16e0a6a0d2
|
@ -880,13 +880,28 @@ static int wacom_remote_status_irq(struct wacom_wac *wacom_wac, size_t len)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void wacom_intuos_general(struct wacom_wac *wacom)
|
static int wacom_intuos_general(struct wacom_wac *wacom)
|
||||||
{
|
{
|
||||||
struct wacom_features *features = &wacom->features;
|
struct wacom_features *features = &wacom->features;
|
||||||
unsigned char *data = wacom->data;
|
unsigned char *data = wacom->data;
|
||||||
struct input_dev *input = wacom->pen_input;
|
struct input_dev *input = wacom->pen_input;
|
||||||
|
int idx = (features->type == INTUOS) ? (data[1] & 0x01) : 0;
|
||||||
unsigned int t;
|
unsigned int t;
|
||||||
|
|
||||||
|
if (data[0] != WACOM_REPORT_PENABLED && data[0] != WACOM_REPORT_CINTIQ &&
|
||||||
|
data[0] != WACOM_REPORT_INTUOS_PEN)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
if (features->type >= INTUOS3S) {
|
||||||
|
input_report_abs(input, ABS_X, (data[2] << 9) | (data[3] << 1) | ((data[9] >> 1) & 1));
|
||||||
|
input_report_abs(input, ABS_Y, (data[4] << 9) | (data[5] << 1) | (data[9] & 1));
|
||||||
|
input_report_abs(input, ABS_DISTANCE, ((data[9] >> 2) & 0x3f));
|
||||||
|
} else {
|
||||||
|
input_report_abs(input, ABS_X, be16_to_cpup((__be16 *)&data[2]));
|
||||||
|
input_report_abs(input, ABS_Y, be16_to_cpup((__be16 *)&data[4]));
|
||||||
|
input_report_abs(input, ABS_DISTANCE, ((data[9] >> 3) & 0x1f));
|
||||||
|
}
|
||||||
|
|
||||||
/* general pen packet */
|
/* general pen packet */
|
||||||
if ((data[1] & 0xb8) == 0xa0) {
|
if ((data[1] & 0xb8) == 0xa0) {
|
||||||
t = (data[6] << 2) | ((data[7] >> 6) & 3);
|
t = (data[6] << 2) | ((data[7] >> 6) & 3);
|
||||||
|
@ -912,55 +927,6 @@ static void wacom_intuos_general(struct wacom_wac *wacom)
|
||||||
(((data[7] << 1) & 0x7e) | (data[8] >> 7)) - 64);
|
(((data[7] << 1) & 0x7e) | (data[8] >> 7)) - 64);
|
||||||
input_report_abs(input, ABS_TILT_Y, (data[8] & 0x7f) - 64);
|
input_report_abs(input, ABS_TILT_Y, (data[8] & 0x7f) - 64);
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
static int wacom_intuos_irq(struct wacom_wac *wacom)
|
|
||||||
{
|
|
||||||
struct wacom_features *features = &wacom->features;
|
|
||||||
unsigned char *data = wacom->data;
|
|
||||||
struct input_dev *input = wacom->pen_input;
|
|
||||||
unsigned int t;
|
|
||||||
int idx = 0, result;
|
|
||||||
|
|
||||||
if (data[0] != WACOM_REPORT_PENABLED &&
|
|
||||||
data[0] != WACOM_REPORT_INTUOSREAD &&
|
|
||||||
data[0] != WACOM_REPORT_INTUOSWRITE &&
|
|
||||||
data[0] != WACOM_REPORT_INTUOSPAD &&
|
|
||||||
data[0] != WACOM_REPORT_INTUOS_PEN &&
|
|
||||||
data[0] != WACOM_REPORT_CINTIQ &&
|
|
||||||
data[0] != WACOM_REPORT_CINTIQPAD &&
|
|
||||||
data[0] != WACOM_REPORT_INTUOS5PAD) {
|
|
||||||
dev_dbg(input->dev.parent,
|
|
||||||
"%s: received unknown report #%d\n", __func__, data[0]);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* tool number */
|
|
||||||
if (features->type == INTUOS)
|
|
||||||
idx = data[1] & 0x01;
|
|
||||||
|
|
||||||
/* process pad events */
|
|
||||||
result = wacom_intuos_pad(wacom);
|
|
||||||
if (result)
|
|
||||||
return result;
|
|
||||||
|
|
||||||
/* process in/out prox events */
|
|
||||||
result = wacom_intuos_inout(wacom);
|
|
||||||
if (result)
|
|
||||||
return result - 1;
|
|
||||||
|
|
||||||
if (features->type >= INTUOS3S) {
|
|
||||||
input_report_abs(input, ABS_X, (data[2] << 9) | (data[3] << 1) | ((data[9] >> 1) & 1));
|
|
||||||
input_report_abs(input, ABS_Y, (data[4] << 9) | (data[5] << 1) | (data[9] & 1));
|
|
||||||
input_report_abs(input, ABS_DISTANCE, ((data[9] >> 2) & 0x3f));
|
|
||||||
} else {
|
|
||||||
input_report_abs(input, ABS_X, be16_to_cpup((__be16 *)&data[2]));
|
|
||||||
input_report_abs(input, ABS_Y, be16_to_cpup((__be16 *)&data[4]));
|
|
||||||
input_report_abs(input, ABS_DISTANCE, ((data[9] >> 3) & 0x1f));
|
|
||||||
}
|
|
||||||
|
|
||||||
/* process general packets */
|
|
||||||
wacom_intuos_general(wacom);
|
|
||||||
|
|
||||||
/* 4D mouse, 2D mouse, marker pen rotation, tilt mouse, or Lens cursor packets */
|
/* 4D mouse, 2D mouse, marker pen rotation, tilt mouse, or Lens cursor packets */
|
||||||
if ((data[1] & 0xbc) == 0xa8 || (data[1] & 0xbe) == 0xb0 || (data[1] & 0xbc) == 0xac) {
|
if ((data[1] & 0xbc) == 0xa8 || (data[1] & 0xbe) == 0xb0 || (data[1] & 0xbc) == 0xac) {
|
||||||
|
@ -1036,7 +1002,44 @@ static int wacom_intuos_irq(struct wacom_wac *wacom)
|
||||||
input_report_key(input, wacom->tool[idx], 1);
|
input_report_key(input, wacom->tool[idx], 1);
|
||||||
input_event(input, EV_MSC, MSC_SERIAL, wacom->serial[idx]);
|
input_event(input, EV_MSC, MSC_SERIAL, wacom->serial[idx]);
|
||||||
wacom->reporting_data = true;
|
wacom->reporting_data = true;
|
||||||
return 1;
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int wacom_intuos_irq(struct wacom_wac *wacom)
|
||||||
|
{
|
||||||
|
unsigned char *data = wacom->data;
|
||||||
|
struct input_dev *input = wacom->pen_input;
|
||||||
|
int result;
|
||||||
|
|
||||||
|
if (data[0] != WACOM_REPORT_PENABLED &&
|
||||||
|
data[0] != WACOM_REPORT_INTUOSREAD &&
|
||||||
|
data[0] != WACOM_REPORT_INTUOSWRITE &&
|
||||||
|
data[0] != WACOM_REPORT_INTUOSPAD &&
|
||||||
|
data[0] != WACOM_REPORT_INTUOS_PEN &&
|
||||||
|
data[0] != WACOM_REPORT_CINTIQ &&
|
||||||
|
data[0] != WACOM_REPORT_CINTIQPAD &&
|
||||||
|
data[0] != WACOM_REPORT_INTUOS5PAD) {
|
||||||
|
dev_dbg(input->dev.parent,
|
||||||
|
"%s: received unknown report #%d\n", __func__, data[0]);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* process pad events */
|
||||||
|
result = wacom_intuos_pad(wacom);
|
||||||
|
if (result)
|
||||||
|
return result;
|
||||||
|
|
||||||
|
/* process in/out prox events */
|
||||||
|
result = wacom_intuos_inout(wacom);
|
||||||
|
if (result)
|
||||||
|
return result - 1;
|
||||||
|
|
||||||
|
/* process general packets */
|
||||||
|
result = wacom_intuos_general(wacom);
|
||||||
|
if (result)
|
||||||
|
return result - 1;
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int int_dist(int x1, int y1, int x2, int y2)
|
static int int_dist(int x1, int y1, int x2, int y2)
|
||||||
|
|
Loading…
Reference in New Issue