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