1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Force feedback support for Zeroplus based devices 4 * 5 * Copyright (c) 2005, 2006 Anssi Hannula <anssi.hannula@gmail.com> 6 */ 7 8 /* 9 */ 10 11 12 #include <linux/hid.h> 13 #include <linux/input.h> 14 #include <linux/slab.h> 15 #include <linux/module.h> 16 17 #include "hid-ids.h" 18 19 #ifdef CONFIG_ZEROPLUS_FF 20 21 struct zpff_device { 22 struct hid_report *report; 23 }; 24 25 static int zpff_play(struct input_dev *dev, void *data, 26 struct ff_effect *effect) 27 { 28 struct hid_device *hid = input_get_drvdata(dev); 29 struct zpff_device *zpff = data; 30 int left, right; 31 32 /* 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 36 */ 37 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); 41 42 left = left * 0x7f / 0xffff; 43 right = right * 0x7f / 0xffff; 44 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); 49 50 return 0; 51 } 52 53 static int zp_input_configured(struct hid_device *hid, struct hid_input *hidinput) 54 { 55 struct zpff_device *zpff; 56 struct hid_report *report; 57 struct input_dev *dev = hidinput->input; 58 int i, error; 59 60 if (!list_is_first(&hidinput->list, &hid->inputs)) 61 return 0; 62 63 for (i = 0; i < 4; i++) { 64 report = hid_validate_values(hid, HID_OUTPUT_REPORT, 0, i, 1); 65 if (!report) 66 return -ENODEV; 67 } 68 69 zpff = kzalloc_obj(struct zpff_device); 70 if (!zpff) 71 return -ENOMEM; 72 73 zpff->report = report; 74 set_bit(FF_RUMBLE, dev->ffbit); 75 76 error = input_ff_create_memless(dev, zpff, zpff_play); 77 if (error) { 78 kfree(zpff); 79 return error; 80 } 81 82 zpff->report->field[0]->value[0] = 0x00; 83 zpff->report->field[1]->value[0] = 0x02; 84 zpff->report->field[2]->value[0] = 0x00; 85 zpff->report->field[3]->value[0] = 0x00; 86 hid_hw_request(hid, zpff->report, HID_REQ_SET_REPORT); 87 88 hid_info(hid, "force feedback for Zeroplus based devices by Anssi Hannula <anssi.hannula@gmail.com>\n"); 89 90 return 0; 91 } 92 #else 93 static inline int zp_input_configured(struct hid_device *hid, 94 struct hid_input *hidinput) 95 { 96 return 0; 97 } 98 #endif 99 100 static const struct hid_device_id zp_devices[] = { 101 { HID_USB_DEVICE(USB_VENDOR_ID_ZEROPLUS, 0x0005) }, 102 { HID_USB_DEVICE(USB_VENDOR_ID_ZEROPLUS, 0x0030) }, 103 { } 104 }; 105 MODULE_DEVICE_TABLE(hid, zp_devices); 106 107 static struct hid_driver zp_driver = { 108 .name = "zeroplus", 109 .id_table = zp_devices, 110 .input_configured = zp_input_configured, 111 }; 112 module_hid_driver(zp_driver); 113 114 MODULE_DESCRIPTION("Force feedback support for Zeroplus based devices"); 115 MODULE_LICENSE("GPL"); 116