diff options
Diffstat (limited to 'drivers/hid/hid-lgff.c')
-rw-r--r-- | drivers/hid/hid-lgff.c | 28 |
1 files changed, 27 insertions, 1 deletions
diff --git a/drivers/hid/hid-lgff.c b/drivers/hid/hid-lgff.c index e379c167ac9e..51aff08e10ce 100644 --- a/drivers/hid/hid-lgff.c +++ b/drivers/hid/hid-lgff.c | |||
@@ -50,6 +50,12 @@ static const signed short ff_joystick[] = { | |||
50 | -1 | 50 | -1 |
51 | }; | 51 | }; |
52 | 52 | ||
53 | static const signed short ff_wheel[] = { | ||
54 | FF_CONSTANT, | ||
55 | FF_AUTOCENTER, | ||
56 | -1 | ||
57 | }; | ||
58 | |||
53 | static const struct dev_type devices[] = { | 59 | static const struct dev_type devices[] = { |
54 | { 0x046d, 0xc211, ff_rumble }, | 60 | { 0x046d, 0xc211, ff_rumble }, |
55 | { 0x046d, 0xc219, ff_rumble }, | 61 | { 0x046d, 0xc219, ff_rumble }, |
@@ -57,7 +63,7 @@ static const struct dev_type devices[] = { | |||
57 | { 0x046d, 0xc286, ff_joystick }, | 63 | { 0x046d, 0xc286, ff_joystick }, |
58 | { 0x046d, 0xc294, ff_joystick }, | 64 | { 0x046d, 0xc294, ff_joystick }, |
59 | { 0x046d, 0xc295, ff_joystick }, | 65 | { 0x046d, 0xc295, ff_joystick }, |
60 | { 0x046d, 0xca03, ff_joystick }, | 66 | { 0x046d, 0xca03, ff_wheel }, |
61 | }; | 67 | }; |
62 | 68 | ||
63 | static int hid_lgff_play(struct input_dev *dev, void *data, struct ff_effect *effect) | 69 | static int hid_lgff_play(struct input_dev *dev, void *data, struct ff_effect *effect) |
@@ -102,6 +108,23 @@ static int hid_lgff_play(struct input_dev *dev, void *data, struct ff_effect *ef | |||
102 | return 0; | 108 | return 0; |
103 | } | 109 | } |
104 | 110 | ||
111 | static void hid_lgff_set_autocenter(struct input_dev *dev, u16 magnitude) | ||
112 | { | ||
113 | struct hid_device *hid = input_get_drvdata(dev); | ||
114 | struct list_head *report_list = &hid->report_enum[HID_OUTPUT_REPORT].report_list; | ||
115 | struct hid_report *report = list_entry(report_list->next, struct hid_report, list); | ||
116 | __s32 *value = report->field[0]->value; | ||
117 | magnitude = (magnitude >> 12) & 0xf; | ||
118 | *value++ = 0xfe; | ||
119 | *value++ = 0x0d; | ||
120 | *value++ = magnitude; /* clockwise strength */ | ||
121 | *value++ = magnitude; /* counter-clockwise strength */ | ||
122 | *value++ = 0x80; | ||
123 | *value++ = 0x00; | ||
124 | *value = 0x00; | ||
125 | usbhid_submit_report(hid, report, USB_DIR_OUT); | ||
126 | } | ||
127 | |||
105 | int lgff_init(struct hid_device* hid) | 128 | int lgff_init(struct hid_device* hid) |
106 | { | 129 | { |
107 | struct hid_input *hidinput = list_entry(hid->inputs.next, struct hid_input, list); | 130 | struct hid_input *hidinput = list_entry(hid->inputs.next, struct hid_input, list); |
@@ -147,6 +170,9 @@ int lgff_init(struct hid_device* hid) | |||
147 | if (error) | 170 | if (error) |
148 | return error; | 171 | return error; |
149 | 172 | ||
173 | if ( test_bit(FF_AUTOCENTER, dev->ffbit) ) | ||
174 | dev->ff->set_autocenter = hid_lgff_set_autocenter; | ||
175 | |||
150 | printk(KERN_INFO "Force feedback for Logitech force feedback devices by Johann Deneux <johann.deneux@it.uu.se>\n"); | 176 | printk(KERN_INFO "Force feedback for Logitech force feedback devices by Johann Deneux <johann.deneux@it.uu.se>\n"); |
151 | 177 | ||
152 | return 0; | 178 | return 0; |