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>

diff --git a/drivers/hid/i2c-hid/i2c-hid.c b/drivers/hid/i2c-hid/i2c-hid.c
index ec79302..935f387 100644 (file)
--- 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,
 };