Input: wacom_w8001 - handle touch error case correctly
If a device failed at the pen setup and gets a zero reply from the touch
device, we need to return an error. Otherwise we have a device with
nothing but a name and the EV_KEY and EV_ABS bits.
Signed-off-by: Peter Hutterer <peter.hutterer@who-t.net>
Acked-by: Benjamin Tissoires <benjamin.tissoires@gmail.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
diff --git a/drivers/input/touchscreen/wacom_w8001.c b/drivers/input/touchscreen/wacom_w8001.c
index 222006e..9ea5f82 100644
--- a/drivers/input/touchscreen/wacom_w8001.c
+++ b/drivers/input/touchscreen/wacom_w8001.c
@@ -385,7 +385,7 @@
struct input_dev *dev = w8001->dev;
struct w8001_coord coord;
struct w8001_touch_query touch;
- int error;
+ int error, err_pen, err_touch;
error = w8001_command(w8001, W8001_CMD_STOP, false);
if (error)
@@ -400,8 +400,8 @@
__set_bit(INPUT_PROP_DIRECT, dev->propbit);
/* penabled? */
- error = w8001_command(w8001, W8001_CMD_QUERY, true);
- if (!error) {
+ err_pen = w8001_command(w8001, W8001_CMD_QUERY, true);
+ if (!err_pen) {
__set_bit(BTN_TOUCH, dev->keybit);
__set_bit(BTN_TOOL_PEN, dev->keybit);
__set_bit(BTN_TOOL_RUBBER, dev->keybit);
@@ -426,13 +426,12 @@
}
/* Touch enabled? */
- error = w8001_command(w8001, W8001_CMD_TOUCHQUERY, true);
+ err_touch = w8001_command(w8001, W8001_CMD_TOUCHQUERY, true);
- /*
- * Some non-touch devices may reply to the touch query. But their
- * second byte is empty, which indicates touch is not supported.
- */
- if (!error && w8001->response[1]) {
+ if (!err_touch && !w8001->response[1])
+ err_touch = -ENXIO;
+
+ if (!err_touch) {
__set_bit(BTN_TOUCH, dev->keybit);
__set_bit(BTN_TOOL_FINGER, dev->keybit);
@@ -491,7 +490,7 @@
strlcat(w8001->name, " Touchscreen", sizeof(w8001->name));
- return 0;
+ return !err_pen || !err_touch ? 0 : -ENXIO;
}
/*