HID: uhid: Add UHID_CREATE2 + UHID_INPUT2

UHID_CREATE2:
HID report descriptor data (rd_data) is an array in struct uhid_create2_req,
instead of a pointer. Enables use from languages that don't support pointers,
e.g. Python.

UHID_INPUT2:
Data array is the last field of struct uhid_input2_req. Enables userspace to
write only the required bytes to kernel (ev.type + ev.u.input2.size + the part
of the data array that matters), instead of the entire struct uhid_input2_req.

Note:
UHID_CREATE2 increases the total size of struct uhid_event slightly, thus
increasing the size of messages that are queued for userspace. However, this
won't affect the userspace processing of these events.

[Jiri Kosina <jkosina@suse.cz>: adjust to hid_get_raw_report() and
				hid_output_raw_report() API changes]

Signed-off-by: Petri Gynther <pgynther@google.com>
Reviewed-by: David Herrmann <dh.herrmann@gmail.com>
Signed-off-by: Jiri Kosina <jkosina@suse.cz>

1 files changed, 78 insertions, 0 deletions

diff --git a/drivers/hid/uhid.c b/drivers/hid/uhid.c
index 7ed79be2686a..0d078c32db4f 100644
--- a/drivers/hid/uhid.c
+++ b/drivers/hid/uhid.c
@@ -428,6 +428,67 @@ err_free:
         return ret;
 }
 
+static int uhid_dev_create2(struct uhid_device *uhid,
+                            const struct uhid_event *ev)
+{
+        struct hid_device *hid;
+        int ret;
+
+        if (uhid->running)
+                return -EALREADY;
+
+        uhid->rd_size = ev->u.create2.rd_size;
+        if (uhid->rd_size <= 0 || uhid->rd_size > HID_MAX_DESCRIPTOR_SIZE)
+                return -EINVAL;
+
+        uhid->rd_data = kmalloc(uhid->rd_size, GFP_KERNEL);
+        if (!uhid->rd_data)
+                return -ENOMEM;
+
+        memcpy(uhid->rd_data, ev->u.create2.rd_data, uhid->rd_size);
+
+        hid = hid_allocate_device();
+        if (IS_ERR(hid)) {
+                ret = PTR_ERR(hid);
+                goto err_free;
+        }
+
+        strncpy(hid->name, ev->u.create2.name, 127);
+        hid->name[127] = 0;
+        strncpy(hid->phys, ev->u.create2.phys, 63);
+        hid->phys[63] = 0;
+        strncpy(hid->uniq, ev->u.create2.uniq, 63);
+        hid->uniq[63] = 0;
+
+        hid->ll_driver = &uhid_hid_driver;
+        hid->bus = ev->u.create2.bus;
+        hid->vendor = ev->u.create2.vendor;
+        hid->product = ev->u.create2.product;
+        hid->version = ev->u.create2.version;
+        hid->country = ev->u.create2.country;
+        hid->driver_data = uhid;
+        hid->dev.parent = uhid_misc.this_device;
+
+        uhid->hid = hid;
+        uhid->running = true;
+
+        ret = hid_add_device(hid);
+        if (ret) {
+                hid_err(hid, "Cannot register HID device\n");
+                goto err_hid;
+        }
+
+        return 0;
+
+err_hid:
+        hid_destroy_device(hid);
+        uhid->hid = NULL;
+        uhid->running = false;
+err_free:
+        kfree(uhid->rd_data);
+        return ret;
+}
+
 static int uhid_dev_destroy(struct uhid_device *uhid)
 {
         if (!uhid->running)
@@ -456,6 +517,17 @@ static int uhid_dev_input(struct uhid_device *uhid, struct uhid_event *ev)
         return 0;
 }
 
+static int uhid_dev_input2(struct uhid_device *uhid, struct uhid_event *ev)
+{
+        if (!uhid->running)
+                return -EINVAL;
+
+        hid_input_report(uhid->hid, HID_INPUT_REPORT, ev->u.input2.data,
+                         min_t(size_t, ev->u.input2.size, UHID_DATA_MAX), 0);
+
+        return 0;
+}
+
 static int uhid_dev_feature_answer(struct uhid_device *uhid,
                                    struct uhid_event *ev)
 {
@@ -592,12 +664,18 @@ static ssize_t uhid_char_write(struct file *file, const char __user *buffer,
         case UHID_CREATE:
                 ret = uhid_dev_create(uhid, &uhid->input_buf);
                 break;
+        case UHID_CREATE2:
+                ret = uhid_dev_create2(uhid, &uhid->input_buf);
+                break;
         case UHID_DESTROY:
                 ret = uhid_dev_destroy(uhid);
                 break;
         case UHID_INPUT:
                 ret = uhid_dev_input(uhid, &uhid->input_buf);
                 break;
+        case UHID_INPUT2:
+                ret = uhid_dev_input2(uhid, &uhid->input_buf);
+                break;
         case UHID_FEATURE_ANSWER:
                 ret = uhid_dev_feature_answer(uhid, &uhid->input_buf);
                 break;