HID: wiimote: Add extension handler stubs

All supported extensions report data as 6 byte block. All DRMs with extension
data provide at least 6 extension bytes. Hence a generic handler for all
extension bytes is sufficient and can be called on all DRMs.

The handler distinguishes the input and passes it to the right handler. Motion+
passes data interleaved so we can have Motion+ and a regular extension enabled
simultaneously.

Signed-off-by: David Herrmann <dh.herrmann@googlemail.com>
Signed-off-by: Jiri Kosina <jkosina@suse.cz>

1 files changed, 29 insertions, 0 deletions

diff --git a/drivers/hid/hid-wiimote-ext.c b/drivers/hid/hid-wiimote-ext.c
index b9254015c58f..ecc7b7b9b171 100644
--- a/drivers/hid/hid-wiimote-ext.c
+++ b/drivers/hid/hid-wiimote-ext.c
@@ -204,6 +204,35 @@ bool wiiext_active(struct wiimote_data *wdata)
         return wdata->ext->motionp || wdata->ext->ext_type;
 }
 
+static void handler_motionp(struct wiimote_ext *ext, const __u8 *payload)
+{
+}
+
+static void handler_nunchuck(struct wiimote_ext *ext, const __u8 *payload)
+{
+}
+
+static void handler_classic(struct wiimote_ext *ext, const __u8 *payload)
+{
+}
+
+/* call this with state.lock spinlock held */
+void wiiext_handle(struct wiimote_data *wdata, const __u8 *payload)
+{
+        struct wiimote_ext *ext = wdata->ext;
+
+        if (!ext)
+                return;
+
+        if (ext->motionp && (payload[5] & 0x02)) {
+                handler_motionp(ext, payload);
+        } else if (ext->ext_type == WIIEXT_NUNCHUCK) {
+                handler_nunchuck(ext, payload);
+        } else if (ext->ext_type == WIIEXT_CLASSIC) {
+                handler_classic(ext, payload);
+        }
+}
+
 static ssize_t wiiext_show(struct device *dev, struct device_attribute *attr,
                                                                 char *buf)
 {