1 files changed, 25 insertions, 18 deletions

diff --git a/drivers/input/serio/serio_raw.c b/drivers/input/serio/serio_raw.c
index 948fd5a045f7..3e243621c0e3 100644
--- a/drivers/input/serio/serio_raw.c
+++ b/drivers/input/serio/serio_raw.c
@@ -165,31 +165,38 @@ static ssize_t serio_raw_read(struct file *file, char __user *buffer,
         struct serio_raw *serio_raw = client->serio_raw;
         char uninitialized_var(c);
         ssize_t read = 0;
-        int retval;
+        int error = 0;
 
-        if (serio_raw->dead)
-                return -ENODEV;
+        do {
+                if (serio_raw->dead)
+                        return -ENODEV;
 
-        if (serio_raw->head == serio_raw->tail && (file->f_flags & O_NONBLOCK))
-                return -EAGAIN;
+                if (serio_raw->head == serio_raw->tail &&
+                    (file->f_flags & O_NONBLOCK))
+                        return -EAGAIN;
 
-        retval = wait_event_interruptible(serio_raw->wait,
-                        serio_raw->head != serio_raw->tail || serio_raw->dead);
-        if (retval)
-                return retval;
+                if (count == 0)
+                        break;
 
-        if (serio_raw->dead)
-                return -ENODEV;
+                while (read < count && serio_raw_fetch_byte(serio_raw, &c)) {
+                        if (put_user(c, buffer++)) {
+                                error = -EFAULT;
+                                goto out;
+                        }
+                        read++;
+                }
 
-        while (read < count && serio_raw_fetch_byte(serio_raw, &c)) {
-                if (put_user(c, buffer++)) {
-                        retval = -EFAULT;
+                if (read)
                         break;
-                }
-                read++;
-        }
 
-        return read ?: retval;
+                if (!(file->f_flags & O_NONBLOCK))
+                        error = wait_event_interruptible(serio_raw->wait,
+                                        serio_raw->head != serio_raw->tail ||
+                                        serio_raw->dead);
+        } while (!error);
+
+out:
+        return read ?: error;
 }
 
 static ssize_t serio_raw_write(struct file *file, const char __user *buffer,