1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30#include <linux/input.h>
31#include <linux/usb.h>
32#include <linux/hid.h>
33
34#include "hid-ids.h"
35
36#ifdef CONFIG_DRAGONRISE_FF
37#include "usbhid/usbhid.h"
38
39struct drff_device {
40 struct hid_report *report;
41};
42
43static int drff_play(struct input_dev *dev, void *data,
44 struct ff_effect *effect)
45{
46 struct hid_device *hid = input_get_drvdata(dev);
47 struct drff_device *drff = data;
48 int strong, weak;
49
50 strong = effect->u.rumble.strong_magnitude;
51 weak = effect->u.rumble.weak_magnitude;
52
53 dbg_hid("called with 0x%04x 0x%04x", strong, weak);
54
55 if (strong || weak) {
56 strong = strong * 0xff / 0xffff;
57 weak = weak * 0xff / 0xffff;
58
59
60
61
62 if (weak == 0x0a)
63 weak = 0x0b;
64
65 drff->report->field[0]->value[0] = 0x51;
66 drff->report->field[0]->value[1] = 0x00;
67 drff->report->field[0]->value[2] = weak;
68 drff->report->field[0]->value[4] = strong;
69 usbhid_submit_report(hid, drff->report, USB_DIR_OUT);
70
71 drff->report->field[0]->value[0] = 0xfa;
72 drff->report->field[0]->value[1] = 0xfe;
73 } else {
74 drff->report->field[0]->value[0] = 0xf3;
75 drff->report->field[0]->value[1] = 0x00;
76 }
77
78 drff->report->field[0]->value[2] = 0x00;
79 drff->report->field[0]->value[4] = 0x00;
80 dbg_hid("running with 0x%02x 0x%02x", strong, weak);
81 usbhid_submit_report(hid, drff->report, USB_DIR_OUT);
82
83 return 0;
84}
85
86static int drff_init(struct hid_device *hid)
87{
88 struct drff_device *drff;
89 struct hid_report *report;
90 struct hid_input *hidinput = list_first_entry(&hid->inputs,
91 struct hid_input, list);
92 struct list_head *report_list =
93 &hid->report_enum[HID_OUTPUT_REPORT].report_list;
94 struct input_dev *dev = hidinput->input;
95 int error;
96
97 if (list_empty(report_list)) {
98 dev_err(&hid->dev, "no output reports found\n");
99 return -ENODEV;
100 }
101
102 report = list_first_entry(report_list, struct hid_report, list);
103 if (report->maxfield < 1) {
104 dev_err(&hid->dev, "no fields in the report\n");
105 return -ENODEV;
106 }
107
108 if (report->field[0]->report_count < 7) {
109 dev_err(&hid->dev, "not enough values in the field\n");
110 return -ENODEV;
111 }
112
113 drff = kzalloc(sizeof(struct drff_device), GFP_KERNEL);
114 if (!drff)
115 return -ENOMEM;
116
117 set_bit(FF_RUMBLE, dev->ffbit);
118
119 error = input_ff_create_memless(dev, drff, drff_play);
120 if (error) {
121 kfree(drff);
122 return error;
123 }
124
125 drff->report = report;
126 drff->report->field[0]->value[0] = 0xf3;
127 drff->report->field[0]->value[1] = 0x00;
128 drff->report->field[0]->value[2] = 0x00;
129 drff->report->field[0]->value[3] = 0x00;
130 drff->report->field[0]->value[4] = 0x00;
131 drff->report->field[0]->value[5] = 0x00;
132 drff->report->field[0]->value[6] = 0x00;
133 usbhid_submit_report(hid, drff->report, USB_DIR_OUT);
134
135 dev_info(&hid->dev, "Force Feedback for DragonRise Inc. game "
136 "controllers by Richard Walmsley <richwalm@gmail.com>\n");
137
138 return 0;
139}
140#else
141static inline int drff_init(struct hid_device *hid)
142{
143 return 0;
144}
145#endif
146
147static int dr_probe(struct hid_device *hdev, const struct hid_device_id *id)
148{
149 int ret;
150
151 dev_dbg(&hdev->dev, "DragonRise Inc. HID hardware probe...");
152
153 ret = hid_parse(hdev);
154 if (ret) {
155 dev_err(&hdev->dev, "parse failed\n");
156 goto err;
157 }
158
159 ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
160 if (ret) {
161 dev_err(&hdev->dev, "hw start failed\n");
162 goto err;
163 }
164
165 drff_init(hdev);
166
167 return 0;
168err:
169 return ret;
170}
171
172static const struct hid_device_id dr_devices[] = {
173 { HID_USB_DEVICE(USB_VENDOR_ID_DRAGONRISE, 0x0006), },
174 { }
175};
176MODULE_DEVICE_TABLE(hid, dr_devices);
177
178static struct hid_driver dr_driver = {
179 .name = "dragonrise",
180 .id_table = dr_devices,
181 .probe = dr_probe,
182};
183
184static int __init dr_init(void)
185{
186 return hid_register_driver(&dr_driver);
187}
188
189static void __exit dr_exit(void)
190{
191 hid_unregister_driver(&dr_driver);
192}
193
194module_init(dr_init);
195module_exit(dr_exit);
196MODULE_LICENSE("GPL");
197