]>
Commit | Line | Data |
---|---|---|
bd28ce00 JS |
1 | /* |
2 | * HID driver for some sony "special" devices | |
3 | * | |
4 | * Copyright (c) 1999 Andreas Gal | |
5 | * Copyright (c) 2000-2005 Vojtech Pavlik <vojtech@suse.cz> | |
6 | * Copyright (c) 2005 Michael Haboustak <mike-@cinci.rr.com> for Concept2, Inc | |
bd28ce00 JS |
7 | * Copyright (c) 2007 Paul Walmsley |
8 | * Copyright (c) 2008 Jiri Slaby | |
cc6e0bbb | 9 | * Copyright (c) 2006-2008 Jiri Kosina |
bd28ce00 JS |
10 | */ |
11 | ||
12 | /* | |
13 | * This program is free software; you can redistribute it and/or modify it | |
14 | * under the terms of the GNU General Public License as published by the Free | |
15 | * Software Foundation; either version 2 of the License, or (at your option) | |
16 | * any later version. | |
17 | */ | |
18 | ||
19 | #include <linux/device.h> | |
20 | #include <linux/hid.h> | |
21 | #include <linux/module.h> | |
5a0e3ad6 | 22 | #include <linux/slab.h> |
bd28ce00 JS |
23 | #include <linux/usb.h> |
24 | ||
25 | #include "hid-ids.h" | |
26 | ||
816651a7 AO |
27 | #define VAIO_RDESC_CONSTANT (1 << 0) |
28 | #define SIXAXIS_CONTROLLER_USB (1 << 1) | |
29 | #define SIXAXIS_CONTROLLER_BT (1 << 2) | |
cc6e0bbb JK |
30 | |
31 | struct sony_sc { | |
32 | unsigned long quirks; | |
33 | }; | |
34 | ||
35 | /* Sony Vaio VGX has wrongly mouse pointer declared as constant */ | |
73e4008d NK |
36 | static __u8 *sony_report_fixup(struct hid_device *hdev, __u8 *rdesc, |
37 | unsigned int *rsize) | |
cc6e0bbb JK |
38 | { |
39 | struct sony_sc *sc = hid_get_drvdata(hdev); | |
40 | ||
41 | if ((sc->quirks & VAIO_RDESC_CONSTANT) && | |
73e4008d | 42 | *rsize >= 56 && rdesc[54] == 0x81 && rdesc[55] == 0x07) { |
cc6e0bbb JK |
43 | dev_info(&hdev->dev, "Fixing up Sony Vaio VGX report " |
44 | "descriptor\n"); | |
45 | rdesc[55] = 0x06; | |
46 | } | |
73e4008d | 47 | return rdesc; |
cc6e0bbb JK |
48 | } |
49 | ||
569b10a5 AO |
50 | static int sixaxis_usb_output_raw_report(struct hid_device *hid, __u8 *buf, |
51 | size_t count, unsigned char report_type) | |
52 | { | |
53 | struct usb_interface *intf = to_usb_interface(hid->dev.parent); | |
54 | struct usb_device *dev = interface_to_usbdev(intf); | |
55 | struct usb_host_interface *interface = intf->cur_altsetting; | |
56 | int report_id = buf[0]; | |
57 | int ret; | |
58 | ||
59 | ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), | |
60 | HID_REQ_SET_REPORT, | |
61 | USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE, | |
62 | ((report_type + 1) << 8) | report_id, | |
63 | interface->desc.bInterfaceNumber, buf, count, | |
64 | USB_CTRL_SET_TIMEOUT); | |
65 | ||
66 | return ret; | |
67 | } | |
68 | ||
bd28ce00 JS |
69 | /* |
70 | * Sending HID_REQ_GET_REPORT changes the operation mode of the ps3 controller | |
71 | * to "operational". Without this, the ps3 controller will not report any | |
72 | * events. | |
73 | */ | |
816651a7 | 74 | static int sixaxis_set_operational_usb(struct hid_device *hdev) |
bd28ce00 JS |
75 | { |
76 | struct usb_interface *intf = to_usb_interface(hdev->dev.parent); | |
77 | struct usb_device *dev = interface_to_usbdev(intf); | |
78 | __u16 ifnum = intf->cur_altsetting->desc.bInterfaceNumber; | |
79 | int ret; | |
80 | char *buf = kmalloc(18, GFP_KERNEL); | |
81 | ||
82 | if (!buf) | |
83 | return -ENOMEM; | |
84 | ||
85 | ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), | |
86 | HID_REQ_GET_REPORT, | |
87 | USB_DIR_IN | USB_TYPE_CLASS | | |
88 | USB_RECIP_INTERFACE, | |
89 | (3 << 8) | 0xf2, ifnum, buf, 17, | |
90 | USB_CTRL_GET_TIMEOUT); | |
91 | if (ret < 0) | |
92 | dev_err(&hdev->dev, "can't set operational mode\n"); | |
93 | ||
94 | kfree(buf); | |
95 | ||
96 | return ret; | |
97 | } | |
98 | ||
816651a7 | 99 | static int sixaxis_set_operational_bt(struct hid_device *hdev) |
f9ce7c28 | 100 | { |
fddb33f2 | 101 | unsigned char buf[] = { 0xf4, 0x42, 0x03, 0x00, 0x00 }; |
f9ce7c28 BN |
102 | return hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT); |
103 | } | |
104 | ||
bd28ce00 JS |
105 | static int sony_probe(struct hid_device *hdev, const struct hid_device_id *id) |
106 | { | |
107 | int ret; | |
cc6e0bbb JK |
108 | unsigned long quirks = id->driver_data; |
109 | struct sony_sc *sc; | |
110 | ||
111 | sc = kzalloc(sizeof(*sc), GFP_KERNEL); | |
112 | if (sc == NULL) { | |
eabe5c90 | 113 | dev_err(&hdev->dev, "can't alloc sony descriptor\n"); |
cc6e0bbb JK |
114 | return -ENOMEM; |
115 | } | |
116 | ||
117 | sc->quirks = quirks; | |
118 | hid_set_drvdata(hdev, sc); | |
bd28ce00 | 119 | |
bd28ce00 JS |
120 | ret = hid_parse(hdev); |
121 | if (ret) { | |
122 | dev_err(&hdev->dev, "parse failed\n"); | |
123 | goto err_free; | |
124 | } | |
125 | ||
93c10132 JS |
126 | ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT | |
127 | HID_CONNECT_HIDDEV_FORCE); | |
bd28ce00 JS |
128 | if (ret) { |
129 | dev_err(&hdev->dev, "hw start failed\n"); | |
130 | goto err_free; | |
131 | } | |
132 | ||
569b10a5 AO |
133 | if (sc->quirks & SIXAXIS_CONTROLLER_USB) { |
134 | hdev->hid_output_raw_report = sixaxis_usb_output_raw_report; | |
816651a7 | 135 | ret = sixaxis_set_operational_usb(hdev); |
569b10a5 | 136 | } |
816651a7 AO |
137 | else if (sc->quirks & SIXAXIS_CONTROLLER_BT) |
138 | ret = sixaxis_set_operational_bt(hdev); | |
139 | else | |
f9ce7c28 | 140 | ret = 0; |
f9ce7c28 | 141 | |
4dfdc464 | 142 | if (ret < 0) |
bd28ce00 JS |
143 | goto err_stop; |
144 | ||
145 | return 0; | |
146 | err_stop: | |
147 | hid_hw_stop(hdev); | |
148 | err_free: | |
cc6e0bbb | 149 | kfree(sc); |
bd28ce00 JS |
150 | return ret; |
151 | } | |
152 | ||
cc6e0bbb JK |
153 | static void sony_remove(struct hid_device *hdev) |
154 | { | |
155 | hid_hw_stop(hdev); | |
156 | kfree(hid_get_drvdata(hdev)); | |
157 | } | |
158 | ||
bd28ce00 | 159 | static const struct hid_device_id sony_devices[] = { |
816651a7 AO |
160 | { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER), |
161 | .driver_data = SIXAXIS_CONTROLLER_USB }, | |
162 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER), | |
163 | .driver_data = SIXAXIS_CONTROLLER_BT }, | |
cc6e0bbb JK |
164 | { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_VAIO_VGX_MOUSE), |
165 | .driver_data = VAIO_RDESC_CONSTANT }, | |
bd28ce00 JS |
166 | { } |
167 | }; | |
168 | MODULE_DEVICE_TABLE(hid, sony_devices); | |
169 | ||
170 | static struct hid_driver sony_driver = { | |
171 | .name = "sony", | |
172 | .id_table = sony_devices, | |
173 | .probe = sony_probe, | |
cc6e0bbb JK |
174 | .remove = sony_remove, |
175 | .report_fixup = sony_report_fixup, | |
bd28ce00 JS |
176 | }; |
177 | ||
a24f423b | 178 | static int __init sony_init(void) |
bd28ce00 JS |
179 | { |
180 | return hid_register_driver(&sony_driver); | |
181 | } | |
182 | ||
a24f423b | 183 | static void __exit sony_exit(void) |
bd28ce00 JS |
184 | { |
185 | hid_unregister_driver(&sony_driver); | |
186 | } | |
187 | ||
188 | module_init(sony_init); | |
189 | module_exit(sony_exit); | |
190 | MODULE_LICENSE("GPL"); |