| /**************************************************************************** |
| * drivers/usbhost/usbhost_skeleton.c |
| * |
| * Copyright (C) 2011 Gregory Nutt. All rights reserved. |
| * Author: Gregory Nutt <spudmonkey@racsa.co.cr> |
| * |
| * 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. |
| * 3. Neither the name NuttX nor the names of its contributors may be |
| * used to endorse or promote products derived from this software |
| * without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS 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 |
| * COPYRIGHT OWNER 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. |
| * |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Included Files |
| ****************************************************************************/ |
| |
| #include <nuttx/config.h> |
| |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <semaphore.h> |
| #include <assert.h> |
| #include <errno.h> |
| #include <debug.h> |
| |
| #include <nuttx/kmalloc.h> |
| #include <nuttx/fs/fs.h> |
| #include <nuttx/arch.h> |
| #include <nuttx/wqueue.h> |
| |
| #include <nuttx/usb/usb.h> |
| #include <nuttx/usb/usbhost.h> |
| |
| /**************************************************************************** |
| * Pre-processor Definitions |
| ****************************************************************************/ |
| |
| /* Configuration ************************************************************/ |
| |
| #ifndef CONFIG_SCHED_WORKQUEUE |
| # warning "Worker thread support is required (CONFIG_SCHED_WORKQUEUE)" |
| #endif |
| |
| /* Driver support ***********************************************************/ |
| /* This format is used to construct the /dev/skel[n] device driver path. It |
| * defined here so that it will be used consistently in all places. |
| */ |
| |
| #define DEV_FORMAT "/dev/skel%c" |
| #define DEV_NAMELEN 12 |
| |
| /* Used in usbhost_cfgdesc() */ |
| |
| #define USBHOST_IFFOUND 0x01 |
| #define USBHOST_BINFOUND 0x02 |
| #define USBHOST_BOUTFOUND 0x04 |
| #define USBHOST_ALLFOUND 0x07 |
| |
| #define USBHOST_MAX_CREFS 0x7fff |
| |
| /**************************************************************************** |
| * Private Types |
| ****************************************************************************/ |
| |
| /* This structure contains the internal, private state of the USB host class |
| * driver. |
| */ |
| |
| struct usbhost_state_s |
| { |
| /* This is the externally visible portion of the state */ |
| |
| struct usbhost_class_s class; |
| |
| /* This is an instance of the USB host driver bound to this class instance */ |
| |
| struct usbhost_driver_s *drvr; |
| |
| /* The remainder of the fields are provide to the class driver */ |
| |
| char devchar; /* Character identifying the /dev/skel[n] device */ |
| volatile bool disconnected; /* TRUE: Device has been disconnected */ |
| uint8_t ifno; /* Interface number */ |
| int16_t crefs; /* Reference count on the driver instance */ |
| sem_t exclsem; /* Used to maintain mutual exclusive access */ |
| struct work_s work; /* For interacting with the worker thread */ |
| FAR uint8_t *tbuffer; /* The allocated transfer buffer */ |
| size_t tbuflen; /* Size of the allocated transfer buffer */ |
| usbhost_ep_t epin; /* IN endpoint */ |
| usbhost_ep_t epout; /* OUT endpoint */ |
| }; |
| |
| /**************************************************************************** |
| * Private Function Prototypes |
| ****************************************************************************/ |
| |
| /* Semaphores */ |
| |
| static void usbhost_takesem(sem_t *sem); |
| #define usbhost_givesem(s) sem_post(s); |
| |
| /* Memory allocation services */ |
| |
| static inline FAR struct usbhost_state_s *usbhost_allocclass(void); |
| static inline void usbhost_freeclass(FAR struct usbhost_state_s *class); |
| |
| /* Device name management */ |
| |
| static int usbhost_allocdevno(FAR struct usbhost_state_s *priv); |
| static void usbhost_freedevno(FAR struct usbhost_state_s *priv); |
| static inline void usbhost_mkdevname(FAR struct usbhost_state_s *priv, char *devname); |
| |
| /* Worker thread actions */ |
| |
| static void usbhost_destroy(FAR void *arg); |
| |
| /* Helpers for usbhost_connect() */ |
| |
| static inline int usbhost_cfgdesc(FAR struct usbhost_state_s *priv, |
| FAR const uint8_t *configdesc, int desclen, |
| uint8_t funcaddr); |
| static inline int usbhost_devinit(FAR struct usbhost_state_s *priv); |
| |
| /* (Little Endian) Data helpers */ |
| |
| static inline uint16_t usbhost_getle16(const uint8_t *val); |
| static inline void usbhost_putle16(uint8_t *dest, uint16_t val); |
| static inline uint32_t usbhost_getle32(const uint8_t *val); |
| static void usbhost_putle32(uint8_t *dest, uint32_t val); |
| |
| /* Transfer descriptor memory management */ |
| |
| static inline int usbhost_talloc(FAR struct usbhost_state_s *priv); |
| static inline int usbhost_tfree(FAR struct usbhost_state_s *priv); |
| |
| /* struct usbhost_registry_s methods */ |
| |
| static struct usbhost_class_s *usbhost_create(FAR struct usbhost_driver_s *drvr, |
| FAR const struct usbhost_id_s *id); |
| |
| /* struct usbhost_class_s methods */ |
| |
| static int usbhost_connect(FAR struct usbhost_class_s *class, |
| FAR const uint8_t *configdesc, int desclen, |
| uint8_t funcaddr); |
| static int usbhost_disconnected(FAR struct usbhost_class_s *class); |
| |
| /* Driver methods -- depend upon the type of NuttX driver interface exported */ |
| |
| /**************************************************************************** |
| * Private Data |
| ****************************************************************************/ |
| |
| /* This structure provides the registry entry ID informatino that will be |
| * used to associate the USB class driver to a connected USB device. |
| */ |
| |
| static const const struct usbhost_id_s g_id = |
| { |
| 0, /* base -- Must be one of the USB_CLASS_* definitions in usb.h */ |
| 0, /* subclass -- depends on the device */ |
| 0, /* proto -- depends on the device */ |
| 0, /* vid */ |
| 0 /* pid */ |
| }; |
| |
| /* This is the USB host storage class's registry entry */ |
| |
| static struct usbhost_registry_s g_skeleton = |
| { |
| NULL, /* flink */ |
| usbhost_create, /* create */ |
| 1, /* nids */ |
| &g_id /* id[] */ |
| }; |
| |
| /* This is a bitmap that is used to allocate device names /dev/skela-z. */ |
| |
| static uint32_t g_devinuse; |
| |
| /**************************************************************************** |
| * Private Functions |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: usbhost_takesem |
| * |
| * Description: |
| * This is just a wrapper to handle the annoying behavior of semaphore |
| * waits that return due to the receipt of a signal. |
| * |
| ****************************************************************************/ |
| |
| static void usbhost_takesem(sem_t *sem) |
| { |
| /* Take the semaphore (perhaps waiting) */ |
| |
| while (sem_wait(sem) != 0) |
| { |
| /* The only case that an error should occr here is if the wait was |
| * awakened by a signal. |
| */ |
| |
| ASSERT(errno == EINTR); |
| } |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_allocclass |
| * |
| * Description: |
| * This is really part of the logic that implements the create() method |
| * of struct usbhost_registry_s. This function allocates memory for one |
| * new class instance. |
| * |
| * Input Parameters: |
| * None |
| * |
| * Returned Values: |
| * On success, this function will return a non-NULL instance of struct |
| * usbhost_class_s. NULL is returned on failure; this function will |
| * will fail only if there are insufficient resources to create another |
| * USB host class instance. |
| * |
| ****************************************************************************/ |
| |
| static inline FAR struct usbhost_state_s *usbhost_allocclass(void) |
| { |
| FAR struct usbhost_state_s *priv; |
| |
| DEBUGASSERT(!up_interrupt_context()); |
| priv = (FAR struct usbhost_state_s *)kmalloc(sizeof(struct usbhost_state_s)); |
| uvdbg("Allocated: %p\n", priv);; |
| return priv; |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_freeclass |
| * |
| * Description: |
| * Free a class instance previously allocated by usbhost_allocclass(). |
| * |
| * Input Parameters: |
| * class - A reference to the class instance to be freed. |
| * |
| * Returned Values: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static inline void usbhost_freeclass(FAR struct usbhost_state_s *class) |
| { |
| DEBUGASSERT(class != NULL); |
| |
| /* Free the class instance (perhaps calling sched_free() in case we are |
| * executing from an interrupt handler. |
| */ |
| |
| uvdbg("Freeing: %p\n", class);; |
| kfree(class); |
| } |
| |
| /**************************************************************************** |
| * Name: Device name management |
| * |
| * Description: |
| * Some tiny functions to coordinate management of device names. |
| * |
| ****************************************************************************/ |
| |
| static int usbhost_allocdevno(FAR struct usbhost_state_s *priv) |
| { |
| irqstate_t flags; |
| int devno; |
| |
| flags = irqsave(); |
| for (devno = 0; devno < 26; devno++) |
| { |
| uint32_t bitno = 1 << devno; |
| if ((g_devinuse & bitno) == 0) |
| { |
| g_devinuse |= bitno; |
| priv->devchar = 'a' + devno; |
| irqrestore(flags); |
| return OK; |
| } |
| } |
| |
| irqrestore(flags); |
| return -EMFILE; |
| } |
| |
| static void usbhost_freedevno(FAR struct usbhost_state_s *priv) |
| { |
| int devno = 'a' - priv->devchar; |
| |
| if (devno >= 0 && devno < 26) |
| { |
| irqstate_t flags = irqsave(); |
| g_devinuse &= ~(1 << devno); |
| irqrestore(flags); |
| } |
| } |
| |
| static inline void usbhost_mkdevname(FAR struct usbhost_state_s *priv, char *devname) |
| { |
| (void)snprintf(devname, DEV_NAMELEN, DEV_FORMAT, priv->devchar); |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_destroy |
| * |
| * Description: |
| * The USB device has been disconnected and the refernce count on the USB |
| * host class instance has gone to 1.. Time to destroy the USB host class |
| * instance. |
| * |
| * Input Parameters: |
| * arg - A reference to the class instance to be destroyed. |
| * |
| * Returned Values: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static void usbhost_destroy(FAR void *arg) |
| { |
| FAR struct usbhost_state_s *priv = (FAR struct usbhost_state_s *)arg; |
| |
| DEBUGASSERT(priv != NULL); |
| uvdbg("crefs: %d\n", priv->crefs); |
| |
| /* Unregister the driver */ |
| |
| /* Release the device name used by this connection */ |
| |
| usbhost_freedevno(priv); |
| |
| /* Free the endpoints */ |
| |
| /* Free any transfer buffers */ |
| |
| /* Destroy the semaphores */ |
| |
| /* Disconnect the USB host device */ |
| |
| DRVR_DISCONNECT(priv->drvr); |
| |
| /* And free the class instance. Hmmm.. this may execute on the worker |
| * thread and the work structure is part of what is getting freed. That |
| * should be okay because once the work contained is removed from the |
| * queue, it should not longer be accessed by the worker thread. |
| */ |
| |
| usbhost_freeclass(priv); |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_cfgdesc |
| * |
| * Description: |
| * This function implements the connect() method of struct |
| * usbhost_class_s. This method is a callback into the class |
| * implementation. It is used to provide the device's configuration |
| * descriptor to the class so that the class may initialize properly |
| * |
| * Input Parameters: |
| * priv - The USB host class instance. |
| * configdesc - A pointer to a uint8_t buffer container the configuration descripor. |
| * desclen - The length in bytes of the configuration descriptor. |
| * funcaddr - The USB address of the function containing the endpoint that EP0 |
| * controls |
| * |
| * Returned Values: |
| * On success, zero (OK) is returned. On a failure, a negated errno value is |
| * returned indicating the nature of the failure |
| * |
| * Assumptions: |
| * This function will *not* be called from an interrupt handler. |
| * |
| ****************************************************************************/ |
| |
| static inline int usbhost_cfgdesc(FAR struct usbhost_state_s *priv, |
| FAR const uint8_t *configdesc, int desclen, |
| uint8_t funcaddr) |
| { |
| FAR struct usb_cfgdesc_s *cfgdesc; |
| FAR struct usb_desc_s *desc; |
| FAR struct usbhost_epdesc_s bindesc; |
| FAR struct usbhost_epdesc_s boutdesc; |
| int remaining; |
| uint8_t found = 0; |
| int ret; |
| |
| DEBUGASSERT(priv != NULL && |
| configdesc != NULL && |
| desclen >= sizeof(struct usb_cfgdesc_s)); |
| |
| /* Verify that we were passed a configuration descriptor */ |
| |
| cfgdesc = (FAR struct usb_cfgdesc_s *)configdesc; |
| if (cfgdesc->type != USB_DESC_TYPE_CONFIG) |
| { |
| return -EINVAL; |
| } |
| |
| /* Get the total length of the configuration descriptor (little endian). |
| * It might be a good check to get the number of interfaces here too. |
| */ |
| |
| remaining = (int)usbhost_getle16(cfgdesc->totallen); |
| |
| /* Skip to the next entry descriptor */ |
| |
| configdesc += cfgdesc->len; |
| remaining -= cfgdesc->len; |
| |
| /* Loop where there are more dscriptors to examine */ |
| |
| while (remaining >= sizeof(struct usb_desc_s)) |
| { |
| /* What is the next descriptor? */ |
| |
| desc = (FAR struct usb_desc_s *)configdesc; |
| switch (desc->type) |
| { |
| /* Interface descriptor. We really should get the number of endpoints |
| * from this descriptor too. |
| */ |
| |
| case USB_DESC_TYPE_INTERFACE: |
| { |
| FAR struct usb_ifdesc_s *ifdesc = (FAR struct usb_ifdesc_s *)configdesc; |
| |
| uvdbg("Interface descriptor\n"); |
| DEBUGASSERT(remaining >= USB_SIZEOF_IFDESC); |
| |
| /* Save the interface number and mark ONLY the interface found */ |
| |
| priv->ifno = ifdesc->ifno; |
| found = USBHOST_IFFOUND; |
| } |
| break; |
| |
| /* Endpoint descriptor. Here, we expect two bulk endpoints, an IN |
| * and an OUT. |
| */ |
| |
| case USB_DESC_TYPE_ENDPOINT: |
| { |
| FAR struct usb_epdesc_s *epdesc = (FAR struct usb_epdesc_s *)configdesc; |
| |
| uvdbg("Endpoint descriptor\n"); |
| DEBUGASSERT(remaining >= USB_SIZEOF_EPDESC); |
| |
| /* Check for a bulk endpoint. */ |
| |
| if ((epdesc->attr & USB_EP_ATTR_XFERTYPE_MASK) == USB_EP_ATTR_XFER_BULK) |
| { |
| /* Yes.. it is a bulk endpoint. IN or OUT? */ |
| |
| if (USB_ISEPOUT(epdesc->addr)) |
| { |
| /* It is an OUT bulk endpoint. There should be only one |
| * bulk OUT endpoint. |
| */ |
| |
| if ((found & USBHOST_BOUTFOUND) != 0) |
| { |
| /* Oops.. more than one endpoint. We don't know |
| * what to do with this. |
| */ |
| |
| return -EINVAL; |
| } |
| found |= USBHOST_BOUTFOUND; |
| |
| /* Save the bulk OUT endpoint information */ |
| |
| boutdesc.addr = epdesc->addr & USB_EP_ADDR_NUMBER_MASK; |
| boutdesc.in = false; |
| boutdesc.funcaddr = funcaddr; |
| boutdesc.xfrtype = USB_EP_ATTR_XFER_BULK; |
| boutdesc.interval = epdesc->interval; |
| boutdesc.mxpacketsize = usbhost_getle16(epdesc->mxpacketsize); |
| uvdbg("Bulk OUT EP addr:%d mxpacketsize:%d\n", |
| boutdesc.addr, boutdesc.mxpacketsize); |
| } |
| else |
| { |
| /* It is an IN bulk endpoint. There should be only one |
| * bulk IN endpoint. |
| */ |
| |
| if ((found & USBHOST_BINFOUND) != 0) |
| { |
| /* Oops.. more than one endpoint. We don't know |
| * what to do with this. |
| */ |
| |
| return -EINVAL; |
| } |
| found |= USBHOST_BINFOUND; |
| |
| /* Save the bulk IN endpoint information */ |
| |
| bindesc.addr = epdesc->addr & USB_EP_ADDR_NUMBER_MASK; |
| bindesc.in = 1; |
| bindesc.funcaddr = funcaddr; |
| bindesc.xfrtype = USB_EP_ATTR_XFER_BULK; |
| bindesc.interval = epdesc->interval; |
| bindesc.mxpacketsize = usbhost_getle16(epdesc->mxpacketsize); |
| uvdbg("Bulk IN EP addr:%d mxpacketsize:%d\n", |
| bindesc.addr, bindesc.mxpacketsize); |
| } |
| } |
| } |
| break; |
| |
| /* Other descriptors are just ignored for now */ |
| |
| default: |
| break; |
| } |
| |
| /* If we found everything we need with this interface, then break out |
| * of the loop early. |
| */ |
| |
| if (found == USBHOST_ALLFOUND) |
| { |
| break; |
| } |
| |
| /* Increment the address of the next descriptor */ |
| |
| configdesc += desc->len; |
| remaining -= desc->len; |
| } |
| |
| /* Sanity checking... did we find all of things that we need? */ |
| |
| if (found != USBHOST_ALLFOUND) |
| { |
| ulldbg("ERROR: Found IF:%s BIN:%s BOUT:%s\n", |
| (found & USBHOST_IFFOUND) != 0 ? "YES" : "NO", |
| (found & USBHOST_BINFOUND) != 0 ? "YES" : "NO", |
| (found & USBHOST_BOUTFOUND) != 0 ? "YES" : "NO"); |
| return -EINVAL; |
| } |
| |
| /* We are good... Allocate the endpoints */ |
| |
| ret = DRVR_EPALLOC(priv->drvr, &boutdesc, &priv->epout); |
| if (ret != OK) |
| { |
| udbg("ERROR: Failed to allocate Bulk OUT endpoint\n"); |
| return ret; |
| } |
| |
| ret = DRVR_EPALLOC(priv->drvr, &bindesc, &priv->epin); |
| if (ret != OK) |
| { |
| udbg("ERROR: Failed to allocate Bulk IN endpoint\n"); |
| (void)DRVR_EPFREE(priv->drvr, priv->epout); |
| return ret; |
| } |
| |
| ullvdbg("Endpoints allocated\n"); |
| return OK; |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_devinit |
| * |
| * Description: |
| * The USB device has been successfully connected. This completes the |
| * initialization operations. It is first called after the |
| * configuration descriptor has been received. |
| * |
| * This function is called from the connect() method. This function always |
| * executes on the thread of the caller of connect(). |
| * |
| * Input Parameters: |
| * priv - A reference to the class instance. |
| * |
| * Returned Values: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static inline int usbhost_devinit(FAR struct usbhost_state_s *priv) |
| { |
| int ret = OK; |
| |
| /* Set aside a transfer buffer for exclusive use by the class driver */ |
| |
| /* Increment the reference count. This will prevent usbhost_destroy() from |
| * being called asynchronously if the device is removed. |
| */ |
| |
| priv->crefs++; |
| DEBUGASSERT(priv->crefs == 2); |
| |
| /* Configure the device */ |
| |
| /* Register the driver */ |
| |
| if (ret == OK) |
| { |
| char devname[DEV_NAMELEN]; |
| |
| uvdbg("Register block driver\n"); |
| usbhost_mkdevname(priv, devname); |
| // ret = register_blockdriver(devname, &g_bops, 0, priv); |
| } |
| |
| /* Check if we successfully initialized. We now have to be concerned |
| * about asynchronous modification of crefs because the block |
| * driver has been registerd. |
| */ |
| |
| if (ret == OK) |
| { |
| usbhost_takesem(&priv->exclsem); |
| DEBUGASSERT(priv->crefs >= 2); |
| |
| /* Handle a corner case where (1) open() has been called so the |
| * reference count is > 2, but the device has been disconnected. |
| * In this case, the class instance needs to persist until close() |
| * is called. |
| */ |
| |
| if (priv->crefs <= 2 && priv->disconnected) |
| { |
| /* We don't have to give the semaphore because it will be |
| * destroyed when usb_destroy is called. |
| */ |
| |
| ret = -ENODEV; |
| } |
| else |
| { |
| /* Ready for normal operation as a block device driver */ |
| |
| uvdbg("Successfully initialized\n"); |
| priv->crefs--; |
| usbhost_givesem(&priv->exclsem); |
| } |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_getle16 |
| * |
| * Description: |
| * Get a (possibly unaligned) 16-bit little endian value. |
| * |
| * Input Parameters: |
| * val - A pointer to the first byte of the little endian value. |
| * |
| * Returned Values: |
| * A uint16_t representing the whole 16-bit integer value |
| * |
| ****************************************************************************/ |
| |
| static inline uint16_t usbhost_getle16(const uint8_t *val) |
| { |
| return (uint16_t)val[1] << 8 | (uint16_t)val[0]; |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_putle16 |
| * |
| * Description: |
| * Put a (possibly unaligned) 16-bit little endian value. |
| * |
| * Input Parameters: |
| * dest - A pointer to the first byte to save the little endian value. |
| * val - The 16-bit value to be saved. |
| * |
| * Returned Values: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static void usbhost_putle16(uint8_t *dest, uint16_t val) |
| { |
| dest[0] = val & 0xff; /* Little endian means LS byte first in byte stream */ |
| dest[1] = val >> 8; |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_getle32 |
| * |
| * Description: |
| * Get a (possibly unaligned) 32-bit little endian value. |
| * |
| * Input Parameters: |
| * dest - A pointer to the first byte to save the big endian value. |
| * val - The 32-bit value to be saved. |
| * |
| * Returned Values: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static inline uint32_t usbhost_getle32(const uint8_t *val) |
| { |
| /* Little endian means LS halfword first in byte stream */ |
| |
| return (uint32_t)usbhost_getle16(&val[2]) << 16 | (uint32_t)usbhost_getle16(val); |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_putle32 |
| * |
| * Description: |
| * Put a (possibly unaligned) 32-bit little endian value. |
| * |
| * Input Parameters: |
| * dest - A pointer to the first byte to save the little endian value. |
| * val - The 32-bit value to be saved. |
| * |
| * Returned Values: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static void usbhost_putle32(uint8_t *dest, uint32_t val) |
| { |
| /* Little endian means LS halfword first in byte stream */ |
| |
| usbhost_putle16(dest, (uint16_t)(val & 0xffff)); |
| usbhost_putle16(dest+2, (uint16_t)(val >> 16)); |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_talloc |
| * |
| * Description: |
| * Allocate transfer buffer memory. |
| * |
| * Input Parameters: |
| * priv - A reference to the class instance. |
| * |
| * Returned Values: |
| * On sucess, zero (OK) is returned. On failure, an negated errno value |
| * is returned to indicate the nature of the failure. |
| * |
| ****************************************************************************/ |
| |
| static inline int usbhost_talloc(FAR struct usbhost_state_s *priv) |
| { |
| DEBUGASSERT(priv && priv->tbuffer == NULL); |
| return DRVR_ALLOC(priv->drvr, &priv->tbuffer, &priv->tbuflen); |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_tfree |
| * |
| * Description: |
| * Free transfer buffer memory. |
| * |
| * Input Parameters: |
| * priv - A reference to the class instance. |
| * |
| * Returned Values: |
| * On sucess, zero (OK) is returned. On failure, an negated errno value |
| * is returned to indicate the nature of the failure. |
| * |
| ****************************************************************************/ |
| |
| static inline int usbhost_tfree(FAR struct usbhost_state_s *priv) |
| { |
| int result = OK; |
| DEBUGASSERT(priv); |
| |
| if (priv->tbuffer) |
| { |
| DEBUGASSERT(priv->drvr); |
| result = DRVR_FREE(priv->drvr, priv->tbuffer); |
| priv->tbuffer = NULL; |
| priv->tbuflen = 0; |
| } |
| return result; |
| } |
| |
| /**************************************************************************** |
| * struct usbhost_registry_s methods |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: usbhost_create |
| * |
| * Description: |
| * This function implements the create() method of struct usbhost_registry_s. |
| * The create() method is a callback into the class implementation. It is |
| * used to (1) create a new instance of the USB host class state and to (2) |
| * bind a USB host driver "session" to the class instance. Use of this |
| * create() method will support environments where there may be multiple |
| * USB ports and multiple USB devices simultaneously connected. |
| * |
| * Input Parameters: |
| * drvr - An instance of struct usbhost_driver_s that the class |
| * implementation will "bind" to its state structure and will |
| * subsequently use to communicate with the USB host driver. |
| * id - In the case where the device supports multiple base classes, |
| * subclasses, or protocols, this specifies which to configure for. |
| * |
| * Returned Values: |
| * On success, this function will return a non-NULL instance of struct |
| * usbhost_class_s that can be used by the USB host driver to communicate |
| * with the USB host class. NULL is returned on failure; this function |
| * will fail only if the drvr input parameter is NULL or if there are |
| * insufficient resources to create another USB host class instance. |
| * |
| ****************************************************************************/ |
| |
| static FAR struct usbhost_class_s *usbhost_create(FAR struct usbhost_driver_s *drvr, |
| FAR const struct usbhost_id_s *id) |
| { |
| FAR struct usbhost_state_s *priv; |
| |
| /* Allocate a USB host class instance */ |
| |
| priv = usbhost_allocclass(); |
| if (priv) |
| { |
| /* Initialize the allocated storage class instance */ |
| |
| memset(priv, 0, sizeof(struct usbhost_state_s)); |
| |
| /* Assign a device number to this class instance */ |
| |
| if (usbhost_allocdevno(priv) == OK) |
| { |
| /* Initialize class method function pointers */ |
| |
| priv->class.connect = usbhost_connect; |
| priv->class.disconnected = usbhost_disconnected; |
| |
| /* The initial reference count is 1... One reference is held by the driver */ |
| |
| priv->crefs = 1; |
| |
| /* Initialize semphores (this works okay in the interrupt context) */ |
| |
| sem_init(&priv->exclsem, 0, 1); |
| |
| /* Bind the driver to the storage class instance */ |
| |
| priv->drvr = drvr; |
| |
| /* Return the instance of the USB class driver */ |
| |
| return &priv->class; |
| } |
| } |
| |
| /* An error occurred. Free the allocation and return NULL on all failures */ |
| |
| if (priv) |
| { |
| usbhost_freeclass(priv); |
| } |
| return NULL; |
| } |
| |
| /**************************************************************************** |
| * struct usbhost_class_s methods |
| ****************************************************************************/ |
| /**************************************************************************** |
| * Name: usbhost_connect |
| * |
| * Description: |
| * This function implements the connect() method of struct |
| * usbhost_class_s. This method is a callback into the class |
| * implementation. It is used to provide the device's configuration |
| * descriptor to the class so that the class may initialize properly |
| * |
| * Input Parameters: |
| * class - The USB host class entry previously obtained from a call to create(). |
| * configdesc - A pointer to a uint8_t buffer container the configuration descripor. |
| * desclen - The length in bytes of the configuration descriptor. |
| * funcaddr - The USB address of the function containing the endpoint that EP0 |
| * controls |
| * |
| * Returned Values: |
| * On success, zero (OK) is returned. On a failure, a negated errno value is |
| * returned indicating the nature of the failure |
| * |
| * NOTE that the class instance remains valid upon return with a failure. It is |
| * the responsibility of the higher level enumeration logic to call |
| * CLASS_DISCONNECTED to free up the class driver resources. |
| * |
| * Assumptions: |
| * - This function will *not* be called from an interrupt handler. |
| * - If this function returns an error, the USB host controller driver |
| * must call to DISCONNECTED method to recover from the error |
| * |
| ****************************************************************************/ |
| |
| static int usbhost_connect(FAR struct usbhost_class_s *class, |
| FAR const uint8_t *configdesc, int desclen, |
| uint8_t funcaddr) |
| { |
| FAR struct usbhost_state_s *priv = (FAR struct usbhost_state_s *)class; |
| int ret; |
| |
| DEBUGASSERT(priv != NULL && |
| configdesc != NULL && |
| desclen >= sizeof(struct usb_cfgdesc_s)); |
| |
| /* Parse the configuration descriptor to get the endpoints */ |
| |
| ret = usbhost_cfgdesc(priv, configdesc, desclen, funcaddr); |
| if (ret != OK) |
| { |
| udbg("usbhost_cfgdesc() failed: %d\n", ret); |
| } |
| else |
| { |
| /* Now configure the device and register the NuttX driver */ |
| |
| ret = usbhost_devinit(priv); |
| if (ret != OK) |
| { |
| udbg("usbhost_devinit() failed: %d\n", ret); |
| } |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: usbhost_disconnected |
| * |
| * Description: |
| * This function implements the disconnected() method of struct |
| * usbhost_class_s. This method is a callback into the class |
| * implementation. It is used to inform the class that the USB device has |
| * been disconnected. |
| * |
| * Input Parameters: |
| * class - The USB host class entry previously obtained from a call to |
| * create(). |
| * |
| * Returned Values: |
| * On success, zero (OK) is returned. On a failure, a negated errno value |
| * is returned indicating the nature of the failure |
| * |
| * Assumptions: |
| * This function may be called from an interrupt handler. |
| * |
| ****************************************************************************/ |
| |
| static int usbhost_disconnected(struct usbhost_class_s *class) |
| { |
| FAR struct usbhost_state_s *priv = (FAR struct usbhost_state_s *)class; |
| irqstate_t flags; |
| |
| DEBUGASSERT(priv != NULL); |
| |
| /* Set an indication to any users of the device that the device is no |
| * longer available. |
| */ |
| |
| flags = irqsave(); |
| priv->disconnected = true; |
| |
| /* Now check the number of references on the class instance. If it is one, |
| * then we can free the class instance now. Otherwise, we will have to |
| * wait until the holders of the references free them by closing the |
| * block driver. |
| */ |
| |
| ullvdbg("crefs: %d\n", priv->crefs); |
| if (priv->crefs == 1) |
| { |
| /* Destroy the class instance. If we are executing from an interrupt |
| * handler, then defer the destruction to the worker thread. |
| * Otherwise, destroy the instance now. |
| */ |
| |
| if (up_interrupt_context()) |
| { |
| /* Destroy the instance on the worker thread. */ |
| |
| uvdbg("Queuing destruction: worker %p->%p\n", priv->work.worker, usbhost_destroy); |
| DEBUGASSERT(priv->work.worker == NULL); |
| (void)work_queue(&priv->work, usbhost_destroy, priv, 0); |
| } |
| else |
| { |
| /* Do the work now */ |
| |
| usbhost_destroy(priv); |
| } |
| } |
| |
| irqrestore(flags); |
| return OK; |
| } |
| |
| /**************************************************************************** |
| * Public Functions |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: usbhost_skelinit |
| * |
| * Description: |
| * Initialize the USB class driver. This function should be called |
| * be platform-specific code in order to initialize and register support |
| * for the USB host class device. |
| * |
| * Input Parameters: |
| * None |
| * |
| * Returned Values: |
| * On success this function will return zero (OK); A negated errno value |
| * will be returned on failure. |
| * |
| ****************************************************************************/ |
| |
| int usbhost_skelinit(void) |
| { |
| /* Perform any one-time initialization of the class implementation */ |
| |
| /* Advertise our availability to support (certain) devices */ |
| |
| return usbhost_registerclass(&g_skeleton); |
| } |