1bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula/* 2bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * Force feedback support for Zeroplus based devices 3bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * 4bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * Copyright (c) 2005, 2006 Anssi Hannula <anssi.hannula@gmail.com> 5bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula */ 6bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 7bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula/* 8bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * This program is free software; you can redistribute it and/or modify 9bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * it under the terms of the GNU General Public License as published by 10bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * the Free Software Foundation; either version 2 of the License, or 11bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * (at your option) any later version. 12bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * 13bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * This program is distributed in the hope that it will be useful, 14bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * but WITHOUT ANY WARRANTY; without even the implied warranty of 15bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * GNU General Public License for more details. 17bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * 18bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * You should have received a copy of the GNU General Public License 19bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * along with this program; if not, write to the Free Software 20bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 21bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula */ 22bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 23bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 24987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby#include <linux/hid.h> 25bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula#include <linux/input.h> 265a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 27bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula#include <linux/usb.h> 288f86a2c3cb90e8bb0733de2d2b0abbe7050bb536Paul Gortmaker#include <linux/module.h> 29987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 30987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby#include "hid-ids.h" 31987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 320f6f4319a72a2b32d19643ff811f25633d8b0207Jiri Kosina#ifdef CONFIG_ZEROPLUS_FF 33987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby#include "usbhid/usbhid.h" 34bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 35bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannulastruct zpff_device { 36bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct hid_report *report; 37bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula}; 38bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 39987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabystatic int zpff_play(struct input_dev *dev, void *data, 40bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct ff_effect *effect) 41bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula{ 42e071298589418076ef0a9813677f2d7032b65baaDmitry Torokhov struct hid_device *hid = input_get_drvdata(dev); 43bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct zpff_device *zpff = data; 44bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula int left, right; 45bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 46bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula /* 47bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * The following is specified the other way around in the Zeroplus 48bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * datasheet but the order below is correct for the XFX Executioner; 49bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula * however it is possible that the XFX Executioner is an exception 50bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula */ 51bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 52bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula left = effect->u.rumble.strong_magnitude; 53bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula right = effect->u.rumble.weak_magnitude; 5458037eb961f859607b161c50d9d4ecb374de1e8fJiri Kosina dbg_hid("called with 0x%04x 0x%04x\n", left, right); 55bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 56bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula left = left * 0x7f / 0xffff; 57bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula right = right * 0x7f / 0xffff; 58bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 59bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff->report->field[2]->value[0] = left; 60bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff->report->field[3]->value[0] = right; 6158037eb961f859607b161c50d9d4ecb374de1e8fJiri Kosina dbg_hid("running with 0x%02x 0x%02x\n", left, right); 624916b3a57fc94664677d439b911b8aaf86c7ec23Jiri Kosina usbhid_submit_report(hid, zpff->report, USB_DIR_OUT); 63bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 64bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula return 0; 65bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula} 66bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 67987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabystatic int zpff_init(struct hid_device *hid) 68bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula{ 69bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct zpff_device *zpff; 70bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct hid_report *report; 71bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct hid_input *hidinput = list_entry(hid->inputs.next, 72bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct hid_input, list); 73bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct list_head *report_list = 74bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula &hid->report_enum[HID_OUTPUT_REPORT].report_list; 75bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula struct input_dev *dev = hidinput->input; 76bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula int error; 77bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 78bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula if (list_empty(report_list)) { 794291ee305e9bb0699504a66f0e2b7aefcf0512a5Joe Perches hid_err(hid, "no output report found\n"); 80bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula return -ENODEV; 81bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula } 82bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 83bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula report = list_entry(report_list->next, struct hid_report, list); 84bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 85bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula if (report->maxfield < 4) { 864291ee305e9bb0699504a66f0e2b7aefcf0512a5Joe Perches hid_err(hid, "not enough fields in report\n"); 87bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula return -ENODEV; 88bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula } 89bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 90bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff = kzalloc(sizeof(struct zpff_device), GFP_KERNEL); 91bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula if (!zpff) 92bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula return -ENOMEM; 93bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 94bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula set_bit(FF_RUMBLE, dev->ffbit); 95bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 96987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby error = input_ff_create_memless(dev, zpff, zpff_play); 97bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula if (error) { 98bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula kfree(zpff); 99bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula return error; 100bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula } 101bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 102bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff->report = report; 103bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff->report->field[0]->value[0] = 0x00; 104bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff->report->field[1]->value[0] = 0x02; 105bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff->report->field[2]->value[0] = 0x00; 106bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula zpff->report->field[3]->value[0] = 0x00; 1074916b3a57fc94664677d439b911b8aaf86c7ec23Jiri Kosina usbhid_submit_report(hid, zpff->report, USB_DIR_OUT); 108bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 1094291ee305e9bb0699504a66f0e2b7aefcf0512a5Joe Perches hid_info(hid, "force feedback for Zeroplus based devices by Anssi Hannula <anssi.hannula@gmail.com>\n"); 110bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula 111bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula return 0; 112bb3caf7f438a67452f5cf4773ca1bf82260bbbadAnssi Hannula} 1130f6f4319a72a2b32d19643ff811f25633d8b0207Jiri Kosina#else 1140f6f4319a72a2b32d19643ff811f25633d8b0207Jiri Kosinastatic inline int zpff_init(struct hid_device *hid) 1150f6f4319a72a2b32d19643ff811f25633d8b0207Jiri Kosina{ 1160f6f4319a72a2b32d19643ff811f25633d8b0207Jiri Kosina return 0; 1170f6f4319a72a2b32d19643ff811f25633d8b0207Jiri Kosina} 1180f6f4319a72a2b32d19643ff811f25633d8b0207Jiri Kosina#endif 119987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 120987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabystatic int zp_probe(struct hid_device *hdev, const struct hid_device_id *id) 121987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby{ 122987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby int ret; 123987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 124987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby ret = hid_parse(hdev); 125987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby if (ret) { 1264291ee305e9bb0699504a66f0e2b7aefcf0512a5Joe Perches hid_err(hdev, "parse failed\n"); 127987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby goto err; 128987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby } 129987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 130987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF); 131987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby if (ret) { 1324291ee305e9bb0699504a66f0e2b7aefcf0512a5Joe Perches hid_err(hdev, "hw start failed\n"); 133987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby goto err; 134987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby } 135987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 136987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby zpff_init(hdev); 137987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 138987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby return 0; 139987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabyerr: 140987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby return ret; 141987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby} 142987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 143987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabystatic const struct hid_device_id zp_devices[] = { 144987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby { HID_USB_DEVICE(USB_VENDOR_ID_ZEROPLUS, 0x0005) }, 145987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby { HID_USB_DEVICE(USB_VENDOR_ID_ZEROPLUS, 0x0030) }, 146987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby { } 147987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby}; 148987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri SlabyMODULE_DEVICE_TABLE(hid, zp_devices); 149987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 150987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabystatic struct hid_driver zp_driver = { 151987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby .name = "zeroplus", 152987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby .id_table = zp_devices, 153987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby .probe = zp_probe, 154987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby}; 155987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 156a24f423bdf253ccee369adc6c5451b40a0716fbbPeter Huewestatic int __init zp_init(void) 157987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby{ 158987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby return hid_register_driver(&zp_driver); 159987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby} 160987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 161a24f423bdf253ccee369adc6c5451b40a0716fbbPeter Huewestatic void __exit zp_exit(void) 162987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby{ 163987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby hid_unregister_driver(&zp_driver); 164987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby} 165987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slaby 166987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabymodule_init(zp_init); 167987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri Slabymodule_exit(zp_exit); 168987fbc1f7d446f4bf7063d3b756ae29db80be75eJiri SlabyMODULE_LICENSE("GPL"); 169