1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
|
// SPDX-License-Identifier: GPL-2.0+
/*
* usbhid-dump - device list
*
* Copyright (C) 2010 Nikolai Kondrashov <spbnick@gmail.com>
*/
#include "config.h"
#include "misc.h"
#include "dev_list.h"
#include <assert.h>
#include <stdlib.h>
#include <stdio.h>
bool
uhd_dev_list_valid(const uhd_dev *list)
{
UHD_DEV_LIST_FOR_EACH(list, list)
if (!uhd_dev_valid(list))
return false;
return true;
}
void
uhd_dev_list_close(uhd_dev *list)
{
uhd_dev *next;
for (; list != NULL; list = next)
{
next = list->next;
uhd_dev_close(list);
}
}
enum libusb_error
uhd_dev_list_open(libusb_context *ctx,
uint8_t bus_num, uint8_t dev_addr,
uint16_t vid, uint16_t pid,
uhd_dev **plist)
{
enum libusb_error err = LIBUSB_ERROR_OTHER;
libusb_device **lusb_list = NULL;
ssize_t num;
ssize_t idx;
libusb_device *lusb_dev;
struct libusb_device_descriptor desc;
uhd_dev *list = NULL;
uhd_dev *dev;
assert(ctx != NULL);
/* Retrieve libusb device list */
num = libusb_get_device_list(ctx, &lusb_list);
if (num == LIBUSB_ERROR_NO_MEM)
{
err = num;
goto cleanup;
}
/* Find and open the devices */
for (idx = 0; idx < num; idx++)
{
lusb_dev = lusb_list[idx];
/* Skip devices not matching bus_num/dev_addr mask */
if ((bus_num != UHD_BUS_NUM_ANY &&
libusb_get_bus_number(lusb_dev) != bus_num) ||
(dev_addr != UHD_DEV_ADDR_ANY &&
libusb_get_device_address(lusb_dev) != dev_addr))
continue;
/* Skip devices not matching vendor/product mask */
if (vid != UHD_VID_ANY || pid != UHD_PID_ANY)
{
err = libusb_get_device_descriptor(lusb_dev, &desc);
if (err != LIBUSB_SUCCESS)
goto cleanup;
if ((vid != UHD_VID_ANY && vid != desc.idVendor) ||
(pid != UHD_PID_ANY && pid != desc.idProduct))
continue;
}
/* Open and append the device to the list */
err = uhd_dev_open(lusb_dev, &dev);
if (err != LIBUSB_SUCCESS)
goto cleanup;
dev->next = list;
list = dev;
}
/* Free the libusb device list freeing unused devices */
libusb_free_device_list(lusb_list, true);
lusb_list = NULL;
/* Output device list, if requested */
assert(uhd_dev_list_valid(list));
if (plist != NULL)
{
*plist = list;
list = NULL;
}
/* Done! */
err = LIBUSB_SUCCESS;
cleanup:
/* Close the device list if not output */
uhd_dev_list_close(list);
/* Free the libusb device list along with devices */
if (lusb_list != NULL)
libusb_free_device_list(lusb_list, true);
return err;
}
|
