c40519075a9426858dd7c46a2451c3b779c1431b
[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 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, 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 libusb_set_debug(jtag_libusb_context, 3);
55
56 cnt = libusb_get_device_list(jtag_libusb_context, &devs);
57
58 for (idx = 0; idx < cnt; idx++) {
59 if (!jtag_libusb_match(devs[idx], vids, pids))
60 continue;
61
62 errCode = libusb_open(devs[idx], out);
63
64 /** Free the device list **/
65 libusb_free_device_list(devs, 1);
66
67 if (errCode < 0)
68 return errCode;
69 return 0;
70 }
71 return -ENODEV;
72 }
73
74 void jtag_libusb_close(jtag_libusb_device_handle *dev)
75 {
76 /* Close device */
77 libusb_close(dev);
78
79 libusb_exit(jtag_libusb_context);
80 }
81
82 int jtag_libusb_control_transfer(jtag_libusb_device_handle *dev, uint8_t requestType,
83 uint8_t request, uint16_t wValue, uint16_t wIndex, char *bytes,
84 uint16_t size, unsigned int timeout)
85 {
86 int transferred = 0;
87
88 transferred = libusb_control_transfer(dev, requestType, request, wValue, wIndex,
89 (unsigned char *)bytes, size, timeout);
90
91 if (transferred < 0)
92 transferred = 0;
93
94 return transferred;
95 }
96
97 int jtag_libusb_bulk_write(jtag_libusb_device_handle *dev, int ep, char *bytes,
98 int size, int timeout)
99 {
100 int transferred = 0;
101
102 libusb_bulk_transfer(dev, ep, (unsigned char *)bytes, size,
103 &transferred, timeout);
104 return transferred;
105 }
106
107 int jtag_libusb_bulk_read(jtag_libusb_device_handle *dev, int ep, char *bytes,
108 int size, int timeout)
109 {
110 int transferred = 0;
111
112 libusb_bulk_transfer(dev, ep, (unsigned char *)bytes, size,
113 &transferred, timeout);
114 return transferred;
115 }
116
117 int jtag_libusb_set_configuration(jtag_libusb_device_handle *devh,
118 int configuration)
119 {
120 struct jtag_libusb_device *udev = jtag_libusb_get_device(devh);
121 int retCode = -99;
122
123 struct libusb_config_descriptor *config = NULL;
124
125 libusb_get_config_descriptor(udev, configuration, &config);
126 retCode = libusb_set_configuration(devh, config->bConfigurationValue);
127
128 libusb_free_config_descriptor(config);
129
130 return retCode;
131 }
132
133 int jtag_libusb_get_endpoints(struct jtag_libusb_device *udev,
134 unsigned int *usb_read_ep,
135 unsigned int *usb_write_ep)
136 {
137 const struct libusb_interface *inter;
138 const struct libusb_interface_descriptor *interdesc;
139 const struct libusb_endpoint_descriptor *epdesc;
140 struct libusb_config_descriptor *config;
141
142 libusb_get_config_descriptor(udev, 0, &config);
143 for (int i = 0; i < (int)config->bNumInterfaces; i++) {
144 inter = &config->interface[i];
145
146 for (int j = 0; j < inter->num_altsetting; j++) {
147 interdesc = &inter->altsetting[j];
148 for (int k = 0;
149 k < (int)interdesc->bNumEndpoints; k++) {
150 epdesc = &interdesc->endpoint[k];
151
152 uint8_t epnum = epdesc->bEndpointAddress;
153 bool is_input = epnum & 0x80;
154 LOG_DEBUG("usb ep %s %02x",
155 is_input ? "in" : "out", epnum);
156
157 if (is_input)
158 *usb_read_ep = epnum;
159 else
160 *usb_write_ep = epnum;
161 }
162 }
163 }
164 libusb_free_config_descriptor(config);
165
166 return 0;
167 }