source: rtems-libbsd/freebsd/sys/dev/usb/usb_lookup.c @ 3d1e767

55-freebsd-126-freebsd-12freebsd-9.3
Last change on this file since 3d1e767 was 3d1e767, checked in by Sebastian Huber <sebastian.huber@…>, on 04/27/16 at 08:25:22

Directly use <sys/types.h> provided by Newlib
  • Property mode set to 100644
File size: 7.3 KB
Line 
1#include <machine/rtems-bsd-kernel-space.h>
2
3/* $FreeBSD$ */
4/*-
5 * Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 *    notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 *    notice, this list of conditions and the following disclaimer in the
14 *    documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29#ifdef USB_GLOBAL_INCLUDE_FILE
30#include USB_GLOBAL_INCLUDE_FILE
31#else
32#include <sys/stdint.h>
33#include <sys/stddef.h>
34#include <rtems/bsd/sys/param.h>
35#include <sys/queue.h>
36#include <sys/types.h>
37#include <sys/systm.h>
38#include <sys/kernel.h>
39#include <sys/bus.h>
40#include <sys/module.h>
41#include <rtems/bsd/sys/lock.h>
42#include <sys/mutex.h>
43#include <sys/condvar.h>
44#include <sys/sysctl.h>
45#include <sys/sx.h>
46#include <rtems/bsd/sys/unistd.h>
47#include <sys/callout.h>
48#include <sys/malloc.h>
49#include <sys/priv.h>
50#include <sys/limits.h>
51#include <sys/endian.h>
52
53#include <dev/usb/usb.h>
54#include <dev/usb/usbdi.h>
55#endif                  /* USB_GLOBAL_INCLUDE_FILE */
56
57/*------------------------------------------------------------------------*
58 *      usbd_lookup_id_by_info
59 *
60 * This functions takes an array of "struct usb_device_id" and tries
61 * to match the entries with the information in "struct usbd_lookup_info".
62 *
63 * NOTE: The "sizeof_id" parameter must be a multiple of the
64 * usb_device_id structure size. Else the behaviour of this function
65 * is undefined.
66 *
67 * Return values:
68 * NULL: No match found.
69 * Else: Pointer to matching entry.
70 *------------------------------------------------------------------------*/
71const struct usb_device_id *
72usbd_lookup_id_by_info(const struct usb_device_id *id, usb_size_t sizeof_id,
73    const struct usbd_lookup_info *info)
74{
75        const struct usb_device_id *id_end;
76
77        if (id == NULL) {
78                goto done;
79        }
80        id_end = (const void *)(((const uint8_t *)id) + sizeof_id);
81
82        /*
83         * Keep on matching array entries until we find a match or
84         * until we reach the end of the matching array:
85         */
86        for (; id != id_end; id++) {
87
88                if ((id->match_flag_vendor) &&
89                    (id->idVendor != info->idVendor)) {
90                        continue;
91                }
92                if ((id->match_flag_product) &&
93                    (id->idProduct != info->idProduct)) {
94                        continue;
95                }
96                if ((id->match_flag_dev_lo) &&
97                    (id->bcdDevice_lo > info->bcdDevice)) {
98                        continue;
99                }
100                if ((id->match_flag_dev_hi) &&
101                    (id->bcdDevice_hi < info->bcdDevice)) {
102                        continue;
103                }
104                if ((id->match_flag_dev_class) &&
105                    (id->bDeviceClass != info->bDeviceClass)) {
106                        continue;
107                }
108                if ((id->match_flag_dev_subclass) &&
109                    (id->bDeviceSubClass != info->bDeviceSubClass)) {
110                        continue;
111                }
112                if ((id->match_flag_dev_protocol) &&
113                    (id->bDeviceProtocol != info->bDeviceProtocol)) {
114                        continue;
115                }
116                if ((id->match_flag_int_class) &&
117                    (id->bInterfaceClass != info->bInterfaceClass)) {
118                        continue;
119                }
120                if ((id->match_flag_int_subclass) &&
121                    (id->bInterfaceSubClass != info->bInterfaceSubClass)) {
122                        continue;
123                }
124                if ((id->match_flag_int_protocol) &&
125                    (id->bInterfaceProtocol != info->bInterfaceProtocol)) {
126                        continue;
127                }
128                /* We found a match! */
129                return (id);
130        }
131
132done:
133        return (NULL);
134}
135
136/*------------------------------------------------------------------------*
137 *      usbd_lookup_id_by_uaa - factored out code
138 *
139 * Return values:
140 *    0: Success
141 * Else: Failure
142 *------------------------------------------------------------------------*/
143int
144usbd_lookup_id_by_uaa(const struct usb_device_id *id, usb_size_t sizeof_id,
145    struct usb_attach_arg *uaa)
146{
147        id = usbd_lookup_id_by_info(id, sizeof_id, &uaa->info);
148        if (id) {
149                /* copy driver info */
150                uaa->driver_info = id->driver_info;
151                return (0);
152        }
153        return (ENXIO);
154}
155
156/*------------------------------------------------------------------------*
157 *      Export the USB device ID format we use to userspace tools.
158 *------------------------------------------------------------------------*/
159#if BYTE_ORDER == BIG_ENDIAN
160#define U16_XOR "8"
161#define U32_XOR "12"
162#define U64_XOR "56"
163#define U8_BITFIELD_XOR "7"
164#define U16_BITFIELD_XOR "15"
165#define U32_BITFIELD_XOR "31"
166#define U64_BITFIELD_XOR "63"
167#else
168#define U16_XOR "0"
169#define U32_XOR "0"
170#define U64_XOR "0"
171#define U8_BITFIELD_XOR "0"
172#define U16_BITFIELD_XOR "0"
173#define U32_BITFIELD_XOR "0"
174#define U64_BITFIELD_XOR "0"
175#endif
176
177#if USB_HAVE_COMPAT_LINUX
178#define MFL_SIZE "1"
179#else
180#define MFL_SIZE "0"
181#endif
182
183#if defined(KLD_MODULE) && (USB_HAVE_ID_SECTION != 0)
184static const char __section("bus_autoconf_format") __used usb_id_format[] = {
185
186        /* Declare that three different sections use the same format */
187
188        "usb_host_id{256,:}"
189        "usb_device_id{256,:}"
190        "usb_dual_id{256,:}"
191
192        /* List size of fields in the usb_device_id structure */
193
194#if ULONG_MAX >= 0xFFFFFFFFUL
195        "unused{0,8}"
196        "unused{0,8}"
197        "unused{0,8}"
198        "unused{0,8}"
199#if ULONG_MAX >= 0xFFFFFFFFFFFFFFFFULL
200        "unused{0,8}"
201        "unused{0,8}"
202        "unused{0,8}"
203        "unused{0,8}"
204#endif
205#else
206#error "Please update code."
207#endif
208
209        "idVendor[0]{" U16_XOR ",8}"
210        "idVendor[1]{" U16_XOR ",8}"
211        "idProduct[0]{" U16_XOR ",8}"
212        "idProduct[1]{" U16_XOR ",8}"
213        "bcdDevice_lo[0]{" U16_XOR ",8}"
214        "bcdDevice_lo[1]{" U16_XOR ",8}"
215        "bcdDevice_hi[0]{" U16_XOR ",8}"
216        "bcdDevice_hi[1]{" U16_XOR ",8}"
217
218        "bDeviceClass{0,8}"
219        "bDeviceSubClass{0,8}"
220        "bDeviceProtocol{0,8}"
221        "bInterfaceClass{0,8}"
222        "bInterfaceSubClass{0,8}"
223        "bInterfaceProtocol{0,8}"
224
225        "mf_vendor{" U8_BITFIELD_XOR ",1}"
226        "mf_product{" U8_BITFIELD_XOR ",1}"
227        "mf_dev_lo{" U8_BITFIELD_XOR ",1}"
228        "mf_dev_hi{" U8_BITFIELD_XOR ",1}"
229
230        "mf_dev_class{" U8_BITFIELD_XOR ",1}"
231        "mf_dev_subclass{" U8_BITFIELD_XOR ",1}"
232        "mf_dev_protocol{" U8_BITFIELD_XOR ",1}"
233        "mf_int_class{" U8_BITFIELD_XOR ",1}"
234
235        "mf_int_subclass{" U8_BITFIELD_XOR ",1}"
236        "mf_int_protocol{" U8_BITFIELD_XOR ",1}"
237        "unused{" U8_BITFIELD_XOR ",6}"
238
239        "mfl_vendor{" U16_XOR "," MFL_SIZE "}"
240        "mfl_product{" U16_XOR "," MFL_SIZE "}"
241        "mfl_dev_lo{" U16_XOR "," MFL_SIZE "}"
242        "mfl_dev_hi{" U16_XOR "," MFL_SIZE "}"
243
244        "mfl_dev_class{" U16_XOR "," MFL_SIZE "}"
245        "mfl_dev_subclass{" U16_XOR "," MFL_SIZE "}"
246        "mfl_dev_protocol{" U16_XOR "," MFL_SIZE "}"
247        "mfl_int_class{" U16_XOR "," MFL_SIZE "}"
248
249        "mfl_int_subclass{" U16_XOR "," MFL_SIZE "}"
250        "mfl_int_protocol{" U16_XOR "," MFL_SIZE "}"
251        "unused{" U16_XOR "," MFL_SIZE "}"
252        "unused{" U16_XOR "," MFL_SIZE "}"
253
254        "unused{" U16_XOR "," MFL_SIZE "}"
255        "unused{" U16_XOR "," MFL_SIZE "}"
256        "unused{" U16_XOR "," MFL_SIZE "}"
257        "unused{" U16_XOR "," MFL_SIZE "}"
258};
259#endif
Note: See TracBrowser for help on using the repository browser.