CHROMIUM: atkbd: improve workaround for chromeos EC bug

[cascardo/linux.git] / drivers / input / keyboard / atkbd.c

diff --git a/drivers/input/keyboard/atkbd.c b/drivers/input/keyboard/atkbd.c
index 41ebfee..4400c30 100644 (file)
--- a/drivers/input/keyboard/atkbd.c
+++ b/drivers/input/keyboard/atkbd.c
@@ -726,8 +726,11 @@ getid_retry:
                        dev_warn(&ps2dev->serio->dev, "atkbd: SETLEDS failed");
                        if (getid_attempts_left <= 0)
                                return -1;
-                       else
+                       else {
+                               ps2_drain(ps2dev, 6, 1);
+                               ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE);
                                goto getid_retry;
+                       }
                }
                atkbd->id = 0xabba;
                return 0;
@@ -737,8 +740,11 @@ getid_retry:
                dev_warn(&ps2dev->serio->dev, "bad keyboard id %d", param[0]);
                if (getid_attempts_left <= 0)
                        return -1;
-               else
+               else {
+                       ps2_drain(ps2dev, 6, 1);
+                       ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE);
                        goto getid_retry;
+               }
        }
 
        atkbd->id = (param[0] << 8) | param[1];