Commit a4d19197 authored by David Herrmann's avatar David Herrmann Committed by Jiri Kosina

HID: wiimote: Add wiimote event handler

Create array of all event handlers and call each handler when we
receive the related event.
Signed-off-by: default avatarDavid Herrmann <dh.herrmann@googlemail.com>
Signed-off-by: default avatarJiri Kosina <jkosina@suse.cz>
parent 23c063cb
...@@ -130,10 +130,22 @@ static int wiimote_input_event(struct input_dev *dev, unsigned int type, ...@@ -130,10 +130,22 @@ static int wiimote_input_event(struct input_dev *dev, unsigned int type,
return 0; return 0;
} }
struct wiiproto_handler {
__u8 id;
size_t size;
void (*func)(struct wiimote_data *wdata, const __u8 *payload);
};
static struct wiiproto_handler handlers[] = {
{ .id = 0 }
};
static int wiimote_hid_event(struct hid_device *hdev, struct hid_report *report, static int wiimote_hid_event(struct hid_device *hdev, struct hid_report *report,
u8 *raw_data, int size) u8 *raw_data, int size)
{ {
struct wiimote_data *wdata = hid_get_drvdata(hdev); struct wiimote_data *wdata = hid_get_drvdata(hdev);
struct wiiproto_handler *h;
int i;
if (!atomic_read(&wdata->ready)) if (!atomic_read(&wdata->ready))
return -EBUSY; return -EBUSY;
...@@ -143,6 +155,12 @@ static int wiimote_hid_event(struct hid_device *hdev, struct hid_report *report, ...@@ -143,6 +155,12 @@ static int wiimote_hid_event(struct hid_device *hdev, struct hid_report *report,
if (size < 1) if (size < 1)
return -EINVAL; return -EINVAL;
for (i = 0; handlers[i].id; ++i) {
h = &handlers[i];
if (h->id == raw_data[0] && h->size < size)
h->func(wdata, &raw_data[1]);
}
return 0; return 0;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment