54be6a624a0fec8bdc00d25d02b881b1d4d3be95
[openocd.git] / src / jtag / drivers / usb_common.c
1 /***************************************************************************
2 * Copyright (C) 2009 by Zachary T Welch <zw@superlucidity.net> *
3 * *
4 * This program is free software; you can redistribute it and/or modify *
5 * it under the terms of the GNU General Public License as published by *
6 * the Free Software Foundation; either version 2 of the License, or *
7 * (at your option) any later version. *
8 * *
9 * This program is distributed in the hope that it will be useful, *
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
12 * GNU General Public License for more details. *
13 * *
14 * You should have received a copy of the GNU General Public License *
15 * along with this program. If not, see <http://www.gnu.org/licenses/>. *
16 ***************************************************************************/
17
18 #ifdef HAVE_CONFIG_H
19 #include "config.h"
20 #endif
21 #include "usb_common.h"
22
23
24 static bool jtag_usb_match(struct usb_device *dev,
25 const uint16_t vids[], const uint16_t pids[])
26 {
27 for (unsigned i = 0; vids[i] && pids[i]; i++) {
28 if (dev->descriptor.idVendor == vids[i] &&
29 dev->descriptor.idProduct == pids[i])
30 return true;
31 }
32 return false;
33 }
34
35 int jtag_usb_open(const uint16_t vids[], const uint16_t pids[],
36 struct usb_dev_handle **out)
37 {
38 usb_find_busses();
39 usb_find_devices();
40
41 struct usb_bus *busses = usb_get_busses();
42 for (struct usb_bus *bus = busses; bus; bus = bus->next) {
43 for (struct usb_device *dev = bus->devices; dev; dev = dev->next) {
44 if (!jtag_usb_match(dev, vids, pids))
45 continue;
46
47 *out = usb_open(dev);
48 if (NULL == *out)
49 return -errno;
50 return 0;
51 }
52 }
53 return -ENODEV;
54 }