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
31
32
33
34
35
36
37
38
39
40
41#define debug(format, arg...) pr_debug("hid-plff: " format "\n" , ## arg)
42
43#include <linux/input.h>
44#include <linux/slab.h>
45#include <linux/module.h>
46#include <linux/hid.h>
47
48#include "hid-ids.h"
49
50#ifdef CONFIG_PANTHERLORD_FF
51
52struct plff_device {
53 struct hid_report *report;
54 s32 maxval;
55 s32 *strong;
56 s32 *weak;
57};
58
59static int hid_plff_play(struct input_dev *dev, void *data,
60 struct ff_effect *effect)
61{
62 struct hid_device *hid = input_get_drvdata(dev);
63 struct plff_device *plff = data;
64 int left, right;
65
66 left = effect->u.rumble.strong_magnitude;
67 right = effect->u.rumble.weak_magnitude;
68 debug("called with 0x%04x 0x%04x", left, right);
69
70 left = left * plff->maxval / 0xffff;
71 right = right * plff->maxval / 0xffff;
72
73 *plff->strong = left;
74 *plff->weak = right;
75 debug("running with 0x%02x 0x%02x", left, right);
76 hid_hw_request(hid, plff->report, HID_REQ_SET_REPORT);
77
78 return 0;
79}
80
81static int plff_init(struct hid_device *hid)
82{
83 struct plff_device *plff;
84 struct hid_report *report;
85 struct hid_input *hidinput;
86 struct list_head *report_list =
87 &hid->report_enum[HID_OUTPUT_REPORT].report_list;
88 struct list_head *report_ptr = report_list;
89 struct input_dev *dev;
90 int error;
91 s32 maxval;
92 s32 *strong;
93 s32 *weak;
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108 if (list_empty(report_list)) {
109 hid_err(hid, "no output reports found\n");
110 return -ENODEV;
111 }
112
113 list_for_each_entry(hidinput, &hid->inputs, list) {
114
115 report_ptr = report_ptr->next;
116
117 if (report_ptr == report_list) {
118 hid_err(hid, "required output report is missing\n");
119 return -ENODEV;
120 }
121
122 report = list_entry(report_ptr, struct hid_report, list);
123 if (report->maxfield < 1) {
124 hid_err(hid, "no fields in the report\n");
125 return -ENODEV;
126 }
127
128 maxval = 0x7f;
129 if (report->field[0]->report_count >= 4) {
130 report->field[0]->value[0] = 0x00;
131 report->field[0]->value[1] = 0x00;
132 strong = &report->field[0]->value[2];
133 weak = &report->field[0]->value[3];
134 debug("detected single-field device");
135 } else if (report->field[0]->maxusage == 1 &&
136 report->field[0]->usage[0].hid ==
137 (HID_UP_LED | 0x43) &&
138 report->maxfield >= 4 &&
139 report->field[0]->report_count >= 1 &&
140 report->field[1]->report_count >= 1 &&
141 report->field[2]->report_count >= 1 &&
142 report->field[3]->report_count >= 1) {
143 report->field[0]->value[0] = 0x00;
144 report->field[1]->value[0] = 0x00;
145 strong = &report->field[2]->value[0];
146 weak = &report->field[3]->value[0];
147 if (hid->vendor == USB_VENDOR_ID_JESS2)
148 maxval = 0xff;
149 debug("detected 4-field device");
150 } else {
151 hid_err(hid, "not enough fields or values\n");
152 return -ENODEV;
153 }
154
155 plff = kzalloc(sizeof(struct plff_device), GFP_KERNEL);
156 if (!plff)
157 return -ENOMEM;
158
159 dev = hidinput->input;
160
161 set_bit(FF_RUMBLE, dev->ffbit);
162
163 error = input_ff_create_memless(dev, plff, hid_plff_play);
164 if (error) {
165 kfree(plff);
166 return error;
167 }
168
169 plff->report = report;
170 plff->strong = strong;
171 plff->weak = weak;
172 plff->maxval = maxval;
173
174 *strong = 0x00;
175 *weak = 0x00;
176 hid_hw_request(hid, plff->report, HID_REQ_SET_REPORT);
177 }
178
179 hid_info(hid, "Force feedback for PantherLord/GreenAsia devices by Anssi Hannula <anssi.hannula@gmail.com>\n");
180
181 return 0;
182}
183#else
184static inline int plff_init(struct hid_device *hid)
185{
186 return 0;
187}
188#endif
189
190static int pl_probe(struct hid_device *hdev, const struct hid_device_id *id)
191{
192 int ret;
193
194 if (id->driver_data)
195 hdev->quirks |= HID_QUIRK_MULTI_INPUT;
196
197 ret = hid_parse(hdev);
198 if (ret) {
199 hid_err(hdev, "parse failed\n");
200 goto err;
201 }
202
203 ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
204 if (ret) {
205 hid_err(hdev, "hw start failed\n");
206 goto err;
207 }
208
209 plff_init(hdev);
210
211 return 0;
212err:
213 return ret;
214}
215
216static const struct hid_device_id pl_devices[] = {
217 { HID_USB_DEVICE(USB_VENDOR_ID_GAMERON, USB_DEVICE_ID_GAMERON_DUAL_PSX_ADAPTOR),
218 .driver_data = 1 },
219 { HID_USB_DEVICE(USB_VENDOR_ID_GAMERON, USB_DEVICE_ID_GAMERON_DUAL_PCS_ADAPTOR),
220 .driver_data = 1 },
221 { HID_USB_DEVICE(USB_VENDOR_ID_GREENASIA, 0x0003), },
222 { HID_USB_DEVICE(USB_VENDOR_ID_JESS2, USB_DEVICE_ID_JESS2_COLOR_RUMBLE_PAD), },
223 { }
224};
225MODULE_DEVICE_TABLE(hid, pl_devices);
226
227static struct hid_driver pl_driver = {
228 .name = "pantherlord",
229 .id_table = pl_devices,
230 .probe = pl_probe,
231};
232module_hid_driver(pl_driver);
233
234MODULE_LICENSE("GPL");
235