2 * hid2hci : switch the radio on devices that support
3 * it from HID to HCI and back
5 * Copyright (C) 2003-2009 Marcel Holtmann <marcel@holtmann.org>
6 * Copyright (C) 2008-2009 Mario Limonciello <mario_limonciello@dell.com>
7 * Copyright (C) 2009 Kay Sievers <kay.sievers@vrfy.org>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
30 #include <sys/ioctl.h>
31 #include <linux/hiddev.h>
35 #include "libudev-private.h"
42 static int usb_switch_csr(struct usb_dev_handle *dev, enum mode mode)
46 err = usb_control_msg(dev,
47 USB_ENDPOINT_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
48 0, mode, 0, NULL, 0, 10000);
53 if (errno == ETIMEDOUT)
59 static int hid_logitech_send_report(int fd, const char *buf, size_t size)
61 struct hiddev_report_info rinfo;
62 struct hiddev_usage_ref uref;
66 for (i = 0; i < size; i++) {
67 memset(&uref, 0, sizeof(uref));
68 uref.report_type = HID_REPORT_TYPE_OUTPUT;
69 uref.report_id = 0x10;
72 uref.usage_code = 0xff000001;
73 uref.value = buf[i] & 0x000000ff;
74 err = ioctl(fd, HIDIOCSUSAGE, &uref);
79 memset(&rinfo, 0, sizeof(rinfo));
80 rinfo.report_type = HID_REPORT_TYPE_OUTPUT;
81 rinfo.report_id = 0x10;
83 err = ioctl(fd, HIDIOCSREPORT, &rinfo);
88 static int hid_switch_logitech(const char *filename)
90 char rep1[] = { 0xff, 0x80, 0x80, 0x01, 0x00, 0x00 };
91 char rep2[] = { 0xff, 0x80, 0x00, 0x00, 0x30, 0x00 };
92 char rep3[] = { 0xff, 0x81, 0x80, 0x00, 0x00, 0x00 };
96 fd = open(filename, O_RDWR);
100 err = ioctl(fd, HIDIOCINITREPORT, 0);
104 err = hid_logitech_send_report(fd, rep1, sizeof(rep1));
108 err = hid_logitech_send_report(fd, rep2, sizeof(rep2));
112 err = hid_logitech_send_report(fd, rep3, sizeof(rep3));
118 static int usb_switch_dell(struct usb_dev_handle *dev, enum mode mode)
120 char report[] = { 0x7f, 0x00, 0x00, 0x00 };
132 /* Don't need to check return, as might not be in use */
133 usb_detach_kernel_driver_np(dev, 0);
135 if (usb_claim_interface(dev, 0) < 0)
138 err = usb_control_msg(dev,
139 USB_ENDPOINT_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
140 USB_REQ_SET_CONFIGURATION, 0x7f | (0x03 << 8), 0,
141 report, sizeof(report), 5000);
147 if (errno == ETIMEDOUT)
154 * The braindead libusb needs to scan and open all devices, just to
155 * to find the device we already have. This needs to be fixed in libusb
156 * or it will be ripped out and we carry our own code.
158 static struct usb_device *usb_device_open_from_udev(struct udev_device *usb_dev)
165 str = udev_device_get_sysattr_value(usb_dev, "busnum");
168 busnum = strtol(str, NULL, 0);
170 str = udev_device_get_sysattr_value(usb_dev, "devnum");
173 devnum = strtol(str, NULL, 0);
179 for (bus = usb_get_busses(); bus; bus = bus->next) {
180 struct usb_device *dev;
182 if (strtol(bus->dirname, NULL, 10) != busnum)
185 for (dev = bus->devices; dev; dev = dev->next) {
186 if (dev->devnum == devnum)
194 static struct usb_dev_handle *find_device(struct udev_device *udev_dev, const char *sibling_intf)
196 struct udev *udev = udev_device_get_udev(udev_dev);
197 struct usb_device *dev;
198 struct udev_device *udev_parent;
199 char str[UTIL_NAME_SIZE];
200 struct udev_enumerate *enumerate;
201 struct udev_list_entry *entry;
202 struct usb_dev_handle *handle = NULL;
204 if (sibling_intf == NULL) {
205 dev = usb_device_open_from_udev(udev_dev);
208 return usb_open(dev);
211 /* find matching sibling of the current usb_device, they share the same hub */
212 udev_parent = udev_device_get_parent_with_subsystem_devtype(udev_dev, "usb", "usb_device");
213 if (udev_parent == NULL)
216 enumerate = udev_enumerate_new(udev);
217 if (enumerate == NULL)
220 udev_enumerate_add_match_subsystem(enumerate, "usb");
222 /* match all childs of the parent */
223 util_strscpyl(str, sizeof(str), udev_device_get_sysname(udev_parent), "*", NULL);
224 udev_enumerate_add_match_sysname(enumerate, str);
226 /* match the specified interface */
227 util_strscpy(str, sizeof(str), sibling_intf);
231 if (strcmp(str, "-1") != 0)
232 udev_enumerate_add_match_sysattr(enumerate, "bInterfaceClass", str);
233 if (strcmp(&str[3], "-1") != 0)
234 udev_enumerate_add_match_sysattr(enumerate, "bInterfaceSubClass", &str[3]);
235 if (strcmp(&str[6], "-1") != 0)
236 udev_enumerate_add_match_sysattr(enumerate, "bInterfaceProtocol", &str[6]);
238 udev_enumerate_scan_devices(enumerate);
239 udev_list_entry_foreach(entry, udev_enumerate_get_list_entry(enumerate)) {
240 struct udev_device *udev_device;
242 udev_device = udev_device_new_from_syspath(udev, udev_list_entry_get_name(entry));
243 if (udev_device != NULL) {
244 /* get the usb_device of the usb_interface we matched */
245 udev_parent = udev_device_get_parent_with_subsystem_devtype(udev_device, "usb", "usb_device");
246 if (udev_parent == NULL)
248 /* only look at the first matching device */
249 dev = usb_device_open_from_udev(udev_parent);
251 handle = usb_open(dev);
252 udev_device_unref(udev_device);
256 udev_enumerate_unref(enumerate);
260 static void usage(const char *error)
263 fprintf(stderr,"\n%s\n", error);
265 printf("hid2hci - Bluetooth HID to HCI mode switching utility\n\n");
267 printf("Usage: hid2hci [options]\n"
268 " --mode= mode to switch to [hid|hci] (default hci)\n"
269 " --devpath= sys device path\n"
270 " --method= method to use to switch [csr|logitech-hid|dell]\n"
271 " --find-sibling-intf= find the sibling device with 00:00:00 (class:subclass:prot)\n"
275 int main(int argc, char *argv[])
277 static const struct option options[] = {
278 { "help", no_argument, NULL, 'h' },
279 { "mode", required_argument, NULL, 'm' },
280 { "devpath", required_argument, NULL, 'p' },
281 { "method", required_argument, NULL, 'M' },
282 { "find-sibling-intf", required_argument, NULL, 'I' },
290 } method = METHOD_UNDEF;
292 struct udev_device *udev_dev = NULL;
293 char syspath[UTIL_PATH_SIZE];
294 int (*usb_switch)(struct usb_dev_handle *dev, enum mode mode) = NULL;
295 enum mode mode = HCI;
296 const char *devpath = NULL;
297 const char *sibling_intf = NULL;
304 option = getopt_long(argc, argv, "m:p:M:I:qh", options, NULL);
310 if (!strcmp(optarg, "hid")) {
312 } else if (!strcmp(optarg, "hci")) {
315 usage("error: undefined radio mode\n");
323 if (!strcmp(optarg, "csr")) {
325 usb_switch = usb_switch_csr;
326 } else if (!strcmp(optarg, "logitech-hid")) {
327 method = METHOD_LOGITECH_HID;
328 } else if (!strcmp(optarg, "dell")) {
329 method = METHOD_DELL;
330 usb_switch = usb_switch_dell;
332 usage("error: undefined switching method\n");
337 sibling_intf = optarg;
346 if (!devpath || method == METHOD_UNDEF) {
347 usage("error: --devpath= and --method= must be defined\n");
355 util_strscpyl(syspath, sizeof(syspath), udev_get_sys_path(udev), devpath, NULL);
356 udev_dev = udev_device_new_from_syspath(udev, syspath);
357 if (udev_dev == NULL) {
358 fprintf(stderr, "error: could not find '%s'\n", devpath);
365 struct udev_device *dev;
366 struct usb_dev_handle *handle;
369 /* get the parent usb_device if needed */
371 type = udev_device_get_devtype(dev);
372 if (type == NULL || strcmp(type, "usb_device") != 0) {
373 dev = udev_device_get_parent_with_subsystem_devtype(dev, "usb", "usb_device");
375 fprintf(stderr, "error: could not find usb_device for '%s'\n", devpath);
380 handle = find_device(dev, sibling_intf);
381 if (handle == NULL) {
382 fprintf(stderr, "error: unable to handle '%s' (intf=%s)\n",
383 udev_device_get_syspath(dev), sibling_intf);
386 err = usb_switch(handle, mode);
389 case METHOD_LOGITECH_HID: {
392 device = udev_device_get_devnode(udev_dev);
393 if (device == NULL) {
394 fprintf(stderr, "error: could not find hiddev device node\n");
397 err = hid_switch_logitech(device);
405 fprintf(stderr, "error: switching device '%s' (intf=%s) failed.\n",
406 udev_device_get_syspath(udev_dev), sibling_intf);
408 udev_device_unref(udev_dev);