Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2  *  Force feedback support for GreenAsia (Product ID 0x12) based devices
  3  *
  4  *  The devices are distributed under various names and the same USB device ID
  5  *  can be used in many game controllers.
  6  *
  7  *
  8  *  0e8f:0012 "GreenAsia Inc.    USB Joystick     "
  9  *   - tested with MANTA Warior MM816 and SpeedLink Strike2 SL-6635.
 10  *
 11  *  Copyright (c) 2008 Lukasz Lubojanski <lukasz@lubojanski.info>
 12  */
 13 
 14 /*
 15  * This program is free software; you can redistribute it and/or modify
 16  * it under the terms of the GNU General Public License as published by
 17  * the Free Software Foundation; either version 2 of the License, or
 18  * (at your option) any later version.
 19  *
 20  * This program is distributed in the hope that it will be useful,
 21  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 22  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 23  * GNU General Public License for more details.
 24  *
 25  * You should have received a copy of the GNU General Public License
 26  * along with this program; if not, write to the Free Software
 27  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 28  */
 29 
 30 #include <linux/input.h>
 31 #include <linux/usb.h>
 32 #include <linux/hid.h>
 33 #include "hid-ids.h"
 34 
 35 #ifdef CONFIG_GREENASIA_FF
 36 #include "usbhid/usbhid.h"
 37 
 38 struct gaff_device {
 39         struct hid_report *report;
 40 };
 41 
 42 static int hid_gaff_play(struct input_dev *dev, void *data,
 43                          struct ff_effect *effect)
 44 {
 45         struct hid_device *hid = input_get_drvdata(dev);
 46         struct gaff_device *gaff = data;
 47         int left, right;
 48 
 49         left = effect->u.rumble.strong_magnitude;
 50         right = effect->u.rumble.weak_magnitude;
 51 
 52         dbg_hid("called with 0x%04x 0x%04x", left, right);
 53 
 54         left = left * 0xfe / 0xffff;
 55         right = right * 0xfe / 0xffff;
 56 
 57         gaff->report->field[0]->value[0] = 0x51;
 58         gaff->report->field[0]->value[1] = 0x0;
 59         gaff->report->field[0]->value[2] = right;
 60         gaff->report->field[0]->value[3] = 0;
 61         gaff->report->field[0]->value[4] = left;
 62         gaff->report->field[0]->value[5] = 0;
 63         dbg_hid("running with 0x%02x 0x%02x", left, right);
 64         usbhid_submit_report(hid, gaff->report, USB_DIR_OUT);
 65 
 66         gaff->report->field[0]->value[0] = 0xfa;
 67         gaff->report->field[0]->value[1] = 0xfe;
 68         gaff->report->field[0]->value[2] = 0x0;
 69         gaff->report->field[0]->value[4] = 0x0;
 70 
 71         usbhid_submit_report(hid, gaff->report, USB_DIR_OUT);
 72 
 73         return 0;
 74 }
 75 
 76 static int gaff_init(struct hid_device *hid)
 77 {
 78         struct gaff_device *gaff;
 79         struct hid_report *report;
 80         struct hid_input *hidinput = list_entry(hid->inputs.next,
 81                                                 struct hid_input, list);
 82         struct list_head *report_list =
 83                         &hid->report_enum[HID_OUTPUT_REPORT].report_list;
 84         struct list_head *report_ptr = report_list;
 85         struct input_dev *dev = hidinput->input;
 86         int error;
 87 
 88         if (list_empty(report_list)) {
 89                 dev_err(&hid->dev, "no output reports found\n");
 90                 return -ENODEV;
 91         }
 92 
 93         report_ptr = report_ptr->next;
 94 
 95         report = list_entry(report_ptr, struct hid_report, list);
 96         if (report->maxfield < 1) {
 97                 dev_err(&hid->dev, "no fields in the report\n");
 98                 return -ENODEV;
 99         }
100 
101         if (report->field[0]->report_count < 6) {
102                 dev_err(&hid->dev, "not enough values in the field\n");
103                 return -ENODEV;
104         }
105 
106         gaff = kzalloc(sizeof(struct gaff_device), GFP_KERNEL);
107         if (!gaff)
108                 return -ENOMEM;
109 
110         set_bit(FF_RUMBLE, dev->ffbit);
111 
112         error = input_ff_create_memless(dev, gaff, hid_gaff_play);
113         if (error) {
114                 kfree(gaff);
115                 return error;
116         }
117 
118         gaff->report = report;
119         gaff->report->field[0]->value[0] = 0x51;
120         gaff->report->field[0]->value[1] = 0x00;
121         gaff->report->field[0]->value[2] = 0x00;
122         gaff->report->field[0]->value[3] = 0x00;
123         usbhid_submit_report(hid, gaff->report, USB_DIR_OUT);
124 
125         gaff->report->field[0]->value[0] = 0xfa;
126         gaff->report->field[0]->value[1] = 0xfe;
127 
128         usbhid_submit_report(hid, gaff->report, USB_DIR_OUT);
129 
130         dev_info(&hid->dev, "Force Feedback for GreenAsia 0x12"
131                " devices by Lukasz Lubojanski <lukasz@lubojanski.info>\n");
132 
133         return 0;
134 }
135 #else
136 static inline int gaff_init(struct hid_device *hdev)
137 {
138         return 0;
139 }
140 #endif
141 
142 static int ga_probe(struct hid_device *hdev, const struct hid_device_id *id)
143 {
144         int ret;
145 
146         dev_dbg(&hdev->dev, "Greenasia HID hardware probe...");
147 
148         ret = hid_parse(hdev);
149         if (ret) {
150                 dev_err(&hdev->dev, "parse failed\n");
151                 goto err;
152         }
153 
154         ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT & ~HID_CONNECT_FF);
155         if (ret) {
156                 dev_err(&hdev->dev, "hw start failed\n");
157                 goto err;
158         }
159 
160         gaff_init(hdev);
161 
162         return 0;
163 err:
164         return ret;
165 }
166 
167 static const struct hid_device_id ga_devices[] = {
168         { HID_USB_DEVICE(USB_VENDOR_ID_GREENASIA, 0x0012),  },
169         { }
170 };
171 MODULE_DEVICE_TABLE(hid, ga_devices);
172 
173 static struct hid_driver ga_driver = {
174         .name = "greenasia",
175         .id_table = ga_devices,
176         .probe = ga_probe,
177 };
178 
179 static int __init ga_init(void)
180 {
181         return hid_register_driver(&ga_driver);
182 }
183 
184 static void __exit ga_exit(void)
185 {
186         hid_unregister_driver(&ga_driver);
187 }
188 
189 module_init(ga_init);
190 module_exit(ga_exit);
191 MODULE_LICENSE("GPL");
192 
  This page was automatically generated by the LXR engine.