ff7cf129710f9e913c0f48956caa50265096e9f9
[firefly-linux-kernel-4.4.55.git] / drivers / hid / hid-wiimote.c
1 /*
2  * HID driver for Nintendo Wiimote devices
3  * Copyright (c) 2011 David Herrmann
4  */
5
6 /*
7  * This program is free software; you can redistribute it and/or modify it
8  * under the terms of the GNU General Public License as published by the Free
9  * Software Foundation; either version 2 of the License, or (at your option)
10  * any later version.
11  */
12
13 #include <linux/hid.h>
14 #include <linux/module.h>
15 #include "hid-ids.h"
16
17 #define WIIMOTE_VERSION "0.1"
18 #define WIIMOTE_NAME "Nintendo Wii Remote"
19
20 struct wiimote_data {
21         struct hid_device *hdev;
22 };
23
24 static int wiimote_hid_event(struct hid_device *hdev, struct hid_report *report,
25                                                         u8 *raw_data, int size)
26 {
27         if (size < 1)
28                 return -EINVAL;
29
30         return 0;
31 }
32
33 static struct wiimote_data *wiimote_create(struct hid_device *hdev)
34 {
35         struct wiimote_data *wdata;
36
37         wdata = kzalloc(sizeof(*wdata), GFP_KERNEL);
38         if (!wdata)
39                 return NULL;
40
41         wdata->hdev = hdev;
42         hid_set_drvdata(hdev, wdata);
43
44         return wdata;
45 }
46
47 static void wiimote_destroy(struct wiimote_data *wdata)
48 {
49         kfree(wdata);
50 }
51
52 static int wiimote_hid_probe(struct hid_device *hdev,
53                                 const struct hid_device_id *id)
54 {
55         struct wiimote_data *wdata;
56         int ret;
57
58         wdata = wiimote_create(hdev);
59         if (!wdata) {
60                 hid_err(hdev, "Can't alloc device\n");
61                 return -ENOMEM;
62         }
63
64         ret = hid_parse(hdev);
65         if (ret) {
66                 hid_err(hdev, "HID parse failed\n");
67                 goto err;
68         }
69
70         ret = hid_hw_start(hdev, HID_CONNECT_HIDRAW);
71         if (ret) {
72                 hid_err(hdev, "HW start failed\n");
73                 goto err;
74         }
75
76         hid_info(hdev, "New device registered\n");
77         return 0;
78
79 err:
80         wiimote_destroy(wdata);
81         return ret;
82 }
83
84 static void wiimote_hid_remove(struct hid_device *hdev)
85 {
86         struct wiimote_data *wdata = hid_get_drvdata(hdev);
87
88         hid_info(hdev, "Device removed\n");
89         hid_hw_stop(hdev);
90         wiimote_destroy(wdata);
91 }
92
93 static const struct hid_device_id wiimote_hid_devices[] = {
94         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO,
95                                 USB_DEVICE_ID_NINTENDO_WIIMOTE) },
96         { }
97 };
98 MODULE_DEVICE_TABLE(hid, wiimote_hid_devices);
99
100 static struct hid_driver wiimote_hid_driver = {
101         .name = "wiimote",
102         .id_table = wiimote_hid_devices,
103         .probe = wiimote_hid_probe,
104         .remove = wiimote_hid_remove,
105         .raw_event = wiimote_hid_event,
106 };
107
108 static int __init wiimote_init(void)
109 {
110         int ret;
111
112         ret = hid_register_driver(&wiimote_hid_driver);
113         if (ret)
114                 pr_err("Can't register wiimote hid driver\n");
115
116         return ret;
117 }
118
119 static void __exit wiimote_exit(void)
120 {
121         hid_unregister_driver(&wiimote_hid_driver);
122 }
123
124 module_init(wiimote_init);
125 module_exit(wiimote_exit);
126 MODULE_LICENSE("GPL");
127 MODULE_AUTHOR("David Herrmann <dh.herrmann@gmail.com>");
128 MODULE_DESCRIPTION(WIIMOTE_NAME " Device Driver");
129 MODULE_VERSION(WIIMOTE_VERSION);