1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Force feedback support for Zeroplus based devices
5 * Copyright (c) 2005, 2006 Anssi Hannula <anssi.hannula@gmail.com>
12 #include <linux/hid.h>
13 #include <linux/input.h>
14 #include <linux/slab.h>
15 #include <linux/module.h>
19 #ifdef CONFIG_ZEROPLUS_FF
22 struct hid_report
*report
;
25 static int zpff_play(struct input_dev
*dev
, void *data
,
26 struct ff_effect
*effect
)
28 struct hid_device
*hid
= input_get_drvdata(dev
);
29 struct zpff_device
*zpff
= data
;
33 * The following is specified the other way around in the Zeroplus
34 * datasheet but the order below is correct for the XFX Executioner;
35 * however it is possible that the XFX Executioner is an exception
38 left
= effect
->u
.rumble
.strong_magnitude
;
39 right
= effect
->u
.rumble
.weak_magnitude
;
40 dbg_hid("called with 0x%04x 0x%04x\n", left
, right
);
42 left
= left
* 0x7f / 0xffff;
43 right
= right
* 0x7f / 0xffff;
45 zpff
->report
->field
[2]->value
[0] = left
;
46 zpff
->report
->field
[3]->value
[0] = right
;
47 dbg_hid("running with 0x%02x 0x%02x\n", left
, right
);
48 hid_hw_request(hid
, zpff
->report
, HID_REQ_SET_REPORT
);
53 static int zpff_init(struct hid_device
*hid
)
55 struct zpff_device
*zpff
;
56 struct hid_report
*report
;
57 struct hid_input
*hidinput
;
58 struct input_dev
*dev
;
61 if (list_empty(&hid
->inputs
)) {
62 hid_err(hid
, "no inputs found\n");
65 hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
66 dev
= hidinput
->input
;
68 for (i
= 0; i
< 4; i
++) {
69 report
= hid_validate_values(hid
, HID_OUTPUT_REPORT
, 0, i
, 1);
74 zpff
= kzalloc(sizeof(struct zpff_device
), GFP_KERNEL
);
78 set_bit(FF_RUMBLE
, dev
->ffbit
);
80 error
= input_ff_create_memless(dev
, zpff
, zpff_play
);
86 zpff
->report
= report
;
87 zpff
->report
->field
[0]->value
[0] = 0x00;
88 zpff
->report
->field
[1]->value
[0] = 0x02;
89 zpff
->report
->field
[2]->value
[0] = 0x00;
90 zpff
->report
->field
[3]->value
[0] = 0x00;
91 hid_hw_request(hid
, zpff
->report
, HID_REQ_SET_REPORT
);
93 hid_info(hid
, "force feedback for Zeroplus based devices by Anssi Hannula <anssi.hannula@gmail.com>\n");
98 static inline int zpff_init(struct hid_device
*hid
)
104 static int zp_probe(struct hid_device
*hdev
, const struct hid_device_id
*id
)
108 ret
= hid_parse(hdev
);
110 hid_err(hdev
, "parse failed\n");
114 ret
= hid_hw_start(hdev
, HID_CONNECT_DEFAULT
& ~HID_CONNECT_FF
);
116 hid_err(hdev
, "hw start failed\n");
127 static const struct hid_device_id zp_devices
[] = {
128 { HID_USB_DEVICE(USB_VENDOR_ID_ZEROPLUS
, 0x0005) },
129 { HID_USB_DEVICE(USB_VENDOR_ID_ZEROPLUS
, 0x0030) },
132 MODULE_DEVICE_TABLE(hid
, zp_devices
);
134 static struct hid_driver zp_driver
= {
136 .id_table
= zp_devices
,
139 module_hid_driver(zp_driver
);
141 MODULE_DESCRIPTION("Force feedback support for Zeroplus based devices");
142 MODULE_LICENSE("GPL");