d9b42cebe7
Resolution of Issue 619 will require multiple steps, this part of the first step in that resolution: Every call to nxsem_wait_uninterruptible() must handle the return value from nxsem_wait_uninterruptible properly. This commit is only for those files under drivers/usbhost.
2360 lines
68 KiB
C
2360 lines
68 KiB
C
/****************************************************************************
|
|
* drivers/usbhost/usbhost_storage.c
|
|
*
|
|
* Licensed to the Apache Software Foundation (ASF) under one or more
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
* this work for additional information regarding copyright ownership. The
|
|
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
|
* "License"); you may not use this file except in compliance with the
|
|
* License. You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
* License for the specific language governing permissions and limitations
|
|
* under the License.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <assert.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
|
|
#include <nuttx/irq.h>
|
|
#include <nuttx/kmalloc.h>
|
|
#include <nuttx/signal.h>
|
|
#include <nuttx/arch.h>
|
|
#include <nuttx/wqueue.h>
|
|
#include <nuttx/scsi.h>
|
|
#include <nuttx/fs/fs.h>
|
|
#include <nuttx/semaphore.h>
|
|
|
|
#include <nuttx/usb/usb.h>
|
|
#include <nuttx/usb/usbhost.h>
|
|
#include <nuttx/usb/storage.h>
|
|
#include <nuttx/usb/usbhost_devaddr.h>
|
|
|
|
/* Don't compile if prerequisites are not met */
|
|
|
|
#if defined(CONFIG_USBHOST) && !defined(CONFIG_USBHOST_BULK_DISABLE) && \
|
|
!defined(CONFIG_DISABLE_MOUNTPOINT)
|
|
|
|
/****************************************************************************
|
|
* Pre-processor Definitions
|
|
****************************************************************************/
|
|
|
|
/* Configuration ************************************************************/
|
|
|
|
#ifndef CONFIG_SCHED_WORKQUEUE
|
|
# warning "Worker thread support is required (CONFIG_SCHED_WORKQUEUE)"
|
|
#endif
|
|
|
|
/* If the create() method is called by the USB host device driver from an
|
|
* interrupt handler, then it will be unable to call kmm_malloc() in order to
|
|
* allocate a new class instance. If the create() method is called from the
|
|
* interrupt level, then class instances must be pre-allocated.
|
|
*/
|
|
|
|
#ifndef CONFIG_USBHOST_NPREALLOC
|
|
# define CONFIG_USBHOST_NPREALLOC 0
|
|
#endif
|
|
|
|
#if CONFIG_USBHOST_NPREALLOC > 26
|
|
# error "Currently limited to 26 devices /dev/sda-z"
|
|
#endif
|
|
|
|
/* Driver support ***********************************************************/
|
|
|
|
/* This format is used to construct the /dev/sd[n] device driver path. It
|
|
* defined here so that it will be used consistently in all places.
|
|
*/
|
|
|
|
#define DEV_FORMAT "/dev/sd%c"
|
|
#define DEV_NAMELEN 10
|
|
|
|
/* Used in usbhost_connect() */
|
|
|
|
#define USBHOST_IFFOUND 0x01
|
|
#define USBHOST_BINFOUND 0x02
|
|
#define USBHOST_BOUTFOUND 0x04
|
|
#define USBHOST_ALLFOUND 0x07
|
|
|
|
#define USBHOST_RETRY_USEC (50*1000) /* Retry each 50 milliseconds */
|
|
#define USBHOST_MAX_RETRIES 100 /* Give up after 5 seconds */
|
|
#define USBHOST_MAX_CREFS INT16_MAX /* Max cref count before signed overflow */
|
|
|
|
/****************************************************************************
|
|
* Private Types
|
|
****************************************************************************/
|
|
|
|
/* This structure contains the internal, private state of the USB host mass
|
|
* storage class.
|
|
*/
|
|
|
|
struct usbhost_state_s
|
|
{
|
|
/* This is the externally visible portion of the state */
|
|
|
|
struct usbhost_class_s usbclass;
|
|
|
|
/* The remainder of the fields are provide to the mass storage class */
|
|
|
|
char sdchar; /* Character identifying the /dev/sd[n] device */
|
|
volatile bool disconnected; /* TRUE: Device has been disconnected */
|
|
uint8_t ifno; /* Interface number */
|
|
int16_t crefs; /* Reference count on the driver instance */
|
|
uint16_t blocksize; /* Block size of USB mass storage device */
|
|
uint32_t nblocks; /* Number of blocks on the USB mass storage device */
|
|
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 bulkin; /* Bulk IN endpoint */
|
|
usbhost_ep_t bulkout; /* Bulk OUT endpoint */
|
|
};
|
|
|
|
/* This is how struct usbhost_state_s looks to the free list logic */
|
|
|
|
struct usbhost_freestate_s
|
|
{
|
|
FAR struct usbhost_freestate_s *flink;
|
|
};
|
|
|
|
/****************************************************************************
|
|
* Private Function Prototypes
|
|
****************************************************************************/
|
|
|
|
/* Semaphores */
|
|
|
|
static int usbhost_takesem(FAR sem_t *sem);
|
|
static void usbhost_forcetake(FAR sem_t *sem);
|
|
#define usbhost_givesem(s) nxsem_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 *usbclass);
|
|
|
|
/* 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,
|
|
FAR char *devname);
|
|
|
|
/* CBW/CSW debug helpers */
|
|
|
|
#if defined(CONFIG_DEBUG_USB) && defined(CONFIG_DEBUG_INFO)
|
|
static void usbhost_dumpcbw(FAR struct usbmsc_cbw_s *cbw);
|
|
static void usbhost_dumpcsw(FAR struct usbmsc_csw_s *csw);
|
|
#else
|
|
# define usbhost_dumpcbw(cbw);
|
|
# define usbhost_dumpcsw(csw);
|
|
#endif
|
|
|
|
/* CBW helpers */
|
|
|
|
static inline void usbhost_requestsensecbw(FAR struct usbmsc_cbw_s *cbw);
|
|
static inline void usbhost_testunitreadycbw(FAR struct usbmsc_cbw_s *cbw);
|
|
static inline void usbhost_readcapacitycbw(FAR struct usbmsc_cbw_s *cbw);
|
|
static inline void usbhost_inquirycbw (FAR struct usbmsc_cbw_s *cbw);
|
|
static inline void usbhost_readcbw (size_t startsector, uint16_t blocksize,
|
|
unsigned int nsectors,
|
|
FAR struct usbmsc_cbw_s *cbw);
|
|
static inline void usbhost_writecbw(size_t startsector, uint16_t blocksize,
|
|
unsigned int nsectors,
|
|
FAR struct usbmsc_cbw_s *cbw);
|
|
|
|
/* Command helpers */
|
|
|
|
static inline int usbhost_maxlunreq(FAR struct usbhost_state_s *priv);
|
|
static inline int usbhost_testunitready(FAR struct usbhost_state_s *priv);
|
|
static inline int usbhost_requestsense(FAR struct usbhost_state_s *priv);
|
|
static inline int usbhost_readcapacity(FAR struct usbhost_state_s *priv);
|
|
static inline int usbhost_inquiry(FAR struct usbhost_state_s *priv);
|
|
|
|
/* 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);
|
|
static inline int usbhost_initvolume(FAR struct usbhost_state_s *priv);
|
|
|
|
/* (Little Endian) Data helpers */
|
|
|
|
static inline uint16_t usbhost_getle16(const uint8_t *val);
|
|
static inline uint16_t usbhost_getbe16(const uint8_t *val);
|
|
static inline void usbhost_putle16(uint8_t *dest, uint16_t val);
|
|
static inline void usbhost_putbe16(uint8_t *dest, uint16_t val);
|
|
static inline uint32_t usbhost_getle32(const uint8_t *val);
|
|
static inline uint32_t usbhost_getbe32(const uint8_t *val);
|
|
static void usbhost_putle32(uint8_t *dest, uint32_t val);
|
|
static void usbhost_putbe32(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);
|
|
static FAR struct usbmsc_cbw_s *
|
|
usbhost_cbwalloc(FAR struct usbhost_state_s *priv);
|
|
|
|
/* struct usbhost_registry_s methods */
|
|
|
|
static struct usbhost_class_s *
|
|
usbhost_create(FAR struct usbhost_hubport_s *hport,
|
|
FAR const struct usbhost_id_s *id);
|
|
|
|
/* struct usbhost_class_s methods */
|
|
|
|
static int usbhost_connect(FAR struct usbhost_class_s *usbclass,
|
|
FAR const uint8_t *configdesc, int desclen);
|
|
static int usbhost_disconnected(FAR struct usbhost_class_s *usbclass);
|
|
|
|
/* struct block_operations methods */
|
|
|
|
static int usbhost_open(FAR struct inode *inode);
|
|
static int usbhost_close(FAR struct inode *inode);
|
|
static ssize_t usbhost_read(FAR struct inode *inode,
|
|
FAR unsigned char *buffer, size_t startsector,
|
|
unsigned int nsectors);
|
|
static ssize_t usbhost_write(FAR struct inode *inode,
|
|
FAR const unsigned char *buffer,
|
|
size_t startsector, unsigned int nsectors);
|
|
static int usbhost_geometry(FAR struct inode *inode,
|
|
FAR struct geometry *geometry);
|
|
static int usbhost_ioctl(FAR struct inode *inode, int cmd,
|
|
unsigned long arg);
|
|
|
|
/****************************************************************************
|
|
* Private Data
|
|
****************************************************************************/
|
|
|
|
/* This structure provides the registry entry ID information that will be
|
|
* used to associate the USB host mass storage class to a connected USB
|
|
* device.
|
|
*/
|
|
|
|
static const struct usbhost_id_s g_id =
|
|
{
|
|
USB_CLASS_MASS_STORAGE, /* base */
|
|
USBMSC_SUBCLASS_SCSI, /* subclass */
|
|
USBMSC_PROTO_BULKONLY, /* proto */
|
|
0, /* vid */
|
|
0 /* pid */
|
|
};
|
|
|
|
/* This is the USB host storage class's registry entry */
|
|
|
|
static struct usbhost_registry_s g_storage =
|
|
{
|
|
NULL, /* flink */
|
|
usbhost_create, /* create */
|
|
1, /* nids */
|
|
&g_id /* id[] */
|
|
};
|
|
|
|
/* Block driver operations. This is the interface exposed to NuttX by the
|
|
* class that permits it to behave like a block driver.
|
|
*/
|
|
|
|
static const struct block_operations g_bops =
|
|
{
|
|
usbhost_open, /* open */
|
|
usbhost_close, /* close */
|
|
usbhost_read, /* read */
|
|
usbhost_write, /* write */
|
|
usbhost_geometry, /* geometry */
|
|
usbhost_ioctl /* ioctl */
|
|
};
|
|
|
|
/* This is an array of pre-allocated USB host storage class instances */
|
|
|
|
#if CONFIG_USBHOST_NPREALLOC > 0
|
|
static struct usbhost_state_s g_prealloc[CONFIG_USBHOST_NPREALLOC];
|
|
#endif
|
|
|
|
/* This is a list of free, pre-allocated USB host storage class instances */
|
|
|
|
#if CONFIG_USBHOST_NPREALLOC > 0
|
|
static FAR struct usbhost_freestate_s *g_freelist;
|
|
#endif
|
|
|
|
/* This is a bitmap that is used to allocate device names /dev/sda-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 int usbhost_takesem(FAR sem_t *sem)
|
|
{
|
|
return nxsem_wait_uninterruptible(sem);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_forcetake
|
|
*
|
|
* Description:
|
|
* This is just another wrapper but this one continues even if the thread
|
|
* is canceled. This must be done in certain conditions where were must
|
|
* continue in order to clean-up resources.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static void usbhost_forcetake(FAR sem_t *sem)
|
|
{
|
|
int ret;
|
|
|
|
do
|
|
{
|
|
ret = nxsem_wait_uninterruptible(sem);
|
|
|
|
/* The only expected error would -ECANCELED meaning that the
|
|
* parent thread has been canceled. We have to continue and
|
|
* terminate the poll in this case.
|
|
*/
|
|
|
|
DEBUGASSERT(ret == OK || ret == -ECANCELED);
|
|
}
|
|
while (ret < 0);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* 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 Value:
|
|
* 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.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#if CONFIG_USBHOST_NPREALLOC > 0
|
|
static inline FAR struct usbhost_state_s *usbhost_allocclass(void)
|
|
{
|
|
FAR struct usbhost_freestate_s *entry;
|
|
irqstate_t flags;
|
|
|
|
/* We may be executing from an interrupt handler so we need to take one of
|
|
* our pre-allocated class instances from the free list.
|
|
*/
|
|
|
|
flags = enter_critical_section();
|
|
entry = g_freelist;
|
|
if (entry)
|
|
{
|
|
g_freelist = entry->flink;
|
|
}
|
|
|
|
leave_critical_section(flags);
|
|
uinfo("Allocated: %p\n", entry);
|
|
return (FAR struct usbhost_state_s *)entry;
|
|
}
|
|
#else
|
|
static inline FAR struct usbhost_state_s *usbhost_allocclass(void)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
|
|
/* We are not executing from an interrupt handler so we can just call
|
|
* kmm_malloc() to get memory for the class instance.
|
|
*/
|
|
|
|
DEBUGASSERT(!up_interrupt_context());
|
|
|
|
priv = (FAR struct usbhost_state_s *)
|
|
kmm_malloc(sizeof(struct usbhost_state_s));
|
|
|
|
uinfo("Allocated: %p\n", priv);
|
|
return priv;
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_freeclass
|
|
*
|
|
* Description:
|
|
* Free a class instance previously allocated by usbhost_allocclass().
|
|
*
|
|
* Input Parameters:
|
|
* usbclass - A reference to the class instance to be freed.
|
|
*
|
|
* Returned Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
#if CONFIG_USBHOST_NPREALLOC > 0
|
|
static inline void usbhost_freeclass(FAR struct usbhost_state_s *usbclass)
|
|
{
|
|
FAR struct usbhost_freestate_s *entry =
|
|
(FAR struct usbhost_freestate_s *)usbclass;
|
|
irqstate_t flags;
|
|
DEBUGASSERT(entry != NULL);
|
|
|
|
uinfo("Freeing: %p\n", entry);
|
|
|
|
/* Just put the pre-allocated class structure back on the freelist */
|
|
|
|
flags = enter_critical_section();
|
|
entry->flink = g_freelist;
|
|
g_freelist = entry;
|
|
leave_critical_section(flags);
|
|
}
|
|
#else
|
|
static inline void usbhost_freeclass(FAR struct usbhost_state_s *usbclass)
|
|
{
|
|
DEBUGASSERT(usbclass != NULL);
|
|
|
|
/* Free the class instance (calling sched_kfree() in case we are executing
|
|
* from an interrupt handler.
|
|
*/
|
|
|
|
uinfo("Freeing: %p\n", usbclass);
|
|
sched_kfree(usbclass);
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: Device name management
|
|
*
|
|
* Description:
|
|
* Some tiny functions to coordinate management of mass storage device
|
|
* names.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static int usbhost_allocdevno(FAR struct usbhost_state_s *priv)
|
|
{
|
|
irqstate_t flags;
|
|
int devno;
|
|
|
|
flags = enter_critical_section();
|
|
for (devno = 0; devno < 26; devno++)
|
|
{
|
|
uint32_t bitno = 1 << devno;
|
|
if ((g_devinuse & bitno) == 0)
|
|
{
|
|
g_devinuse |= bitno;
|
|
priv->sdchar = 'a' + devno;
|
|
leave_critical_section(flags);
|
|
return OK;
|
|
}
|
|
}
|
|
|
|
leave_critical_section(flags);
|
|
return -EMFILE;
|
|
}
|
|
|
|
static void usbhost_freedevno(FAR struct usbhost_state_s *priv)
|
|
{
|
|
int devno = 'a' - priv->sdchar;
|
|
|
|
if (devno >= 0 && devno < 26)
|
|
{
|
|
irqstate_t flags = enter_critical_section();
|
|
g_devinuse &= ~(1 << devno);
|
|
leave_critical_section(flags);
|
|
}
|
|
}
|
|
|
|
static inline void usbhost_mkdevname(FAR struct usbhost_state_s *priv,
|
|
FAR char *devname)
|
|
{
|
|
snprintf(devname, DEV_NAMELEN, DEV_FORMAT, priv->sdchar);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: CBW/CSW debug helpers
|
|
*
|
|
* Description:
|
|
* The following functions are helper functions used to dump CBWs and CSWs.
|
|
*
|
|
* Input Parameters:
|
|
* cbw/csw - A reference to the CBW/CSW to dump.
|
|
*
|
|
* Returned Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
#if defined(CONFIG_DEBUG_USB) && defined(CONFIG_DEBUG_INFO)
|
|
static void usbhost_dumpcbw(FAR struct usbmsc_cbw_s *cbw)
|
|
{
|
|
int i;
|
|
|
|
uinfo("CBW:\n");
|
|
uinfo(" signature: %08x\n", usbhost_getle32(cbw->signature));
|
|
uinfo(" tag: %08x\n", usbhost_getle32(cbw->tag));
|
|
uinfo(" datlen: %08x\n", usbhost_getle32(cbw->datlen));
|
|
uinfo(" flags: %02x\n", cbw->flags);
|
|
uinfo(" lun: %02x\n", cbw->lun);
|
|
uinfo(" cdblen: %02x\n", cbw->cdblen);
|
|
|
|
uinfo("CDB:\n");
|
|
for (i = 0; i < cbw->cdblen; i += 8)
|
|
{
|
|
uinfo(" %02x %02x %02x %02x %02x %02x %02x %02x\n",
|
|
cbw->cdb[i], cbw->cdb[i + 1], cbw->cdb[i + 2],
|
|
cbw->cdb[i + 3], cbw->cdb[i + 4], cbw->cdb[i + 5],
|
|
cbw->cdb[i + 6], cbw->cdb[i + 7]);
|
|
}
|
|
}
|
|
|
|
static void usbhost_dumpcsw(FAR struct usbmsc_csw_s *csw)
|
|
{
|
|
uinfo("CSW:\n");
|
|
uinfo(" signature: %08x\n", usbhost_getle32(csw->signature));
|
|
uinfo(" tag: %08x\n", usbhost_getle32(csw->tag));
|
|
uinfo(" residue: %08x\n", usbhost_getle32(csw->residue));
|
|
uinfo(" status: %02x\n", csw->status);
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: CBW helpers
|
|
*
|
|
* Description:
|
|
* The following functions are helper functions used to format CBWs.
|
|
*
|
|
* Input Parameters:
|
|
* cbw - A reference to allocated and initialized CBW to be built.
|
|
*
|
|
* Returned Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline void usbhost_requestsensecbw(FAR struct usbmsc_cbw_s *cbw)
|
|
{
|
|
FAR struct scsicmd_requestsense_s *reqsense;
|
|
|
|
/* Format the CBW */
|
|
|
|
usbhost_putle32(cbw->datlen, SCSIRESP_FIXEDSENSEDATA_SIZEOF);
|
|
cbw->flags = USBMSC_CBWFLAG_IN;
|
|
cbw->cdblen = SCSICMD_REQUESTSENSE_SIZEOF;
|
|
|
|
/* Format the CDB */
|
|
|
|
reqsense = (FAR struct scsicmd_requestsense_s *)cbw->cdb;
|
|
reqsense->opcode = SCSI_CMD_REQUESTSENSE;
|
|
reqsense->alloclen = SCSIRESP_FIXEDSENSEDATA_SIZEOF;
|
|
|
|
usbhost_dumpcbw(cbw);
|
|
}
|
|
|
|
static inline void usbhost_testunitreadycbw(FAR struct usbmsc_cbw_s *cbw)
|
|
{
|
|
/* Format the CBW */
|
|
|
|
cbw->cdblen = SCSICMD_TESTUNITREADY_SIZEOF;
|
|
|
|
/* Format the CDB */
|
|
|
|
cbw->cdb[0] = SCSI_CMD_TESTUNITREADY;
|
|
|
|
usbhost_dumpcbw(cbw);
|
|
}
|
|
|
|
static inline void usbhost_readcapacitycbw(FAR struct usbmsc_cbw_s *cbw)
|
|
{
|
|
FAR struct scsicmd_readcapacity10_s *rcap10;
|
|
|
|
/* Format the CBW */
|
|
|
|
usbhost_putle32(cbw->datlen, SCSIRESP_READCAPACITY10_SIZEOF);
|
|
cbw->flags = USBMSC_CBWFLAG_IN;
|
|
cbw->cdblen = SCSICMD_READCAPACITY10_SIZEOF;
|
|
|
|
/* Format the CDB */
|
|
|
|
rcap10 = (FAR struct scsicmd_readcapacity10_s *)cbw->cdb;
|
|
rcap10->opcode = SCSI_CMD_READCAPACITY10;
|
|
|
|
usbhost_dumpcbw(cbw);
|
|
}
|
|
|
|
static inline void usbhost_inquirycbw (FAR struct usbmsc_cbw_s *cbw)
|
|
{
|
|
FAR struct scscicmd_inquiry_s *inq;
|
|
|
|
/* Format the CBW */
|
|
|
|
usbhost_putle32(cbw->datlen, SCSIRESP_INQUIRY_SIZEOF);
|
|
cbw->flags = USBMSC_CBWFLAG_IN;
|
|
cbw->cdblen = SCSICMD_INQUIRY_SIZEOF;
|
|
|
|
/* Format the CDB */
|
|
|
|
inq = (FAR struct scscicmd_inquiry_s *)cbw->cdb;
|
|
inq->opcode = SCSI_CMD_INQUIRY;
|
|
usbhost_putbe16(inq->alloclen, SCSIRESP_INQUIRY_SIZEOF);
|
|
|
|
usbhost_dumpcbw(cbw);
|
|
}
|
|
|
|
static inline void
|
|
usbhost_readcbw (size_t startsector, uint16_t blocksize,
|
|
unsigned int nsectors, FAR struct usbmsc_cbw_s *cbw)
|
|
{
|
|
FAR struct scsicmd_read10_s *rd10;
|
|
|
|
/* Format the CBW */
|
|
|
|
usbhost_putle32(cbw->datlen, blocksize * nsectors);
|
|
cbw->flags = USBMSC_CBWFLAG_IN;
|
|
cbw->cdblen = SCSICMD_READ10_SIZEOF;
|
|
|
|
/* Format the CDB */
|
|
|
|
rd10 = (FAR struct scsicmd_read10_s *)cbw->cdb;
|
|
rd10->opcode = SCSI_CMD_READ10;
|
|
usbhost_putbe32(rd10->lba, startsector);
|
|
usbhost_putbe16(rd10->xfrlen, nsectors);
|
|
|
|
usbhost_dumpcbw(cbw);
|
|
}
|
|
|
|
static inline void
|
|
usbhost_writecbw(size_t startsector, uint16_t blocksize,
|
|
unsigned int nsectors, FAR struct usbmsc_cbw_s *cbw)
|
|
{
|
|
FAR struct scsicmd_write10_s *wr10;
|
|
|
|
/* Format the CBW */
|
|
|
|
usbhost_putle32(cbw->datlen, blocksize * nsectors);
|
|
cbw->cdblen = SCSICMD_WRITE10_SIZEOF;
|
|
|
|
/* Format the CDB */
|
|
|
|
wr10 = (FAR struct scsicmd_write10_s *)cbw->cdb;
|
|
wr10->opcode = SCSI_CMD_WRITE10;
|
|
usbhost_putbe32(wr10->lba, startsector);
|
|
usbhost_putbe16(wr10->xfrlen, nsectors);
|
|
|
|
usbhost_dumpcbw(cbw);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: Command helpers
|
|
*
|
|
* Description:
|
|
* The following functions are helper functions used to send commands.
|
|
*
|
|
* Input Parameters:
|
|
* priv - A reference to the class instance.
|
|
*
|
|
* Returned Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline int usbhost_maxlunreq(FAR struct usbhost_state_s *priv)
|
|
{
|
|
FAR struct usb_ctrlreq_s *req = (FAR struct usb_ctrlreq_s *)priv->tbuffer;
|
|
FAR struct usbhost_hubport_s *hport;
|
|
DEBUGASSERT(priv && priv->tbuffer);
|
|
int ret;
|
|
|
|
/* Request maximum logical unit number. NOTE: On an IN transaction, The
|
|
* req and buffer pointers passed to DRVR_CTRLIN may refer to the same
|
|
* allocated memory.
|
|
*/
|
|
|
|
uinfo("Request maximum logical unit number\n");
|
|
|
|
memset(req, 0, sizeof(struct usb_ctrlreq_s));
|
|
req->type = USB_DIR_IN | USB_REQ_TYPE_CLASS |
|
|
USB_REQ_RECIPIENT_INTERFACE;
|
|
req->req = USBMSC_REQ_GETMAXLUN;
|
|
usbhost_putle16(req->len, 1);
|
|
|
|
DEBUGASSERT(priv->usbclass.hport);
|
|
hport = priv->usbclass.hport;
|
|
|
|
ret = DRVR_CTRLIN(hport->drvr, hport->ep0, req, priv->tbuffer);
|
|
if (ret < 0)
|
|
{
|
|
/* Devices that do not support multiple LUNs may stall this command.
|
|
* On a failure, a single LUN is assumed.
|
|
*/
|
|
|
|
*(priv->tbuffer) = 0;
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
|
|
static inline int usbhost_testunitready(FAR struct usbhost_state_s *priv)
|
|
{
|
|
FAR struct usbhost_hubport_s *hport;
|
|
FAR struct usbmsc_cbw_s *cbw;
|
|
ssize_t nbytes;
|
|
|
|
DEBUGASSERT(priv->usbclass.hport);
|
|
hport = priv->usbclass.hport;
|
|
|
|
/* Initialize a CBW (re-using the allocated transfer buffer) */
|
|
|
|
cbw = usbhost_cbwalloc(priv);
|
|
if (!cbw)
|
|
{
|
|
uerr("ERROR: Failed to create CBW\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* Construct and send the CBW */
|
|
|
|
usbhost_testunitreadycbw(cbw);
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkout,
|
|
(FAR uint8_t *)cbw, USBMSC_CBW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the CSW */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, USBMSC_CSW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
usbhost_dumpcsw((FAR struct usbmsc_csw_s *)priv->tbuffer);
|
|
}
|
|
}
|
|
|
|
return nbytes < 0 ? (int)nbytes : OK;
|
|
}
|
|
|
|
static inline int usbhost_requestsense(FAR struct usbhost_state_s *priv)
|
|
{
|
|
FAR struct usbhost_hubport_s *hport;
|
|
FAR struct usbmsc_cbw_s *cbw;
|
|
ssize_t nbytes;
|
|
|
|
DEBUGASSERT(priv->usbclass.hport);
|
|
hport = priv->usbclass.hport;
|
|
|
|
/* Initialize a CBW (re-using the allocated transfer buffer) */
|
|
|
|
cbw = usbhost_cbwalloc(priv);
|
|
if (!cbw)
|
|
{
|
|
uerr("ERROR: Failed to create CBW\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* Construct and send the CBW */
|
|
|
|
usbhost_requestsensecbw(cbw);
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkout,
|
|
(FAR uint8_t *)cbw, USBMSC_CBW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the sense data response */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, SCSIRESP_FIXEDSENSEDATA_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the CSW */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, USBMSC_CSW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
usbhost_dumpcsw((FAR struct usbmsc_csw_s *)priv->tbuffer);
|
|
}
|
|
}
|
|
}
|
|
|
|
return nbytes < 0 ? (int)nbytes : OK;
|
|
}
|
|
|
|
static inline int usbhost_readcapacity(FAR struct usbhost_state_s *priv)
|
|
{
|
|
FAR struct usbhost_hubport_s *hport;
|
|
FAR struct usbmsc_cbw_s *cbw;
|
|
FAR struct scsiresp_readcapacity10_s *resp;
|
|
ssize_t nbytes;
|
|
|
|
DEBUGASSERT(priv->usbclass.hport);
|
|
hport = priv->usbclass.hport;
|
|
|
|
/* Initialize a CBW (re-using the allocated transfer buffer) */
|
|
|
|
cbw = usbhost_cbwalloc(priv);
|
|
if (!cbw)
|
|
{
|
|
uerr("ERROR: Failed to create CBW\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* Construct and send the CBW */
|
|
|
|
usbhost_readcapacitycbw(cbw);
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkout,
|
|
(FAR uint8_t *)cbw, USBMSC_CBW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the read capacity CBW IN response */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, SCSIRESP_READCAPACITY10_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Save the capacity information */
|
|
|
|
resp = (FAR struct scsiresp_readcapacity10_s *)
|
|
priv->tbuffer;
|
|
priv->nblocks = usbhost_getbe32(resp->lba) + 1;
|
|
priv->blocksize = usbhost_getbe32(resp->blklen);
|
|
|
|
/* Receive the CSW */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, USBMSC_CSW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
usbhost_dumpcsw((FAR struct usbmsc_csw_s *)priv->tbuffer);
|
|
}
|
|
}
|
|
}
|
|
|
|
return nbytes < 0 ? (int)nbytes : OK;
|
|
}
|
|
|
|
static inline int usbhost_inquiry(FAR struct usbhost_state_s *priv)
|
|
{
|
|
FAR struct usbhost_hubport_s *hport;
|
|
FAR struct usbmsc_cbw_s *cbw;
|
|
ssize_t nbytes;
|
|
|
|
DEBUGASSERT(priv->usbclass.hport);
|
|
hport = priv->usbclass.hport;
|
|
|
|
/* Initialize a CBW (re-using the allocated transfer buffer) */
|
|
|
|
cbw = usbhost_cbwalloc(priv);
|
|
if (!cbw)
|
|
{
|
|
uerr("ERROR: Failed to create CBW\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* Construct and send the CBW */
|
|
|
|
usbhost_inquirycbw(cbw);
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkout,
|
|
(FAR uint8_t *)cbw, USBMSC_CBW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the CBW IN response */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, SCSIRESP_INQUIRY_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
#if 0
|
|
FAR struct scsiresp_inquiry_s *resp;
|
|
|
|
/* TODO: If USB debug is enabled, dump the response data here */
|
|
|
|
resp = (FAR struct scsiresp_inquiry_s *)priv->tbuffer;
|
|
#endif
|
|
/* Receive the CSW */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, USBMSC_CSW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
usbhost_dumpcsw((FAR struct usbmsc_csw_s *)priv->tbuffer);
|
|
}
|
|
}
|
|
}
|
|
|
|
return nbytes < 0 ? (int)nbytes : OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_destroy
|
|
*
|
|
* Description:
|
|
* The USB mass storage device has been disconnected and the reference
|
|
* 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 Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static void usbhost_destroy(FAR void *arg)
|
|
{
|
|
FAR struct usbhost_state_s *priv = (FAR struct usbhost_state_s *)arg;
|
|
FAR struct usbhost_hubport_s *hport;
|
|
char devname[DEV_NAMELEN];
|
|
|
|
DEBUGASSERT(priv != NULL && priv->usbclass.hport != NULL);
|
|
hport = priv->usbclass.hport;
|
|
|
|
uinfo("crefs: %d\n", priv->crefs);
|
|
|
|
/* Unregister the block driver */
|
|
|
|
usbhost_mkdevname(priv, devname);
|
|
unregister_blockdriver(devname);
|
|
|
|
/* Release the device name used by this connection */
|
|
|
|
usbhost_freedevno(priv);
|
|
|
|
/* Free the bulk endpoints */
|
|
|
|
if (priv->bulkout)
|
|
{
|
|
DRVR_EPFREE(hport->drvr, priv->bulkout);
|
|
}
|
|
|
|
if (priv->bulkin)
|
|
{
|
|
DRVR_EPFREE(hport->drvr, priv->bulkin);
|
|
}
|
|
|
|
/* Free any transfer buffers */
|
|
|
|
usbhost_tfree(priv);
|
|
|
|
/* Destroy the semaphores */
|
|
|
|
nxsem_destroy(&priv->exclsem);
|
|
|
|
/* Disconnect the USB host device */
|
|
|
|
DRVR_DISCONNECT(hport->drvr, hport);
|
|
|
|
/* Free the function address assigned to this device */
|
|
|
|
usbhost_devaddr_destroy(hport, hport->funcaddr);
|
|
hport->funcaddr = 0;
|
|
|
|
/* And free the class instance. */
|
|
|
|
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
|
|
* descriptor.
|
|
* desclen - The length in bytes of the configuration descriptor.
|
|
*
|
|
* Returned Value:
|
|
* 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)
|
|
{
|
|
FAR struct usbhost_hubport_s *hport;
|
|
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 && priv->usbclass.hport &&
|
|
configdesc != NULL && desclen >= sizeof(struct usb_cfgdesc_s));
|
|
hport = priv->usbclass.hport;
|
|
|
|
/* Keep the compiler from complaining about uninitialized variables */
|
|
|
|
memset(&bindesc, 0, sizeof(struct usbhost_epdesc_s));
|
|
memset(&boutdesc, 0, sizeof(struct usbhost_epdesc_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;
|
|
|
|
uinfo("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. 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;
|
|
|
|
uinfo("Endpoint descriptor\n");
|
|
DEBUGASSERT(remaining >= USB_SIZEOF_EPDESC);
|
|
|
|
/* Check for a bulk endpoint. We only support the bulk-only
|
|
* protocol so I suppose anything else should really be an error.
|
|
*/
|
|
|
|
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.hport = hport;
|
|
boutdesc.addr = epdesc->addr &
|
|
USB_EP_ADDR_NUMBER_MASK;
|
|
boutdesc.in = false;
|
|
boutdesc.xfrtype = USB_EP_ATTR_XFER_BULK;
|
|
boutdesc.interval = epdesc->interval;
|
|
boutdesc.mxpacketsize =
|
|
usbhost_getle16(epdesc->mxpacketsize);
|
|
|
|
uinfo("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.hport = hport;
|
|
bindesc.addr = epdesc->addr &
|
|
USB_EP_ADDR_NUMBER_MASK;
|
|
bindesc.in = 1;
|
|
bindesc.xfrtype = USB_EP_ATTR_XFER_BULK;
|
|
bindesc.interval = epdesc->interval;
|
|
bindesc.mxpacketsize =
|
|
usbhost_getle16(epdesc->mxpacketsize);
|
|
|
|
uinfo("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? Hmmm..
|
|
* I wonder.. can we work read-only or write-only if only one bulk
|
|
* endpoint found?
|
|
*/
|
|
|
|
if (found != USBHOST_ALLFOUND)
|
|
{
|
|
uerr("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(hport->drvr, &boutdesc, &priv->bulkout);
|
|
if (ret < 0)
|
|
{
|
|
uerr("ERROR: Failed to allocate Bulk OUT endpoint\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = DRVR_EPALLOC(hport->drvr, &bindesc, &priv->bulkin);
|
|
if (ret < 0)
|
|
{
|
|
uerr("ERROR: Failed to allocate Bulk IN endpoint\n");
|
|
DRVR_EPFREE(hport->drvr, priv->bulkout);
|
|
return ret;
|
|
}
|
|
|
|
uinfo("Endpoints allocated\n");
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_initvolume
|
|
*
|
|
* Description:
|
|
* The USB mass storage 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 Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline int usbhost_initvolume(FAR struct usbhost_state_s *priv)
|
|
{
|
|
FAR struct usbmsc_csw_s *csw;
|
|
unsigned int retries;
|
|
int ret = OK;
|
|
|
|
DEBUGASSERT(priv != NULL);
|
|
|
|
/* Set aside a transfer buffer for exclusive use by the mass storage driver */
|
|
|
|
ret = usbhost_talloc(priv);
|
|
if (ret < 0)
|
|
{
|
|
uerr("ERROR: Failed to allocate transfer buffer\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Increment the reference count. This will prevent usbhost_destroy() from
|
|
* being called asynchronously if the device is removed.
|
|
*/
|
|
|
|
priv->crefs++;
|
|
DEBUGASSERT(priv->crefs == 2);
|
|
|
|
/* Request the maximum logical unit number */
|
|
|
|
uinfo("Get max LUN\n");
|
|
ret = usbhost_maxlunreq(priv);
|
|
|
|
for (retries = 0; retries < USBHOST_MAX_RETRIES; retries++)
|
|
{
|
|
uinfo("Test unit ready, retries=%d\n", retries);
|
|
|
|
/* Wait just a bit */
|
|
|
|
nxsig_usleep(USBHOST_RETRY_USEC);
|
|
|
|
/* Send TESTUNITREADY to see if the unit is ready. The most likely
|
|
* error error that can occur here is a a stall which simply means
|
|
* that the the device is not yet able to respond.
|
|
*/
|
|
|
|
ret = usbhost_testunitready(priv);
|
|
if (ret >= 0)
|
|
{
|
|
/* Is the unit is ready */
|
|
|
|
csw = (FAR struct usbmsc_csw_s *)priv->tbuffer;
|
|
if (csw->status == 0)
|
|
{
|
|
/* Yes... break out of the loop */
|
|
|
|
break;
|
|
}
|
|
|
|
/* No.. Request mode sense information. The REQUEST SENSE command
|
|
* is sent only "to clear interlocked unit attention conditions."
|
|
* The returned status is ignored here.
|
|
*/
|
|
|
|
uinfo("Request sense\n");
|
|
ret = usbhost_requestsense(priv);
|
|
}
|
|
|
|
/* It is acceptable for a mass storage device to respond to the
|
|
* Test Unit Ready and Request Sense commands with a stall if it is
|
|
* unable to respond. But other failures mean that something is
|
|
* wrong and a device reset is in order. The transfer functions will
|
|
* return -EPERM if the transfer failed due to a stall.
|
|
*/
|
|
|
|
if (ret < 0 && ret != -EPERM)
|
|
{
|
|
uerr("ERROR: DRVR_TRANSFER returned: %d\n", ret);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* Did the unit become ready? Did an error occur? Or did we time out? */
|
|
|
|
if (retries >= USBHOST_MAX_RETRIES)
|
|
{
|
|
uerr("ERROR: Timeout!\n");
|
|
ret = -ETIMEDOUT;
|
|
}
|
|
|
|
if (ret >= 0)
|
|
{
|
|
/* Get the capacity of the volume */
|
|
|
|
uinfo("Read capacity\n");
|
|
ret = usbhost_readcapacity(priv);
|
|
if (ret >= 0)
|
|
{
|
|
/* Check the CSW for errors */
|
|
|
|
csw = (FAR struct usbmsc_csw_s *)priv->tbuffer;
|
|
if (csw->status != 0)
|
|
{
|
|
uerr("ERROR: CSW status error: %d\n", csw->status);
|
|
ret = -ENODEV;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Get information about the volume */
|
|
|
|
if (ret >= 0)
|
|
{
|
|
/* Inquiry */
|
|
|
|
uinfo("Inquiry\n");
|
|
ret = usbhost_inquiry(priv);
|
|
if (ret >= 0)
|
|
{
|
|
/* Check the CSW for errors */
|
|
|
|
csw = (FAR struct usbmsc_csw_s *)priv->tbuffer;
|
|
if (csw->status != 0)
|
|
{
|
|
uerr("ERROR: CSW status error: %d\n", csw->status);
|
|
ret = -ENODEV;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Register the block driver */
|
|
|
|
if (ret >= 0)
|
|
{
|
|
char devname[DEV_NAMELEN];
|
|
|
|
uinfo("Register block driver\n");
|
|
usbhost_mkdevname(priv, devname);
|
|
ret = register_blockdriver(devname, &g_bops, 0, priv);
|
|
}
|
|
|
|
/* Decrement the reference count. We incremented the reference count
|
|
* above so that usbhost_destroy() could not be called. We now have to
|
|
* be concerned about asynchronous modification of crefs because the block
|
|
* driver has been registered.
|
|
*/
|
|
|
|
usbhost_forcetake(&priv->exclsem);
|
|
DEBUGASSERT(priv->crefs >= 2);
|
|
|
|
/* Decrement the reference count */
|
|
|
|
priv->crefs--;
|
|
|
|
/* Check if we successfully initialized. If so, handle a corner case
|
|
* where (1) open() has been called so the reference count was > 2, but
|
|
* the device has been disconnected. In this case, the class instance
|
|
* needs to persist until close()
|
|
* is called.
|
|
*/
|
|
|
|
if (ret >= 0 && priv->crefs <= 1 && priv->disconnected)
|
|
{
|
|
/* The will cause the enumeration logic to disconnect the class
|
|
* driver.
|
|
*/
|
|
|
|
ret = -ENODEV;
|
|
}
|
|
|
|
/* Release the semaphore... there is a race condition here.
|
|
* Decrementing the reference count and releasing the semaphore
|
|
* allows usbhost_destroy() to execute (on the worker thread);
|
|
* the class driver instance could get destroyed before we are
|
|
* ready to handle it!
|
|
*/
|
|
|
|
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 Value:
|
|
* 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_getbe16
|
|
*
|
|
* Description:
|
|
* Get a (possibly unaligned) 16-bit big endian value.
|
|
*
|
|
* Input Parameters:
|
|
* val - A pointer to the first byte of the big endian value.
|
|
*
|
|
* Returned Value:
|
|
* A uint16_t representing the whole 16-bit integer value
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline uint16_t usbhost_getbe16(const uint8_t *val)
|
|
{
|
|
return (uint16_t)val[0] << 8 | (uint16_t)val[1];
|
|
}
|
|
|
|
/****************************************************************************
|
|
* 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 Value:
|
|
* 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_putbe16
|
|
*
|
|
* Description:
|
|
* Put a (possibly unaligned) 16-bit big endian value.
|
|
*
|
|
* Input Parameters:
|
|
* dest - A pointer to the first byte to save the big endian value.
|
|
* val - The 16-bit value to be saved.
|
|
*
|
|
* Returned Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static void usbhost_putbe16(uint8_t *dest, uint16_t val)
|
|
{
|
|
dest[0] = val >> 8; /* Big endian means MS byte first in byte stream */
|
|
dest[1] = val & 0xff;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* 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 Value:
|
|
* 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_getbe32
|
|
*
|
|
* Description:
|
|
* Get a (possibly unaligned) 32-bit big 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 Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline uint32_t usbhost_getbe32(const uint8_t *val)
|
|
{
|
|
/* Big endian means MS halfword first in byte stream */
|
|
|
|
return (uint32_t)usbhost_getbe16(val) << 16 |
|
|
(uint32_t)usbhost_getbe16(&val[2]);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* 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 Value:
|
|
* 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_putbe32
|
|
*
|
|
* Description:
|
|
* Put a (possibly unaligned) 32-bit big 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 Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static void usbhost_putbe32(uint8_t *dest, uint32_t val)
|
|
{
|
|
/* Big endian means MS halfword first in byte stream */
|
|
|
|
usbhost_putbe16(dest, (uint16_t)(val >> 16));
|
|
usbhost_putbe16(dest + 2, (uint16_t)(val & 0xffff));
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_talloc
|
|
*
|
|
* Description:
|
|
* Allocate transfer buffer memory.
|
|
*
|
|
* Input Parameters:
|
|
* priv - A reference to the class instance.
|
|
*
|
|
* Returned Value:
|
|
* On success, 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)
|
|
{
|
|
FAR struct usbhost_hubport_s *hport;
|
|
|
|
DEBUGASSERT(priv != NULL && priv->usbclass.hport != NULL &&
|
|
priv->tbuffer == NULL);
|
|
hport = priv->usbclass.hport;
|
|
|
|
return DRVR_ALLOC(hport->drvr, &priv->tbuffer, &priv->tbuflen);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_tfree
|
|
*
|
|
* Description:
|
|
* Free transfer buffer memory.
|
|
*
|
|
* Input Parameters:
|
|
* priv - A reference to the class instance.
|
|
*
|
|
* Returned Value:
|
|
* On success, 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)
|
|
{
|
|
FAR struct usbhost_hubport_s *hport;
|
|
int result = OK;
|
|
|
|
DEBUGASSERT(priv != NULL && priv->usbclass.hport != NULL);
|
|
|
|
if (priv->tbuffer)
|
|
{
|
|
hport = priv->usbclass.hport;
|
|
result = DRVR_FREE(hport->drvr, priv->tbuffer);
|
|
priv->tbuffer = NULL;
|
|
priv->tbuflen = 0;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_cbwalloc
|
|
*
|
|
* Description:
|
|
* Initialize a CBW (re-using the allocated transfer buffer). Upon
|
|
* successful return, the CBW is cleared and has the CBW signature in
|
|
* place.
|
|
*
|
|
* Input Parameters:
|
|
* priv - A reference to the class instance.
|
|
*
|
|
* Returned Value:
|
|
* None
|
|
*
|
|
****************************************************************************/
|
|
|
|
static FAR struct usbmsc_cbw_s *
|
|
usbhost_cbwalloc(FAR struct usbhost_state_s *priv)
|
|
{
|
|
FAR struct usbmsc_cbw_s *cbw = NULL;
|
|
|
|
DEBUGASSERT(priv->tbuffer && priv->tbuflen >= sizeof(struct usbmsc_cbw_s));
|
|
|
|
/* Initialize the CBW structure */
|
|
|
|
cbw = (FAR struct usbmsc_cbw_s *)priv->tbuffer;
|
|
memset(cbw, 0, sizeof(struct usbmsc_cbw_s));
|
|
usbhost_putle32(cbw->signature, USBMSC_CBW_SIGNATURE);
|
|
return cbw;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* 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:
|
|
* hport - The hub port that manages the new class instance.
|
|
* id - In the case where the device supports multiple base classes,
|
|
* subclasses, or protocols, this specifies which to configure for.
|
|
*
|
|
* Returned Value:
|
|
* 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 hport 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_hubport_s *hport,
|
|
FAR const struct usbhost_id_s *id)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
|
|
/* Allocate a USB host mass storage 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->usbclass.hport = hport;
|
|
priv->usbclass.connect = usbhost_connect;
|
|
priv->usbclass.disconnected = usbhost_disconnected;
|
|
|
|
/* The initial reference count is 1... One reference is held by
|
|
* the driver.
|
|
*/
|
|
|
|
priv->crefs = 1;
|
|
|
|
/* Initialize semaphores (this works okay in the interrupt context) */
|
|
|
|
nxsem_init(&priv->exclsem, 0, 1);
|
|
|
|
/* NOTE: We do not yet know the geometry of the USB mass storage
|
|
* device.
|
|
*/
|
|
|
|
/* Return the instance of the USB mass storage class */
|
|
|
|
return &priv->usbclass;
|
|
}
|
|
}
|
|
|
|
/* An error occurred. Free the allocation and return NULL on all failures */
|
|
|
|
if (priv)
|
|
{
|
|
usbhost_freeclass(priv);
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* 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:
|
|
* usbclass - The USB host class entry previously obtained from a call to
|
|
* create().
|
|
* configdesc - A pointer to a uint8_t buffer container the configuration
|
|
* descriptor.
|
|
* desclen - The length in bytes of the configuration descriptor.
|
|
*
|
|
* Returned Value:
|
|
* 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 *usbclass,
|
|
FAR const uint8_t *configdesc, int desclen)
|
|
{
|
|
FAR struct usbhost_state_s *priv = (FAR struct usbhost_state_s *)usbclass;
|
|
int ret;
|
|
|
|
DEBUGASSERT(priv != NULL &&
|
|
configdesc != NULL &&
|
|
desclen >= sizeof(struct usb_cfgdesc_s));
|
|
|
|
/* Parse the configuration descriptor to get the bulk I/O endpoints */
|
|
|
|
ret = usbhost_cfgdesc(priv, configdesc, desclen);
|
|
if (ret < 0)
|
|
{
|
|
uerr("ERROR: usbhost_cfgdesc() failed: %d\n", ret);
|
|
}
|
|
else
|
|
{
|
|
/* Now configure the LUNs and register the block driver(s) */
|
|
|
|
ret = usbhost_initvolume(priv);
|
|
if (ret < 0)
|
|
{
|
|
uerr("ERROR: usbhost_initvolume() 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:
|
|
* usbclass - The USB host class entry previously obtained from a call to
|
|
* create().
|
|
*
|
|
* Returned Value:
|
|
* 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 *usbclass)
|
|
{
|
|
FAR struct usbhost_state_s *priv = (FAR struct usbhost_state_s *)usbclass;
|
|
irqstate_t flags;
|
|
|
|
DEBUGASSERT(priv != NULL);
|
|
|
|
/* Set an indication to any users of the mass storage device that the
|
|
* device is no longer available.
|
|
*/
|
|
|
|
flags = enter_critical_section();
|
|
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.
|
|
*/
|
|
|
|
uinfo("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. */
|
|
|
|
uinfo("Queuing destruction: worker %p->%p\n",
|
|
priv->work.worker, usbhost_destroy);
|
|
DEBUGASSERT(priv->work.worker == NULL);
|
|
work_queue(HPWORK, &priv->work, usbhost_destroy, priv, 0);
|
|
}
|
|
else
|
|
{
|
|
/* Do the work now */
|
|
|
|
usbhost_destroy(priv);
|
|
}
|
|
}
|
|
|
|
leave_critical_section(flags);
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_open
|
|
*
|
|
* Description: Open the block device
|
|
*
|
|
****************************************************************************/
|
|
|
|
static int usbhost_open(FAR struct inode *inode)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
irqstate_t flags;
|
|
int ret;
|
|
|
|
uinfo("Entry\n");
|
|
DEBUGASSERT(inode && inode->i_private);
|
|
priv = (FAR struct usbhost_state_s *)inode->i_private;
|
|
|
|
/* Make sure that we have exclusive access to the private data structure */
|
|
|
|
DEBUGASSERT(priv->crefs > 0 && priv->crefs < USBHOST_MAX_CREFS);
|
|
ret = usbhost_takesem(&priv->exclsem);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
/* Check if the mass storage device is still connected. We need to
|
|
* disable interrupts momentarily to assure that there are no asynchronous
|
|
* disconnect events.
|
|
*/
|
|
|
|
flags = enter_critical_section();
|
|
if (priv->disconnected)
|
|
{
|
|
/* No... the block driver is no longer bound to the class. That means
|
|
* that the USB storage device is no longer connected. Refuse any
|
|
* further attempts to open the driver.
|
|
*/
|
|
|
|
ret = -ENODEV;
|
|
}
|
|
else
|
|
{
|
|
/* Otherwise, just increment the reference count on the driver */
|
|
|
|
priv->crefs++;
|
|
ret = OK;
|
|
}
|
|
|
|
leave_critical_section(flags);
|
|
|
|
usbhost_givesem(&priv->exclsem);
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_close
|
|
*
|
|
* Description: close the block device
|
|
*
|
|
****************************************************************************/
|
|
|
|
static int usbhost_close(FAR struct inode *inode)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
irqstate_t flags;
|
|
|
|
uinfo("Entry\n");
|
|
DEBUGASSERT(inode && inode->i_private);
|
|
priv = (FAR struct usbhost_state_s *)inode->i_private;
|
|
|
|
/* Decrement the reference count on the block driver */
|
|
|
|
DEBUGASSERT(priv->crefs > 1);
|
|
|
|
usbhost_forcetake(&priv->exclsem);
|
|
priv->crefs--;
|
|
|
|
/* Release the semaphore. The following operations when crefs == 1 are
|
|
* safe because we know that there is no outstanding open references to
|
|
* the block driver.
|
|
*/
|
|
|
|
usbhost_givesem(&priv->exclsem);
|
|
|
|
/* We need to disable interrupts momentarily to assure that there are
|
|
* no asynchronous disconnect events.
|
|
*/
|
|
|
|
flags = enter_critical_section();
|
|
|
|
/* Check if the USB mass storage device is still connected. If the
|
|
* storage device is not connected and the reference count just
|
|
* decremented to one, then unregister the block driver and free
|
|
* the class instance.
|
|
*/
|
|
|
|
if (priv->crefs <= 1 && priv->disconnected)
|
|
{
|
|
/* Destroy the class instance */
|
|
|
|
DEBUGASSERT(priv->crefs == 1);
|
|
usbhost_destroy(priv);
|
|
}
|
|
|
|
leave_critical_section(flags);
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_read
|
|
*
|
|
* Description:
|
|
* Read the specified number of sectors from the read-ahead buffer or from
|
|
* the physical device.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static ssize_t usbhost_read(FAR struct inode *inode, unsigned char *buffer,
|
|
size_t startsector, unsigned int nsectors)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
FAR struct usbhost_hubport_s *hport;
|
|
ssize_t nbytes = 0;
|
|
int ret;
|
|
|
|
DEBUGASSERT(inode && inode->i_private);
|
|
priv = (FAR struct usbhost_state_s *)inode->i_private;
|
|
|
|
DEBUGASSERT(priv->usbclass.hport);
|
|
hport = priv->usbclass.hport;
|
|
|
|
uinfo("startsector: %d nsectors: %d sectorsize: %d\n",
|
|
startsector, nsectors, priv->blocksize);
|
|
|
|
/* Check if the mass storage device is still connected */
|
|
|
|
if (priv->disconnected)
|
|
{
|
|
/* No... the block driver is no longer bound to the class. That means
|
|
* that the USB storage device is no longer connected. Refuse any
|
|
* attempt to read from the device.
|
|
*/
|
|
|
|
nbytes = -ENODEV;
|
|
}
|
|
else if (nsectors > 0)
|
|
{
|
|
FAR struct usbmsc_cbw_s *cbw;
|
|
|
|
ret = usbhost_takesem(&priv->exclsem);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
/* Assume allocation failure */
|
|
|
|
nbytes = -ENOMEM;
|
|
|
|
/* Initialize a CBW (re-using the allocated transfer buffer) */
|
|
|
|
cbw = usbhost_cbwalloc(priv);
|
|
if (cbw)
|
|
{
|
|
/* Loop in the event that EAGAIN is returned (mean that the
|
|
* transaction was NAKed and we should try again.
|
|
*/
|
|
|
|
do
|
|
{
|
|
/* Assume some device failure */
|
|
|
|
nbytes = -ENODEV;
|
|
|
|
/* Construct and send the CBW */
|
|
|
|
usbhost_readcbw(startsector, priv->blocksize, nsectors, cbw);
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkout,
|
|
(FAR uint8_t *)cbw, USBMSC_CBW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the user data */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
buffer, priv->blocksize * nsectors);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the CSW */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer,
|
|
USBMSC_CSW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
FAR struct usbmsc_csw_s *csw;
|
|
|
|
/* Check the CSW status */
|
|
|
|
csw = (FAR struct usbmsc_csw_s *)priv->tbuffer;
|
|
if (csw->status != 0)
|
|
{
|
|
uerr("ERROR: CSW status error: %d\n",
|
|
csw->status);
|
|
nbytes = -ENODEV;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
while (nbytes == -EAGAIN);
|
|
}
|
|
|
|
usbhost_givesem(&priv->exclsem);
|
|
}
|
|
|
|
/* On success, return the number of blocks read */
|
|
|
|
return nbytes < 0 ? (int)nbytes : nsectors;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_write
|
|
*
|
|
* Description:
|
|
* Write the specified number of sectors to the write buffer or to the
|
|
* physical device.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static ssize_t usbhost_write(FAR struct inode *inode,
|
|
FAR const unsigned char *buffer,
|
|
size_t startsector, unsigned int nsectors)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
FAR struct usbhost_hubport_s *hport;
|
|
ssize_t nbytes;
|
|
int ret;
|
|
|
|
uinfo("sector: %d nsectors: %d sectorsize: %d\n");
|
|
|
|
DEBUGASSERT(inode && inode->i_private);
|
|
priv = (FAR struct usbhost_state_s *)inode->i_private;
|
|
|
|
DEBUGASSERT(priv->usbclass.hport);
|
|
hport = priv->usbclass.hport;
|
|
|
|
/* Check if the mass storage device is still connected */
|
|
|
|
if (priv->disconnected)
|
|
{
|
|
/* No... the block driver is no longer bound to the class. That means
|
|
* that the USB storage device is no longer connected. Refuse any
|
|
* attempt to write to the device.
|
|
*/
|
|
|
|
nbytes = -ENODEV;
|
|
}
|
|
else
|
|
{
|
|
FAR struct usbmsc_cbw_s *cbw;
|
|
|
|
ret = usbhost_takesem(&priv->exclsem);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
/* Assume allocation failure */
|
|
|
|
nbytes = -ENOMEM;
|
|
|
|
/* Initialize a CBW (re-using the allocated transfer buffer) */
|
|
|
|
cbw = usbhost_cbwalloc(priv);
|
|
if (cbw)
|
|
{
|
|
/* Assume some device failure */
|
|
|
|
nbytes = -ENODEV;
|
|
|
|
/* Construct and send the CBW */
|
|
|
|
usbhost_writecbw(startsector, priv->blocksize, nsectors, cbw);
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkout,
|
|
(FAR uint8_t *)cbw, USBMSC_CBW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Send the user data */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkout,
|
|
(FAR uint8_t *)buffer,
|
|
priv->blocksize * nsectors);
|
|
if (nbytes >= 0)
|
|
{
|
|
/* Receive the CSW */
|
|
|
|
nbytes = DRVR_TRANSFER(hport->drvr, priv->bulkin,
|
|
priv->tbuffer, USBMSC_CSW_SIZEOF);
|
|
if (nbytes >= 0)
|
|
{
|
|
FAR struct usbmsc_csw_s *csw;
|
|
|
|
/* Check the CSW status */
|
|
|
|
csw = (FAR struct usbmsc_csw_s *)priv->tbuffer;
|
|
if (csw->status != 0)
|
|
{
|
|
uerr("ERROR: CSW status error: %d\n", csw->status);
|
|
nbytes = -ENODEV;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
usbhost_givesem(&priv->exclsem);
|
|
}
|
|
|
|
/* On success, return the number of blocks written */
|
|
|
|
return nbytes < 0 ? (int)nbytes : nsectors;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_geometry
|
|
*
|
|
* Description: Return device geometry
|
|
*
|
|
****************************************************************************/
|
|
|
|
static int usbhost_geometry(FAR struct inode *inode,
|
|
FAR struct geometry *geometry)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
int ret = -EINVAL;
|
|
|
|
uinfo("Entry\n");
|
|
DEBUGASSERT(inode && inode->i_private);
|
|
|
|
/* Check if the mass storage device is still connected */
|
|
|
|
priv = (FAR struct usbhost_state_s *)inode->i_private;
|
|
if (priv->disconnected)
|
|
{
|
|
/* No... the block driver is no longer bound to the class. That means
|
|
* that the USB storage device is no longer connected. Refuse to
|
|
* return any geometry info.
|
|
*/
|
|
|
|
ret = -ENODEV;
|
|
}
|
|
else if (geometry)
|
|
{
|
|
/* Return the geometry of the USB mass storage device */
|
|
|
|
ret = usbhost_takesem(&priv->exclsem);
|
|
if (ret >= 0)
|
|
{
|
|
geometry->geo_available = true;
|
|
geometry->geo_mediachanged = false;
|
|
geometry->geo_writeenabled = true;
|
|
geometry->geo_nsectors = priv->nblocks;
|
|
geometry->geo_sectorsize = priv->blocksize;
|
|
usbhost_givesem(&priv->exclsem);
|
|
|
|
uinfo("nsectors: %ld sectorsize: %d\n",
|
|
(long)geometry->geo_nsectors, geometry->geo_sectorsize);
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_ioctl
|
|
*
|
|
* Description: Return device geometry
|
|
*
|
|
****************************************************************************/
|
|
|
|
static int usbhost_ioctl(FAR struct inode *inode, int cmd, unsigned long arg)
|
|
{
|
|
FAR struct usbhost_state_s *priv;
|
|
int ret;
|
|
|
|
uinfo("Entry\n");
|
|
DEBUGASSERT(inode && inode->i_private);
|
|
priv = (FAR struct usbhost_state_s *)inode->i_private;
|
|
|
|
/* Check if the mass storage device is still connected */
|
|
|
|
if (priv->disconnected)
|
|
{
|
|
/* No... the block driver is no longer bound to the class. That means
|
|
* that the USB storage device is no longer connected. Refuse to
|
|
* process any ioctl commands.
|
|
*/
|
|
|
|
ret = -ENODEV;
|
|
}
|
|
else
|
|
{
|
|
/* Process the IOCTL by command */
|
|
|
|
ret = usbhost_takesem(&priv->exclsem);
|
|
if (ret >= 0)
|
|
{
|
|
switch (cmd)
|
|
{
|
|
/* Add support for ioctl commands here */
|
|
|
|
default:
|
|
ret = -ENOTTY;
|
|
break;
|
|
}
|
|
|
|
usbhost_givesem(&priv->exclsem);
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: usbhost_msc_initialize
|
|
*
|
|
* Description:
|
|
* Initialize the USB host storage class. This function should be called
|
|
* be platform-specific code in order to initialize and register support
|
|
* for the USB host storage class.
|
|
*
|
|
* Input Parameters:
|
|
* None
|
|
*
|
|
* Returned Value:
|
|
* On success this function will return zero (OK); A negated errno value
|
|
* will be returned on failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int usbhost_msc_initialize(void)
|
|
{
|
|
/* If we have been configured to use pre-allocated storage class instances,
|
|
* then place all of the pre-allocated USB host storage class instances
|
|
* into a free list.
|
|
*/
|
|
|
|
#if CONFIG_USBHOST_NPREALLOC > 0
|
|
FAR struct usbhost_freestate_s *entry;
|
|
int i;
|
|
|
|
g_freelist = NULL;
|
|
for (i = 0; i < CONFIG_USBHOST_NPREALLOC; i++)
|
|
{
|
|
entry = (FAR struct usbhost_freestate_s *)&g_prealloc[i];
|
|
entry->flink = g_freelist;
|
|
g_freelist = entry;
|
|
}
|
|
#endif
|
|
|
|
/* Advertise our availability to support (certain) mass storage devices */
|
|
|
|
return usbhost_registerclass(&g_storage);
|
|
}
|
|
|
|
#endif /* CONFIG_USBHOST && !CONFIG_USBHOST_BULK_DISABLE && !CONFIG_DISABLE_MOUNTPOINT */
|