usb_quirk.c revision 188942
150472Speter/* $FreeBSD: head/sys/dev/usb/quirk/usb_quirk.c 188942 2009-02-23 18:31:00Z thompsa $ */
2207995Sobrien/*-
3169718Skan * Copyright (c) 1998 The NetBSD Foundation, Inc. All rights reserved.
4169718Skan * Copyright (c) 1998 Lennart Augustsson. All rights reserved.
51823Sphk * Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
6169718Skan *
7169718Skan * Redistribution and use in source and binary forms, with or without
8169718Skan * modification, are permitted provided that the following conditions
9156854Sru * are met:
10195697Skan * 1. Redistributions of source code must retain the above copyright
11195697Skan *    notice, this list of conditions and the following disclaimer.
12195697Skan * 2. Redistributions in binary form must reproduce the above copyright
13195697Skan *    notice, this list of conditions and the following disclaimer in the
14195697Skan *    documentation and/or other materials provided with the distribution.
15195697Skan *
1696456Sobrien * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1745299Sobrien * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18245539Sandrew * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19245539Sandrew * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20245539Sandrew * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21245539Sandrew * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22169718Skan * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2345171Sobrien * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24169718Skan * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25169718Skan * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26169718Skan * SUCH DAMAGE.
27169718Skan */
28169718Skan
2918441Speter#include <dev/usb/usb.h>
30169718Skan#include <dev/usb/usb_ioctl.h>
31271125Sngie#include <dev/usb/usb_mfunc.h>
32195152Skan#include "usbdevs.h"
3396340Sobrien
34215082Simp#define	USB_DEBUG_VAR usb2_debug
3596784Sobrien
3696340Sobrien#include <dev/usb/usb_core.h>
3796340Sobrien#include <dev/usb/usb_lookup.h>
38260998Spfg#include <dev/usb/usb_debug.h>
39260998Spfg#include <dev/usb/usb_dynamic.h>
4096340Sobrien
41169718Skan#include <dev/usb/quirk/usb_quirk.h>
42244382Sandrew
43132751SkanMODULE_DEPEND(usb_quirk, usb, 1, 1, 1);
44132751SkanMODULE_VERSION(usb_quirk, 1);
45132751Skan
46169718Skan/*
47169718Skan * The following macro adds one or more quirks for a USB device:
48260998Spfg */
49244382Sandrew#define	USB_QUIRK_ENTRY(v,p,l,h,...) \
50244382Sandrew  .vid = (v), .pid = (p), .lo_rev = (l), .hi_rev = (h), .quirks = { __VA_ARGS__ }
51244382Sandrew
5218390Speter#define	USB_DEV_QUIRKS_MAX 128
53169718Skan#define	USB_SUB_QUIRKS_MAX 8
54169718Skan
55169718Skanstruct usb2_quirk_entry {
56169718Skan	uint16_t vid;
57169718Skan	uint16_t pid;
58169718Skan	uint16_t lo_rev;
59245539Sandrew	uint16_t hi_rev;
60245539Sandrew	uint16_t quirks[USB_SUB_QUIRKS_MAX];
61169718Skan};
62169718Skan
63169718Skanstatic struct mtx usb2_quirk_mtx;
64169718Skan
65245539Sandrewstatic struct usb2_quirk_entry usb2_quirks[USB_DEV_QUIRKS_MAX] = {
66169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_ASUS, USB_PRODUCT_ASUS_LCM, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
67169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_INSIDEOUT, USB_PRODUCT_INSIDEOUT_EDGEPORT4, 0x094, 0x094, UQ_SWAP_UNICODE, UQ_NONE)},
68169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_DALLAS, USB_PRODUCT_DALLAS_J6502, 0x0a2, 0x0a2, UQ_BAD_ADC, UQ_NONE)},
69169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_DALLAS, USB_PRODUCT_DALLAS_J6502, 0x0a2, 0x0a2, UQ_AU_NO_XU, UQ_NONE)},
70169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_ALTEC, USB_PRODUCT_ALTEC_ADA70, 0x103, 0x103, UQ_BAD_ADC, UQ_NONE)},
71169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_ALTEC, USB_PRODUCT_ALTEC_ASC495, 0x000, 0x000, UQ_BAD_AUDIO, UQ_NONE)},
72169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_QTRONIX, USB_PRODUCT_QTRONIX_980N, 0x110, 0x110, UQ_SPUR_BUT_UP, UQ_NONE)},
73169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_ALCOR2, USB_PRODUCT_ALCOR2_KBD_HUB, 0x001, 0x001, UQ_SPUR_BUT_UP, UQ_NONE)},
74169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_MCT, USB_PRODUCT_MCT_HUB0100, 0x102, 0x102, UQ_BUS_POWERED, UQ_NONE)},
75169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_MCT, USB_PRODUCT_MCT_USB232, 0x102, 0x102, UQ_BUS_POWERED, UQ_NONE)},
76169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_TI, USB_PRODUCT_TI_UTUSB41, 0x110, 0x110, UQ_POWER_CLAIM, UQ_NONE)},
77169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_TELEX, USB_PRODUCT_TELEX_MIC1, 0x009, 0x009, UQ_AU_NO_FRAC, UQ_NONE)},
78169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_SILICONPORTALS, USB_PRODUCT_SILICONPORTALS_YAPPHONE, 0x100, 0x100, UQ_AU_INP_ASYNC, UQ_NONE)},
79169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_LOGITECH, USB_PRODUCT_LOGITECH_UN53B, 0x0000, 0xFFFF, UQ_NO_STRINGS, UQ_NONE)},
80169718Skan
81169718Skan	/*
82169718Skan	 * XXX The following quirks should have a more specific revision
83169718Skan	 * number:
8496340Sobrien	 */
85169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_HP, USB_PRODUCT_HP_895C, 0x0000, 0xFFFF, UQ_BROKEN_BIDIR, UQ_NONE)},
86169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_HP, USB_PRODUCT_HP_880C, 0x0000, 0xFFFF, UQ_BROKEN_BIDIR, UQ_NONE)},
87132751Skan	{USB_QUIRK_ENTRY(USB_VENDOR_HP, USB_PRODUCT_HP_815C, 0x0000, 0xFFFF, UQ_BROKEN_BIDIR, UQ_NONE)},
8845299Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_HP, USB_PRODUCT_HP_810C, 0x0000, 0xFFFF, UQ_BROKEN_BIDIR, UQ_NONE)},
8996340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_HP, USB_PRODUCT_HP_830C, 0x0000, 0xFFFF, UQ_BROKEN_BIDIR, UQ_NONE)},
9096340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_HP, USB_PRODUCT_HP_1220C, 0x0000, 0xFFFF, UQ_BROKEN_BIDIR, UQ_NONE)},
9196340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_XEROX, USB_PRODUCT_XEROX_WCM15, 0x0000, 0xFFFF, UQ_BROKEN_BIDIR, UQ_NONE)},
92169718Skan	/* Devices which should be ignored by uhid */
9345299Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_APC, USB_PRODUCT_APC_UPS, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
9496340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F6C550AVR, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
9596340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_CYBERPOWER, USB_PRODUCT_CYBERPOWER_1500CAVRLCD, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
9696340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_DELORME, USB_PRODUCT_DELORME_EARTHMATE, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
97169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_ITUNERNET, USB_PRODUCT_ITUNERNET_USBLCD2X20, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
9845299Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_ITUNERNET, USB_PRODUCT_ITUNERNET_USBLCD4X20, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
99132751Skan	{USB_QUIRK_ENTRY(USB_VENDOR_MGE, USB_PRODUCT_MGE_UPS1, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
100132751Skan	{USB_QUIRK_ENTRY(USB_VENDOR_MGE, USB_PRODUCT_MGE_UPS2, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
101132751Skan	{USB_QUIRK_ENTRY(USB_VENDOR_APPLE, USB_PRODUCT_APPLE_IPHONE, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
102132751Skan	{USB_QUIRK_ENTRY(USB_VENDOR_APPLE, USB_PRODUCT_APPLE_IPHONE_3G, 0x0000, 0xFFFF, UQ_HID_IGNORE, UQ_NONE)},
103132751Skan	/* Devices which should be ignored by both ukbd and uhid */
10496340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_CYPRESS, USB_PRODUCT_CYPRESS_WISPY1A, 0x0000, 0xFFFF, UQ_KBD_IGNORE, UQ_HID_IGNORE, UQ_NONE)},
10596340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_METAGEEK, USB_PRODUCT_METAGEEK_WISPY1B, 0x0000, 0xFFFF, UQ_KBD_IGNORE, UQ_HID_IGNORE, UQ_NONE)},
10696340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_TENX, USB_PRODUCT_TENX_UAUDIO0, 0x0101, 0x0101, UQ_AUDIO_SWAP_LR, UQ_NONE)},
10718609Speter	/* MS keyboards do weird things */
10896340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_MICROSOFT, USB_PRODUCT_MICROSOFT_WLNOTEBOOK, 0x0000, 0xFFFF, UQ_MS_BAD_CLASS, UQ_MS_LEADING_BYTE, UQ_NONE)},
10996340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_MICROSOFT, USB_PRODUCT_MICROSOFT_WLNOTEBOOK2, 0x0000, 0xFFFF, UQ_MS_BAD_CLASS, UQ_MS_LEADING_BYTE, UQ_NONE)},
11096340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_MICROSOFT, USB_PRODUCT_MICROSOFT_WLINTELLIMOUSE, 0x0000, 0xFFFF, UQ_MS_LEADING_BYTE, UQ_NONE)},
111169718Skan	{USB_QUIRK_ENTRY(USB_VENDOR_MICROSOFT, USB_PRODUCT_MICROSOFT_COMFORT3000, 0x0000, 0xFFFF, UQ_MS_BAD_CLASS, UQ_MS_LEADING_BYTE, UQ_NONE)},
11296340Sobrien	{USB_QUIRK_ENTRY(USB_VENDOR_METAGEEK, USB_PRODUCT_METAGEEK_WISPY24X, 0x0000, 0xFFFF, UQ_KBD_IGNORE, UQ_HID_IGNORE, UQ_NONE)},
113215082Simp};
11496340Sobrien
115132751Skanstatic const char *usb_quirk_str[USB_QUIRK_MAX] = {
116260096Sdim	[UQ_NONE]		= "UQ_NONE",
117244382Sandrew	[UQ_AUDIO_SWAP_LR]	= "UQ_AUDIO_SWAP_LR",
118132751Skan	[UQ_AU_INP_ASYNC]	= "UQ_AU_INP_ASYNC",
119169718Skan	[UQ_AU_NO_FRAC]		= "UQ_AU_NO_FRAC",
120245539Sandrew	[UQ_AU_NO_XU]		= "UQ_AU_NO_XU",
121245539Sandrew	[UQ_BAD_ADC]		= "UQ_BAD_ADC",
122248401Sandrew	[UQ_BAD_AUDIO]		= "UQ_BAD_AUDIO",
123248401Sandrew	[UQ_BROKEN_BIDIR]	= "UQ_BROKEN_BIDIR",
124248401Sandrew	[UQ_BUS_POWERED]	= "UQ_BUS_POWERED",
125245539Sandrew	[UQ_HID_IGNORE]		= "UQ_HID_IGNORE",
126169718Skan	[UQ_KBD_IGNORE]		= "UQ_KBD_IGNORE",
12745306Sobrien	[UQ_MS_BAD_CLASS]	= "UQ_MS_BAD_CLASS",
128245539Sandrew	[UQ_MS_LEADING_BYTE]	= "UQ_MS_LEADING_BYTE",
12934814Sbde	[UQ_MS_REVZ]		= "UQ_MS_REVZ",
130217123Simp	[UQ_NO_STRINGS]		= "UQ_NO_STRINGS",
131201852Simp	[UQ_OPEN_CLEARSTALL]	= "UQ_OPEN_CLEARSTALL",
132217942Sjchandra	[UQ_POWER_CLAIM]	= "UQ_POWER_CLAIM",
133233644Sjmallett	[UQ_SPUR_BUT_UP]	= "UQ_SPUR_BUT_UP",
134208737Sjmallett	[UQ_SWAP_UNICODE]	= "UQ_SWAP_UNICODE",
135208737Sjmallett	[UQ_CFG_INDEX_1]	= "UQ_CFG_INDEX_1",
136208737Sjmallett	[UQ_CFG_INDEX_2]	= "UQ_CFG_INDEX_2",
137208737Sjmallett	[UQ_CFG_INDEX_3]	= "UQ_CFG_INDEX_3",
138201852Simp	[UQ_CFG_INDEX_4]	= "UQ_CFG_INDEX_4",
139208737Sjmallett	[UQ_CFG_INDEX_0]	= "UQ_CFG_INDEX_0",
140201852Simp};
141215082Simp
14296340Sobrien/*------------------------------------------------------------------------*
143169718Skan *	usb2_quirkstr
144169718Skan *
145169718Skan * This function converts an USB quirk code into a string.
146169718Skan *------------------------------------------------------------------------*/
147169718Skanstatic const char *
148169718Skanusb2_quirkstr(uint16_t quirk)
149169718Skan{
15096340Sobrien	return ((quirk < USB_QUIRK_MAX) ?
15134814Sbde	    usb_quirk_str[quirk] : "USB_QUIRK_UNKNOWN");
152215275Simp}
15396340Sobrien
154176530Sraj/*------------------------------------------------------------------------*
15596779Sobrien *	usb2_test_quirk_by_info
15696340Sobrien *
1571823Sphk * Returns:
158215275Simp * 0: Quirk not found
159209867Snwhitehorn * Else: Quirk found
160209867Snwhitehorn *------------------------------------------------------------------------*/
161209867Snwhitehornstatic uint8_t
162209867Snwhitehornusb2_test_quirk_by_info(const struct usb2_lookup_info *info, uint16_t quirk)
163215082Simp{
16496340Sobrien	uint16_t x;
165169718Skan	uint16_t y;
16696340Sobrien
16796340Sobrien	if (quirk == UQ_NONE) {
1681823Sphk		return (0);
16996340Sobrien	}
17096340Sobrien	mtx_lock(&usb2_quirk_mtx);
17196449Sobrien
17296449Sobrien	for (x = 0; x != USB_DEV_QUIRKS_MAX; x++) {
17396449Sobrien		/* see if quirk information does not match */
17496449Sobrien		if ((usb2_quirks[x].vid != info->idVendor) ||
175133103Skan		    (usb2_quirks[x].pid != info->idProduct) ||
17696449Sobrien		    (usb2_quirks[x].lo_rev > info->bcdDevice) ||
17796449Sobrien		    (usb2_quirks[x].hi_rev < info->bcdDevice)) {
17896449Sobrien			continue;
17996449Sobrien		}
180169718Skan		/* lookup quirk */
18196456Sobrien		for (y = 0; y != USB_SUB_QUIRKS_MAX; y++) {
182169718Skan			if (usb2_quirks[x].quirks[y] == quirk) {
183169718Skan				mtx_unlock(&usb2_quirk_mtx);
184169718Skan				DPRINTF("Found quirk '%s'.\n", usb2_quirkstr(quirk));
185169718Skan				return (1);
186169718Skan			}
187169718Skan		}
188169718Skan		/* no quirk found */
189169718Skan		break;
19096449Sobrien	}
191169718Skan	mtx_unlock(&usb2_quirk_mtx);
192169718Skan	return (0);
193169718Skan}
194169718Skan
195169718Skanstatic struct usb2_quirk_entry *
196169718Skanusb2_quirk_get_entry(uint16_t vid, uint16_t pid,
19796340Sobrien    uint16_t lo_rev, uint16_t hi_rev, uint8_t do_alloc)
198169718Skan{
199169718Skan	uint16_t x;
20096340Sobrien
201169718Skan	mtx_assert(&usb2_quirk_mtx, MA_OWNED);
202169718Skan
20396340Sobrien	if ((vid | pid | lo_rev | hi_rev) == 0) {
204169718Skan		/* all zero - special case */
20545299Sobrien		return (usb2_quirks + USB_DEV_QUIRKS_MAX - 1);
206169718Skan	}
207169718Skan	/* search for an existing entry */
208169718Skan	for (x = 0; x != USB_DEV_QUIRKS_MAX; x++) {
209169718Skan		/* see if quirk information does not match */
210215082Simp		if ((usb2_quirks[x].vid != vid) ||
211215082Simp		    (usb2_quirks[x].pid != pid) ||
212169718Skan		    (usb2_quirks[x].lo_rev != lo_rev) ||
213169718Skan		    (usb2_quirks[x].hi_rev != hi_rev)) {
214169718Skan			continue;
215169718Skan		}
216169718Skan		return (usb2_quirks + x);
217169718Skan	}
218169718Skan
219169718Skan	if (do_alloc == 0) {
2201823Sphk		/* no match */
2211823Sphk		return (NULL);
222169718Skan	}
223169718Skan	/* search for a free entry */
224169718Skan	for (x = 0; x != USB_DEV_QUIRKS_MAX; x++) {
225169718Skan		/* see if quirk information does not match */
226169718Skan		if ((usb2_quirks[x].vid |
227169718Skan		    usb2_quirks[x].pid |
228169718Skan		    usb2_quirks[x].lo_rev |
229169718Skan		    usb2_quirks[x].hi_rev) != 0) {
230169718Skan			continue;
231169718Skan		}
232169718Skan		usb2_quirks[x].vid = vid;
233169718Skan		usb2_quirks[x].pid = pid;
234169718Skan		usb2_quirks[x].lo_rev = lo_rev;
235169718Skan		usb2_quirks[x].hi_rev = hi_rev;
236169718Skan
237169718Skan		return (usb2_quirks + x);
238169718Skan	}
239169718Skan
240169718Skan	/* no entry found */
241169718Skan	return (NULL);
242169718Skan}
243169718Skan
244169718Skan/*------------------------------------------------------------------------*
245169718Skan *	usb2_quirk_ioctl - handle quirk IOCTLs
246169718Skan *
247169718Skan * Returns:
2481823Sphk * 0: Success
2491823Sphk * Else: Failure
250169718Skan *------------------------------------------------------------------------*/
251169718Skanstatic int
252169718Skanusb2_quirk_ioctl(unsigned long cmd, caddr_t data,
253169718Skan    int fflag, struct thread *td)
254171846Skan{
255169718Skan	struct usb2_gen_quirk *pgq;
256169718Skan	struct usb2_quirk_entry *pqe;
257169718Skan	uint32_t x;
258169718Skan	uint32_t y;
259169718Skan	int err;
260169718Skan
261169718Skan	switch (cmd) {
262169718Skan	case USB_DEV_QUIRK_GET:
263169718Skan		pgq = (void *)data;
264169718Skan		x = pgq->index % USB_SUB_QUIRKS_MAX;
265169718Skan		y = pgq->index / USB_SUB_QUIRKS_MAX;
266169718Skan		if (y >= USB_DEV_QUIRKS_MAX) {
267169718Skan			return (EINVAL);
26896456Sobrien		}
269169718Skan		mtx_lock(&usb2_quirk_mtx);
270169718Skan		/* copy out data */
271169718Skan		pgq->vid = usb2_quirks[y].vid;
272169718Skan		pgq->pid = usb2_quirks[y].pid;
273169718Skan		pgq->bcdDeviceLow = usb2_quirks[y].lo_rev;
274169718Skan		pgq->bcdDeviceHigh = usb2_quirks[y].hi_rev;
275169718Skan		strlcpy(pgq->quirkname,
276169718Skan		    usb2_quirkstr(usb2_quirks[y].quirks[x]),
277169718Skan		    sizeof(pgq->quirkname));
278169718Skan		mtx_unlock(&usb2_quirk_mtx);
279169718Skan		return (0);		/* success */
280169718Skan
281169718Skan	case USB_QUIRK_NAME_GET:
282169718Skan		pgq = (void *)data;
28396850Sobrien		x = pgq->index;
284169718Skan		if (x >= USB_QUIRK_MAX) {
285169718Skan			return (EINVAL);
286169718Skan		}
287234546Simp		strlcpy(pgq->quirkname,
288169718Skan		    usb2_quirkstr(x), sizeof(pgq->quirkname));
289169718Skan		return (0);		/* success */
29096456Sobrien
291169718Skan	case USB_DEV_QUIRK_ADD:
29296456Sobrien		pgq = (void *)data;
29396456Sobrien
294169718Skan		/* check privileges */
295169718Skan		err = priv_check(curthread, PRIV_DRIVER);
296169718Skan		if (err) {
297169718Skan			return (err);
298169718Skan		}
299169718Skan		/* convert quirk string into numerical */
300169718Skan		for (y = 0; y != USB_DEV_QUIRKS_MAX; y++) {
301169718Skan			if (strcmp(pgq->quirkname, usb2_quirkstr(y)) == 0) {
302169718Skan				break;
303169718Skan			}
304169718Skan		}
305169718Skan		if (y == USB_DEV_QUIRKS_MAX) {
306169718Skan			return (EINVAL);
307169718Skan		}
308169718Skan		if (y == UQ_NONE) {
309169718Skan			return (EINVAL);
310169718Skan		}
311169718Skan		mtx_lock(&usb2_quirk_mtx);
312169718Skan		pqe = usb2_quirk_get_entry(pgq->vid, pgq->pid,
313169718Skan		    pgq->bcdDeviceLow, pgq->bcdDeviceHigh, 1);
314169718Skan		for (x = 0; x != USB_SUB_QUIRKS_MAX; x++) {
315169718Skan			if (pqe->quirks[x] == UQ_NONE) {
316169718Skan				pqe->quirks[x] = y;
317169718Skan				break;
318169718Skan			}
319169718Skan		}
320169718Skan		mtx_unlock(&usb2_quirk_mtx);
321169718Skan		if (x == USB_SUB_QUIRKS_MAX) {
322169718Skan			return (ENOMEM);
323169718Skan		}
324169718Skan		return (0);		/* success */
325169718Skan
326169718Skan	case USB_DEV_QUIRK_REMOVE:
327169718Skan		pgq = (void *)data;
328200499Skan		/* check privileges */
329169718Skan		err = priv_check(curthread, PRIV_DRIVER);
330169718Skan		if (err) {
331169718Skan			return (err);
332169718Skan		}
333245539Sandrew		/* convert quirk string into numerical */
334245539Sandrew		for (y = 0; y != USB_DEV_QUIRKS_MAX; y++) {
335245539Sandrew			if (strcmp(pgq->quirkname, usb2_quirkstr(y)) == 0) {
336169718Skan				break;
337169718Skan			}
338169718Skan		}
339234546Simp		if (y == USB_DEV_QUIRKS_MAX) {
340169718Skan			return (EINVAL);
341169718Skan		}
342169718Skan		if (y == UQ_NONE) {
343169718Skan			return (EINVAL);
344169718Skan		}
345169718Skan		mtx_lock(&usb2_quirk_mtx);
346169718Skan		pqe = usb2_quirk_get_entry(pgq->vid, pgq->pid,
347169718Skan		    pgq->bcdDeviceLow, pgq->bcdDeviceHigh, 0);
348169718Skan		for (x = 0; x != USB_SUB_QUIRKS_MAX; x++) {
349169718Skan			if (pqe->quirks[x] == y) {
350200499Skan				pqe->quirks[x] = UQ_NONE;
351169718Skan				break;
352215126Sed			}
353215126Sed		}
354169718Skan		if (x == USB_SUB_QUIRKS_MAX) {
355243933Seadler			mtx_unlock(&usb2_quirk_mtx);
356270484Sdes			return (ENOMEM);
357169718Skan		}
358215126Sed		for (x = 0; x != USB_SUB_QUIRKS_MAX; x++) {
359169718Skan			if (pqe->quirks[x] != UQ_NONE) {
360156854Sru				break;
361215126Sed			}
362215126Sed		}
363169718Skan		if (x == USB_SUB_QUIRKS_MAX) {
364243933Seadler			/* all quirk entries are unused - release */
365270484Sdes			memset(pqe, 0, sizeof(pqe));
366215126Sed		}
36796456Sobrien		mtx_unlock(&usb2_quirk_mtx);
368169718Skan		return (0);		/* success */
369169718Skan
370169718Skan	default:
371169718Skan		break;
372188583Sjkim	}
373169718Skan	return (ENOIOCTL);
374215126Sed}
375188583Sjkim
376169718Skanstatic void
377169718Skanusb2_quirk_init(void *arg)
378215126Sed{
37996456Sobrien	/* initialize mutex */
38096456Sobrien	mtx_init(&usb2_quirk_mtx, "USB quirk", NULL, MTX_DEF);
381215126Sed
382169718Skan	/* register our function */
3831823Sphk	usb2_test_quirk_p = &usb2_test_quirk_by_info;
384169718Skan	usb2_quirk_ioctl_p = &usb2_quirk_ioctl;
385169718Skan}
386
387static void
388usb2_quirk_uninit(void *arg)
389{
390	usb2_quirk_unload(arg);
391
392	/* destroy mutex */
393	mtx_destroy(&usb2_quirk_mtx);
394}
395
396SYSINIT(usb2_quirk_init, SI_SUB_LOCK, SI_ORDER_FIRST, usb2_quirk_init, NULL);
397SYSUNINIT(usb2_quirk_uninit, SI_SUB_LOCK, SI_ORDER_ANY, usb2_quirk_uninit, NULL);
398