Home | History | Annotate | Line # | Download | only in usb
usbdi_util.c revision 1.71
      1  1.71   msaitoh /*	$NetBSD: usbdi_util.c,v 1.71 2018/07/24 03:58:36 msaitoh Exp $	*/
      2   1.1  augustss 
      3   1.1  augustss /*
      4  1.57       mrg  * Copyright (c) 1998, 2012 The NetBSD Foundation, Inc.
      5   1.1  augustss  * All rights reserved.
      6   1.1  augustss  *
      7   1.5  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8  1.30  augustss  * by Lennart Augustsson (lennart (at) augustsson.net) at
      9  1.57       mrg  * Carlstedt Research & Technology and Matthew R. Green (mrg (at) eterna.com.au).
     10   1.1  augustss  *
     11   1.1  augustss  * Redistribution and use in source and binary forms, with or without
     12   1.1  augustss  * modification, are permitted provided that the following conditions
     13   1.1  augustss  * are met:
     14   1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     15   1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     16   1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     17   1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     18   1.1  augustss  *    documentation and/or other materials provided with the distribution.
     19   1.1  augustss  *
     20   1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     21   1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22   1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23   1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     24   1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     25   1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     26   1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     27   1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     28   1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29   1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30   1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     31   1.1  augustss  */
     32  1.36     lukem 
     33  1.36     lukem #include <sys/cdefs.h>
     34  1.71   msaitoh __KERNEL_RCSID(0, "$NetBSD: usbdi_util.c,v 1.71 2018/07/24 03:58:36 msaitoh Exp $");
     35  1.63     skrll 
     36  1.63     skrll #ifdef _KERNEL_OPT
     37  1.63     skrll #include "opt_usb.h"
     38  1.63     skrll #endif
     39   1.1  augustss 
     40   1.1  augustss #include <sys/param.h>
     41   1.1  augustss #include <sys/systm.h>
     42   1.1  augustss #include <sys/kernel.h>
     43  1.65     skrll #include <sys/kmem.h>
     44   1.1  augustss #include <sys/proc.h>
     45  1.14  augustss #include <sys/device.h>
     46  1.57       mrg #include <sys/bus.h>
     47   1.1  augustss 
     48   1.1  augustss #include <dev/usb/usb.h>
     49   1.1  augustss #include <dev/usb/usbhid.h>
     50   1.1  augustss #include <dev/usb/usbdi.h>
     51  1.57       mrg #include <dev/usb/usbdivar.h>
     52   1.1  augustss #include <dev/usb/usbdi_util.h>
     53  1.63     skrll #include <dev/usb/usbhist.h>
     54   1.1  augustss 
     55  1.65     skrll #define	DPRINTF(FMT,A,B,C,D)	USBHIST_LOGN(usbdebug,1,FMT,A,B,C,D)
     56  1.65     skrll #define	DPRINTFN(N,FMT,A,B,C,D)	USBHIST_LOGN(usbdebug,N,FMT,A,B,C,D)
     57   1.1  augustss 
     58   1.1  augustss usbd_status
     59  1.65     skrll usbd_get_desc(struct usbd_device *dev, int type, int index, int len, void *desc)
     60   1.1  augustss {
     61   1.1  augustss 	usb_device_request_t req;
     62   1.1  augustss 
     63  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
     64  1.65     skrll 
     65  1.70  pgoyette 	DPRINTFN(3,"type=%jd, index=%jd, len=%jd", type, index, len, 0);
     66  1.26  augustss 
     67   1.1  augustss 	req.bmRequestType = UT_READ_DEVICE;
     68   1.1  augustss 	req.bRequest = UR_GET_DESCRIPTOR;
     69   1.1  augustss 	USETW2(req.wValue, type, index);
     70   1.1  augustss 	USETW(req.wIndex, 0);
     71   1.1  augustss 	USETW(req.wLength, len);
     72  1.65     skrll 	return usbd_do_request(dev, &req, desc);
     73   1.1  augustss }
     74   1.1  augustss 
     75   1.1  augustss usbd_status
     76  1.65     skrll usbd_get_config_desc(struct usbd_device *dev, int confidx,
     77  1.31  augustss 		     usb_config_descriptor_t *d)
     78   1.1  augustss {
     79  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
     80  1.23  augustss 	usbd_status err;
     81   1.9  augustss 
     82  1.70  pgoyette 	DPRINTFN(3, "confidx=%jd", confidx, 0, 0, 0);
     83  1.40  augustss 	err = usbd_get_desc(dev, UDESC_CONFIG, confidx,
     84  1.26  augustss 			    USB_CONFIG_DESCRIPTOR_SIZE, d);
     85  1.23  augustss 	if (err)
     86  1.65     skrll 		return err;
     87   1.9  augustss 	if (d->bDescriptorType != UDESC_CONFIG) {
     88  1.70  pgoyette 		DPRINTFN(1, "confidx=%jd, bad desc len=%d type=%d",
     89  1.65     skrll 		    confidx, d->bLength, d->bDescriptorType, 0);
     90  1.65     skrll 		return USBD_INVAL;
     91   1.9  augustss 	}
     92  1.65     skrll 	return USBD_NORMAL_COMPLETION;
     93   1.1  augustss }
     94   1.1  augustss 
     95   1.1  augustss usbd_status
     96  1.65     skrll usbd_get_config_desc_full(struct usbd_device *dev, int conf, void *d, int size)
     97   1.4  augustss {
     98  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
     99  1.65     skrll 
    100  1.70  pgoyette 	DPRINTFN(3, "conf=%jd", conf, 0, 0, 0);
    101  1.65     skrll 	return usbd_get_desc(dev, UDESC_CONFIG, conf, size, d);
    102   1.4  augustss }
    103   1.4  augustss 
    104   1.4  augustss usbd_status
    105  1.65     skrll usbd_get_bos_desc(struct usbd_device *dev, int confidx,
    106  1.64     skrll 		     usb_bos_descriptor_t *d)
    107  1.64     skrll {
    108  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    109  1.64     skrll 	usbd_status err;
    110  1.64     skrll 
    111  1.70  pgoyette 	DPRINTFN(3, "confidx=%jd", confidx, 0, 0, 0);
    112  1.64     skrll 	err = usbd_get_desc(dev, UDESC_BOS, confidx,
    113  1.64     skrll 			    USB_BOS_DESCRIPTOR_SIZE, d);
    114  1.64     skrll 	if (err)
    115  1.69     skrll 		return err;
    116  1.64     skrll 	if (d->bDescriptorType != UDESC_BOS) {
    117  1.70  pgoyette 		DPRINTFN(1, "confidx=%jd, bad desc len=%d type=%d",
    118  1.65     skrll 		    confidx, d->bLength, d->bDescriptorType, 0);
    119  1.65     skrll 		return USBD_INVAL;
    120  1.64     skrll 	}
    121  1.65     skrll 	return USBD_NORMAL_COMPLETION;
    122  1.64     skrll }
    123  1.64     skrll 
    124  1.64     skrll usbd_status
    125  1.65     skrll usbd_get_bos_desc_full(struct usbd_device *dev, int conf, void *d, int size)
    126  1.64     skrll {
    127  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    128  1.65     skrll 
    129  1.70  pgoyette 	DPRINTFN(3, "conf=%jd", conf, 0, 0, 0);
    130  1.65     skrll 	return usbd_get_desc(dev, UDESC_BOS, conf, size, d);
    131  1.64     skrll }
    132  1.64     skrll 
    133  1.64     skrll usbd_status
    134  1.65     skrll usbd_get_device_desc(struct usbd_device *dev, usb_device_descriptor_t *d)
    135   1.1  augustss {
    136  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    137  1.65     skrll 
    138  1.69     skrll 	return usbd_get_desc(dev, UDESC_DEVICE,
    139  1.69     skrll 			     0, USB_DEVICE_DESCRIPTOR_SIZE, d);
    140   1.1  augustss }
    141   1.1  augustss 
    142   1.1  augustss usbd_status
    143  1.65     skrll usbd_get_device_status(struct usbd_device *dev, usb_status_t *st)
    144   1.1  augustss {
    145  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    146   1.1  augustss 	usb_device_request_t req;
    147   1.1  augustss 
    148   1.1  augustss 	req.bmRequestType = UT_READ_DEVICE;
    149   1.1  augustss 	req.bRequest = UR_GET_STATUS;
    150   1.1  augustss 	USETW(req.wValue, 0);
    151   1.1  augustss 	USETW(req.wIndex, 0);
    152   1.1  augustss 	USETW(req.wLength, sizeof(usb_status_t));
    153  1.65     skrll 	return usbd_do_request(dev, &req, st);
    154  1.40  augustss }
    155   1.1  augustss 
    156   1.1  augustss usbd_status
    157  1.65     skrll usbd_get_hub_status(struct usbd_device *dev, usb_hub_status_t *st)
    158   1.1  augustss {
    159  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    160   1.1  augustss 	usb_device_request_t req;
    161   1.1  augustss 
    162  1.70  pgoyette 	DPRINTF("dev %#jx", (uintptr_t)dev, 0, 0, 0);
    163   1.1  augustss 	req.bmRequestType = UT_READ_CLASS_DEVICE;
    164   1.1  augustss 	req.bRequest = UR_GET_STATUS;
    165   1.1  augustss 	USETW(req.wValue, 0);
    166   1.1  augustss 	USETW(req.wIndex, 0);
    167   1.1  augustss 	USETW(req.wLength, sizeof(usb_hub_status_t));
    168  1.65     skrll 	return usbd_do_request(dev, &req, st);
    169  1.40  augustss }
    170   1.1  augustss 
    171   1.1  augustss usbd_status
    172  1.65     skrll usbd_set_address(struct usbd_device *dev, int addr)
    173   1.1  augustss {
    174  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    175   1.1  augustss 	usb_device_request_t req;
    176   1.1  augustss 
    177  1.70  pgoyette 	DPRINTF("dev %#jx addr %jd", (uintptr_t)dev, addr, 0, 0);
    178   1.1  augustss 	req.bmRequestType = UT_WRITE_DEVICE;
    179   1.1  augustss 	req.bRequest = UR_SET_ADDRESS;
    180   1.1  augustss 	USETW(req.wValue, addr);
    181   1.1  augustss 	USETW(req.wIndex, 0);
    182   1.1  augustss 	USETW(req.wLength, 0);
    183   1.1  augustss 	return usbd_do_request(dev, &req, 0);
    184   1.1  augustss }
    185   1.1  augustss 
    186   1.1  augustss usbd_status
    187  1.65     skrll usbd_get_port_status(struct usbd_device *dev, int port, usb_port_status_t *ps)
    188   1.1  augustss {
    189  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    190   1.1  augustss 	usb_device_request_t req;
    191   1.1  augustss 
    192  1.70  pgoyette 	DPRINTF("dev %#jx port %jd", (uintptr_t)dev, port, 0, 0);
    193   1.1  augustss 	req.bmRequestType = UT_READ_CLASS_OTHER;
    194   1.1  augustss 	req.bRequest = UR_GET_STATUS;
    195   1.1  augustss 	USETW(req.wValue, 0);
    196   1.1  augustss 	USETW(req.wIndex, port);
    197  1.65     skrll 	USETW(req.wLength, sizeof(*ps));
    198  1.65     skrll 	return usbd_do_request(dev, &req, ps);
    199  1.65     skrll }
    200  1.65     skrll 
    201  1.65     skrll /* USB 3.1 10.16.2.6, 10.16.2.6.3 */
    202  1.65     skrll usbd_status
    203  1.65     skrll usbd_get_port_status_ext(struct usbd_device *dev, int port,
    204  1.65     skrll     usb_port_status_ext_t *pse)
    205  1.65     skrll {
    206  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    207  1.65     skrll 	usb_device_request_t req;
    208  1.65     skrll 
    209  1.70  pgoyette 	DPRINTF("dev %#jx port %jd", (uintptr_t)dev, port, 0, 0);
    210  1.65     skrll 	req.bmRequestType = UT_READ_CLASS_OTHER;
    211  1.65     skrll 	req.bRequest = UR_GET_STATUS;
    212  1.65     skrll 	USETW2(req.wValue, 0, UR_PST_EXT_PORT_STATUS);
    213  1.65     skrll 	USETW(req.wIndex, port);
    214  1.65     skrll 	USETW(req.wLength, sizeof(*pse));
    215  1.69     skrll 	return usbd_do_request(dev, &req, pse);
    216  1.16  augustss }
    217  1.16  augustss 
    218  1.16  augustss usbd_status
    219  1.65     skrll usbd_clear_hub_feature(struct usbd_device *dev, int sel)
    220  1.16  augustss {
    221  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    222  1.16  augustss 	usb_device_request_t req;
    223  1.16  augustss 
    224  1.70  pgoyette 	DPRINTF("dev %#jx sel %jd", (uintptr_t)dev, sel, 0, 0);
    225  1.16  augustss 	req.bmRequestType = UT_WRITE_CLASS_DEVICE;
    226  1.16  augustss 	req.bRequest = UR_CLEAR_FEATURE;
    227  1.16  augustss 	USETW(req.wValue, sel);
    228  1.16  augustss 	USETW(req.wIndex, 0);
    229  1.16  augustss 	USETW(req.wLength, 0);
    230  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    231  1.16  augustss }
    232  1.16  augustss 
    233  1.16  augustss usbd_status
    234  1.65     skrll usbd_set_hub_feature(struct usbd_device *dev, int sel)
    235  1.16  augustss {
    236  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    237  1.16  augustss 	usb_device_request_t req;
    238  1.16  augustss 
    239  1.70  pgoyette 	DPRINTF("dev %#jx sel %jd", (uintptr_t)dev, sel, 0, 0);
    240  1.16  augustss 	req.bmRequestType = UT_WRITE_CLASS_DEVICE;
    241  1.16  augustss 	req.bRequest = UR_SET_FEATURE;
    242  1.16  augustss 	USETW(req.wValue, sel);
    243  1.16  augustss 	USETW(req.wIndex, 0);
    244  1.16  augustss 	USETW(req.wLength, 0);
    245  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    246   1.1  augustss }
    247   1.1  augustss 
    248   1.1  augustss usbd_status
    249  1.65     skrll usbd_clear_port_feature(struct usbd_device *dev, int port, int sel)
    250   1.1  augustss {
    251  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    252   1.1  augustss 	usb_device_request_t req;
    253   1.1  augustss 
    254  1.70  pgoyette 	DPRINTF("dev %#jx port %jd sel %jd", (uintptr_t)dev, port, sel, 0);
    255   1.1  augustss 	req.bmRequestType = UT_WRITE_CLASS_OTHER;
    256   1.1  augustss 	req.bRequest = UR_CLEAR_FEATURE;
    257   1.1  augustss 	USETW(req.wValue, sel);
    258   1.1  augustss 	USETW(req.wIndex, port);
    259   1.1  augustss 	USETW(req.wLength, 0);
    260  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    261   1.1  augustss }
    262   1.1  augustss 
    263   1.1  augustss usbd_status
    264  1.65     skrll usbd_set_port_feature(struct usbd_device *dev, int port, int sel)
    265   1.1  augustss {
    266  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    267   1.1  augustss 	usb_device_request_t req;
    268   1.1  augustss 
    269  1.70  pgoyette 	DPRINTF("dev %#jx port %jd sel %.d", (uintptr_t)dev, sel, 0, 0);
    270   1.1  augustss 	req.bmRequestType = UT_WRITE_CLASS_OTHER;
    271   1.1  augustss 	req.bRequest = UR_SET_FEATURE;
    272   1.1  augustss 	USETW(req.wValue, sel);
    273   1.1  augustss 	USETW(req.wIndex, port);
    274   1.1  augustss 	USETW(req.wLength, 0);
    275  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    276   1.1  augustss }
    277   1.1  augustss 
    278  1.39  augustss usbd_status
    279  1.65     skrll usbd_set_port_u1_timeout(struct usbd_device *dev, int port, int timeout)
    280  1.65     skrll {
    281  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    282  1.65     skrll 	usb_device_request_t req;
    283  1.65     skrll 
    284  1.70  pgoyette 	DPRINTF("dev %#jx port %jd timeout %.d", (uintptr_t)dev, port,
    285  1.70  pgoyette 	    timeout, 0);
    286  1.65     skrll 	req.bmRequestType = UT_WRITE_CLASS_OTHER;
    287  1.65     skrll 	req.bRequest = UR_SET_FEATURE;
    288  1.65     skrll 	USETW(req.wValue, UHF_PORT_U1_TIMEOUT);
    289  1.65     skrll 	USETW2(req.wIndex, timeout, port);
    290  1.65     skrll 	USETW(req.wLength, 0);
    291  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    292  1.65     skrll }
    293  1.65     skrll 
    294  1.65     skrll usbd_status
    295  1.65     skrll usbd_set_port_u2_timeout(struct usbd_device *dev, int port, int timeout)
    296  1.65     skrll {
    297  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    298  1.65     skrll 	usb_device_request_t req;
    299  1.65     skrll 
    300  1.70  pgoyette 	DPRINTF("dev %#jx port %jd timeout %jd", (uintptr_t)dev, port,
    301  1.70  pgoyette 	    timeout, 0);
    302  1.65     skrll 	req.bmRequestType = UT_WRITE_CLASS_OTHER;
    303  1.65     skrll 	req.bRequest = UR_SET_FEATURE;
    304  1.65     skrll 	USETW(req.wValue, UHF_PORT_U2_TIMEOUT);
    305  1.65     skrll 	USETW2(req.wIndex, timeout, port);
    306  1.65     skrll 	USETW(req.wLength, 0);
    307  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    308  1.65     skrll }
    309  1.65     skrll 
    310  1.65     skrll usbd_status
    311  1.65     skrll usbd_get_protocol(struct usbd_interface *iface, uint8_t *report)
    312  1.39  augustss {
    313  1.39  augustss 	usb_interface_descriptor_t *id = usbd_get_interface_descriptor(iface);
    314  1.65     skrll 	struct usbd_device *dev;
    315  1.39  augustss 	usb_device_request_t req;
    316  1.39  augustss 
    317  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    318  1.65     skrll 
    319  1.39  augustss 	if (id == NULL)
    320  1.65     skrll 		return USBD_IOERROR;
    321  1.70  pgoyette 	DPRINTFN(4, "iface=%#jx, endpt=%jd", (uintptr_t)iface,
    322  1.70  pgoyette 	    id->bInterfaceNumber, 0, 0);
    323  1.68      maya 
    324  1.39  augustss 	usbd_interface2device_handle(iface, &dev);
    325  1.39  augustss 	req.bmRequestType = UT_READ_CLASS_INTERFACE;
    326  1.39  augustss 	req.bRequest = UR_GET_PROTOCOL;
    327  1.39  augustss 	USETW(req.wValue, 0);
    328  1.39  augustss 	USETW(req.wIndex, id->bInterfaceNumber);
    329  1.39  augustss 	USETW(req.wLength, 1);
    330  1.65     skrll 	return usbd_do_request(dev, &req, report);
    331  1.39  augustss }
    332   1.1  augustss 
    333   1.1  augustss usbd_status
    334  1.65     skrll usbd_set_protocol(struct usbd_interface *iface, int report)
    335   1.1  augustss {
    336   1.1  augustss 	usb_interface_descriptor_t *id = usbd_get_interface_descriptor(iface);
    337  1.65     skrll 	struct usbd_device *dev;
    338   1.1  augustss 	usb_device_request_t req;
    339   1.1  augustss 
    340  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    341  1.65     skrll 
    342  1.67      maya 	if (id == NULL)
    343  1.67      maya 		return USBD_IOERROR;
    344  1.70  pgoyette 	DPRINTFN(4, "iface=%#jx, report=%jd, endpt=%jd", (uintptr_t)iface,
    345  1.70  pgoyette 	    report, id->bInterfaceNumber, 0);
    346  1.67      maya 
    347  1.37  augustss 	usbd_interface2device_handle(iface, &dev);
    348   1.1  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    349   1.1  augustss 	req.bRequest = UR_SET_PROTOCOL;
    350   1.1  augustss 	USETW(req.wValue, report);
    351   1.1  augustss 	USETW(req.wIndex, id->bInterfaceNumber);
    352   1.1  augustss 	USETW(req.wLength, 0);
    353  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    354   1.1  augustss }
    355   1.1  augustss 
    356   1.1  augustss usbd_status
    357  1.65     skrll usbd_set_report(struct usbd_interface *iface, int type, int id, void *data,
    358  1.31  augustss 		int len)
    359   1.1  augustss {
    360   1.1  augustss 	usb_interface_descriptor_t *ifd = usbd_get_interface_descriptor(iface);
    361  1.65     skrll 	struct usbd_device *dev;
    362   1.1  augustss 	usb_device_request_t req;
    363   1.1  augustss 
    364  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    365  1.65     skrll 
    366  1.70  pgoyette 	DPRINTFN(4, "len=%jd", len, 0, 0, 0);
    367  1.23  augustss 	if (ifd == NULL)
    368  1.65     skrll 		return USBD_IOERROR;
    369  1.37  augustss 	usbd_interface2device_handle(iface, &dev);
    370   1.1  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    371   1.1  augustss 	req.bRequest = UR_SET_REPORT;
    372   1.2  augustss 	USETW2(req.wValue, type, id);
    373   1.2  augustss 	USETW(req.wIndex, ifd->bInterfaceNumber);
    374   1.2  augustss 	USETW(req.wLength, len);
    375  1.65     skrll 	return usbd_do_request(dev, &req, data);
    376   1.3  augustss }
    377   1.3  augustss 
    378   1.3  augustss usbd_status
    379  1.65     skrll usbd_get_report(struct usbd_interface *iface, int type, int id, void *data,
    380  1.31  augustss 		int len)
    381   1.2  augustss {
    382   1.2  augustss 	usb_interface_descriptor_t *ifd = usbd_get_interface_descriptor(iface);
    383  1.65     skrll 	struct usbd_device *dev;
    384   1.2  augustss 	usb_device_request_t req;
    385   1.2  augustss 
    386  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    387  1.65     skrll 
    388  1.70  pgoyette 	DPRINTFN(4, "len=%jd", len, 0, 0, 0);
    389  1.28  augustss 	if (ifd == NULL)
    390  1.65     skrll 		return USBD_IOERROR;
    391  1.37  augustss 	usbd_interface2device_handle(iface, &dev);
    392   1.2  augustss 	req.bmRequestType = UT_READ_CLASS_INTERFACE;
    393   1.2  augustss 	req.bRequest = UR_GET_REPORT;
    394   1.1  augustss 	USETW2(req.wValue, type, id);
    395   1.1  augustss 	USETW(req.wIndex, ifd->bInterfaceNumber);
    396   1.1  augustss 	USETW(req.wLength, len);
    397  1.65     skrll 	return usbd_do_request(dev, &req, data);
    398   1.1  augustss }
    399   1.1  augustss 
    400   1.1  augustss usbd_status
    401  1.65     skrll usbd_set_idle(struct usbd_interface *iface, int duration, int id)
    402   1.1  augustss {
    403   1.1  augustss 	usb_interface_descriptor_t *ifd = usbd_get_interface_descriptor(iface);
    404  1.65     skrll 	struct usbd_device *dev;
    405   1.1  augustss 	usb_device_request_t req;
    406   1.1  augustss 
    407  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    408  1.65     skrll 
    409  1.70  pgoyette 	DPRINTFN(4, "duration %jd id %jd", duration, id, 0, 0);
    410  1.23  augustss 	if (ifd == NULL)
    411  1.65     skrll 		return USBD_IOERROR;
    412  1.37  augustss 	usbd_interface2device_handle(iface, &dev);
    413   1.1  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    414   1.1  augustss 	req.bRequest = UR_SET_IDLE;
    415   1.1  augustss 	USETW2(req.wValue, duration, id);
    416   1.1  augustss 	USETW(req.wIndex, ifd->bInterfaceNumber);
    417   1.1  augustss 	USETW(req.wLength, 0);
    418  1.65     skrll 	return usbd_do_request(dev, &req, 0);
    419   1.1  augustss }
    420   1.1  augustss 
    421   1.1  augustss usbd_status
    422  1.65     skrll usbd_get_report_descriptor(struct usbd_device *dev, int ifcno,
    423  1.31  augustss 			   int size, void *d)
    424   1.1  augustss {
    425  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    426   1.1  augustss 	usb_device_request_t req;
    427   1.1  augustss 
    428  1.70  pgoyette 	DPRINTF("dev %#jx ifcno %jd size %jd", (uintptr_t)dev, ifcno, size, 0);
    429   1.1  augustss 	req.bmRequestType = UT_READ_INTERFACE;
    430   1.1  augustss 	req.bRequest = UR_GET_DESCRIPTOR;
    431  1.35  augustss 	USETW2(req.wValue, UDESC_REPORT, 0); /* report id should be 0 */
    432   1.6  augustss 	USETW(req.wIndex, ifcno);
    433   1.1  augustss 	USETW(req.wLength, size);
    434  1.65     skrll 	return usbd_do_request(dev, &req, d);
    435   1.1  augustss }
    436   1.1  augustss 
    437   1.1  augustss usb_hid_descriptor_t *
    438  1.65     skrll usbd_get_hid_descriptor(struct usbd_interface *ifc)
    439   1.1  augustss {
    440   1.1  augustss 	usb_interface_descriptor_t *idesc = usbd_get_interface_descriptor(ifc);
    441  1.65     skrll 	struct usbd_device *dev;
    442   1.1  augustss 	usb_config_descriptor_t *cdesc;
    443   1.1  augustss 	usb_hid_descriptor_t *hd;
    444   1.1  augustss 	char *p, *end;
    445   1.1  augustss 
    446  1.23  augustss 	if (idesc == NULL)
    447  1.65     skrll 		return NULL;
    448  1.41  augustss 	usbd_interface2device_handle(ifc, &dev);
    449   1.1  augustss 	cdesc = usbd_get_config_descriptor(dev);
    450   1.1  augustss 
    451   1.1  augustss 	p = (char *)idesc + idesc->bLength;
    452   1.1  augustss 	end = (char *)cdesc + UGETW(cdesc->wTotalLength);
    453   1.1  augustss 
    454   1.1  augustss 	for (; p < end; p += hd->bLength) {
    455   1.1  augustss 		hd = (usb_hid_descriptor_t *)p;
    456   1.1  augustss 		if (p + hd->bLength <= end && hd->bDescriptorType == UDESC_HID)
    457  1.65     skrll 			return hd;
    458   1.1  augustss 		if (hd->bDescriptorType == UDESC_INTERFACE)
    459   1.1  augustss 			break;
    460   1.1  augustss 	}
    461  1.65     skrll 	return NULL;
    462   1.1  augustss }
    463   1.1  augustss 
    464   1.1  augustss usbd_status
    465  1.65     skrll usbd_read_report_desc(struct usbd_interface *ifc, void **descp, int *sizep)
    466   1.1  augustss {
    467   1.6  augustss 	usb_interface_descriptor_t *id;
    468   1.1  augustss 	usb_hid_descriptor_t *hid;
    469  1.65     skrll 	struct usbd_device *dev;
    470  1.23  augustss 	usbd_status err;
    471   1.1  augustss 
    472  1.37  augustss 	usbd_interface2device_handle(ifc, &dev);
    473   1.6  augustss 	id = usbd_get_interface_descriptor(ifc);
    474  1.23  augustss 	if (id == NULL)
    475  1.65     skrll 		return USBD_INVAL;
    476   1.1  augustss 	hid = usbd_get_hid_descriptor(ifc);
    477  1.25  augustss 	if (hid == NULL)
    478  1.65     skrll 		return USBD_IOERROR;
    479   1.1  augustss 	*sizep = UGETW(hid->descrs[0].wDescriptorLength);
    480  1.65     skrll 	*descp = kmem_alloc(*sizep, KM_SLEEP);
    481  1.35  augustss 	err = usbd_get_report_descriptor(dev, id->bInterfaceNumber,
    482  1.35  augustss 					 *sizep, *descp);
    483  1.23  augustss 	if (err) {
    484  1.65     skrll 		kmem_free(*descp, *sizep);
    485  1.34  augustss 		*descp = NULL;
    486  1.65     skrll 		return err;
    487   1.1  augustss 	}
    488  1.65     skrll 	return USBD_NORMAL_COMPLETION;
    489   1.7  augustss }
    490   1.7  augustss 
    491  1.40  augustss usbd_status
    492  1.65     skrll usbd_get_config(struct usbd_device *dev, uint8_t *conf)
    493   1.7  augustss {
    494  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    495   1.7  augustss 	usb_device_request_t req;
    496   1.7  augustss 
    497  1.70  pgoyette 	DPRINTF("dev %#jx", (uintptr_t)dev, 0, 0, 0);
    498   1.7  augustss 	req.bmRequestType = UT_READ_DEVICE;
    499   1.7  augustss 	req.bRequest = UR_GET_CONFIG;
    500   1.7  augustss 	USETW(req.wValue, 0);
    501   1.7  augustss 	USETW(req.wIndex, 0);
    502   1.7  augustss 	USETW(req.wLength, 1);
    503  1.65     skrll 	return usbd_do_request(dev, &req, conf);
    504   1.1  augustss }
    505  1.10  augustss 
    506  1.10  augustss usbd_status
    507  1.65     skrll usbd_bulk_transfer(struct usbd_xfer *xfer, struct usbd_pipe *pipe,
    508  1.65     skrll     uint16_t flags, uint32_t timeout, void *buf, uint32_t *size)
    509  1.10  augustss {
    510  1.23  augustss 	usbd_status err;
    511  1.10  augustss 
    512  1.63     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    513  1.63     skrll 
    514  1.65     skrll 	usbd_setup_xfer(xfer, 0, buf, *size, flags, timeout, NULL);
    515  1.70  pgoyette 	DPRINTFN(1, "start transfer %jd bytes", *size, 0, 0, 0);
    516  1.61     skrll 	err = usbd_sync_transfer_sig(xfer);
    517  1.57       mrg 
    518  1.57       mrg 	usbd_get_xfer_status(xfer, NULL, NULL, size, NULL);
    519  1.70  pgoyette 	DPRINTFN(1, "transferred %jd", *size, 0, 0, 0);
    520  1.23  augustss 	if (err) {
    521  1.10  augustss 		usbd_clear_endpoint_stall(pipe);
    522  1.10  augustss 	}
    523  1.70  pgoyette 	USBHIST_LOG(usbdebug, "<- done xfer %#jx err %d", (uintptr_t)xfer,
    524  1.70  pgoyette 	    err, 0, 0);
    525  1.61     skrll 
    526  1.65     skrll 	return err;
    527  1.10  augustss }
    528  1.10  augustss 
    529  1.42  augustss usbd_status
    530  1.65     skrll usbd_intr_transfer(struct usbd_xfer *xfer, struct usbd_pipe *pipe,
    531  1.65     skrll     uint16_t flags, uint32_t timeout, void *buf, uint32_t *size)
    532  1.42  augustss {
    533  1.42  augustss 	usbd_status err;
    534  1.42  augustss 
    535  1.63     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    536  1.63     skrll 
    537  1.65     skrll 	usbd_setup_xfer(xfer, 0, buf, *size, flags, timeout, NULL);
    538  1.61     skrll 
    539  1.70  pgoyette 	DPRINTFN(1, "start transfer %jd bytes", *size, 0, 0, 0);
    540  1.57       mrg 	err = usbd_sync_transfer_sig(xfer);
    541  1.61     skrll 
    542  1.57       mrg 	usbd_get_xfer_status(xfer, NULL, NULL, size, NULL);
    543  1.61     skrll 
    544  1.70  pgoyette 	DPRINTFN(1, "transferred %jd", *size, 0, 0, 0);
    545  1.42  augustss 	if (err) {
    546  1.42  augustss 		usbd_clear_endpoint_stall(pipe);
    547  1.42  augustss 	}
    548  1.70  pgoyette 	USBHIST_LOG(usbdebug, "<- done xfer %#jx err %jd", (uintptr_t)xfer,
    549  1.70  pgoyette 	    err, 0, 0);
    550  1.63     skrll 
    551  1.65     skrll 	return err;
    552  1.42  augustss }
    553  1.42  augustss 
    554  1.14  augustss void
    555  1.57       mrg usb_detach_wait(device_t dv, kcondvar_t *cv, kmutex_t *lock)
    556  1.57       mrg {
    557  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    558  1.65     skrll 
    559  1.70  pgoyette 	DPRINTFN(1, "waiting for dv %#jx", (uintptr_t)dv, 0, 0, 0);
    560  1.57       mrg 	if (cv_timedwait(cv, lock, hz * 60))	// dv, PZERO, "usbdet", hz * 60
    561  1.71   msaitoh 		aprint_error_dev(dv, "usb_detach_wait: didn't detach\n");
    562  1.65     skrll 	DPRINTFN(1, "done", 0, 0, 0, 0);
    563  1.57       mrg }
    564  1.57       mrg 
    565  1.57       mrg void
    566  1.57       mrg usb_detach_broadcast(device_t dv, kcondvar_t *cv)
    567  1.57       mrg {
    568  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    569  1.65     skrll 
    570  1.70  pgoyette 	DPRINTFN(1, "for dv %#jx", (uintptr_t)dv, 0, 0, 0);
    571  1.57       mrg 	cv_broadcast(cv);
    572  1.57       mrg }
    573  1.57       mrg 
    574  1.57       mrg void
    575  1.56       mrg usb_detach_waitold(device_t dv)
    576  1.14  augustss {
    577  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    578  1.65     skrll 
    579  1.70  pgoyette 	DPRINTFN(1, "waiting for dv %#jx", (uintptr_t)dv, 0, 0, 0);
    580  1.57       mrg 	if (tsleep(dv, PZERO, "usbdet", hz * 60)) /* XXXSMP ok */
    581  1.71   msaitoh 		aprint_error_dev(dv, "usb_detach_waitold: didn't detach\n");
    582  1.65     skrll 	DPRINTFN(1, "done", 0, 0, 0, 0);
    583  1.40  augustss }
    584  1.14  augustss 
    585  1.14  augustss void
    586  1.56       mrg usb_detach_wakeupold(device_t dv)
    587  1.14  augustss {
    588  1.65     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    589  1.65     skrll 
    590  1.70  pgoyette 	DPRINTFN(1, "for dv %#jx", (uintptr_t)dv, 0, 0, 0);
    591  1.57       mrg 	wakeup(dv); /* XXXSMP ok */
    592  1.40  augustss }
    593  1.38  augustss 
    594  1.48  drochner const usb_cdc_descriptor_t *
    595  1.65     skrll usb_find_desc(struct usbd_device *dev, int type, int subtype)
    596  1.38  augustss {
    597  1.41  augustss 	usbd_desc_iter_t iter;
    598  1.48  drochner 	const usb_cdc_descriptor_t *desc;
    599  1.41  augustss 
    600  1.41  augustss 	usb_desc_iter_init(dev, &iter);
    601  1.41  augustss 	for (;;) {
    602  1.48  drochner 		desc = (const usb_cdc_descriptor_t *)usb_desc_iter_next(&iter);
    603  1.41  augustss 		if (!desc || (desc->bDescriptorType == type &&
    604  1.48  drochner 			      (subtype == USBD_CDCSUBTYPE_ANY ||
    605  1.41  augustss 			       subtype == desc->bDescriptorSubtype)))
    606  1.41  augustss 			break;
    607  1.38  augustss 	}
    608  1.41  augustss 	return desc;
    609  1.38  augustss }
    610  1.43     itohy 
    611  1.43     itohy /* same as usb_find_desc(), but searches only in the specified interface. */
    612  1.48  drochner const usb_cdc_descriptor_t *
    613  1.65     skrll usb_find_desc_if(struct usbd_device *dev, int type, int subtype,
    614  1.43     itohy 		 usb_interface_descriptor_t *id)
    615  1.43     itohy {
    616  1.43     itohy 	usbd_desc_iter_t iter;
    617  1.48  drochner 	const usb_cdc_descriptor_t *desc;
    618  1.43     itohy 
    619  1.54  christos 	if (id == NULL)
    620  1.54  christos 		return usb_find_desc(dev, type, subtype);
    621  1.54  christos 
    622  1.43     itohy 	usb_desc_iter_init(dev, &iter);
    623  1.43     itohy 
    624  1.43     itohy 	iter.cur = (void *)id;		/* start from the interface desc */
    625  1.43     itohy 	usb_desc_iter_next(&iter);	/* and skip it */
    626  1.43     itohy 
    627  1.48  drochner 	while ((desc = (const usb_cdc_descriptor_t *)usb_desc_iter_next(&iter))
    628  1.48  drochner 	       != NULL) {
    629  1.43     itohy 		if (desc->bDescriptorType == UDESC_INTERFACE) {
    630  1.43     itohy 			/* we ran into the next interface --- not found */
    631  1.43     itohy 			return NULL;
    632  1.43     itohy 		}
    633  1.43     itohy 		if (desc->bDescriptorType == type &&
    634  1.48  drochner 		    (subtype == USBD_CDCSUBTYPE_ANY ||
    635  1.43     itohy 		     subtype == desc->bDescriptorSubtype))
    636  1.43     itohy 			break;
    637  1.43     itohy 	}
    638  1.43     itohy 	return desc;
    639  1.43     itohy }
    640