Blame view

drivers/hid/hid-pl.c 5.87 KB
20eb12790   Anssi Hannula   hid: force feedba...
1
  /*
5edc41ee8   Anssi Hannula   HID: use hid-plff...
2
3
4
5
6
7
8
9
10
11
   *  Force feedback support for PantherLord/GreenAsia based devices
   *
   *  The devices are distributed under various names and the same USB device ID
   *  can be used in both adapters and actual game controllers.
   *
   *  0810:0001 "Twin USB Joystick"
   *   - tested with PantherLord USB/PS2 2in1 Adapter
   *   - contains two reports, one for each port (HID_QUIRK_MULTI_INPUT)
   *
   *  0e8f:0003 "GreenAsia Inc.    USB Joystick     "
d36b69107   Al Viro   misc latin1 to ut...
12
   *   - tested with König Gaming gamepad
20eb12790   Anssi Hannula   hid: force feedba...
13
   *
27a9c1793   Anssi Hannula   HID: add support ...
14
   *  0e8f:0003 "GASIA USB Gamepad"
d36b69107   Al Viro   misc latin1 to ut...
15
   *   - another version of the König gamepad
27a9c1793   Anssi Hannula   HID: add support ...
16
17
   *
   *  Copyright (c) 2007, 2009 Anssi Hannula <anssi.hannula@gmail.com>
20eb12790   Anssi Hannula   hid: force feedba...
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
   */
  
  /*
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License, or
   * (at your option) any later version.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program; if not, write to the Free Software
   * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
   */
  
  
  /* #define DEBUG */
  
  #define debug(format, arg...) pr_debug("hid-plff: " format "
  " , ## arg)
  
  #include <linux/input.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
43
  #include <linux/slab.h>
8f86a2c3c   Paul Gortmaker   hid: Add module.h...
44
  #include <linux/module.h>
20eb12790   Anssi Hannula   hid: force feedba...
45
46
  #include <linux/usb.h>
  #include <linux/hid.h>
5f022298a   Jiri Slaby   HID: move panther...
47
48
49
50
51
  
  #include "hid-ids.h"
  
  #ifdef CONFIG_PANTHERLORD_FF
  #include "usbhid/usbhid.h"
20eb12790   Anssi Hannula   hid: force feedba...
52
53
54
  
  struct plff_device {
  	struct hid_report *report;
27a9c1793   Anssi Hannula   HID: add support ...
55
56
  	s32 *strong;
  	s32 *weak;
20eb12790   Anssi Hannula   hid: force feedba...
57
58
59
60
61
  };
  
  static int hid_plff_play(struct input_dev *dev, void *data,
  			 struct ff_effect *effect)
  {
e07129858   Dmitry Torokhov   HID: switch to us...
62
  	struct hid_device *hid = input_get_drvdata(dev);
20eb12790   Anssi Hannula   hid: force feedba...
63
64
65
66
67
68
69
70
71
  	struct plff_device *plff = data;
  	int left, right;
  
  	left = effect->u.rumble.strong_magnitude;
  	right = effect->u.rumble.weak_magnitude;
  	debug("called with 0x%04x 0x%04x", left, right);
  
  	left = left * 0x7f / 0xffff;
  	right = right * 0x7f / 0xffff;
27a9c1793   Anssi Hannula   HID: add support ...
72
73
  	*plff->strong = left;
  	*plff->weak = right;
20eb12790   Anssi Hannula   hid: force feedba...
74
75
76
77
78
  	debug("running with 0x%02x 0x%02x", left, right);
  	usbhid_submit_report(hid, plff->report, USB_DIR_OUT);
  
  	return 0;
  }
5f022298a   Jiri Slaby   HID: move panther...
79
  static int plff_init(struct hid_device *hid)
20eb12790   Anssi Hannula   hid: force feedba...
80
81
82
83
84
85
86
87
88
  {
  	struct plff_device *plff;
  	struct hid_report *report;
  	struct hid_input *hidinput;
  	struct list_head *report_list =
  			&hid->report_enum[HID_OUTPUT_REPORT].report_list;
  	struct list_head *report_ptr = report_list;
  	struct input_dev *dev;
  	int error;
27a9c1793   Anssi Hannula   HID: add support ...
89
90
  	s32 *strong;
  	s32 *weak;
20eb12790   Anssi Hannula   hid: force feedba...
91

5edc41ee8   Anssi Hannula   HID: use hid-plff...
92
93
94
  	/* The device contains one output report per physical device, all
  	   containing 1 field, which contains 4 ff00.0002 usages and 4 16bit
  	   absolute values.
20eb12790   Anssi Hannula   hid: force feedba...
95

5edc41ee8   Anssi Hannula   HID: use hid-plff...
96
  	   The input reports also contain a field which contains
20eb12790   Anssi Hannula   hid: force feedba...
97
  	   8 ff00.0001 usages and 8 boolean values. Their meaning is
27a9c1793   Anssi Hannula   HID: add support ...
98
99
100
101
102
103
  	   currently unknown.
  	   
  	   A version of the 0e8f:0003 exists that has all the values in
  	   separate fields and misses the extra input field, thus resembling
  	   Zeroplus (hid-zpff) devices.
  	*/
20eb12790   Anssi Hannula   hid: force feedba...
104
105
  
  	if (list_empty(report_list)) {
4291ee305   Joe Perches   HID: Add and use ...
106
107
  		hid_err(hid, "no output reports found
  ");
20eb12790   Anssi Hannula   hid: force feedba...
108
109
110
111
112
113
114
115
  		return -ENODEV;
  	}
  
  	list_for_each_entry(hidinput, &hid->inputs, list) {
  
  		report_ptr = report_ptr->next;
  
  		if (report_ptr == report_list) {
4291ee305   Joe Perches   HID: Add and use ...
116
117
  			hid_err(hid, "required output report is missing
  ");
20eb12790   Anssi Hannula   hid: force feedba...
118
119
120
121
122
  			return -ENODEV;
  		}
  
  		report = list_entry(report_ptr, struct hid_report, list);
  		if (report->maxfield < 1) {
4291ee305   Joe Perches   HID: Add and use ...
123
124
  			hid_err(hid, "no fields in the report
  ");
20eb12790   Anssi Hannula   hid: force feedba...
125
126
  			return -ENODEV;
  		}
27a9c1793   Anssi Hannula   HID: add support ...
127
128
129
130
131
132
133
134
135
136
137
138
139
140
  		if (report->field[0]->report_count >= 4) {
  			report->field[0]->value[0] = 0x00;
  			report->field[0]->value[1] = 0x00;
  			strong = &report->field[0]->value[2];
  			weak = &report->field[0]->value[3];
  			debug("detected single-field device");
  		} else if (report->maxfield >= 4 && report->field[0]->maxusage == 1 &&
  				report->field[0]->usage[0].hid == (HID_UP_LED | 0x43)) {
  			report->field[0]->value[0] = 0x00;
  			report->field[1]->value[0] = 0x00;
  			strong = &report->field[2]->value[0];
  			weak = &report->field[3]->value[0];
  			debug("detected 4-field device");
  		} else {
4291ee305   Joe Perches   HID: Add and use ...
141
142
  			hid_err(hid, "not enough fields or values
  ");
20eb12790   Anssi Hannula   hid: force feedba...
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
  			return -ENODEV;
  		}
  
  		plff = kzalloc(sizeof(struct plff_device), GFP_KERNEL);
  		if (!plff)
  			return -ENOMEM;
  
  		dev = hidinput->input;
  
  		set_bit(FF_RUMBLE, dev->ffbit);
  
  		error = input_ff_create_memless(dev, plff, hid_plff_play);
  		if (error) {
  			kfree(plff);
  			return error;
  		}
  
  		plff->report = report;
27a9c1793   Anssi Hannula   HID: add support ...
161
162
163
164
165
  		plff->strong = strong;
  		plff->weak = weak;
  
  		*strong = 0x00;
  		*weak = 0x00;
20eb12790   Anssi Hannula   hid: force feedba...
166
167
  		usbhid_submit_report(hid, plff->report, USB_DIR_OUT);
  	}
4291ee305   Joe Perches   HID: Add and use ...
168
169
  	hid_info(hid, "Force feedback for PantherLord/GreenAsia devices by Anssi Hannula <anssi.hannula@gmail.com>
  ");
20eb12790   Anssi Hannula   hid: force feedba...
170
171
172
  
  	return 0;
  }
5f022298a   Jiri Slaby   HID: move panther...
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
  #else
  static inline int plff_init(struct hid_device *hid)
  {
  	return 0;
  }
  #endif
  
  static int pl_probe(struct hid_device *hdev, const struct hid_device_id *id)
  {
  	int ret;
  
  	if (id->driver_data)
  		hdev->quirks |= HID_QUIRK_MULTI_INPUT;
  
  	ret = hid_parse(hdev);
  	if (ret) {
4291ee305   Joe Perches   HID: Add and use ...
189
190
  		hid_err(hdev, "parse failed
  ");
5f022298a   Jiri Slaby   HID: move panther...
191
192
193
194
195
  		goto err;
  	}
  
  	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
  	if (ret) {
4291ee305   Joe Perches   HID: Add and use ...
196
197
  		hid_err(hdev, "hw start failed
  ");
5f022298a   Jiri Slaby   HID: move panther...
198
199
200
201
202
203
204
205
206
207
208
209
210
  		goto err;
  	}
  
  	plff_init(hdev);
  
  	return 0;
  err:
  	return ret;
  }
  
  static const struct hid_device_id pl_devices[] = {
  	{ HID_USB_DEVICE(USB_VENDOR_ID_GAMERON, USB_DEVICE_ID_GAMERON_DUAL_PSX_ADAPTOR),
  		.driver_data = 1 }, /* Twin USB Joystick */
578f3a35f   Jiri Kosina   HID: add USB ID f...
211
212
  	{ HID_USB_DEVICE(USB_VENDOR_ID_GAMERON, USB_DEVICE_ID_GAMERON_DUAL_PCS_ADAPTOR),
  		.driver_data = 1 }, /* Twin USB Joystick */
27a9c1793   Anssi Hannula   HID: add support ...
213
  	{ HID_USB_DEVICE(USB_VENDOR_ID_GREENASIA, 0x0003), },
5f022298a   Jiri Slaby   HID: move panther...
214
215
216
217
218
219
220
221
222
  	{ }
  };
  MODULE_DEVICE_TABLE(hid, pl_devices);
  
  static struct hid_driver pl_driver = {
  	.name = "pantherlord",
  	.id_table = pl_devices,
  	.probe = pl_probe,
  };
a24f423bd   Peter Huewe   HID: adding __ini...
223
  static int __init pl_init(void)
5f022298a   Jiri Slaby   HID: move panther...
224
225
226
  {
  	return hid_register_driver(&pl_driver);
  }
a24f423bd   Peter Huewe   HID: adding __ini...
227
  static void __exit pl_exit(void)
5f022298a   Jiri Slaby   HID: move panther...
228
229
230
231
232
233
234
  {
  	hid_unregister_driver(&pl_driver);
  }
  
  module_init(pl_init);
  module_exit(pl_exit);
  MODULE_LICENSE("GPL");