Current Path : /usr/src/lib/libusb/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
Current File : //usr/src/lib/libusb/libusb01.c |
/* $FreeBSD: release/9.1.0/lib/libusb/libusb01.c 224085 2011-07-16 08:29:12Z hselasky $ */ /*- * Copyright (c) 2008 Hans Petter Selasky. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. */ /* * This file contains the emulation layer for LibUSB v0.1 from sourceforge. */ #include <sys/queue.h> #include <errno.h> #include <stdio.h> #include <stdlib.h> #include "libusb20.h" #include "libusb20_desc.h" #include "libusb20_int.h" #include "usb.h" /* * The two following macros were taken from the original LibUSB v0.1 * for sake of compatibility: */ #define LIST_ADD(begin, ent) \ do { \ if (begin) { \ ent->next = begin; \ ent->next->prev = ent; \ } else { \ ent->next = NULL; \ } \ ent->prev = NULL; \ begin = ent; \ } while(0) #define LIST_DEL(begin, ent) \ do { \ if (ent->prev) { \ ent->prev->next = ent->next; \ } else { \ begin = ent->next; \ } \ if (ent->next) { \ ent->next->prev = ent->prev; \ } \ ent->prev = NULL; \ ent->next = NULL; \ } while (0) struct usb_bus *usb_busses = NULL; static struct usb_bus usb_global_bus = { .dirname = {"/dev/usb"}, .root_dev = NULL, .devices = NULL, }; static struct libusb20_backend *usb_backend = NULL; struct usb_parse_state { struct { struct libusb20_endpoint *currep; struct libusb20_interface *currifc; struct libusb20_config *currcfg; struct libusb20_me_struct *currextra; } a; struct { struct usb_config_descriptor *currcfg; struct usb_interface_descriptor *currifc; struct usb_endpoint_descriptor *currep; struct usb_interface *currifcw; uint8_t *currextra; } b; uint8_t preparse; }; static struct libusb20_transfer * usb_get_transfer_by_ep_no(usb_dev_handle * dev, uint8_t ep_no) { struct libusb20_device *pdev = (void *)dev; struct libusb20_transfer *xfer; int err; uint32_t bufsize; uint8_t x; uint8_t speed; x = (ep_no & LIBUSB20_ENDPOINT_ADDRESS_MASK) * 2; if (ep_no & LIBUSB20_ENDPOINT_DIR_MASK) { /* this is an IN endpoint */ x |= 1; } speed = libusb20_dev_get_speed(pdev); /* select a sensible buffer size */ if (speed == LIBUSB20_SPEED_LOW) { bufsize = 256; } else if (speed == LIBUSB20_SPEED_FULL) { bufsize = 4096; } else { bufsize = 16384; } xfer = libusb20_tr_get_pointer(pdev, x); if (xfer == NULL) return (xfer); err = libusb20_tr_open(xfer, bufsize, 1, ep_no); if (err == LIBUSB20_ERROR_BUSY) { /* already opened */ return (xfer); } else if (err) { return (NULL); } /* success */ return (xfer); } usb_dev_handle * usb_open(struct usb_device *dev) { int err; err = libusb20_dev_open(dev->dev, 16 * 2); if (err == LIBUSB20_ERROR_BUSY) { /* * Workaround buggy USB applications which open the USB * device multiple times: */ return (dev->dev); } if (err) return (NULL); /* * Dequeue USB device from backend queue so that it does not get * freed when the backend is re-scanned: */ libusb20_be_dequeue_device(usb_backend, dev->dev); return (dev->dev); } int usb_close(usb_dev_handle * udev) { struct usb_device *dev; int err; err = libusb20_dev_close((void *)udev); if (err) return (-1); if (usb_backend != NULL) { /* * Enqueue USB device to backend queue so that it gets freed * when the backend is re-scanned: */ libusb20_be_enqueue_device(usb_backend, (void *)udev); } else { /* * The backend is gone. Free device data so that we * don't start leaking memory! */ dev = usb_device(udev); libusb20_dev_free((void *)udev); LIST_DEL(usb_global_bus.devices, dev); free(dev); } return (0); } int usb_get_string(usb_dev_handle * dev, int strindex, int langid, char *buf, size_t buflen) { int err; if (dev == NULL) return (-1); if (buflen > 65535) buflen = 65535; err = libusb20_dev_req_string_sync((void *)dev, strindex, langid, buf, buflen); if (err) return (-1); return (0); } int usb_get_string_simple(usb_dev_handle * dev, int strindex, char *buf, size_t buflen) { int err; if (dev == NULL) return (-1); if (buflen > 65535) buflen = 65535; err = libusb20_dev_req_string_simple_sync((void *)dev, strindex, buf, buflen); if (err) return (-1); return (strlen(buf)); } int usb_get_descriptor_by_endpoint(usb_dev_handle * udev, int ep, uint8_t type, uint8_t ep_index, void *buf, int size) { memset(buf, 0, size); if (udev == NULL) return (-1); if (size > 65535) size = 65535; return (usb_control_msg(udev, ep | USB_ENDPOINT_IN, USB_REQ_GET_DESCRIPTOR, (type << 8) + ep_index, 0, buf, size, 1000)); } int usb_get_descriptor(usb_dev_handle * udev, uint8_t type, uint8_t desc_index, void *buf, int size) { memset(buf, 0, size); if (udev == NULL) return (-1); if (size > 65535) size = 65535; return (usb_control_msg(udev, USB_ENDPOINT_IN, USB_REQ_GET_DESCRIPTOR, (type << 8) + desc_index, 0, buf, size, 1000)); } int usb_parse_descriptor(uint8_t *source, char *description, void *dest) { uint8_t *sp = source; uint8_t *dp = dest; uint16_t w; uint32_t d; char *cp; for (cp = description; *cp; cp++) { switch (*cp) { case 'b': /* 8-bit byte */ *dp++ = *sp++; break; /* * 16-bit word, convert from little endian to CPU */ case 'w': w = (sp[1] << 8) | sp[0]; sp += 2; /* Align to word boundary */ dp += ((dp - (uint8_t *)0) & 1); *((uint16_t *)dp) = w; dp += 2; break; /* * 32-bit dword, convert from little endian to CPU */ case 'd': d = (sp[3] << 24) | (sp[2] << 16) | (sp[1] << 8) | sp[0]; sp += 4; /* Align to word boundary */ dp += ((dp - (uint8_t *)0) & 1); /* Align to double word boundary */ dp += ((dp - (uint8_t *)0) & 2); *((uint32_t *)dp) = d; dp += 4; break; } } return (sp - source); } static void usb_parse_extra(struct usb_parse_state *ps, uint8_t **pptr, int *plen) { void *ptr; uint16_t len; ptr = ps->a.currextra->ptr; len = ps->a.currextra->len; if (ps->preparse == 0) { memcpy(ps->b.currextra, ptr, len); *pptr = ps->b.currextra; *plen = len; } ps->b.currextra += len; return; } static void usb_parse_endpoint(struct usb_parse_state *ps) { struct usb_endpoint_descriptor *bep; struct libusb20_endpoint *aep; aep = ps->a.currep; bep = ps->b.currep++; if (ps->preparse == 0) { /* copy descriptor fields */ bep->bLength = aep->desc.bLength; bep->bDescriptorType = aep->desc.bDescriptorType; bep->bEndpointAddress = aep->desc.bEndpointAddress; bep->bmAttributes = aep->desc.bmAttributes; bep->wMaxPacketSize = aep->desc.wMaxPacketSize; bep->bInterval = aep->desc.bInterval; bep->bRefresh = aep->desc.bRefresh; bep->bSynchAddress = aep->desc.bSynchAddress; } ps->a.currextra = &aep->extra; usb_parse_extra(ps, &bep->extra, &bep->extralen); return; } static void usb_parse_iface_sub(struct usb_parse_state *ps) { struct libusb20_interface *aifc; struct usb_interface_descriptor *bifc; uint8_t x; aifc = ps->a.currifc; bifc = ps->b.currifc++; if (ps->preparse == 0) { /* copy descriptor fields */ bifc->bLength = aifc->desc.bLength; bifc->bDescriptorType = aifc->desc.bDescriptorType; bifc->bInterfaceNumber = aifc->desc.bInterfaceNumber; bifc->bAlternateSetting = aifc->desc.bAlternateSetting; bifc->bNumEndpoints = aifc->num_endpoints; bifc->bInterfaceClass = aifc->desc.bInterfaceClass; bifc->bInterfaceSubClass = aifc->desc.bInterfaceSubClass; bifc->bInterfaceProtocol = aifc->desc.bInterfaceProtocol; bifc->iInterface = aifc->desc.iInterface; bifc->endpoint = ps->b.currep; } for (x = 0; x != aifc->num_endpoints; x++) { ps->a.currep = aifc->endpoints + x; usb_parse_endpoint(ps); } ps->a.currextra = &aifc->extra; usb_parse_extra(ps, &bifc->extra, &bifc->extralen); return; } static void usb_parse_iface(struct usb_parse_state *ps) { struct libusb20_interface *aifc; struct usb_interface *bifc; uint8_t x; aifc = ps->a.currifc; bifc = ps->b.currifcw++; if (ps->preparse == 0) { /* initialise interface wrapper */ bifc->altsetting = ps->b.currifc; bifc->num_altsetting = aifc->num_altsetting + 1; } usb_parse_iface_sub(ps); for (x = 0; x != aifc->num_altsetting; x++) { ps->a.currifc = aifc->altsetting + x; usb_parse_iface_sub(ps); } return; } static void usb_parse_config(struct usb_parse_state *ps) { struct libusb20_config *acfg; struct usb_config_descriptor *bcfg; uint8_t x; acfg = ps->a.currcfg; bcfg = ps->b.currcfg; if (ps->preparse == 0) { /* initialise config wrapper */ bcfg->bLength = acfg->desc.bLength; bcfg->bDescriptorType = acfg->desc.bDescriptorType; bcfg->wTotalLength = acfg->desc.wTotalLength; bcfg->bNumInterfaces = acfg->num_interface; bcfg->bConfigurationValue = acfg->desc.bConfigurationValue; bcfg->iConfiguration = acfg->desc.iConfiguration; bcfg->bmAttributes = acfg->desc.bmAttributes; bcfg->MaxPower = acfg->desc.bMaxPower; bcfg->interface = ps->b.currifcw; } for (x = 0; x != acfg->num_interface; x++) { ps->a.currifc = acfg->interface + x; usb_parse_iface(ps); } ps->a.currextra = &acfg->extra; usb_parse_extra(ps, &bcfg->extra, &bcfg->extralen); return; } int usb_parse_configuration(struct usb_config_descriptor *config, uint8_t *buffer) { struct usb_parse_state ps; uint8_t *ptr; uint32_t a; uint32_t b; uint32_t c; uint32_t d; if ((buffer == NULL) || (config == NULL)) { return (-1); } memset(&ps, 0, sizeof(ps)); ps.a.currcfg = libusb20_parse_config_desc(buffer); ps.b.currcfg = config; if (ps.a.currcfg == NULL) { /* could not parse config or out of memory */ return (-1); } /* do the pre-parse */ ps.preparse = 1; usb_parse_config(&ps); a = ((uint8_t *)(ps.b.currifcw) - ((uint8_t *)0)); b = ((uint8_t *)(ps.b.currifc) - ((uint8_t *)0)); c = ((uint8_t *)(ps.b.currep) - ((uint8_t *)0)); d = ((uint8_t *)(ps.b.currextra) - ((uint8_t *)0)); /* allocate memory for our configuration */ ptr = malloc(a + b + c + d); if (ptr == NULL) { /* free config structure */ free(ps.a.currcfg); return (-1); } /* "currifcw" must be first, hence this pointer is freed */ ps.b.currifcw = (void *)(ptr); ps.b.currifc = (void *)(ptr + a); ps.b.currep = (void *)(ptr + a + b); ps.b.currextra = (void *)(ptr + a + b + c); /* generate a libusb v0.1 compatible structure */ ps.preparse = 0; usb_parse_config(&ps); /* free config structure */ free(ps.a.currcfg); return (0); /* success */ } void usb_destroy_configuration(struct usb_device *dev) { uint8_t c; if (dev->config == NULL) { return; } for (c = 0; c != dev->descriptor.bNumConfigurations; c++) { struct usb_config_descriptor *cf = &dev->config[c]; if (cf->interface != NULL) { free(cf->interface); cf->interface = NULL; } } free(dev->config); dev->config = NULL; return; } void usb_fetch_and_parse_descriptors(usb_dev_handle * udev) { struct usb_device *dev; struct libusb20_device *pdev; uint8_t *ptr; int error; uint32_t size; uint16_t len; uint8_t x; if (udev == NULL) { /* be NULL safe */ return; } dev = usb_device(udev); pdev = (void *)udev; if (dev->descriptor.bNumConfigurations == 0) { /* invalid device */ return; } size = dev->descriptor.bNumConfigurations * sizeof(struct usb_config_descriptor); dev->config = malloc(size); if (dev->config == NULL) { /* out of memory */ return; } memset(dev->config, 0, size); for (x = 0; x != dev->descriptor.bNumConfigurations; x++) { error = (pdev->methods->get_config_desc_full) ( pdev, &ptr, &len, x); if (error) { usb_destroy_configuration(dev); return; } usb_parse_configuration(dev->config + x, ptr); /* free config buffer */ free(ptr); } return; } static int usb_std_io(usb_dev_handle * dev, int ep, char *bytes, int size, int timeout, int is_intr) { struct libusb20_transfer *xfer; uint32_t temp; uint32_t maxsize; uint32_t actlen; char *oldbytes; xfer = usb_get_transfer_by_ep_no(dev, ep); if (xfer == NULL) return (-1); if (libusb20_tr_pending(xfer)) { /* there is already a transfer ongoing */ return (-1); } maxsize = libusb20_tr_get_max_total_length(xfer); oldbytes = bytes; /* * We allow transferring zero bytes which is the same * equivalent to a zero length USB packet. */ do { temp = size; if (temp > maxsize) { /* find maximum possible length */ temp = maxsize; } if (is_intr) libusb20_tr_setup_intr(xfer, bytes, temp, timeout); else libusb20_tr_setup_bulk(xfer, bytes, temp, timeout); libusb20_tr_start(xfer); while (1) { if (libusb20_dev_process((void *)dev) != 0) { /* device detached */ return (-1); } if (libusb20_tr_pending(xfer) == 0) { /* transfer complete */ break; } /* wait for USB event from kernel */ libusb20_dev_wait_process((void *)dev, -1); } switch (libusb20_tr_get_status(xfer)) { case 0: /* success */ break; case LIBUSB20_TRANSFER_TIMED_OUT: /* transfer timeout */ return (-ETIMEDOUT); default: /* other transfer error */ return (-ENXIO); } actlen = libusb20_tr_get_actual_length(xfer); bytes += actlen; size -= actlen; if (actlen != temp) { /* short transfer */ break; } } while (size > 0); return (bytes - oldbytes); } int usb_bulk_write(usb_dev_handle * dev, int ep, char *bytes, int size, int timeout) { return (usb_std_io(dev, ep & ~USB_ENDPOINT_DIR_MASK, bytes, size, timeout, 0)); } int usb_bulk_read(usb_dev_handle * dev, int ep, char *bytes, int size, int timeout) { return (usb_std_io(dev, ep | USB_ENDPOINT_DIR_MASK, bytes, size, timeout, 0)); } int usb_interrupt_write(usb_dev_handle * dev, int ep, char *bytes, int size, int timeout) { return (usb_std_io(dev, ep & ~USB_ENDPOINT_DIR_MASK, bytes, size, timeout, 1)); } int usb_interrupt_read(usb_dev_handle * dev, int ep, char *bytes, int size, int timeout) { return (usb_std_io(dev, ep | USB_ENDPOINT_DIR_MASK, bytes, size, timeout, 1)); } int usb_control_msg(usb_dev_handle * dev, int requesttype, int request, int value, int wIndex, char *bytes, int size, int timeout) { struct LIBUSB20_CONTROL_SETUP_DECODED req; int err; uint16_t actlen; LIBUSB20_INIT(LIBUSB20_CONTROL_SETUP, &req); req.bmRequestType = requesttype; req.bRequest = request; req.wValue = value; req.wIndex = wIndex; req.wLength = size; err = libusb20_dev_request_sync((void *)dev, &req, bytes, &actlen, timeout, 0); if (err) return (-1); return (actlen); } int usb_set_configuration(usb_dev_handle * udev, int bConfigurationValue) { struct usb_device *dev; int err; uint8_t i; /* * Need to translate from "bConfigurationValue" to * configuration index: */ if (bConfigurationValue == 0) { /* unconfigure */ i = 255; } else { /* lookup configuration index */ dev = usb_device(udev); /* check if the configuration array is not there */ if (dev->config == NULL) { return (-1); } for (i = 0;; i++) { if (i == dev->descriptor.bNumConfigurations) { /* "bConfigurationValue" not found */ return (-1); } if ((dev->config + i)->bConfigurationValue == bConfigurationValue) { break; } } } err = libusb20_dev_set_config_index((void *)udev, i); if (err) return (-1); return (0); } int usb_claim_interface(usb_dev_handle * dev, int interface) { struct libusb20_device *pdev = (void *)dev; pdev->claimed_interface = interface; return (0); } int usb_release_interface(usb_dev_handle * dev, int interface) { /* do nothing */ return (0); } int usb_set_altinterface(usb_dev_handle * dev, int alternate) { struct libusb20_device *pdev = (void *)dev; int err; uint8_t iface; iface = pdev->claimed_interface; err = libusb20_dev_set_alt_index((void *)dev, iface, alternate); if (err) return (-1); return (0); } int usb_resetep(usb_dev_handle * dev, unsigned int ep) { /* emulate an endpoint reset through clear-STALL */ return (usb_clear_halt(dev, ep)); } int usb_clear_halt(usb_dev_handle * dev, unsigned int ep) { struct libusb20_transfer *xfer; xfer = usb_get_transfer_by_ep_no(dev, ep); if (xfer == NULL) return (-1); libusb20_tr_clear_stall_sync(xfer); return (0); } int usb_reset(usb_dev_handle * dev) { int err; err = libusb20_dev_reset((void *)dev); if (err) return (-1); /* * Be compatible with LibUSB from sourceforge and close the * handle after reset! */ return (usb_close(dev)); } int usb_check_connected(usb_dev_handle * dev) { int err; err = libusb20_dev_check_connected((void *)dev); if (err) return (-1); return (0); } const char * usb_strerror(void) { /* TODO */ return ("Unknown error"); } void usb_init(void) { /* nothing to do */ return; } void usb_set_debug(int level) { /* use kernel UGEN debugging if you need to see what is going on */ return; } int usb_find_busses(void) { usb_busses = &usb_global_bus; return (1); } int usb_find_devices(void) { struct libusb20_device *pdev; struct usb_device *udev; struct LIBUSB20_DEVICE_DESC_DECODED *ddesc; int devnum; int err; /* cleanup after last device search */ /* close all opened devices, if any */ while ((pdev = libusb20_be_device_foreach(usb_backend, NULL))) { udev = pdev->privLuData; libusb20_be_dequeue_device(usb_backend, pdev); libusb20_dev_free(pdev); if (udev != NULL) { LIST_DEL(usb_global_bus.devices, udev); free(udev); } } /* free old USB backend, if any */ libusb20_be_free(usb_backend); /* do a new backend device search */ usb_backend = libusb20_be_alloc_default(); if (usb_backend == NULL) { return (-1); } /* iterate all devices */ devnum = 1; pdev = NULL; while ((pdev = libusb20_be_device_foreach(usb_backend, pdev))) { udev = malloc(sizeof(*udev)); if (udev == NULL) break; memset(udev, 0, sizeof(*udev)); udev->bus = &usb_global_bus; snprintf(udev->filename, sizeof(udev->filename), "/dev/ugen%u.%u", libusb20_dev_get_bus_number(pdev), libusb20_dev_get_address(pdev)); ddesc = libusb20_dev_get_device_desc(pdev); udev->descriptor.bLength = sizeof(udev->descriptor); udev->descriptor.bDescriptorType = ddesc->bDescriptorType; udev->descriptor.bcdUSB = ddesc->bcdUSB; udev->descriptor.bDeviceClass = ddesc->bDeviceClass; udev->descriptor.bDeviceSubClass = ddesc->bDeviceSubClass; udev->descriptor.bDeviceProtocol = ddesc->bDeviceProtocol; udev->descriptor.bMaxPacketSize0 = ddesc->bMaxPacketSize0; udev->descriptor.idVendor = ddesc->idVendor; udev->descriptor.idProduct = ddesc->idProduct; udev->descriptor.bcdDevice = ddesc->bcdDevice; udev->descriptor.iManufacturer = ddesc->iManufacturer; udev->descriptor.iProduct = ddesc->iProduct; udev->descriptor.iSerialNumber = ddesc->iSerialNumber; udev->descriptor.bNumConfigurations = ddesc->bNumConfigurations; if (udev->descriptor.bNumConfigurations > USB_MAXCONFIG) { /* truncate number of configurations */ udev->descriptor.bNumConfigurations = USB_MAXCONFIG; } udev->devnum = devnum++; /* link together the two structures */ udev->dev = pdev; pdev->privLuData = udev; err = libusb20_dev_open(pdev, 0); if (err == 0) { /* XXX get all config descriptors by default */ usb_fetch_and_parse_descriptors((void *)pdev); libusb20_dev_close(pdev); } LIST_ADD(usb_global_bus.devices, udev); } return (devnum - 1); /* success */ } struct usb_device * usb_device(usb_dev_handle * dev) { struct libusb20_device *pdev; pdev = (void *)dev; return (pdev->privLuData); } struct usb_bus * usb_get_busses(void) { return (usb_busses); } int usb_get_driver_np(usb_dev_handle * dev, int interface, char *name, int namelen) { struct libusb20_device *pdev; char *ptr; int err; pdev = (void *)dev; if (pdev == NULL) return (-1); if (namelen < 1) return (-1); if (namelen > 255) namelen = 255; err = libusb20_dev_get_iface_desc(pdev, interface, name, namelen); if (err != 0) return (-1); /* we only want the driver name */ ptr = strstr(name, ":"); if (ptr != NULL) *ptr = 0; return (0); } int usb_detach_kernel_driver_np(usb_dev_handle * dev, int interface) { struct libusb20_device *pdev; int err; pdev = (void *)dev; if (pdev == NULL) return (-1); err = libusb20_dev_detach_kernel_driver(pdev, interface); if (err != 0) return (-1); return (0); }