V4L/DVB (6715): ivtv: Remove unnecessary register update
[linux-2.6/verdex.git] / drivers / hid / usbhid / hid-zpff.c
blob5a688274f6a3331d2264d10de5fff780de473b9c
1 /*
2 * Force feedback support for Zeroplus based devices
4 * Copyright (c) 2005, 2006 Anssi Hannula <anssi.hannula@gmail.com>
5 */
7 /*
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
24 #include <linux/input.h>
25 #include <linux/usb.h>
26 #include <linux/hid.h>
27 #include "usbhid.h"
29 struct zpff_device {
30 struct hid_report *report;
33 static int hid_zpff_play(struct input_dev *dev, void *data,
34 struct ff_effect *effect)
36 struct hid_device *hid = input_get_drvdata(dev);
37 struct zpff_device *zpff = data;
38 int left, right;
41 * The following is specified the other way around in the Zeroplus
42 * datasheet but the order below is correct for the XFX Executioner;
43 * however it is possible that the XFX Executioner is an exception
46 left = effect->u.rumble.strong_magnitude;
47 right = effect->u.rumble.weak_magnitude;
48 dbg_hid("called with 0x%04x 0x%04x\n", left, right);
50 left = left * 0x7f / 0xffff;
51 right = right * 0x7f / 0xffff;
53 zpff->report->field[2]->value[0] = left;
54 zpff->report->field[3]->value[0] = right;
55 dbg_hid("running with 0x%02x 0x%02x\n", left, right);
56 usbhid_submit_report(hid, zpff->report, USB_DIR_OUT);
58 return 0;
61 int hid_zpff_init(struct hid_device *hid)
63 struct zpff_device *zpff;
64 struct hid_report *report;
65 struct hid_input *hidinput = list_entry(hid->inputs.next,
66 struct hid_input, list);
67 struct list_head *report_list =
68 &hid->report_enum[HID_OUTPUT_REPORT].report_list;
69 struct input_dev *dev = hidinput->input;
70 int error;
72 if (list_empty(report_list)) {
73 printk(KERN_ERR "hid-zpff: no output report found\n");
74 return -ENODEV;
77 report = list_entry(report_list->next, struct hid_report, list);
79 if (report->maxfield < 4) {
80 printk(KERN_ERR "hid-zpff: not enough fields in report\n");
81 return -ENODEV;
84 zpff = kzalloc(sizeof(struct zpff_device), GFP_KERNEL);
85 if (!zpff)
86 return -ENOMEM;
88 set_bit(FF_RUMBLE, dev->ffbit);
90 error = input_ff_create_memless(dev, zpff, hid_zpff_play);
91 if (error) {
92 kfree(zpff);
93 return error;
96 zpff->report = report;
97 zpff->report->field[0]->value[0] = 0x00;
98 zpff->report->field[1]->value[0] = 0x02;
99 zpff->report->field[2]->value[0] = 0x00;
100 zpff->report->field[3]->value[0] = 0x00;
101 usbhid_submit_report(hid, zpff->report, USB_DIR_OUT);
103 printk(KERN_INFO "Force feedback for Zeroplus based devices by "
104 "Anssi Hannula <anssi.hannula@gmail.com>\n");
106 return 0;