27 #include <linux/input.h>
29 #include <linux/hid.h>
35 #define DFGT_REV_MAJ 0x13
36 #define DFGT_REV_MIN 0x22
37 #define DFP_REV_MAJ 0x11
38 #define DFP_REV_MIN 0x06
39 #define FFEX_REV_MAJ 0x21
40 #define FFEX_REV_MIN 0x00
41 #define G25_REV_MAJ 0x12
42 #define G25_REV_MIN 0x22
43 #define G27_REV_MAJ 0x12
44 #define G27_REV_MIN 0x38
47 #define DFP_X_MAX 16383
48 #define DFP_PEDAL_MIN 0
49 #define DFP_PEDAL_MAX 255
51 #define to_hid_device(pdev) container_of(pdev, struct hid_device, dev)
65 #ifdef CONFIG_LEDS_CLASS
73 static const signed short lg4ff_wheel_effects[] = {
111 {0xf8, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00}
116 {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00,
117 0xf8, 0x09, 0x03, 0x01, 0x00, 0x00, 0x00}
122 {0xf8, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00}
127 {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00,
128 0xf8, 0x09, 0x04, 0x01, 0x00, 0x00, 0x00}
146 else if (range == 200)
148 else if (range < 200)
153 new_value = 8192 +
mult_frac(value - 8192, max_range, range);
156 else if (new_value > 16383)
169 hid_err(hid,
"Device properties not found");
175 switch (usage->
code) {
177 new_value = lg4ff_adjust_dfp_x_axis(value, entry->
range);
188 static int hid_lg4ff_play(
struct input_dev *
dev,
void *
data,
struct ff_effect *effect)
190 struct hid_device *hid = input_get_drvdata(dev);
196 #define CLAMP(x) do { if (x < 0) x = 0; else if (x > 0xff) x = 0xff; } while (0)
198 switch (effect->
type) {
200 x = effect->
u.
ramp.start_level + 0x80;
218 static void hid_lg4ff_set_autocenter_default(
struct input_dev *dev,
u16 magnitude)
220 struct hid_device *hid = input_get_drvdata(dev);
227 value[2] = magnitude >> 13;
228 value[3] = magnitude >> 13;
229 value[4] = magnitude >> 8;
237 static void hid_lg4ff_set_autocenter_ffex(
struct input_dev *dev,
u16 magnitude)
239 struct hid_device *hid = input_get_drvdata(dev);
243 magnitude = magnitude * 90 / 65535;
247 value[2] = magnitude >> 14;
248 value[3] = magnitude >> 14;
249 value[4] = magnitude;
257 static void hid_lg4ff_set_range_g25(
struct hid_device *hid,
u16 range)
263 dbg_hid(
"G25/G27/DFGT: setting range to %u\n", range);
267 value[2] = range & 0x00ff;
268 value[3] = (range & 0xff00) >> 8;
277 static void hid_lg4ff_set_range_dfp(
struct hid_device *hid,
__u16 range)
281 int start_left, start_right, full_range;
284 dbg_hid(
"Driving Force Pro: setting range to %u\n", range);
296 report->
field[0]->value[1] = 0x03;
299 report->
field[0]->value[1] = 0x02;
313 if (range == 200 || range == 900) {
319 start_left = (((full_range - range + 1) * 2047) / full_range);
320 start_right = 0xfff - start_left;
322 value[2] = start_left >> 4;
323 value[3] = start_right >> 4;
325 value[5] = (start_right & 0xe) << 4 | (start_left & 0
xe);
338 while (j < 7*cmd->cmd_num) {
339 for (i = 0; i < 7; i++)
340 report->
field[0]->value[i] = cmd->
cmd[j++];
354 drv_data = hid_get_drvdata(hid);
356 hid_err(hid,
"Private driver data not found!\n");
362 hid_err(hid,
"Device properties not found!\n");
379 drv_data = hid_get_drvdata(hid);
381 hid_err(hid,
"Private driver data not found!\n");
387 hid_err(hid,
"Device properties not found!\n");
404 #ifdef CONFIG_LEDS_CLASS
421 static void lg4ff_led_set_brightness(
struct led_classdev *led_cdev,
424 struct device *dev = led_cdev->
dev->parent;
426 struct lg_drv_data *drv_data = hid_get_drvdata(hid);
431 hid_err(hid,
"Device data not found.");
438 hid_err(hid,
"Device properties not found.");
442 for (i = 0; i < 5; i++) {
443 if (led_cdev != entry->led[i])
445 state = (entry->led_state >>
i) & 1;
446 if (value ==
LED_OFF && state) {
447 entry->led_state &= ~(1 <<
i);
448 lg4ff_set_leds(hid, entry->led_state);
449 }
else if (value !=
LED_OFF && !state) {
450 entry->led_state |= 1 <<
i;
451 lg4ff_set_leds(hid, entry->led_state);
459 struct device *dev = led_cdev->
dev->parent;
461 struct lg_drv_data *drv_data = hid_get_drvdata(hid);
466 hid_err(hid,
"Device data not found.");
473 hid_err(hid,
"Device properties not found.");
477 for (i = 0; i < 5; i++)
478 if (led_cdev == entry->led[i]) {
479 value = (entry->led_state >>
i) & 1;
491 struct input_dev *dev = hidinput->
input;
501 if (list_empty(report_list)) {
502 hid_err(hid,
"No output report found\n");
509 hid_err(hid,
"NULL output report\n");
513 field = report->
field[0];
520 for (i = 0; i <
ARRAY_SIZE(lg4ff_devices); i++) {
522 dbg_hid(
"Found compatible device, product ID %04X\n", lg4ff_devices[i].
product_id);
528 hid_err(hid,
"Device is not supported by lg4ff driver. If you think it should be, consider reporting a bug to"
536 hid_err(hid,
"NULL USB device descriptor\n");
540 rev_maj = bcdDevice >> 8;
541 rev_min = bcdDevice & 0xff;
544 dbg_hid(
"Generic wheel detected, can it do native?\n");
545 dbg_hid(
"USB revision: %2x.%02x\n", rev_maj, rev_min);
547 for (j = 0; j <
ARRAY_SIZE(lg4ff_revs); j++) {
548 if (lg4ff_revs[j].rev_maj == rev_maj && lg4ff_revs[j].rev_min == rev_min) {
549 hid_lg4ff_switch_native(hid, lg4ff_revs[j].
command);
550 hid_info(hid,
"Switched to native mode\n");
557 set_bit(lg4ff_devices[i].ff_effects[j], dev->ffbit);
568 dev->ff->set_autocenter = hid_lg4ff_set_autocenter_ffex;
570 dev->ff->set_autocenter = hid_lg4ff_set_autocenter_default;
572 dev->ff->set_autocenter(dev, 0);
576 drv_data = hid_get_drvdata(hid);
578 hid_err(hid,
"Cannot add device, private driver data not allocated\n");
585 hid_err(hid,
"Cannot add device, insufficient memory to allocate device properties.\n");
599 dbg_hid(
"sysfs interface created\n");
604 dbg_hid(
"Setting axes parameters for Driving Force Pro\n");
618 #ifdef CONFIG_LEDS_CLASS
620 entry->led_state = 0;
621 for (j = 0; j < 5; j++)
622 entry->led[j] =
NULL;
629 lg4ff_set_leds(hid, 0);
631 name_sz =
strlen(dev_name(&hid->
dev)) + 8;
633 for (j = 0; j < 5; j++) {
636 hid_err(hid,
"can't allocate memory for LED %d\n", j);
640 name = (
void *)(&led[1]);
641 snprintf(name, name_sz,
"%s::RPM%d", dev_name(&hid->
dev), j+1);
652 hid_err(hid,
"failed to register LED %d. Aborting.\n", j);
655 for (j = 0; j < 5; j++) {
657 entry->led[
j] =
NULL;
669 hid_info(hid,
"Force feedback support for Logitech Gaming Wheels\n");
682 drv_data = hid_get_drvdata(hid);
684 hid_err(hid,
"Error while deinitializing device, no private driver data.\n");
689 hid_err(hid,
"Error while deinitializing device, no device properties data.\n");
693 #ifdef CONFIG_LEDS_CLASS
699 for (j = 0; j < 5; j++) {
702 entry->led[
j] =
NULL;
714 dbg_hid(
"Device successfully unregistered\n");