Input: libps2 - relax command byte ACK handling

When we probe PS/2 devices we first issue "Get ID" command and only if we
receive what we consider a valid keyboard or mouse ID we disable the device
and continue with protocol detection. That means that the device may be
transmitting motion or keystroke data, while we expect ACK response.

Instead of signaling failure if we see anything but ACK/NAK let's ignore
"garbage" response until we see ACK for the command byte (first byte). The
checks for subsequent ACKs of command parameters will continue be strict.

Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>

diff --git a/drivers/input/serio/libps2.c b/drivers/input/serio/libps2.c
index f05c407b31f3d1b224d229f1aa9c87b9bf223957..e6a07e68d1ff69d0ae16ac9d862c8816eb39cc05 100644 (file)
--- a/drivers/input/serio/libps2.c
+++ b/drivers/input/serio/libps2.c
@@ -256,16 +256,23 @@ int __ps2_command(struct ps2dev *ps2dev, u8 *param, unsigned int command)
                for (i = 0; i < receive; i++)
                        ps2dev->cmdbuf[(receive - 1) - i] = param[i];
 
+       /* Signal that we are sending the command byte */
+       ps2dev->flags |= PS2_FLAG_ACK_CMD;
+
        /*
         * Some devices (Synaptics) peform the reset before
         * ACKing the reset command, and so it can take a long
         * time before the ACK arrives.
         */
-       rc = ps2_do_sendbyte(ps2dev, command & 0xff,
-                            command == PS2_CMD_RESET_BAT ? 1000 : 200, 2);
+       timeout = command == PS2_CMD_RESET_BAT ? 1000 : 200;
+
+       rc = ps2_do_sendbyte(ps2dev, command & 0xff, timeout, 2);
        if (rc)
                goto out_reset_flags;
 
+       /* Now we are sending command parameters, if any */
+       ps2dev->flags &= ~PS2_FLAG_ACK_CMD;
+
        for (i = 0; i < send; i++) {
                rc = ps2_do_sendbyte(ps2dev, param[i], 200, 2);
                if (rc)
@@ -416,7 +423,19 @@ bool ps2_handle_ack(struct ps2dev *ps2dev, u8 data)
                }
                /* Fall through */
        default:
-               return false;
+               /*
+                * Do not signal errors if we get unexpected reply while
+                * waiting for an ACK to the initial (first) command byte:
+                * the device might not be quiesced yet and continue
+                * delivering data.
+                * Note that we reset PS2_FLAG_WAITID flag, so the workaround
+                * for mice not acknowledging the Get ID command only triggers
+                * on the 1st byte; if device spews data we really want to see
+                * a real ACK from it.
+                */
+               dev_dbg(&ps2dev->serio->dev, "unexpected %#02x\n", data);
+               ps2dev->flags &= ~PS2_FLAG_WAITID;
+               return ps2dev->flags & PS2_FLAG_ACK_CMD;
        }
 
        if (!ps2dev->nak) {

diff --git a/include/linux/libps2.h b/include/linux/libps2.h
index 3c69cd796f48b4e85479ce43ae5fa39d08eb80a1..5f18fe02ae371901a8bd87efce9a521c573d5643 100644 (file)
--- a/include/linux/libps2.h
+++ b/include/linux/libps2.h
@@ -31,6 +31,7 @@
 #define PS2_FLAG_CMD1          BIT(2)  /* Waiting for the first byte of command response */
 #define PS2_FLAG_WAITID                BIT(3)  /* Command executing is GET ID */
 #define PS2_FLAG_NAK           BIT(4)  /* Last transmission was NAKed */
+#define PS2_FLAG_ACK_CMD       BIT(5)  /* Waiting to ACK the command (first) byte */
 
 struct ps2dev {
        struct serio *serio;