[PATCH 17/53] Input: atmel_mxt_ts - Read and report bootloader version

[Nick Dyer]

Signed-off-by: Nick Dyer <nick.d...@itdev.co.uk>
Acked-by: Benson Leung <ble...@chromium.org>
---
 drivers/input/touchscreen/atmel_mxt_ts.c |   26 ++++++++++++++++++++++++++
 1 file changed, 26 insertions(+)

diff --git a/drivers/input/touchscreen/atmel_mxt_ts.c 
b/drivers/input/touchscreen/atmel_mxt_ts.c
index 842312e..df8fc1a 100644
--- a/drivers/input/touchscreen/atmel_mxt_ts.c
+++ b/drivers/input/touchscreen/atmel_mxt_ts.c
@@ -206,6 +206,8 @@
 #define MXT_FRAME_CRC_PASS     0x04
 #define MXT_APP_CRC_FAIL       0x40    /* valid 7 8 bit only */
 #define MXT_BOOT_STATUS_MASK   0x3f
+#define MXT_BOOT_EXTENDED_ID   (1 << 5)
+#define MXT_BOOT_ID_MASK       0x1f
 
 /* Touch status */
 #define MXT_UNGRIP             (1 << 0)
@@ -430,6 +432,27 @@ static int mxt_lookup_bootloader_address(struct mxt_data 
*data)
        return 0;
 }
 
+static u8 mxt_get_bootloader_version(struct mxt_data *data, u8 val)
+{
+       struct device *dev = &data->client->dev;
+       u8 buf[3];
+
+       if (val & MXT_BOOT_EXTENDED_ID) {
+               if (mxt_bootloader_read(data, &buf[0], 3) != 0) {
+                       dev_err(dev, "%s: i2c failure\n", __func__);
+                       return -EIO;
+               }
+
+               dev_info(dev, "Bootloader ID:%d Version:%d\n", buf[1], buf[2]);
+
+               return buf[0];
+       } else {
+               dev_info(dev, "Bootloader ID:%d\n", val & MXT_BOOT_ID_MASK);
+
+               return val;
+       }
+}
+
 static int mxt_check_bootloader(struct mxt_data *data, unsigned int state)
 {
        struct device *dev = &data->client->dev;
@@ -462,6 +485,9 @@ recheck:
        if (ret)
                return ret;
 
+       if (state == MXT_WAITING_BOOTLOAD_CMD)
+               val = mxt_get_bootloader_version(data, val);
+
        switch (state) {
        case MXT_WAITING_BOOTLOAD_CMD:
        case MXT_WAITING_FRAME_DATA:
-- 
1.7.10.4

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/