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) { |
4291ee30 | 43 | hid_info(hdev, "Fixing up Sony Vaio VGX report descriptor\n"); |
cc6e0bbb JK |
44 | rdesc[55] = 0x06; |
45 | } | |
73e4008d | 46 | return rdesc; |
cc6e0bbb JK |
47 | } |
48 | ||
569b10a5 AO |
49 | static int sixaxis_usb_output_raw_report(struct hid_device *hid, __u8 *buf, |
50 | size_t count, unsigned char report_type) | |
51 | { | |
52 | struct usb_interface *intf = to_usb_interface(hid->dev.parent); | |
53 | struct usb_device *dev = interface_to_usbdev(intf); | |
54 | struct usb_host_interface *interface = intf->cur_altsetting; | |
55 | int report_id = buf[0]; | |
56 | int ret; | |
57 | ||
58 | ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), | |
59 | HID_REQ_SET_REPORT, | |
60 | USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE, | |
61 | ((report_type + 1) << 8) | report_id, | |
62 | interface->desc.bInterfaceNumber, buf, count, | |
63 | USB_CTRL_SET_TIMEOUT); | |
64 | ||
65 | return ret; | |
66 | } | |
67 | ||
bd28ce00 JS |
68 | /* |
69 | * Sending HID_REQ_GET_REPORT changes the operation mode of the ps3 controller | |
70 | * to "operational". Without this, the ps3 controller will not report any | |
71 | * events. | |
72 | */ | |
816651a7 | 73 | static int sixaxis_set_operational_usb(struct hid_device *hdev) |
bd28ce00 JS |
74 | { |
75 | struct usb_interface *intf = to_usb_interface(hdev->dev.parent); | |
76 | struct usb_device *dev = interface_to_usbdev(intf); | |
77 | __u16 ifnum = intf->cur_altsetting->desc.bInterfaceNumber; | |
78 | int ret; | |
79 | char *buf = kmalloc(18, GFP_KERNEL); | |
80 | ||
81 | if (!buf) | |
82 | return -ENOMEM; | |
83 | ||
84 | ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), | |
85 | HID_REQ_GET_REPORT, | |
86 | USB_DIR_IN | USB_TYPE_CLASS | | |
87 | USB_RECIP_INTERFACE, | |
88 | (3 << 8) | 0xf2, ifnum, buf, 17, | |
89 | USB_CTRL_GET_TIMEOUT); | |
90 | if (ret < 0) | |
4291ee30 | 91 | hid_err(hdev, "can't set operational mode\n"); |
bd28ce00 JS |
92 | |
93 | kfree(buf); | |
94 | ||
95 | return ret; | |
96 | } | |
97 | ||
816651a7 | 98 | static int sixaxis_set_operational_bt(struct hid_device *hdev) |
f9ce7c28 | 99 | { |
fddb33f2 | 100 | unsigned char buf[] = { 0xf4, 0x42, 0x03, 0x00, 0x00 }; |
f9ce7c28 BN |
101 | return hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT); |
102 | } | |
103 | ||
bd28ce00 JS |
104 | static int sony_probe(struct hid_device *hdev, const struct hid_device_id *id) |
105 | { | |
106 | int ret; | |
cc6e0bbb JK |
107 | unsigned long quirks = id->driver_data; |
108 | struct sony_sc *sc; | |
109 | ||
110 | sc = kzalloc(sizeof(*sc), GFP_KERNEL); | |
111 | if (sc == NULL) { | |
4291ee30 | 112 | hid_err(hdev, "can't alloc sony descriptor\n"); |
cc6e0bbb JK |
113 | return -ENOMEM; |
114 | } | |
115 | ||
116 | sc->quirks = quirks; | |
117 | hid_set_drvdata(hdev, sc); | |
bd28ce00 | 118 | |
bd28ce00 JS |
119 | ret = hid_parse(hdev); |
120 | if (ret) { | |
4291ee30 | 121 | hid_err(hdev, "parse failed\n"); |
bd28ce00 JS |
122 | goto err_free; |
123 | } | |
124 | ||
93c10132 JS |
125 | ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT | |
126 | HID_CONNECT_HIDDEV_FORCE); | |
bd28ce00 | 127 | if (ret) { |
4291ee30 | 128 | hid_err(hdev, "hw start failed\n"); |
bd28ce00 JS |
129 | goto err_free; |
130 | } | |
131 | ||
569b10a5 AO |
132 | if (sc->quirks & SIXAXIS_CONTROLLER_USB) { |
133 | hdev->hid_output_raw_report = sixaxis_usb_output_raw_report; | |
816651a7 | 134 | ret = sixaxis_set_operational_usb(hdev); |
569b10a5 | 135 | } |
816651a7 AO |
136 | else if (sc->quirks & SIXAXIS_CONTROLLER_BT) |
137 | ret = sixaxis_set_operational_bt(hdev); | |
138 | else | |
f9ce7c28 | 139 | ret = 0; |
f9ce7c28 | 140 | |
4dfdc464 | 141 | if (ret < 0) |
bd28ce00 JS |
142 | goto err_stop; |
143 | ||
144 | return 0; | |
145 | err_stop: | |
146 | hid_hw_stop(hdev); | |
147 | err_free: | |
cc6e0bbb | 148 | kfree(sc); |
bd28ce00 JS |
149 | return ret; |
150 | } | |
151 | ||
cc6e0bbb JK |
152 | static void sony_remove(struct hid_device *hdev) |
153 | { | |
154 | hid_hw_stop(hdev); | |
155 | kfree(hid_get_drvdata(hdev)); | |
156 | } | |
157 | ||
bd28ce00 | 158 | static const struct hid_device_id sony_devices[] = { |
816651a7 AO |
159 | { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER), |
160 | .driver_data = SIXAXIS_CONTROLLER_USB }, | |
161 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER), | |
162 | .driver_data = SIXAXIS_CONTROLLER_BT }, | |
cc6e0bbb JK |
163 | { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_VAIO_VGX_MOUSE), |
164 | .driver_data = VAIO_RDESC_CONSTANT }, | |
bd28ce00 JS |
165 | { } |
166 | }; | |
167 | MODULE_DEVICE_TABLE(hid, sony_devices); | |
168 | ||
169 | static struct hid_driver sony_driver = { | |
170 | .name = "sony", | |
171 | .id_table = sony_devices, | |
172 | .probe = sony_probe, | |
cc6e0bbb JK |
173 | .remove = sony_remove, |
174 | .report_fixup = sony_report_fixup, | |
bd28ce00 JS |
175 | }; |
176 | ||
a24f423b | 177 | static int __init sony_init(void) |
bd28ce00 JS |
178 | { |
179 | return hid_register_driver(&sony_driver); | |
180 | } | |
181 | ||
a24f423b | 182 | static void __exit sony_exit(void) |
bd28ce00 JS |
183 | { |
184 | hid_unregister_driver(&sony_driver); | |
185 | } | |
186 | ||
187 | module_init(sony_init); | |
188 | module_exit(sony_exit); | |
189 | MODULE_LICENSE("GPL"); |