74b8144d2a2d022e76b8939109b4eb1b872519b3
[openocd.git] / src / jtag / drivers / libusb1_common.c
1 /***************************************************************************
2 * Copyright (C) 2009 by Zachary T Welch <zw@superlucidity.net> *
3 * *
4 * Copyright (C) 2011 by Mauro Gamba <maurillo71@gmail.com> *
5 * *
6 * This program is free software; you can redistribute it and/or modify *
7 * it under the terms of the GNU General Public License as published by *
8 * the Free Software Foundation; either version 2 of the License, or *
9 * (at your option) any later version. *
10 * *
11 * This program is distributed in the hope that it will be useful, *
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
14 * GNU General Public License for more details. *
15 * *
16 * You should have received a copy of the GNU General Public License *
17 * along with this program; if not, write to the *
18 * Free Software Foundation, Inc., *
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. *
20 ***************************************************************************/
21
22 #ifdef HAVE_CONFIG_H
23 #include "config.h"
24 #endif
25 #include "log.h"
26 #include "libusb1_common.h"
27
28 static struct libusb_context *jtag_libusb_context; /**< Libusb context **/
29 static libusb_device **devs; /**< The usb device list **/
30
31 static bool jtag_libusb_match(struct jtag_libusb_device *dev,
32 const uint16_t vids[], const uint16_t pids[])
33 {
34 struct libusb_device_descriptor dev_desc;
35
36 for (unsigned i = 0; vids[i]; i++) {
37 if (libusb_get_device_descriptor(dev, &dev_desc) == 0) {
38 if (dev_desc.idVendor == vids[i] &&
39 dev_desc.idProduct == pids[i])
40 return true;
41 }
42 }
43 return false;
44 }
45
46 int jtag_libusb_open(const uint16_t vids[], const uint16_t pids[],
47 struct jtag_libusb_device_handle **out)
48 {
49 int cnt, idx, errCode;
50
51 if (libusb_init(&jtag_libusb_context) < 0)
52 return -ENODEV;
53
54 cnt = libusb_get_device_list(jtag_libusb_context, &devs);
55
56 for (idx = 0; idx < cnt; idx++) {
57 if (!jtag_libusb_match(devs[idx], vids, pids))
58 continue;
59
60 errCode = libusb_open(devs[idx], out);
61
62 /** Free the device list **/
63 libusb_free_device_list(devs, 1);
64
65 if (errCode < 0)
66 return errCode;
67 return 0;
68 }
69 return -ENODEV;
70 }
71
72 void jtag_libusb_close(jtag_libusb_device_handle *dev)
73 {
74 /* Close device */
75 libusb_close(dev);
76
77 libusb_exit(jtag_libusb_context);
78 }
79
80 int jtag_libusb_control_transfer(jtag_libusb_device_handle *dev, uint8_t requestType,
81 uint8_t request, uint16_t wValue, uint16_t wIndex, char *bytes,
82 uint16_t size, unsigned int timeout)
83 {
84 int transferred = 0;
85
86 transferred = libusb_control_transfer(dev, requestType, request, wValue, wIndex,
87 (unsigned char *)bytes, size, timeout);
88
89 if (transferred < 0)
90 transferred = 0;
91
92 return transferred;
93 }
94
95 int jtag_libusb_bulk_write(jtag_libusb_device_handle *dev, int ep, char *bytes,
96 int size, int timeout)
97 {
98 int transferred = 0;
99
100 libusb_bulk_transfer(dev, ep, (unsigned char *)bytes, size,
101 &transferred, timeout);
102 return transferred;
103 }
104
105 int jtag_libusb_bulk_read(jtag_libusb_device_handle *dev, int ep, char *bytes,
106 int size, int timeout)
107 {
108 int transferred = 0;
109
110 libusb_bulk_transfer(dev, ep, (unsigned char *)bytes, size,
111 &transferred, timeout);
112 return transferred;
113 }
114
115 int jtag_libusb_set_configuration(jtag_libusb_device_handle *devh,
116 int configuration)
117 {
118 struct jtag_libusb_device *udev = jtag_libusb_get_device(devh);
119 int retCode = -99;
120
121 struct libusb_config_descriptor *config = NULL;
122
123 libusb_get_config_descriptor(udev, configuration, &config);
124 retCode = libusb_set_configuration(devh, config->bConfigurationValue);
125
126 libusb_free_config_descriptor(config);
127
128 return retCode;
129 }
130
131 int jtag_libusb_get_endpoints(struct jtag_libusb_device *udev,
132 unsigned int *usb_read_ep,
133 unsigned int *usb_write_ep)
134 {
135 const struct libusb_interface *inter;
136 const struct libusb_interface_descriptor *interdesc;
137 const struct libusb_endpoint_descriptor *epdesc;
138 struct libusb_config_descriptor *config;
139
140 libusb_get_config_descriptor(udev, 0, &config);
141 for (int i = 0; i < (int)config->bNumInterfaces; i++) {
142 inter = &config->interface[i];
143
144 for (int j = 0; j < inter->num_altsetting; j++) {
145 interdesc = &inter->altsetting[j];
146 for (int k = 0;
147 k < (int)interdesc->bNumEndpoints; k++) {
148 epdesc = &interdesc->endpoint[k];
149
150 uint8_t epnum = epdesc->bEndpointAddress;
151 bool is_input = epnum & 0x80;
152 LOG_DEBUG("usb ep %s %02x",
153 is_input ? "in" : "out", epnum);
154
155 if (is_input)
156 *usb_read_ep = epnum;
157 else
158 *usb_write_ep = epnum;
159 }
160 }
161 }
162 libusb_free_config_descriptor(config);
163
164 return 0;
165 }