Blame view

drivers/hid/hid-lg2ff.c 3.1 KB
c17f9c901   Anssi Hannula   HID: force feedba...
1
  /*
2c6118e43   Hendrik Iben   HID: force feedba...
2
   *  Force feedback support for Logitech RumblePad and Rumblepad 2
c17f9c901   Anssi Hannula   HID: force feedba...
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
   *
   *  Copyright (c) 2008 Anssi Hannula <anssi.hannula@gmail.com>
   */
  
  /*
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License, or
   * (at your option) any later version.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program; if not, write to the Free Software
   * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
   */
  
  
  #include <linux/input.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
25
  #include <linux/slab.h>
c17f9c901   Anssi Hannula   HID: force feedba...
26
27
  #include <linux/usb.h>
  #include <linux/hid.h>
606bd0a86   Jiri Slaby   HID: move logitec...
28
29
30
  
  #include "usbhid/usbhid.h"
  #include "hid-lg.h"
c17f9c901   Anssi Hannula   HID: force feedba...
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
  
  struct lg2ff_device {
  	struct hid_report *report;
  };
  
  static int play_effect(struct input_dev *dev, void *data,
  			 struct ff_effect *effect)
  {
  	struct hid_device *hid = input_get_drvdata(dev);
  	struct lg2ff_device *lg2ff = data;
  	int weak, strong;
  
  	strong = effect->u.rumble.strong_magnitude;
  	weak = effect->u.rumble.weak_magnitude;
  
  	if (weak || strong) {
  		weak = weak * 0xff / 0xffff;
  		strong = strong * 0xff / 0xffff;
  
  		lg2ff->report->field[0]->value[0] = 0x51;
  		lg2ff->report->field[0]->value[2] = weak;
  		lg2ff->report->field[0]->value[4] = strong;
  	} else {
  		lg2ff->report->field[0]->value[0] = 0xf3;
  		lg2ff->report->field[0]->value[2] = 0x00;
  		lg2ff->report->field[0]->value[4] = 0x00;
  	}
  
  	usbhid_submit_report(hid, lg2ff->report, USB_DIR_OUT);
  	return 0;
  }
606bd0a86   Jiri Slaby   HID: move logitec...
62
  int lg2ff_init(struct hid_device *hid)
c17f9c901   Anssi Hannula   HID: force feedba...
63
64
65
66
67
68
69
70
71
72
73
  {
  	struct lg2ff_device *lg2ff;
  	struct hid_report *report;
  	struct hid_input *hidinput = list_entry(hid->inputs.next,
  						struct hid_input, list);
  	struct list_head *report_list =
  			&hid->report_enum[HID_OUTPUT_REPORT].report_list;
  	struct input_dev *dev = hidinput->input;
  	int error;
  
  	if (list_empty(report_list)) {
4291ee305   Joe Perches   HID: Add and use ...
74
75
  		hid_err(hid, "no output report found
  ");
c17f9c901   Anssi Hannula   HID: force feedba...
76
77
78
79
80
81
  		return -ENODEV;
  	}
  
  	report = list_entry(report_list->next, struct hid_report, list);
  
  	if (report->maxfield < 1) {
4291ee305   Joe Perches   HID: Add and use ...
82
83
  		hid_err(hid, "output report is empty
  ");
c17f9c901   Anssi Hannula   HID: force feedba...
84
85
86
  		return -ENODEV;
  	}
  	if (report->field[0]->report_count < 7) {
4291ee305   Joe Perches   HID: Add and use ...
87
88
  		hid_err(hid, "not enough values in the field
  ");
c17f9c901   Anssi Hannula   HID: force feedba...
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
  		return -ENODEV;
  	}
  
  	lg2ff = kmalloc(sizeof(struct lg2ff_device), GFP_KERNEL);
  	if (!lg2ff)
  		return -ENOMEM;
  
  	set_bit(FF_RUMBLE, dev->ffbit);
  
  	error = input_ff_create_memless(dev, lg2ff, play_effect);
  	if (error) {
  		kfree(lg2ff);
  		return error;
  	}
  
  	lg2ff->report = report;
  	report->field[0]->value[0] = 0xf3;
  	report->field[0]->value[1] = 0x00;
  	report->field[0]->value[2] = 0x00;
  	report->field[0]->value[3] = 0x00;
  	report->field[0]->value[4] = 0x00;
  	report->field[0]->value[5] = 0x00;
  	report->field[0]->value[6] = 0x00;
  
  	usbhid_submit_report(hid, report, USB_DIR_OUT);
4291ee305   Joe Perches   HID: Add and use ...
114
115
  	hid_info(hid, "Force feedback for Logitech RumblePad/Rumblepad 2 by Anssi Hannula <anssi.hannula@gmail.com>
  ");
c17f9c901   Anssi Hannula   HID: force feedba...
116
117
118
  
  	return 0;
  }