summaryrefslogtreecommitdiffstats
path: root/lib/libusb/libusb20.c
diff options
context:
space:
mode:
authorthompsa <thompsa@FreeBSD.org>2009-03-09 17:09:46 +0000
committerthompsa <thompsa@FreeBSD.org>2009-03-09 17:09:46 +0000
commitb95f7329df6e4c18574c02802a132848e5955244 (patch)
tree1a660dc6369df9725d748f63f8b5222d3a420a1c /lib/libusb/libusb20.c
parent4aa75fa98d0391c03bb764e4ef26baa6e4f0d6d8 (diff)
downloadFreeBSD-src-b95f7329df6e4c18574c02802a132848e5955244.zip
FreeBSD-src-b95f7329df6e4c18574c02802a132848e5955244.tar.gz
libusb20 is now installed as libusb, remove the version number from the
directory name.
Diffstat (limited to 'lib/libusb/libusb20.c')
-rw-r--r--lib/libusb/libusb20.c1141
1 files changed, 1141 insertions, 0 deletions
diff --git a/lib/libusb/libusb20.c b/lib/libusb/libusb20.c
new file mode 100644
index 0000000..704480a
--- /dev/null
+++ b/lib/libusb/libusb20.c
@@ -0,0 +1,1141 @@
+/* $FreeBSD$ */
+/*-
+ * 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.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <poll.h>
+#include <ctype.h>
+#include <sys/queue.h>
+
+#include "libusb20.h"
+#include "libusb20_desc.h"
+#include "libusb20_int.h"
+
+static int
+dummy_int(void)
+{
+ return (LIBUSB20_ERROR_NOT_SUPPORTED);
+}
+
+static void
+dummy_void(void)
+{
+ return;
+}
+
+static void
+dummy_callback(struct libusb20_transfer *xfer)
+{
+ ; /* style fix */
+ switch (libusb20_tr_get_status(xfer)) {
+ case LIBUSB20_TRANSFER_START:
+ libusb20_tr_submit(xfer);
+ break;
+ default:
+ /* complete or error */
+ break;
+ }
+ return;
+}
+
+#define dummy_get_config_desc_full (void *)dummy_int
+#define dummy_get_config_index (void *)dummy_int
+#define dummy_set_config_index (void *)dummy_int
+#define dummy_claim_interface (void *)dummy_int
+#define dummy_release_interface (void *)dummy_int
+#define dummy_set_alt_index (void *)dummy_int
+#define dummy_reset_device (void *)dummy_int
+#define dummy_set_power_mode (void *)dummy_int
+#define dummy_get_power_mode (void *)dummy_int
+#define dummy_kernel_driver_active (void *)dummy_int
+#define dummy_detach_kernel_driver (void *)dummy_int
+#define dummy_do_request_sync (void *)dummy_int
+#define dummy_tr_open (void *)dummy_int
+#define dummy_tr_close (void *)dummy_int
+#define dummy_tr_clear_stall_sync (void *)dummy_int
+#define dummy_process (void *)dummy_int
+#define dummy_dev_info (void *)dummy_int
+#define dummy_dev_get_iface_driver (void *)dummy_int
+
+#define dummy_tr_submit (void *)dummy_void
+#define dummy_tr_cancel_async (void *)dummy_void
+
+static const struct libusb20_device_methods libusb20_dummy_methods = {
+ LIBUSB20_DEVICE(LIBUSB20_DECLARE, dummy)
+};
+
+void
+libusb20_tr_callback_wrapper(struct libusb20_transfer *xfer)
+{
+ ; /* style fix */
+
+repeat:
+
+ if (!xfer->is_pending) {
+ xfer->status = LIBUSB20_TRANSFER_START;
+ } else {
+ xfer->is_pending = 0;
+ }
+
+ xfer->callback(xfer);
+
+ if (xfer->is_restart) {
+ xfer->is_restart = 0;
+ goto repeat;
+ }
+ if (xfer->is_draining &&
+ (!xfer->is_pending)) {
+ xfer->is_draining = 0;
+ xfer->status = LIBUSB20_TRANSFER_DRAINED;
+ xfer->callback(xfer);
+ }
+ return;
+}
+
+int
+libusb20_tr_close(struct libusb20_transfer *xfer)
+{
+ int error;
+
+ if (!xfer->is_opened) {
+ return (LIBUSB20_ERROR_OTHER);
+ }
+ error = xfer->pdev->methods->tr_close(xfer);
+
+ if (xfer->pLength) {
+ free(xfer->pLength);
+ }
+ if (xfer->ppBuffer) {
+ free(xfer->ppBuffer);
+ }
+ /* clear some fields */
+ xfer->is_opened = 0;
+ xfer->maxFrames = 0;
+ xfer->maxTotalLength = 0;
+ xfer->maxPacketLen = 0;
+ return (error);
+}
+
+int
+libusb20_tr_open(struct libusb20_transfer *xfer, uint32_t MaxBufSize,
+ uint32_t MaxFrameCount, uint8_t ep_no)
+{
+ uint32_t size;
+ int error;
+
+ if (xfer->is_opened) {
+ return (LIBUSB20_ERROR_BUSY);
+ }
+ if (MaxFrameCount == 0) {
+ return (LIBUSB20_ERROR_INVALID_PARAM);
+ }
+ xfer->maxFrames = MaxFrameCount;
+
+ size = MaxFrameCount * sizeof(xfer->pLength[0]);
+ xfer->pLength = malloc(size);
+ if (xfer->pLength == NULL) {
+ return (LIBUSB20_ERROR_NO_MEM);
+ }
+ memset(xfer->pLength, 0, size);
+
+ size = MaxFrameCount * sizeof(xfer->ppBuffer[0]);
+ xfer->ppBuffer = malloc(size);
+ if (xfer->ppBuffer == NULL) {
+ free(xfer->pLength);
+ return (LIBUSB20_ERROR_NO_MEM);
+ }
+ memset(xfer->ppBuffer, 0, size);
+
+ error = xfer->pdev->methods->tr_open(xfer, MaxBufSize,
+ MaxFrameCount, ep_no);
+
+ if (error) {
+ free(xfer->ppBuffer);
+ free(xfer->pLength);
+ } else {
+ xfer->is_opened = 1;
+ }
+ return (error);
+}
+
+struct libusb20_transfer *
+libusb20_tr_get_pointer(struct libusb20_device *pdev, uint16_t trIndex)
+{
+ if (trIndex >= pdev->nTransfer) {
+ return (NULL);
+ }
+ return (pdev->pTransfer + trIndex);
+}
+
+uint32_t
+libusb20_tr_get_actual_frames(struct libusb20_transfer *xfer)
+{
+ return (xfer->aFrames);
+}
+
+uint16_t
+libusb20_tr_get_time_complete(struct libusb20_transfer *xfer)
+{
+ return (xfer->timeComplete);
+}
+
+uint32_t
+libusb20_tr_get_actual_length(struct libusb20_transfer *xfer)
+{
+ uint32_t x;
+ uint32_t actlen = 0;
+
+ for (x = 0; x != xfer->aFrames; x++) {
+ actlen += xfer->pLength[x];
+ }
+ return (actlen);
+}
+
+uint32_t
+libusb20_tr_get_max_frames(struct libusb20_transfer *xfer)
+{
+ return (xfer->maxFrames);
+}
+
+uint32_t
+libusb20_tr_get_max_packet_length(struct libusb20_transfer *xfer)
+{
+ /*
+ * Special Case NOTE: If the packet multiplier is non-zero for
+ * High Speed USB, the value returned is equal to
+ * "wMaxPacketSize * multiplier" !
+ */
+ return (xfer->maxPacketLen);
+}
+
+uint32_t
+libusb20_tr_get_max_total_length(struct libusb20_transfer *xfer)
+{
+ return (xfer->maxTotalLength);
+}
+
+uint8_t
+libusb20_tr_get_status(struct libusb20_transfer *xfer)
+{
+ return (xfer->status);
+}
+
+uint8_t
+libusb20_tr_pending(struct libusb20_transfer *xfer)
+{
+ return (xfer->is_pending);
+}
+
+void *
+libusb20_tr_get_priv_sc0(struct libusb20_transfer *xfer)
+{
+ return (xfer->priv_sc0);
+}
+
+void *
+libusb20_tr_get_priv_sc1(struct libusb20_transfer *xfer)
+{
+ return (xfer->priv_sc1);
+}
+
+void
+libusb20_tr_stop(struct libusb20_transfer *xfer)
+{
+ if (!xfer->is_pending) {
+ /* transfer not pending */
+ return;
+ }
+ if (xfer->is_cancel) {
+ /* already cancelling */
+ return;
+ }
+ xfer->is_cancel = 1; /* we are cancelling */
+
+ xfer->pdev->methods->tr_cancel_async(xfer);
+ return;
+}
+
+void
+libusb20_tr_drain(struct libusb20_transfer *xfer)
+{
+ /* make sure that we are cancelling */
+ libusb20_tr_stop(xfer);
+
+ if (xfer->is_pending) {
+ xfer->is_draining = 1;
+ }
+ return;
+}
+
+void
+libusb20_tr_clear_stall_sync(struct libusb20_transfer *xfer)
+{
+ xfer->pdev->methods->tr_clear_stall_sync(xfer);
+ return;
+}
+
+void
+libusb20_tr_set_buffer(struct libusb20_transfer *xfer, void *buffer, uint16_t frIndex)
+{
+ xfer->ppBuffer[frIndex] = buffer;
+ return;
+}
+
+void
+libusb20_tr_set_callback(struct libusb20_transfer *xfer, libusb20_tr_callback_t *cb)
+{
+ xfer->callback = cb;
+ return;
+}
+
+void
+libusb20_tr_set_flags(struct libusb20_transfer *xfer, uint8_t flags)
+{
+ xfer->flags = flags;
+ return;
+}
+
+void
+libusb20_tr_set_length(struct libusb20_transfer *xfer, uint32_t length, uint16_t frIndex)
+{
+ xfer->pLength[frIndex] = length;
+ return;
+}
+
+void
+libusb20_tr_set_priv_sc0(struct libusb20_transfer *xfer, void *sc0)
+{
+ xfer->priv_sc0 = sc0;
+ return;
+}
+
+void
+libusb20_tr_set_priv_sc1(struct libusb20_transfer *xfer, void *sc1)
+{
+ xfer->priv_sc1 = sc1;
+ return;
+}
+
+void
+libusb20_tr_set_timeout(struct libusb20_transfer *xfer, uint32_t timeout)
+{
+ xfer->timeout = timeout;
+ return;
+}
+
+void
+libusb20_tr_set_total_frames(struct libusb20_transfer *xfer, uint32_t nFrames)
+{
+ if (nFrames > xfer->maxFrames) {
+ /* should not happen */
+ nFrames = xfer->maxFrames;
+ }
+ xfer->nFrames = nFrames;
+ return;
+}
+
+void
+libusb20_tr_setup_bulk(struct libusb20_transfer *xfer, void *pBuf, uint32_t length, uint32_t timeout)
+{
+ xfer->ppBuffer[0] = pBuf;
+ xfer->pLength[0] = length;
+ xfer->timeout = timeout;
+ xfer->nFrames = 1;
+ return;
+}
+
+void
+libusb20_tr_setup_control(struct libusb20_transfer *xfer, void *psetup, void *pBuf, uint32_t timeout)
+{
+ uint16_t len;
+
+ xfer->ppBuffer[0] = psetup;
+ xfer->pLength[0] = 8; /* fixed */
+ xfer->timeout = timeout;
+
+ len = ((uint8_t *)psetup)[6] | (((uint8_t *)psetup)[7] << 8);
+
+ if (len != 0) {
+ xfer->nFrames = 2;
+ xfer->ppBuffer[1] = pBuf;
+ xfer->pLength[1] = len;
+ } else {
+ xfer->nFrames = 1;
+ }
+ return;
+}
+
+void
+libusb20_tr_setup_intr(struct libusb20_transfer *xfer, void *pBuf, uint32_t length, uint32_t timeout)
+{
+ xfer->ppBuffer[0] = pBuf;
+ xfer->pLength[0] = length;
+ xfer->timeout = timeout;
+ xfer->nFrames = 1;
+ return;
+}
+
+void
+libusb20_tr_setup_isoc(struct libusb20_transfer *xfer, void *pBuf, uint32_t length, uint16_t frIndex)
+{
+ if (frIndex >= xfer->maxFrames) {
+ /* should not happen */
+ return;
+ }
+ xfer->ppBuffer[frIndex] = pBuf;
+ xfer->pLength[frIndex] = length;
+ return;
+}
+
+void
+libusb20_tr_submit(struct libusb20_transfer *xfer)
+{
+ if (xfer->is_pending) {
+ /* should not happen */
+ return;
+ }
+ xfer->is_pending = 1; /* we are pending */
+ xfer->is_cancel = 0; /* not cancelling */
+ xfer->is_restart = 0; /* not restarting */
+
+ xfer->pdev->methods->tr_submit(xfer);
+ return;
+}
+
+void
+libusb20_tr_start(struct libusb20_transfer *xfer)
+{
+ if (xfer->is_pending) {
+ if (xfer->is_cancel) {
+ /* cancelling - restart */
+ xfer->is_restart = 1;
+ }
+ /* transfer not pending */
+ return;
+ }
+ /* get into the callback */
+ libusb20_tr_callback_wrapper(xfer);
+ return;
+}
+
+/* USB device operations */
+
+int
+libusb20_dev_claim_interface(struct libusb20_device *pdev, uint8_t ifaceIndex)
+{
+ int error;
+
+ if (ifaceIndex >= 32) {
+ error = LIBUSB20_ERROR_INVALID_PARAM;
+ } else if (pdev->claimed_interfaces & (1 << ifaceIndex)) {
+ error = LIBUSB20_ERROR_NOT_FOUND;
+ } else {
+ error = pdev->methods->claim_interface(pdev, ifaceIndex);
+ }
+ if (!error) {
+ pdev->claimed_interfaces |= (1 << ifaceIndex);
+ }
+ return (error);
+}
+
+int
+libusb20_dev_close(struct libusb20_device *pdev)
+{
+ struct libusb20_transfer *xfer;
+ uint16_t x;
+ int error = 0;
+
+ if (!pdev->is_opened) {
+ return (LIBUSB20_ERROR_OTHER);
+ }
+ for (x = 0; x != pdev->nTransfer; x++) {
+ xfer = pdev->pTransfer + x;
+
+ libusb20_tr_drain(xfer);
+ }
+
+ if (pdev->pTransfer != NULL) {
+ free(pdev->pTransfer);
+ pdev->pTransfer = NULL;
+ }
+ error = pdev->beMethods->close_device(pdev);
+
+ pdev->methods = &libusb20_dummy_methods;
+
+ pdev->is_opened = 0;
+
+ pdev->claimed_interfaces = 0;
+
+ return (error);
+}
+
+int
+libusb20_dev_detach_kernel_driver(struct libusb20_device *pdev, uint8_t ifaceIndex)
+{
+ int error;
+
+ error = pdev->methods->detach_kernel_driver(pdev, ifaceIndex);
+ return (error);
+}
+
+struct LIBUSB20_DEVICE_DESC_DECODED *
+libusb20_dev_get_device_desc(struct libusb20_device *pdev)
+{
+ return (&(pdev->ddesc));
+}
+
+int
+libusb20_dev_get_fd(struct libusb20_device *pdev)
+{
+ return (pdev->file);
+}
+
+int
+libusb20_dev_kernel_driver_active(struct libusb20_device *pdev, uint8_t ifaceIndex)
+{
+ int error;
+
+ error = pdev->methods->kernel_driver_active(pdev, ifaceIndex);
+ return (error);
+}
+
+int
+libusb20_dev_open(struct libusb20_device *pdev, uint16_t nTransferMax)
+{
+ struct libusb20_transfer *xfer;
+ uint32_t size;
+ uint16_t x;
+ int error;
+
+ if (pdev->is_opened) {
+ return (LIBUSB20_ERROR_BUSY);
+ }
+ if (nTransferMax >= 256) {
+ return (LIBUSB20_ERROR_INVALID_PARAM);
+ } else if (nTransferMax != 0) {
+ size = sizeof(pdev->pTransfer[0]) * nTransferMax;
+ pdev->pTransfer = malloc(size);
+ if (pdev->pTransfer == NULL) {
+ return (LIBUSB20_ERROR_NO_MEM);
+ }
+ memset(pdev->pTransfer, 0, size);
+ }
+ /* initialise all transfers */
+ for (x = 0; x != nTransferMax; x++) {
+
+ xfer = pdev->pTransfer + x;
+
+ xfer->pdev = pdev;
+ xfer->trIndex = x;
+ xfer->callback = &dummy_callback;
+ }
+
+ /* set "nTransfer" early */
+ pdev->nTransfer = nTransferMax;
+
+ error = pdev->beMethods->open_device(pdev, nTransferMax);
+
+ if (error) {
+ if (pdev->pTransfer != NULL) {
+ free(pdev->pTransfer);
+ pdev->pTransfer = NULL;
+ }
+ pdev->file = -1;
+ pdev->file_ctrl = -1;
+ pdev->nTransfer = 0;
+ } else {
+ pdev->is_opened = 1;
+ }
+ return (error);
+}
+
+int
+libusb20_dev_release_interface(struct libusb20_device *pdev, uint8_t ifaceIndex)
+{
+ int error;
+
+ if (ifaceIndex >= 32) {
+ error = LIBUSB20_ERROR_INVALID_PARAM;
+ } else if (!(pdev->claimed_interfaces & (1 << ifaceIndex))) {
+ error = LIBUSB20_ERROR_NOT_FOUND;
+ } else {
+ error = pdev->methods->release_interface(pdev, ifaceIndex);
+ }
+ if (!error) {
+ pdev->claimed_interfaces &= ~(1 << ifaceIndex);
+ }
+ return (error);
+}
+
+int
+libusb20_dev_reset(struct libusb20_device *pdev)
+{
+ int error;
+
+ error = pdev->methods->reset_device(pdev);
+ return (error);
+}
+
+int
+libusb20_dev_set_power_mode(struct libusb20_device *pdev, uint8_t power_mode)
+{
+ int error;
+
+ error = pdev->methods->set_power_mode(pdev, power_mode);
+ return (error);
+}
+
+uint8_t
+libusb20_dev_get_power_mode(struct libusb20_device *pdev)
+{
+ int error;
+ uint8_t power_mode;
+
+ error = pdev->methods->get_power_mode(pdev, &power_mode);
+ if (error)
+ power_mode = LIBUSB20_POWER_ON; /* fake power mode */
+ return (power_mode);
+}
+
+int
+libusb20_dev_set_alt_index(struct libusb20_device *pdev, uint8_t ifaceIndex, uint8_t altIndex)
+{
+ int error;
+
+ error = pdev->methods->set_alt_index(pdev, ifaceIndex, altIndex);
+ return (error);
+}
+
+int
+libusb20_dev_set_config_index(struct libusb20_device *pdev, uint8_t configIndex)
+{
+ int error;
+
+ error = pdev->methods->set_config_index(pdev, configIndex);
+ return (error);
+}
+
+int
+libusb20_dev_request_sync(struct libusb20_device *pdev,
+ struct LIBUSB20_CONTROL_SETUP_DECODED *setup, void *data,
+ uint16_t *pactlen, uint32_t timeout, uint8_t flags)
+{
+ int error;
+
+ error = pdev->methods->do_request_sync(pdev,
+ setup, data, pactlen, timeout, flags);
+ return (error);
+}
+
+int
+libusb20_dev_req_string_sync(struct libusb20_device *pdev,
+ uint8_t str_index, uint16_t langid, void *ptr, uint16_t len)
+{
+ struct LIBUSB20_CONTROL_SETUP_DECODED req;
+ int error;
+
+ if (len < 4) {
+ /* invalid length */
+ return (LIBUSB20_ERROR_INVALID_PARAM);
+ }
+ LIBUSB20_INIT(LIBUSB20_CONTROL_SETUP, &req);
+
+ /*
+ * We need to read the USB string in two steps else some USB
+ * devices will complain.
+ */
+ req.bmRequestType =
+ LIBUSB20_REQUEST_TYPE_STANDARD |
+ LIBUSB20_RECIPIENT_DEVICE |
+ LIBUSB20_ENDPOINT_IN;
+ req.bRequest = LIBUSB20_REQUEST_GET_DESCRIPTOR;
+ req.wValue = (LIBUSB20_DT_STRING << 8) | str_index;
+ req.wIndex = langid;
+ req.wLength = 4; /* bytes */
+
+ error = libusb20_dev_request_sync(pdev, &req,
+ ptr, NULL, 1000, LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK);
+ if (error) {
+ return (error);
+ }
+ req.wLength = *(uint8_t *)ptr; /* bytes */
+ if (req.wLength > len) {
+ /* partial string read */
+ req.wLength = len;
+ }
+ error = libusb20_dev_request_sync(pdev, &req,
+ ptr, NULL, 1000, LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK);
+
+ if (error) {
+ return (error);
+ }
+ if (((uint8_t *)ptr)[1] != LIBUSB20_DT_STRING) {
+ return (LIBUSB20_ERROR_OTHER);
+ }
+ return (0); /* success */
+}
+
+int
+libusb20_dev_req_string_simple_sync(struct libusb20_device *pdev,
+ uint8_t str_index, void *ptr, uint16_t len)
+{
+ char *buf;
+ int error;
+ uint16_t langid;
+ uint16_t n;
+ uint16_t i;
+ uint16_t c;
+ uint8_t temp[255];
+ uint8_t swap;
+
+ /* the following code derives from the FreeBSD USB kernel */
+
+ if ((len < 1) || (ptr == NULL)) {
+ /* too short buffer */
+ return (LIBUSB20_ERROR_INVALID_PARAM);
+ }
+ error = libusb20_dev_req_string_sync(pdev,
+ 0, 0, temp, sizeof(temp));
+ if (error < 0) {
+ *(uint8_t *)ptr = 0; /* zero terminate */
+ return (error);
+ }
+ langid = temp[2] | (temp[3] << 8);
+
+ error = libusb20_dev_req_string_sync(pdev, str_index,
+ langid, temp, sizeof(temp));
+ if (error < 0) {
+ *(uint8_t *)ptr = 0; /* zero terminate */
+ return (error);
+ }
+ if (temp[0] < 2) {
+ /* string length is too short */
+ *(uint8_t *)ptr = 0; /* zero terminate */
+ return (LIBUSB20_ERROR_OTHER);
+ }
+ /* reserve one byte for terminating zero */
+ len--;
+
+ /* find maximum length */
+ n = (temp[0] / 2) - 1;
+ if (n > len) {
+ n = len;
+ }
+ /* reset swap state */
+ swap = 3;
+
+ /* setup output buffer pointer */
+ buf = ptr;
+
+ /* convert and filter */
+ for (i = 0; (i != n); i++) {
+ c = temp[(2 * i) + 2] | (temp[(2 * i) + 3] << 8);
+
+ /* convert from Unicode, handle buggy strings */
+ if (((c & 0xff00) == 0) && (swap & 1)) {
+ /* Little Endian, default */
+ *buf = c;
+ swap = 1;
+ } else if (((c & 0x00ff) == 0) && (swap & 2)) {
+ /* Big Endian */
+ *buf = c >> 8;
+ swap = 2;
+ } else {
+ /* skip invalid character */
+ continue;
+ }
+ /*
+ * Filter by default - we don't allow greater and less than
+ * signs because they might confuse the dmesg printouts!
+ */
+ if ((*buf == '<') || (*buf == '>') || (!isprint(*buf))) {
+ /* skip invalid character */
+ continue;
+ }
+ buf++;
+ }
+ *buf = 0; /* zero terminate string */
+
+ return (0);
+}
+
+struct libusb20_config *
+libusb20_dev_alloc_config(struct libusb20_device *pdev, uint8_t configIndex)
+{
+ struct libusb20_config *retval = NULL;
+ uint8_t *ptr;
+ uint16_t len;
+ uint8_t do_close;
+ int error;
+
+ if (!pdev->is_opened) {
+ error = libusb20_dev_open(pdev, 0);
+ if (error) {
+ return (NULL);
+ }
+ do_close = 1;
+ } else {
+ do_close = 0;
+ }
+ error = pdev->methods->get_config_desc_full(pdev,
+ &ptr, &len, configIndex);
+
+ if (error) {
+ goto done;
+ }
+ /* parse new config descriptor */
+ retval = libusb20_parse_config_desc(ptr);
+
+ /* free config descriptor */
+ free(ptr);
+
+done:
+ if (do_close) {
+ error = libusb20_dev_close(pdev);
+ }
+ return (retval);
+}
+
+struct libusb20_device *
+libusb20_dev_alloc(void)
+{
+ struct libusb20_device *pdev;
+
+ pdev = malloc(sizeof(*pdev));
+ if (pdev == NULL) {
+ return (NULL);
+ }
+ memset(pdev, 0, sizeof(*pdev));
+
+ pdev->file = -1;
+ pdev->file_ctrl = -1;
+ pdev->methods = &libusb20_dummy_methods;
+ return (pdev);
+}
+
+uint8_t
+libusb20_dev_get_config_index(struct libusb20_device *pdev)
+{
+ int error;
+ uint8_t cfg_index;
+ uint8_t do_close;
+
+ if (!pdev->is_opened) {
+ error = libusb20_dev_open(pdev, 0);
+ if (error == 0) {
+ do_close = 1;
+ } else {
+ do_close = 0;
+ }
+ } else {
+ do_close = 0;
+ }
+
+ error = pdev->methods->get_config_index(pdev, &cfg_index);
+ if (error) {
+ cfg_index = 0 - 1; /* current config index */
+ }
+ if (do_close) {
+ if (libusb20_dev_close(pdev)) {
+ /* ignore */
+ }
+ }
+ return (cfg_index);
+}
+
+uint8_t
+libusb20_dev_get_mode(struct libusb20_device *pdev)
+{
+ return (pdev->usb_mode);
+}
+
+uint8_t
+libusb20_dev_get_speed(struct libusb20_device *pdev)
+{
+ return (pdev->usb_speed);
+}
+
+/* if this function returns an error, the device is gone */
+int
+libusb20_dev_process(struct libusb20_device *pdev)
+{
+ int error;
+
+ error = pdev->methods->process(pdev);
+ return (error);
+}
+
+void
+libusb20_dev_wait_process(struct libusb20_device *pdev, int timeout)
+{
+ struct pollfd pfd[1];
+
+ if (!pdev->is_opened) {
+ return;
+ }
+ pfd[0].fd = pdev->file;
+ pfd[0].events = (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM);
+ pfd[0].revents = 0;
+
+ if (poll(pfd, 1, timeout)) {
+ /* ignore any error */
+ }
+ return;
+}
+
+void
+libusb20_dev_free(struct libusb20_device *pdev)
+{
+ if (pdev == NULL) {
+ /* be NULL safe */
+ return;
+ }
+ if (pdev->is_opened) {
+ if (libusb20_dev_close(pdev)) {
+ /* ignore any errors */
+ }
+ }
+ free(pdev);
+ return;
+}
+
+int
+libusb20_dev_get_info(struct libusb20_device *pdev,
+ struct usb2_device_info *pinfo)
+{
+ if (pinfo == NULL)
+ return (LIBUSB20_ERROR_INVALID_PARAM);
+
+ return (pdev->beMethods->dev_get_info(pdev, pinfo));
+}
+
+const char *
+libusb20_dev_get_backend_name(struct libusb20_device *pdev)
+{
+ return (pdev->beMethods->get_backend_name());
+}
+
+const char *
+libusb20_dev_get_desc(struct libusb20_device *pdev)
+{
+ return (pdev->usb_desc);
+}
+
+void
+libusb20_dev_set_debug(struct libusb20_device *pdev, int debug)
+{
+ pdev->debug = debug;
+ return;
+}
+
+int
+libusb20_dev_get_debug(struct libusb20_device *pdev)
+{
+ return (pdev->debug);
+}
+
+uint8_t
+libusb20_dev_get_address(struct libusb20_device *pdev)
+{
+ return (pdev->device_address);
+}
+
+uint8_t
+libusb20_dev_get_bus_number(struct libusb20_device *pdev)
+{
+ return (pdev->bus_number);
+}
+
+int
+libusb20_dev_get_iface_desc(struct libusb20_device *pdev,
+ uint8_t iface_index, char *buf, uint8_t len)
+{
+ if ((buf == NULL) || (len == 0))
+ return (LIBUSB20_ERROR_INVALID_PARAM);
+
+ return (pdev->beMethods->dev_get_iface_desc(
+ pdev, iface_index, buf, len));
+}
+
+/* USB backend operations */
+
+int
+libusb20_be_get_dev_quirk(struct libusb20_backend *pbe,
+ uint16_t quirk_index, struct libusb20_quirk *pq)
+{
+ return (pbe->methods->root_get_dev_quirk(pbe, quirk_index, pq));
+}
+
+int
+libusb20_be_get_quirk_name(struct libusb20_backend *pbe,
+ uint16_t quirk_index, struct libusb20_quirk *pq)
+{
+ return (pbe->methods->root_get_quirk_name(pbe, quirk_index, pq));
+}
+
+int
+libusb20_be_add_dev_quirk(struct libusb20_backend *pbe,
+ struct libusb20_quirk *pq)
+{
+ return (pbe->methods->root_add_dev_quirk(pbe, pq));
+}
+
+int
+libusb20_be_remove_dev_quirk(struct libusb20_backend *pbe,
+ struct libusb20_quirk *pq)
+{
+ return (pbe->methods->root_remove_dev_quirk(pbe, pq));
+}
+
+int
+libusb20_be_set_template(struct libusb20_backend *pbe, int temp)
+{
+ return (pbe->methods->root_set_template(pbe, temp));
+}
+
+int
+libusb20_be_get_template(struct libusb20_backend *pbe, int *ptemp)
+{
+ int temp;
+
+ if (ptemp == NULL)
+ ptemp = &temp;
+
+ return (pbe->methods->root_get_template(pbe, ptemp));
+}
+
+struct libusb20_device *
+libusb20_be_device_foreach(struct libusb20_backend *pbe, struct libusb20_device *pdev)
+{
+ if (pbe == NULL) {
+ pdev = NULL;
+ } else if (pdev == NULL) {
+ pdev = TAILQ_FIRST(&(pbe->usb_devs));
+ } else {
+ pdev = TAILQ_NEXT(pdev, dev_entry);
+ }
+ return (pdev);
+}
+
+struct libusb20_backend *
+libusb20_be_alloc(const struct libusb20_backend_methods *methods)
+{
+ struct libusb20_backend *pbe;
+
+ pbe = malloc(sizeof(*pbe));
+ if (pbe == NULL) {
+ return (NULL);
+ }
+ memset(pbe, 0, sizeof(*pbe));
+
+ TAILQ_INIT(&(pbe->usb_devs));
+
+ pbe->methods = methods; /* set backend methods */
+
+ /* do the initial device scan */
+ if (pbe->methods->init_backend) {
+ pbe->methods->init_backend(pbe);
+ }
+ return (pbe);
+}
+
+struct libusb20_backend *
+libusb20_be_alloc_linux(void)
+{
+ struct libusb20_backend *pbe;
+
+#ifdef __linux__
+ pbe = libusb20_be_alloc(&libusb20_linux_backend);
+#else
+ pbe = NULL;
+#endif
+ return (pbe);
+}
+
+struct libusb20_backend *
+libusb20_be_alloc_ugen20(void)
+{
+ struct libusb20_backend *pbe;
+
+#ifdef __FreeBSD__
+ pbe = libusb20_be_alloc(&libusb20_ugen20_backend);
+#else
+ pbe = NULL;
+#endif
+ return (pbe);
+}
+
+struct libusb20_backend *
+libusb20_be_alloc_default(void)
+{
+ struct libusb20_backend *pbe;
+
+ pbe = libusb20_be_alloc_linux();
+ if (pbe) {
+ return (pbe);
+ }
+ pbe = libusb20_be_alloc_ugen20();
+ if (pbe) {
+ return (pbe);
+ }
+ return (NULL); /* no backend found */
+}
+
+void
+libusb20_be_free(struct libusb20_backend *pbe)
+{
+ struct libusb20_device *pdev;
+
+ if (pbe == NULL) {
+ /* be NULL safe */
+ return;
+ }
+ while ((pdev = libusb20_be_device_foreach(pbe, NULL))) {
+ libusb20_be_dequeue_device(pbe, pdev);
+ libusb20_dev_free(pdev);
+ }
+ if (pbe->methods->exit_backend) {
+ pbe->methods->exit_backend(pbe);
+ }
+ return;
+}
+
+void
+libusb20_be_enqueue_device(struct libusb20_backend *pbe, struct libusb20_device *pdev)
+{
+ pdev->beMethods = pbe->methods; /* copy backend methods */
+ TAILQ_INSERT_TAIL(&(pbe->usb_devs), pdev, dev_entry);
+ return;
+}
+
+void
+libusb20_be_dequeue_device(struct libusb20_backend *pbe,
+ struct libusb20_device *pdev)
+{
+ TAILQ_REMOVE(&(pbe->usb_devs), pdev, dev_entry);
+ return;
+}
OpenPOWER on IntegriCloud