HID: i2c-hid: implement request() callback

This allows HID drivers to also get/set reports through hid_hw_request().

Tested-by: Mika Westerberg <mika.westerberg@linux.intel.com>
Signed-off-by: Benjamin Tissoires <benjamin.tissoires@gmail.com>
Signed-off-by: Mika Westerberg <mika.westerberg@linux.intel.com>
Signed-off-by: Jiri Kosina <jkosina@suse.cz>

1 files changed, 32 insertions, 0 deletions

diff --git a/drivers/hid/i2c-hid/i2c-hid.c b/drivers/hid/i2c-hid/i2c-hid.c
index ec7930217a6d..935f387be95a 100644
--- a/drivers/hid/i2c-hid/i2c-hid.c
+++ b/drivers/hid/i2c-hid/i2c-hid.c
@@ -563,6 +563,37 @@ static int i2c_hid_output_raw_report(struct hid_device *hid, __u8 *buf,
         return ret;
 }
 
+static void i2c_hid_request(struct hid_device *hid, struct hid_report *rep,
+                int reqtype)
+{
+        struct i2c_client *client = hid->driver_data;
+        struct i2c_hid *ihid = i2c_get_clientdata(client);
+        char *buf;
+        int ret;
+
+        buf = kzalloc(ihid->bufsize, GFP_KERNEL);
+        if (!buf)
+                return;
+
+        switch (reqtype) {
+        case HID_REQ_GET_REPORT:
+                ret = i2c_hid_get_raw_report(hid, rep->id, buf, ihid->bufsize,
+                                             rep->type);
+                if (ret < 0)
+                        dev_err(&client->dev, "%s: unable to get report: %d\n",
+                                __func__, ret);
+                else
+                        hid_input_report(hid, rep->type, buf, ret, 0);
+                break;
+        case HID_REQ_SET_REPORT:
+                hid_output_report(rep, buf);
+                i2c_hid_output_raw_report(hid, buf, ihid->bufsize, rep->type);
+                break;
+        }
+
+        kfree(buf);
+}
+
 static int i2c_hid_parse(struct hid_device *hid)
 {
         struct i2c_client *client = hid->driver_data;
@@ -742,6 +773,7 @@ static struct hid_ll_driver i2c_hid_ll_driver = {
         .open = i2c_hid_open,
         .close = i2c_hid_close,
         .power = i2c_hid_power,
+        .request = i2c_hid_request,
         .hidinput_input_event = i2c_hid_hidinput_input_event,
 };