Input: sur40 - skip all blobs that are not touches

The SUR40 labels all reported blobs as touch, token, or generic blob.
Previously, all blobs were reported as touch regardless of type, causing
lots of false positives. Present patch fixes this.

Signed-off-by: Martin Kaltenbrunner <modin@yuri.at>
Signed-off-by: Florian Echtler <floe@butterbrot.org>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>

diff --git a/drivers/input/touchscreen/sur40.c b/drivers/input/touchscreen/sur40.c
index f04adeaa45b3cbe766f4a2c2bf2c52a7e1960e2f..f16f8358c70aab09da0cda18a4fa623f7d8a027a 100644 (file)
--- a/drivers/input/touchscreen/sur40.c
+++ b/drivers/input/touchscreen/sur40.c
@@ -296,20 +296,24 @@ static void sur40_close(struct input_polled_dev *polldev)
 static void sur40_report_blob(struct sur40_blob *blob, struct input_dev *input)
 {
        int wide, major, minor;
+       int bb_size_x, bb_size_y, pos_x, pos_y, ctr_x, ctr_y, slotnum;
 
-       int bb_size_x = le16_to_cpu(blob->bb_size_x);
-       int bb_size_y = le16_to_cpu(blob->bb_size_y);
-
-       int pos_x = le16_to_cpu(blob->pos_x);
-       int pos_y = le16_to_cpu(blob->pos_y);
-
-       int ctr_x = le16_to_cpu(blob->ctr_x);
-       int ctr_y = le16_to_cpu(blob->ctr_y);
+       if (blob->type != SUR40_TOUCH)
+               return;
 
-       int slotnum = input_mt_get_slot_by_key(input, blob->blob_id);
+       slotnum = input_mt_get_slot_by_key(input, blob->blob_id);
        if (slotnum < 0 || slotnum >= MAX_CONTACTS)
                return;
 
+       bb_size_x = le16_to_cpu(blob->bb_size_x);
+       bb_size_y = le16_to_cpu(blob->bb_size_y);
+
+       pos_x = le16_to_cpu(blob->pos_x);
+       pos_y = le16_to_cpu(blob->pos_y);
+
+       ctr_x = le16_to_cpu(blob->ctr_x);
+       ctr_y = le16_to_cpu(blob->ctr_y);
+
        input_mt_slot(input, slotnum);
        input_mt_report_slot_state(input, MT_TOOL_FINGER, 1);
        wide = (bb_size_x > bb_size_y);