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