Fix for DUE - no host support on native USB if SD card not enabled (#10148)

This commit is contained in:
Eduardo José Tagle 2018-03-18 21:49:51 -03:00 committed by Scott Lahteine
parent 772810fb24
commit bbfbf90797
7 changed files with 1197 additions and 758 deletions

View file

@ -54,11 +54,7 @@
*/ */
//! @{ //! @{
#ifdef SDSUPPORT #define LUN_0 ENABLE //!< SD/MMC Card over MCI Slot 0.
#define LUN_0 ENABLE //!< SD/MMC Card over MCI Slot 0.
#else
#define LUN_0 DISABLE
#endif
#define LUN_1 DISABLE #define LUN_1 DISABLE
#define LUN_2 DISABLE #define LUN_2 DISABLE
#define LUN_3 DISABLE #define LUN_3 DISABLE

View file

@ -114,48 +114,51 @@
#define USB_DEVICE_SPECIFIC_REQUEST() usb_task_other_requests() #define USB_DEVICE_SPECIFIC_REQUEST() usb_task_other_requests()
//@} //@}
/** #if ENABLED(SDSUPPORT)
* USB Device low level configuration /**
* When only one interface is used, these configurations are defined by the class module. * USB Device low level configuration
* For composite device, these configuration must be defined here * When only one interface is used, these configurations are defined by the class module.
* @{ * For composite device, these configuration must be defined here
*/ * @{
//! Control endpoint size */
#define USB_DEVICE_EP_CTRL_SIZE 64 //! Control endpoint size
#define USB_DEVICE_EP_CTRL_SIZE 64
//! Two interfaces for this device (CDC COM + CDC DATA + MSC) //! Two interfaces for this device (CDC COM + CDC DATA + MSC)
#define USB_DEVICE_NB_INTERFACE 3 #define USB_DEVICE_NB_INTERFACE 3
//! 5 endpoints used by CDC and MSC interfaces //! 5 endpoints used by CDC and MSC interfaces
#if SAM3U #if SAM3U
// (3 | USB_EP_DIR_IN) // CDC Notify endpoint // (3 | USB_EP_DIR_IN) // CDC Notify endpoint
// (6 | USB_EP_DIR_IN) // CDC TX // (6 | USB_EP_DIR_IN) // CDC TX
// (5 | USB_EP_DIR_OUT) // CDC RX // (5 | USB_EP_DIR_OUT) // CDC RX
// (1 | USB_EP_DIR_IN) // MSC IN // (1 | USB_EP_DIR_IN) // MSC IN
// (2 | USB_EP_DIR_OUT) // MSC OUT // (2 | USB_EP_DIR_OUT) // MSC OUT
# define USB_DEVICE_MAX_EP 6 # define USB_DEVICE_MAX_EP 6
# if defined(USB_DEVICE_HS_SUPPORT) # if defined(USB_DEVICE_HS_SUPPORT)
// In HS mode, size of bulk endpoints are 512 // In HS mode, size of bulk endpoints are 512
// If CDC and MSC endpoints all uses 2 banks, DPRAM is not enough: 4 bulk // If CDC and MSC endpoints all uses 2 banks, DPRAM is not enough: 4 bulk
// endpoints requires 4K bytes. So reduce the number of banks of CDC bulk // endpoints requires 4K bytes. So reduce the number of banks of CDC bulk
// endpoints to use less DPRAM. Keep MSC setting to keep MSC performance. // endpoints to use less DPRAM. Keep MSC setting to keep MSC performance.
# define UDD_BULK_NB_BANK(ep) ((ep == 5 || ep== 6) ? 1 : 2) # define UDD_BULK_NB_BANK(ep) ((ep == 5 || ep== 6) ? 1 : 2)
#endif #endif
#else #else
// (3 | USB_EP_DIR_IN) // CDC Notify endpoint // (3 | USB_EP_DIR_IN) // CDC Notify endpoint
// (4 | USB_EP_DIR_IN) // CDC TX // (4 | USB_EP_DIR_IN) // CDC TX
// (5 | USB_EP_DIR_OUT) // CDC RX // (5 | USB_EP_DIR_OUT) // CDC RX
// (1 | USB_EP_DIR_IN) // MSC IN // (1 | USB_EP_DIR_IN) // MSC IN
// (2 | USB_EP_DIR_OUT) // MSC OUT // (2 | USB_EP_DIR_OUT) // MSC OUT
# define USB_DEVICE_MAX_EP 5 # define USB_DEVICE_MAX_EP 5
# if SAM3XA && defined(USB_DEVICE_HS_SUPPORT) # if SAM3XA && defined(USB_DEVICE_HS_SUPPORT)
// In HS mode, size of bulk endpoints are 512 // In HS mode, size of bulk endpoints are 512
// If CDC and MSC endpoints all uses 2 banks, DPRAM is not enough: 4 bulk // If CDC and MSC endpoints all uses 2 banks, DPRAM is not enough: 4 bulk
// endpoints requires 4K bytes. So reduce the number of banks of CDC bulk // endpoints requires 4K bytes. So reduce the number of banks of CDC bulk
// endpoints to use less DPRAM. Keep MSC setting to keep MSC performance. // endpoints to use less DPRAM. Keep MSC setting to keep MSC performance.
# define UDD_BULK_NB_BANK(ep) ((ep == 4 || ep== 5) ? 1 : 2) # define UDD_BULK_NB_BANK(ep) ((ep == 4 || ep== 5) ? 1 : 2)
# endif # endif
#endif
#endif #endif
//@} //@}
//@} //@}
@ -195,107 +198,112 @@
//! Enable id string of interface to add an extra USB string //! Enable id string of interface to add an extra USB string
#define UDI_CDC_IAD_STRING_ID 4 #define UDI_CDC_IAD_STRING_ID 4
/** #if ENABLED(SDSUPPORT)
* USB CDC low level configuration /**
* In standalone these configurations are defined by the CDC module. * USB CDC low level configuration
* For composite device, these configuration must be defined here * In standalone these configurations are defined by the CDC module.
* @{ * For composite device, these configuration must be defined here
*/ * @{
//! Endpoint numbers definition */
#if SAM3U //! Endpoint numbers definition
# define UDI_CDC_COMM_EP_0 (3 | USB_EP_DIR_IN) // Notify endpoint #if SAM3U
# define UDI_CDC_DATA_EP_IN_0 (6 | USB_EP_DIR_IN) // TX # define UDI_CDC_COMM_EP_0 (3 | USB_EP_DIR_IN) // Notify endpoint
# define UDI_CDC_DATA_EP_OUT_0 (5 | USB_EP_DIR_OUT)// RX # define UDI_CDC_DATA_EP_IN_0 (6 | USB_EP_DIR_IN) // TX
# define UDI_CDC_DATA_EP_OUT_0 (5 | USB_EP_DIR_OUT)// RX
#else
# define UDI_CDC_COMM_EP_0 (3 | USB_EP_DIR_IN) // Notify endpoint
# define UDI_CDC_DATA_EP_IN_0 (4 | USB_EP_DIR_IN) // TX
# define UDI_CDC_DATA_EP_OUT_0 (5 | USB_EP_DIR_OUT)// RX
#endif
//! Interface numbers
#define UDI_CDC_COMM_IFACE_NUMBER_0 0
#define UDI_CDC_DATA_IFACE_NUMBER_0 1
//@}
//@}
/**
* Configuration of MSC interface
* @{
*/
//! Vendor name and Product version of MSC interface
#define UDI_MSC_GLOBAL_VENDOR_ID \
'M', 'A', 'R', 'L', 'I', 'N', '3', 'D'
#define UDI_MSC_GLOBAL_PRODUCT_VERSION \
'1', '.', '0', '0'
//! Interface callback definition
#define UDI_MSC_ENABLE_EXT() usb_task_msc_enable()
#define UDI_MSC_DISABLE_EXT() usb_task_msc_disable()
//! Enable id string of interface to add an extra USB string
#define UDI_MSC_STRING_ID 5
/**
* USB MSC low level configuration
* In standalone these configurations are defined by the MSC module.
* For composite device, these configuration must be defined here
* @{
*/
//! Endpoint numbers definition
#define UDI_MSC_EP_IN (1 | USB_EP_DIR_IN)
#define UDI_MSC_EP_OUT (2 | USB_EP_DIR_OUT)
//! Interface number
#define UDI_MSC_IFACE_NUMBER 2
//@}
//@}
//@}
/**
* Description of Composite Device
* @{
*/
//! USB Interfaces descriptor structure
#define UDI_COMPOSITE_DESC_T \
usb_iad_desc_t udi_cdc_iad; \
udi_cdc_comm_desc_t udi_cdc_comm; \
udi_cdc_data_desc_t udi_cdc_data; \
udi_msc_desc_t udi_msc
//! USB Interfaces descriptor value for Full Speed
#define UDI_COMPOSITE_DESC_FS \
.udi_cdc_iad = UDI_CDC_IAD_DESC_0, \
.udi_cdc_comm = UDI_CDC_COMM_DESC_0, \
.udi_cdc_data = UDI_CDC_DATA_DESC_0_FS, \
.udi_msc = UDI_MSC_DESC_FS
//! USB Interfaces descriptor value for High Speed
#define UDI_COMPOSITE_DESC_HS \
.udi_cdc_iad = UDI_CDC_IAD_DESC_0, \
.udi_cdc_comm = UDI_CDC_COMM_DESC_0, \
.udi_cdc_data = UDI_CDC_DATA_DESC_0_HS, \
.udi_msc = UDI_MSC_DESC_HS
//! USB Interface APIs
#define UDI_COMPOSITE_API \
&udi_api_cdc_comm, \
&udi_api_cdc_data, \
&udi_api_msc
//@}
/**
* USB Device Driver Configuration
* @{
*/
//@}
//! The includes of classes and other headers must be done at the end of this file to avoid compile error
#include "udi_cdc.h"
#include "udi_msc.h"
#else #else
# define UDI_CDC_COMM_EP_0 (3 | USB_EP_DIR_IN) // Notify endpoint #include "udi_cdc_conf.h"
# define UDI_CDC_DATA_EP_IN_0 (4 | USB_EP_DIR_IN) // TX
# define UDI_CDC_DATA_EP_OUT_0 (5 | USB_EP_DIR_OUT)// RX
#endif #endif
//! Interface numbers
#define UDI_CDC_COMM_IFACE_NUMBER_0 0
#define UDI_CDC_DATA_IFACE_NUMBER_0 1
//@}
//@}
/**
* Configuration of MSC interface
* @{
*/
//! Vendor name and Product version of MSC interface
#define UDI_MSC_GLOBAL_VENDOR_ID \
'M', 'A', 'R', 'L', 'I', 'N', '3', 'D'
#define UDI_MSC_GLOBAL_PRODUCT_VERSION \
'1', '.', '0', '0'
//! Interface callback definition
#define UDI_MSC_ENABLE_EXT() usb_task_msc_enable()
#define UDI_MSC_DISABLE_EXT() usb_task_msc_disable()
//! Enable id string of interface to add an extra USB string
#define UDI_MSC_STRING_ID 5
/**
* USB MSC low level configuration
* In standalone these configurations are defined by the MSC module.
* For composite device, these configuration must be defined here
* @{
*/
//! Endpoint numbers definition
#define UDI_MSC_EP_IN (1 | USB_EP_DIR_IN)
#define UDI_MSC_EP_OUT (2 | USB_EP_DIR_OUT)
//! Interface number
#define UDI_MSC_IFACE_NUMBER 2
//@}
//@}
//@}
/**
* Description of Composite Device
* @{
*/
//! USB Interfaces descriptor structure
#define UDI_COMPOSITE_DESC_T \
usb_iad_desc_t udi_cdc_iad; \
udi_cdc_comm_desc_t udi_cdc_comm; \
udi_cdc_data_desc_t udi_cdc_data; \
udi_msc_desc_t udi_msc
//! USB Interfaces descriptor value for Full Speed
#define UDI_COMPOSITE_DESC_FS \
.udi_cdc_iad = UDI_CDC_IAD_DESC_0, \
.udi_cdc_comm = UDI_CDC_COMM_DESC_0, \
.udi_cdc_data = UDI_CDC_DATA_DESC_0_FS, \
.udi_msc = UDI_MSC_DESC_FS
//! USB Interfaces descriptor value for High Speed
#define UDI_COMPOSITE_DESC_HS \
.udi_cdc_iad = UDI_CDC_IAD_DESC_0, \
.udi_cdc_comm = UDI_CDC_COMM_DESC_0, \
.udi_cdc_data = UDI_CDC_DATA_DESC_0_HS, \
.udi_msc = UDI_MSC_DESC_HS
//! USB Interface APIs
#define UDI_COMPOSITE_API \
&udi_api_cdc_comm, \
&udi_api_cdc_data, \
&udi_api_msc
//@}
/**
* USB Device Driver Configuration
* @{
*/
//@}
//! The includes of classes and other headers must be done at the end of this file to avoid compile error
#include "udi_cdc.h"
#include "udi_msc.h"
#include "usb_task.h" #include "usb_task.h"
#endif // _CONF_USB_H_ #endif // _CONF_USB_H_

View file

@ -0,0 +1,156 @@
/**
* \file
*
* \brief Default CDC configuration for a USB Device with a single interface
*
* Copyright (c) 2009-2015 Atmel Corporation. All rights reserved.
*
* \asf_license_start
*
* \page License
*
* 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. The name of Atmel may not be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* 4. This software may only be redistributed and used in connection with an
* Atmel microcontroller product.
*
* THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR IMPLIED
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
* EXPRESSLY AND SPECIFICALLY DISCLAIMED. IN NO EVENT SHALL ATMEL 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.
*
* \asf_license_stop
*
*/
/*
* Support and FAQ: visit <a href="http://www.atmel.com/design-support/">Atmel Support</a>
*/
#ifndef _UDI_CDC_CONF_H_
#define _UDI_CDC_CONF_H_
#include "usb_protocol_cdc.h"
#include "conf_usb.h"
#ifndef UDI_CDC_PORT_NB
# define UDI_CDC_PORT_NB 1
#endif
#ifdef __cplusplus
extern "C" {
#endif
/**
* \addtogroup udi_cdc_group_single_desc
* @{
*/
//! Control endpoint size (Endpoint 0)
#define USB_DEVICE_EP_CTRL_SIZE 64
#if XMEGA
/**
* \name Endpoint configuration on XMEGA
* The XMEGA supports a IN and OUT endpoint with the same number endpoint,
* thus XMEGA can support up to 7 CDC interfaces.
*/
//@{
#define UDI_CDC_DATA_EP_IN_0 ( 1 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_0 ( 2 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_0 ( 2 | USB_EP_DIR_IN) // Notify endpoint
#define UDI_CDC_DATA_EP_IN_1 ( 3 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_1 ( 4 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_1 ( 4 | USB_EP_DIR_IN) // Notify endpoint
#define UDI_CDC_DATA_EP_IN_2 ( 5 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_2 ( 6 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_2 ( 6 | USB_EP_DIR_IN) // Notify endpoint
#define UDI_CDC_DATA_EP_IN_3 ( 7 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_3 ( 8 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_3 ( 8 | USB_EP_DIR_IN) // Notify endpoint
#define UDI_CDC_DATA_EP_IN_4 ( 9 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_4 (10 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_4 (10 | USB_EP_DIR_IN) // Notify endpoint
#define UDI_CDC_DATA_EP_IN_5 (11 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_5 (12 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_5 (12 | USB_EP_DIR_IN) // Notify endpoint
#define UDI_CDC_DATA_EP_IN_6 (13 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_6 (14 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_6 (14 | USB_EP_DIR_IN) // Notify endpoint
//! 2 endpoints numbers used per CDC interface
#define USB_DEVICE_MAX_EP (2*UDI_CDC_PORT_NB)
//@}
#else
/**
* \name Default endpoint configuration
* The USBB, UDP, UDPHS and UOTGHS interfaces can support up to 2 CDC interfaces.
*/
//@{
# if UDI_CDC_PORT_NB > 2
# error USBB, UDP, UDPHS and UOTGHS interfaces have not enought endpoints.
# endif
#define UDI_CDC_DATA_EP_IN_0 (1 | USB_EP_DIR_IN) // TX
#define UDI_CDC_DATA_EP_OUT_0 (2 | USB_EP_DIR_OUT) // RX
#define UDI_CDC_COMM_EP_0 (3 | USB_EP_DIR_IN) // Notify endpoint
# if SAM3U
/* For 3U max endpoint size of 4 is 64, use 5 and 6 as bulk tx and rx */
# define UDI_CDC_DATA_EP_IN_1 (6 | USB_EP_DIR_IN) // TX
# define UDI_CDC_DATA_EP_OUT_1 (5 | USB_EP_DIR_OUT) // RX
# define UDI_CDC_COMM_EP_1 (4 | USB_EP_DIR_IN) // Notify
# else
# define UDI_CDC_DATA_EP_IN_1 (4 | USB_EP_DIR_IN) // TX
# define UDI_CDC_DATA_EP_OUT_1 (5 | USB_EP_DIR_OUT) // RX
# define UDI_CDC_COMM_EP_1 (6 | USB_EP_DIR_IN) // Notify
# endif
//! 3 endpoints used per CDC interface
#undef USB_DEVICE_MAX_EP // undefine this definition in header file
#define USB_DEVICE_MAX_EP (3*UDI_CDC_PORT_NB)
//@}
#endif
/**
* \name Default Interface numbers
*/
//@{
#define UDI_CDC_COMM_IFACE_NUMBER_0 0
#define UDI_CDC_DATA_IFACE_NUMBER_0 1
#define UDI_CDC_COMM_IFACE_NUMBER_1 2
#define UDI_CDC_DATA_IFACE_NUMBER_1 3
#define UDI_CDC_COMM_IFACE_NUMBER_2 4
#define UDI_CDC_DATA_IFACE_NUMBER_2 5
#define UDI_CDC_COMM_IFACE_NUMBER_3 6
#define UDI_CDC_DATA_IFACE_NUMBER_3 7
#define UDI_CDC_COMM_IFACE_NUMBER_4 8
#define UDI_CDC_DATA_IFACE_NUMBER_4 9
#define UDI_CDC_COMM_IFACE_NUMBER_5 10
#define UDI_CDC_DATA_IFACE_NUMBER_5 11
#define UDI_CDC_COMM_IFACE_NUMBER_6 12
#define UDI_CDC_DATA_IFACE_NUMBER_6 13
//@}
//@}
#ifdef __cplusplus
}
#endif
#endif // _UDI_CDC_CONF_H_

View file

@ -0,0 +1,259 @@
/**
* \file
*
* \brief Default descriptors for a USB Device with a single interface CDC
*
* Copyright (c) 2009-2016 Atmel Corporation. All rights reserved.
*
* \asf_license_start
*
* \page License
*
* 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. The name of Atmel may not be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* 4. This software may only be redistributed and used in connection with an
* Atmel microcontroller product.
*
* THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR IMPLIED
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
* EXPRESSLY AND SPECIFICALLY DISCLAIMED. IN NO EVENT SHALL ATMEL 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.
*
* \asf_license_stop
*
*/
/*
* Support and FAQ: visit <a href="http://www.atmel.com/design-support/">Atmel Support</a>
*/
#ifdef ARDUINO_ARCH_SAM
#include "conf_usb.h"
#include "udd.h"
#include "udc_desc.h"
#include "udi_cdc.h"
#if DISABLED(SDSUPPORT)
/**
* \defgroup udi_cdc_group_single_desc USB device descriptors for a single interface
*
* The following structures provide the USB device descriptors required for
* USB Device with a single interface CDC.
*
* It is ready to use and do not require more definition.
*
* @{
*/
//! Two interfaces for a CDC device
#define USB_DEVICE_NB_INTERFACE (2*UDI_CDC_PORT_NB)
#ifdef USB_DEVICE_LPM_SUPPORT
# define USB_VERSION USB_V2_1
#else
# define USB_VERSION USB_V2_0
#endif
//! USB Device Descriptor
COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE usb_dev_desc_t udc_device_desc = {
.bLength = sizeof(usb_dev_desc_t),
.bDescriptorType = USB_DT_DEVICE,
.bcdUSB = LE16(USB_VERSION),
#if UDI_CDC_PORT_NB > 1
.bDeviceClass = 0,
#else
.bDeviceClass = CDC_CLASS_DEVICE,
#endif
.bDeviceSubClass = 0,
.bDeviceProtocol = 0,
.bMaxPacketSize0 = USB_DEVICE_EP_CTRL_SIZE,
.idVendor = LE16(USB_DEVICE_VENDOR_ID),
.idProduct = LE16(USB_DEVICE_PRODUCT_ID),
.bcdDevice = LE16((USB_DEVICE_MAJOR_VERSION << 8)
| USB_DEVICE_MINOR_VERSION),
#ifdef USB_DEVICE_MANUFACTURE_NAME
.iManufacturer = 1,
#else
.iManufacturer = 0, // No manufacture string
#endif
#ifdef USB_DEVICE_PRODUCT_NAME
.iProduct = 2,
#else
.iProduct = 0, // No product string
#endif
#if (defined USB_DEVICE_SERIAL_NAME || defined USB_DEVICE_GET_SERIAL_NAME_POINTER)
.iSerialNumber = 3,
#else
.iSerialNumber = 0, // No serial string
#endif
.bNumConfigurations = 1
};
#ifdef USB_DEVICE_HS_SUPPORT
//! USB Device Qualifier Descriptor for HS
COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE usb_dev_qual_desc_t udc_device_qual = {
.bLength = sizeof(usb_dev_qual_desc_t),
.bDescriptorType = USB_DT_DEVICE_QUALIFIER,
.bcdUSB = LE16(USB_VERSION),
#if UDI_CDC_PORT_NB > 1
.bDeviceClass = 0,
#else
.bDeviceClass = CDC_CLASS_DEVICE,
#endif
.bDeviceSubClass = 0,
.bDeviceProtocol = 0,
.bMaxPacketSize0 = USB_DEVICE_EP_CTRL_SIZE,
.bNumConfigurations = 1
};
#endif
#ifdef USB_DEVICE_LPM_SUPPORT
//! USB Device Qualifier Descriptor
COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE usb_dev_lpm_desc_t udc_device_lpm = {
.bos.bLength = sizeof(usb_dev_bos_desc_t),
.bos.bDescriptorType = USB_DT_BOS,
.bos.wTotalLength = LE16(sizeof(usb_dev_bos_desc_t) + sizeof(usb_dev_capa_ext_desc_t)),
.bos.bNumDeviceCaps = 1,
.capa_ext.bLength = sizeof(usb_dev_capa_ext_desc_t),
.capa_ext.bDescriptorType = USB_DT_DEVICE_CAPABILITY,
.capa_ext.bDevCapabilityType = USB_DC_USB20_EXTENSION,
.capa_ext.bmAttributes = USB_DC_EXT_LPM,
};
#endif
//! Structure for USB Device Configuration Descriptor
COMPILER_PACK_SET(1)
typedef struct {
usb_conf_desc_t conf;
#if UDI_CDC_PORT_NB == 1
udi_cdc_comm_desc_t udi_cdc_comm_0;
udi_cdc_data_desc_t udi_cdc_data_0;
#else
# define UDI_CDC_DESC_STRUCTURE(index, unused) \
usb_iad_desc_t udi_cdc_iad_##index; \
udi_cdc_comm_desc_t udi_cdc_comm_##index; \
udi_cdc_data_desc_t udi_cdc_data_##index;
MREPEAT(UDI_CDC_PORT_NB, UDI_CDC_DESC_STRUCTURE, ~)
# undef UDI_CDC_DESC_STRUCTURE
#endif
} udc_desc_t;
COMPILER_PACK_RESET()
//! USB Device Configuration Descriptor filled for full and high speed
COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE udc_desc_t udc_desc_fs = {
.conf.bLength = sizeof(usb_conf_desc_t),
.conf.bDescriptorType = USB_DT_CONFIGURATION,
.conf.wTotalLength = LE16(sizeof(udc_desc_t)),
.conf.bNumInterfaces = USB_DEVICE_NB_INTERFACE,
.conf.bConfigurationValue = 1,
.conf.iConfiguration = 0,
.conf.bmAttributes = USB_CONFIG_ATTR_MUST_SET | USB_DEVICE_ATTR,
.conf.bMaxPower = USB_CONFIG_MAX_POWER(USB_DEVICE_POWER),
#if UDI_CDC_PORT_NB == 1
.udi_cdc_comm_0 = UDI_CDC_COMM_DESC_0,
.udi_cdc_data_0 = UDI_CDC_DATA_DESC_0_FS,
#else
# define UDI_CDC_DESC_FS(index, unused) \
.udi_cdc_iad_##index = UDI_CDC_IAD_DESC_##index,\
.udi_cdc_comm_##index = UDI_CDC_COMM_DESC_##index,\
.udi_cdc_data_##index = UDI_CDC_DATA_DESC_##index##_FS,
MREPEAT(UDI_CDC_PORT_NB, UDI_CDC_DESC_FS, ~)
# undef UDI_CDC_DESC_FS
#endif
};
#ifdef USB_DEVICE_HS_SUPPORT
COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE udc_desc_t udc_desc_hs = {
.conf.bLength = sizeof(usb_conf_desc_t),
.conf.bDescriptorType = USB_DT_CONFIGURATION,
.conf.wTotalLength = LE16(sizeof(udc_desc_t)),
.conf.bNumInterfaces = USB_DEVICE_NB_INTERFACE,
.conf.bConfigurationValue = 1,
.conf.iConfiguration = 0,
.conf.bmAttributes = USB_CONFIG_ATTR_MUST_SET | USB_DEVICE_ATTR,
.conf.bMaxPower = USB_CONFIG_MAX_POWER(USB_DEVICE_POWER),
#if UDI_CDC_PORT_NB == 1
.udi_cdc_comm_0 = UDI_CDC_COMM_DESC_0,
.udi_cdc_data_0 = UDI_CDC_DATA_DESC_0_HS,
#else
# define UDI_CDC_DESC_HS(index, unused) \
.udi_cdc_iad_##index = UDI_CDC_IAD_DESC_##index, \
.udi_cdc_comm_##index = UDI_CDC_COMM_DESC_##index, \
.udi_cdc_data_##index = UDI_CDC_DATA_DESC_##index##_HS,
MREPEAT(UDI_CDC_PORT_NB, UDI_CDC_DESC_HS, ~)
# undef UDI_CDC_DESC_HS
#endif
};
#endif
/**
* \name UDC structures which content all USB Device definitions
*/
//@{
//! Associate an UDI for each USB interface
UDC_DESC_STORAGE udi_api_t *udi_apis[USB_DEVICE_NB_INTERFACE] = {
# define UDI_CDC_API(index, unused) \
&udi_api_cdc_comm, \
&udi_api_cdc_data,
MREPEAT(UDI_CDC_PORT_NB, UDI_CDC_API, ~)
# undef UDI_CDC_API
};
//! Add UDI with USB Descriptors FS & HS
UDC_DESC_STORAGE udc_config_speed_t udc_config_fs[1] = { {
.desc = (usb_conf_desc_t UDC_DESC_STORAGE*)&udc_desc_fs,
.udi_apis = udi_apis,
}};
#ifdef USB_DEVICE_HS_SUPPORT
UDC_DESC_STORAGE udc_config_speed_t udc_config_hs[1] = { {
.desc = (usb_conf_desc_t UDC_DESC_STORAGE*)&udc_desc_hs,
.udi_apis = udi_apis,
}};
#endif
//! Add all information about USB Device in global structure for UDC
UDC_DESC_STORAGE udc_config_t udc_config = {
.confdev_lsfs = &udc_device_desc,
.conf_lsfs = udc_config_fs,
#ifdef USB_DEVICE_HS_SUPPORT
.confdev_hs = &udc_device_desc,
.qualifier = &udc_device_qual,
.conf_hs = udc_config_hs,
#endif
#ifdef USB_DEVICE_LPM_SUPPORT
.conf_bos = &udc_device_lpm.bos,
#else
.conf_bos = NULL,
#endif
};
//@}
//@}
#endif
#endif

View file

@ -50,6 +50,8 @@
#include "udd.h" #include "udd.h"
#include "udc_desc.h" #include "udc_desc.h"
#if ENABLED(SDSUPPORT)
/** /**
* \defgroup udi_group_desc Descriptors for a USB Device * \defgroup udi_group_desc Descriptors for a USB Device
* composite * composite
@ -62,33 +64,33 @@
//! USB Device Descriptor //! USB Device Descriptor
COMPILER_WORD_ALIGNED COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE usb_dev_desc_t udc_device_desc = { UDC_DESC_STORAGE usb_dev_desc_t udc_device_desc = {
.bLength = sizeof(usb_dev_desc_t), .bLength = sizeof(usb_dev_desc_t),
.bDescriptorType = USB_DT_DEVICE, .bDescriptorType = USB_DT_DEVICE,
.bcdUSB = LE16(USB_V2_0), .bcdUSB = LE16(USB_V2_0),
.bDeviceClass = 0, .bDeviceClass = 0,
.bDeviceSubClass = 0, .bDeviceSubClass = 0,
.bDeviceProtocol = 0, .bDeviceProtocol = 0,
.bMaxPacketSize0 = USB_DEVICE_EP_CTRL_SIZE, .bMaxPacketSize0 = USB_DEVICE_EP_CTRL_SIZE,
.idVendor = LE16(USB_DEVICE_VENDOR_ID), .idVendor = LE16(USB_DEVICE_VENDOR_ID),
.idProduct = LE16(USB_DEVICE_PRODUCT_ID), .idProduct = LE16(USB_DEVICE_PRODUCT_ID),
.bcdDevice = LE16((USB_DEVICE_MAJOR_VERSION << 8) .bcdDevice = LE16((USB_DEVICE_MAJOR_VERSION << 8)
| USB_DEVICE_MINOR_VERSION), | USB_DEVICE_MINOR_VERSION),
#ifdef USB_DEVICE_MANUFACTURE_NAME #ifdef USB_DEVICE_MANUFACTURE_NAME
.iManufacturer = 1, .iManufacturer = 1,
#else #else
.iManufacturer = 0, // No manufacture string .iManufacturer = 0, // No manufacture string
#endif #endif
#ifdef USB_DEVICE_PRODUCT_NAME #ifdef USB_DEVICE_PRODUCT_NAME
.iProduct = 2, .iProduct = 2,
#else #else
.iProduct = 0, // No product string .iProduct = 0, // No product string
#endif #endif
#if (defined USB_DEVICE_SERIAL_NAME || defined USB_DEVICE_GET_SERIAL_NAME_POINTER) #if (defined USB_DEVICE_SERIAL_NAME || defined USB_DEVICE_GET_SERIAL_NAME_POINTER)
.iSerialNumber = 3, .iSerialNumber = 3,
#else #else
.iSerialNumber = 0, // No serial string .iSerialNumber = 0, // No serial string
#endif #endif
.bNumConfigurations = 1 .bNumConfigurations = 1
}; };
@ -96,52 +98,52 @@ UDC_DESC_STORAGE usb_dev_desc_t udc_device_desc = {
//! USB Device Qualifier Descriptor for HS //! USB Device Qualifier Descriptor for HS
COMPILER_WORD_ALIGNED COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE usb_dev_qual_desc_t udc_device_qual = { UDC_DESC_STORAGE usb_dev_qual_desc_t udc_device_qual = {
.bLength = sizeof(usb_dev_qual_desc_t), .bLength = sizeof(usb_dev_qual_desc_t),
.bDescriptorType = USB_DT_DEVICE_QUALIFIER, .bDescriptorType = USB_DT_DEVICE_QUALIFIER,
.bcdUSB = LE16(USB_V2_0), .bcdUSB = LE16(USB_V2_0),
.bDeviceClass = 0, .bDeviceClass = 0,
.bDeviceSubClass = 0, .bDeviceSubClass = 0,
.bDeviceProtocol = 0, .bDeviceProtocol = 0,
.bMaxPacketSize0 = USB_DEVICE_EP_CTRL_SIZE, .bMaxPacketSize0 = USB_DEVICE_EP_CTRL_SIZE,
.bNumConfigurations = 1 .bNumConfigurations = 1
}; };
#endif #endif
//! Structure for USB Device Configuration Descriptor //! Structure for USB Device Configuration Descriptor
COMPILER_PACK_SET(1) COMPILER_PACK_SET(1)
typedef struct { typedef struct {
usb_conf_desc_t conf; usb_conf_desc_t conf;
UDI_COMPOSITE_DESC_T; UDI_COMPOSITE_DESC_T;
} udc_desc_t; } udc_desc_t;
COMPILER_PACK_RESET() COMPILER_PACK_RESET()
//! USB Device Configuration Descriptor filled for FS //! USB Device Configuration Descriptor filled for FS
COMPILER_WORD_ALIGNED COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE udc_desc_t udc_desc_fs = { UDC_DESC_STORAGE udc_desc_t udc_desc_fs = {
.conf.bLength = sizeof(usb_conf_desc_t), .conf.bLength = sizeof(usb_conf_desc_t),
.conf.bDescriptorType = USB_DT_CONFIGURATION, .conf.bDescriptorType = USB_DT_CONFIGURATION,
.conf.wTotalLength = LE16(sizeof(udc_desc_t)), .conf.wTotalLength = LE16(sizeof(udc_desc_t)),
.conf.bNumInterfaces = USB_DEVICE_NB_INTERFACE, .conf.bNumInterfaces = USB_DEVICE_NB_INTERFACE,
.conf.bConfigurationValue = 1, .conf.bConfigurationValue = 1,
.conf.iConfiguration = 0, .conf.iConfiguration = 0,
.conf.bmAttributes = USB_CONFIG_ATTR_MUST_SET | USB_DEVICE_ATTR, .conf.bmAttributes = USB_CONFIG_ATTR_MUST_SET | USB_DEVICE_ATTR,
.conf.bMaxPower = USB_CONFIG_MAX_POWER(USB_DEVICE_POWER), .conf.bMaxPower = USB_CONFIG_MAX_POWER(USB_DEVICE_POWER),
UDI_COMPOSITE_DESC_FS UDI_COMPOSITE_DESC_FS
}; };
#ifdef USB_DEVICE_HS_SUPPORT #ifdef USB_DEVICE_HS_SUPPORT
//! USB Device Configuration Descriptor filled for HS //! USB Device Configuration Descriptor filled for HS
COMPILER_WORD_ALIGNED COMPILER_WORD_ALIGNED
UDC_DESC_STORAGE udc_desc_t udc_desc_hs = { UDC_DESC_STORAGE udc_desc_t udc_desc_hs = {
.conf.bLength = sizeof(usb_conf_desc_t), .conf.bLength = sizeof(usb_conf_desc_t),
.conf.bDescriptorType = USB_DT_CONFIGURATION, .conf.bDescriptorType = USB_DT_CONFIGURATION,
.conf.wTotalLength = LE16(sizeof(udc_desc_t)), .conf.wTotalLength = LE16(sizeof(udc_desc_t)),
.conf.bNumInterfaces = USB_DEVICE_NB_INTERFACE, .conf.bNumInterfaces = USB_DEVICE_NB_INTERFACE,
.conf.bConfigurationValue = 1, .conf.bConfigurationValue = 1,
.conf.iConfiguration = 0, .conf.iConfiguration = 0,
.conf.bmAttributes = USB_CONFIG_ATTR_MUST_SET | USB_DEVICE_ATTR, .conf.bmAttributes = USB_CONFIG_ATTR_MUST_SET | USB_DEVICE_ATTR,
.conf.bMaxPower = USB_CONFIG_MAX_POWER(USB_DEVICE_POWER), .conf.bMaxPower = USB_CONFIG_MAX_POWER(USB_DEVICE_POWER),
UDI_COMPOSITE_DESC_HS UDI_COMPOSITE_DESC_HS
}; };
#endif #endif
@ -153,31 +155,31 @@ UDC_DESC_STORAGE udc_desc_t udc_desc_hs = {
//! Associate an UDI for each USB interface //! Associate an UDI for each USB interface
UDC_DESC_STORAGE udi_api_t *udi_apis[USB_DEVICE_NB_INTERFACE] = { UDC_DESC_STORAGE udi_api_t *udi_apis[USB_DEVICE_NB_INTERFACE] = {
UDI_COMPOSITE_API UDI_COMPOSITE_API
}; };
//! Add UDI with USB Descriptors FS //! Add UDI with USB Descriptors FS
UDC_DESC_STORAGE udc_config_speed_t udc_config_lsfs[1] = {{ UDC_DESC_STORAGE udc_config_speed_t udc_config_lsfs[1] = {{
.desc = (usb_conf_desc_t UDC_DESC_STORAGE*)&udc_desc_fs, .desc = (usb_conf_desc_t UDC_DESC_STORAGE*)&udc_desc_fs,
.udi_apis = udi_apis, .udi_apis = udi_apis,
}}; }};
#ifdef USB_DEVICE_HS_SUPPORT #ifdef USB_DEVICE_HS_SUPPORT
//! Add UDI with USB Descriptors HS //! Add UDI with USB Descriptors HS
UDC_DESC_STORAGE udc_config_speed_t udc_config_hs[1] = {{ UDC_DESC_STORAGE udc_config_speed_t udc_config_hs[1] = {{
.desc = (usb_conf_desc_t UDC_DESC_STORAGE*)&udc_desc_hs, .desc = (usb_conf_desc_t UDC_DESC_STORAGE*)&udc_desc_hs,
.udi_apis = udi_apis, .udi_apis = udi_apis,
}}; }};
#endif #endif
//! Add all information about USB Device in global structure for UDC //! Add all information about USB Device in global structure for UDC
UDC_DESC_STORAGE udc_config_t udc_config = { UDC_DESC_STORAGE udc_config_t udc_config = {
.confdev_lsfs = &udc_device_desc, .confdev_lsfs = &udc_device_desc,
.conf_lsfs = udc_config_lsfs, .conf_lsfs = udc_config_lsfs,
#ifdef USB_DEVICE_HS_SUPPORT #ifdef USB_DEVICE_HS_SUPPORT
.confdev_hs = &udc_device_desc, .confdev_hs = &udc_device_desc,
.qualifier = &udc_device_qual, .qualifier = &udc_device_qual,
.conf_hs = udc_config_hs, .conf_hs = udc_config_hs,
#endif #endif
}; };
@ -185,4 +187,5 @@ UDC_DESC_STORAGE udc_config_t udc_config = {
/**INDENT-ON**/ /**INDENT-ON**/
//@} //@}
#endif
#endif #endif

View file

@ -57,6 +57,8 @@
#include "ctrl_access.h" #include "ctrl_access.h"
#include <string.h> #include <string.h>
#if ENABLED(SDSUPPORT)
#ifndef UDI_MSC_NOTIFY_TRANS_EXT #ifndef UDI_MSC_NOTIFY_TRANS_EXT
# define UDI_MSC_NOTIFY_TRANS_EXT() # define UDI_MSC_NOTIFY_TRANS_EXT()
#endif #endif
@ -76,11 +78,11 @@ uint8_t udi_msc_getsetting(void);
//! Global structure which contains standard UDI API for UDC //! Global structure which contains standard UDI API for UDC
UDC_DESC_STORAGE udi_api_t udi_api_msc = { UDC_DESC_STORAGE udi_api_t udi_api_msc = {
.enable = udi_msc_enable, .enable = udi_msc_enable,
.disable = udi_msc_disable, .disable = udi_msc_disable,
.setup = udi_msc_setup, .setup = udi_msc_setup,
.getsetting = udi_msc_getsetting, .getsetting = udi_msc_getsetting,
.sof_notify = NULL, .sof_notify = NULL,
}; };
//@} //@}
@ -105,7 +107,7 @@ UDC_DESC_STORAGE udi_api_t udi_api_msc = {
UDC_BSS(4) static struct usb_msc_cbw udi_msc_cbw; UDC_BSS(4) static struct usb_msc_cbw udi_msc_cbw;
//! Structure to send a CSW packet //! Structure to send a CSW packet
UDC_DATA(4) static struct usb_msc_csw udi_msc_csw = UDC_DATA(4) static struct usb_msc_csw udi_msc_csw =
{.dCSWSignature = CPU_TO_BE32(USB_CSW_SIGNATURE) }; {.dCSWSignature = CPU_TO_BE32(USB_CSW_SIGNATURE) };
//! Number of lun //! Number of lun
UDC_DATA(4) static uint8_t udi_msc_nb_lun = 0; UDC_DATA(4) static uint8_t udi_msc_nb_lun = 0;
//! Structure with current SCSI sense data //! Structure with current SCSI sense data
@ -174,7 +176,7 @@ static void udi_msc_cbw_wait(void);
* \param nb_received number of data transfered * \param nb_received number of data transfered
*/ */
static void udi_msc_cbw_received(udd_ep_status_t status, static void udi_msc_cbw_received(udd_ep_status_t status,
iram_size_t nb_received, udd_ep_id_t ep); iram_size_t nb_received, udd_ep_id_t ep);
/** /**
* \brief Function to check the CBW length and direction * \brief Function to check the CBW length and direction
@ -212,7 +214,7 @@ static void udi_msc_data_send(uint8_t * buffer, uint8_t buf_size);
* \param nb_sent number of data transfered * \param nb_sent number of data transfered
*/ */
static void udi_msc_data_sent(udd_ep_status_t status, iram_size_t nb_sent, static void udi_msc_data_sent(udd_ep_status_t status, iram_size_t nb_sent,
udd_ep_id_t ep); udd_ep_id_t ep);
//@} //@}
@ -245,7 +247,7 @@ void udi_msc_csw_send(void);
* \param nb_sent number of data transfered * \param nb_sent number of data transfered
*/ */
static void udi_msc_csw_sent(udd_ep_status_t status, iram_size_t nb_sent, static void udi_msc_csw_sent(udd_ep_status_t status, iram_size_t nb_sent,
udd_ep_id_t ep); udd_ep_id_t ep);
//@} //@}
@ -267,7 +269,7 @@ static void udi_msc_clear_sense(void);
* \param lba LBA corresponding at error * \param lba LBA corresponding at error
*/ */
static void udi_msc_sense_fail(uint8_t sense_key, uint16_t add_sense, static void udi_msc_sense_fail(uint8_t sense_key, uint16_t add_sense,
uint32_t lba); uint32_t lba);
/** /**
* \brief Update sense data with new value to signal success * \brief Update sense data with new value to signal success
@ -373,85 +375,85 @@ static void udi_msc_sbc_trans(bool b_read);
bool udi_msc_enable(void) bool udi_msc_enable(void)
{ {
uint8_t lun; uint8_t lun;
udi_msc_b_trans_req = false; udi_msc_b_trans_req = false;
udi_msc_b_cbw_invalid = false; udi_msc_b_cbw_invalid = false;
udi_msc_b_ack_trans = true; udi_msc_b_ack_trans = true;
udi_msc_b_reset_trans = true; udi_msc_b_reset_trans = true;
udi_msc_nb_lun = get_nb_lun(); udi_msc_nb_lun = get_nb_lun();
if (0 == udi_msc_nb_lun) if (0 == udi_msc_nb_lun)
return false; // No lun available, then not authorize to enable interface return false; // No lun available, then not authorize to enable interface
udi_msc_nb_lun--; udi_msc_nb_lun--;
// Call application callback // Call application callback
// to initialize memories or signal that interface is enabled // to initialize memories or signal that interface is enabled
if (!UDI_MSC_ENABLE_EXT()) if (!UDI_MSC_ENABLE_EXT())
return false; return false;
// Load the medium on each LUN // Load the medium on each LUN
for (lun = 0; lun <= udi_msc_nb_lun; lun ++) { for (lun = 0; lun <= udi_msc_nb_lun; lun ++) {
mem_unload(lun, false); mem_unload(lun, false);
} }
// Start MSC process by CBW reception // Start MSC process by CBW reception
udi_msc_cbw_wait(); udi_msc_cbw_wait();
return true; return true;
} }
void udi_msc_disable(void) void udi_msc_disable(void)
{ {
udi_msc_b_trans_req = false; udi_msc_b_trans_req = false;
udi_msc_b_ack_trans = true; udi_msc_b_ack_trans = true;
udi_msc_b_reset_trans = true; udi_msc_b_reset_trans = true;
UDI_MSC_DISABLE_EXT(); UDI_MSC_DISABLE_EXT();
} }
bool udi_msc_setup(void) bool udi_msc_setup(void)
{ {
if (Udd_setup_is_in()) { if (Udd_setup_is_in()) {
// Requests Interface GET // Requests Interface GET
if (Udd_setup_type() == USB_REQ_TYPE_CLASS) { if (Udd_setup_type() == USB_REQ_TYPE_CLASS) {
// Requests Class Interface Get // Requests Class Interface Get
switch (udd_g_ctrlreq.req.bRequest) { switch (udd_g_ctrlreq.req.bRequest) {
case USB_REQ_MSC_GET_MAX_LUN: case USB_REQ_MSC_GET_MAX_LUN:
// Give the number of memories available // Give the number of memories available
if (1 != udd_g_ctrlreq.req.wLength) if (1 != udd_g_ctrlreq.req.wLength)
return false; // Error for USB host return false; // Error for USB host
if (0 != udd_g_ctrlreq.req.wValue) if (0 != udd_g_ctrlreq.req.wValue)
return false; return false;
udd_g_ctrlreq.payload = &udi_msc_nb_lun; udd_g_ctrlreq.payload = &udi_msc_nb_lun;
udd_g_ctrlreq.payload_size = 1; udd_g_ctrlreq.payload_size = 1;
return true; return true;
} }
} }
} }
if (Udd_setup_is_out()) { if (Udd_setup_is_out()) {
// Requests Interface SET // Requests Interface SET
if (Udd_setup_type() == USB_REQ_TYPE_CLASS) { if (Udd_setup_type() == USB_REQ_TYPE_CLASS) {
// Requests Class Interface Set // Requests Class Interface Set
switch (udd_g_ctrlreq.req.bRequest) { switch (udd_g_ctrlreq.req.bRequest) {
case USB_REQ_MSC_BULK_RESET: case USB_REQ_MSC_BULK_RESET:
// Reset MSC interface // Reset MSC interface
if (0 != udd_g_ctrlreq.req.wLength) if (0 != udd_g_ctrlreq.req.wLength)
return false; return false;
if (0 != udd_g_ctrlreq.req.wValue) if (0 != udd_g_ctrlreq.req.wValue)
return false; return false;
udi_msc_b_cbw_invalid = false; udi_msc_b_cbw_invalid = false;
udi_msc_b_trans_req = false; udi_msc_b_trans_req = false;
// Abort all tasks (transfer or clear stall wait) on endpoints // Abort all tasks (transfer or clear stall wait) on endpoints
udd_ep_abort(UDI_MSC_EP_OUT); udd_ep_abort(UDI_MSC_EP_OUT);
udd_ep_abort(UDI_MSC_EP_IN); udd_ep_abort(UDI_MSC_EP_IN);
// Restart by CBW wait // Restart by CBW wait
udi_msc_cbw_wait(); udi_msc_cbw_wait();
return true; return true;
} }
} }
} }
return false; // Not supported request return false; // Not supported request
} }
uint8_t udi_msc_getsetting(void) uint8_t udi_msc_getsetting(void)
{ {
return 0; // MSC don't have multiple alternate setting return 0; // MSC don't have multiple alternate setting
} }
@ -460,154 +462,154 @@ uint8_t udi_msc_getsetting(void)
static void udi_msc_cbw_invalid(void) static void udi_msc_cbw_invalid(void)
{ {
if (!udi_msc_b_cbw_invalid) if (!udi_msc_b_cbw_invalid)
return; // Don't re-stall endpoint if error reseted by setup return; // Don't re-stall endpoint if error reseted by setup
udd_ep_set_halt(UDI_MSC_EP_OUT); udd_ep_set_halt(UDI_MSC_EP_OUT);
// If stall cleared then re-stall it. Only Setup MSC Reset can clear it // If stall cleared then re-stall it. Only Setup MSC Reset can clear it
udd_ep_wait_stall_clear(UDI_MSC_EP_OUT, udi_msc_cbw_invalid); udd_ep_wait_stall_clear(UDI_MSC_EP_OUT, udi_msc_cbw_invalid);
} }
static void udi_msc_csw_invalid(void) static void udi_msc_csw_invalid(void)
{ {
if (!udi_msc_b_cbw_invalid) if (!udi_msc_b_cbw_invalid)
return; // Don't re-stall endpoint if error reseted by setup return; // Don't re-stall endpoint if error reseted by setup
udd_ep_set_halt(UDI_MSC_EP_IN); udd_ep_set_halt(UDI_MSC_EP_IN);
// If stall cleared then re-stall it. Only Setup MSC Reset can clear it // If stall cleared then re-stall it. Only Setup MSC Reset can clear it
udd_ep_wait_stall_clear(UDI_MSC_EP_IN, udi_msc_csw_invalid); udd_ep_wait_stall_clear(UDI_MSC_EP_IN, udi_msc_csw_invalid);
} }
static void udi_msc_cbw_wait(void) static void udi_msc_cbw_wait(void)
{ {
// Register buffer and callback on OUT endpoint // Register buffer and callback on OUT endpoint
if (!udd_ep_run(UDI_MSC_EP_OUT, true, if (!udd_ep_run(UDI_MSC_EP_OUT, true,
(uint8_t *) & udi_msc_cbw, (uint8_t *) & udi_msc_cbw,
sizeof(udi_msc_cbw), sizeof(udi_msc_cbw),
udi_msc_cbw_received)) { udi_msc_cbw_received)) {
// OUT endpoint not available (halted), then wait a clear of halt. // OUT endpoint not available (halted), then wait a clear of halt.
udd_ep_wait_stall_clear(UDI_MSC_EP_OUT, udi_msc_cbw_wait); udd_ep_wait_stall_clear(UDI_MSC_EP_OUT, udi_msc_cbw_wait);
} }
} }
static void udi_msc_cbw_received(udd_ep_status_t status, static void udi_msc_cbw_received(udd_ep_status_t status,
iram_size_t nb_received, udd_ep_id_t ep) iram_size_t nb_received, udd_ep_id_t ep)
{ {
UNUSED(ep); UNUSED(ep);
// Check status of transfer // Check status of transfer
if (UDD_EP_TRANSFER_OK != status) { if (UDD_EP_TRANSFER_OK != status) {
// Transfer aborted // Transfer aborted
// Now wait MSC setup reset to relaunch CBW reception // Now wait MSC setup reset to relaunch CBW reception
return; return;
} }
// Check CBW integrity: // Check CBW integrity:
// transfer status/CBW length/CBW signature // transfer status/CBW length/CBW signature
if ((sizeof(udi_msc_cbw) != nb_received) if ((sizeof(udi_msc_cbw) != nb_received)
|| (udi_msc_cbw.dCBWSignature != || (udi_msc_cbw.dCBWSignature !=
CPU_TO_BE32(USB_CBW_SIGNATURE))) { CPU_TO_BE32(USB_CBW_SIGNATURE))) {
// (5.2.1) Devices receiving a CBW with an invalid signature should stall // (5.2.1) Devices receiving a CBW with an invalid signature should stall
// further traffic on the Bulk In pipe, and either stall further traffic // further traffic on the Bulk In pipe, and either stall further traffic
// or accept and discard further traffic on the Bulk Out pipe, until // or accept and discard further traffic on the Bulk Out pipe, until
// reset recovery. // reset recovery.
udi_msc_b_cbw_invalid = true; udi_msc_b_cbw_invalid = true;
udi_msc_cbw_invalid(); udi_msc_cbw_invalid();
udi_msc_csw_invalid(); udi_msc_csw_invalid();
return; return;
} }
// Check LUN asked // Check LUN asked
udi_msc_cbw.bCBWLUN &= USB_CBW_LUN_MASK; udi_msc_cbw.bCBWLUN &= USB_CBW_LUN_MASK;
if (udi_msc_cbw.bCBWLUN > udi_msc_nb_lun) { if (udi_msc_cbw.bCBWLUN > udi_msc_nb_lun) {
// Bad LUN, then stop command process // Bad LUN, then stop command process
udi_msc_sense_fail_cdb_invalid(); udi_msc_sense_fail_cdb_invalid();
udi_msc_csw_process(); udi_msc_csw_process();
return; return;
} }
// Prepare CSW residue field with the size requested // Prepare CSW residue field with the size requested
udi_msc_csw.dCSWDataResidue = udi_msc_csw.dCSWDataResidue =
le32_to_cpu(udi_msc_cbw.dCBWDataTransferLength); le32_to_cpu(udi_msc_cbw.dCBWDataTransferLength);
// Decode opcode // Decode opcode
switch (udi_msc_cbw.CDB[0]) { switch (udi_msc_cbw.CDB[0]) {
case SPC_REQUEST_SENSE: case SPC_REQUEST_SENSE:
udi_msc_spc_requestsense(); udi_msc_spc_requestsense();
break; break;
case SPC_INQUIRY: case SPC_INQUIRY:
udi_msc_spc_inquiry(); udi_msc_spc_inquiry();
break; break;
case SPC_MODE_SENSE6: case SPC_MODE_SENSE6:
udi_msc_spc_mode_sense(false); udi_msc_spc_mode_sense(false);
break; break;
case SPC_MODE_SENSE10: case SPC_MODE_SENSE10:
udi_msc_spc_mode_sense(true); udi_msc_spc_mode_sense(true);
break; break;
case SPC_TEST_UNIT_READY: case SPC_TEST_UNIT_READY:
udi_msc_spc_testunitready(); udi_msc_spc_testunitready();
break; break;
case SBC_READ_CAPACITY10: case SBC_READ_CAPACITY10:
udi_msc_sbc_read_capacity(); udi_msc_sbc_read_capacity();
break; break;
case SBC_START_STOP_UNIT: case SBC_START_STOP_UNIT:
udi_msc_sbc_start_stop(); udi_msc_sbc_start_stop();
break; break;
// Accepts request to support plug/plug in case of card reader // Accepts request to support plug/plug in case of card reader
case SPC_PREVENT_ALLOW_MEDIUM_REMOVAL: case SPC_PREVENT_ALLOW_MEDIUM_REMOVAL:
udi_msc_spc_prevent_allow_medium_removal(); udi_msc_spc_prevent_allow_medium_removal();
break; break;
// Accepts request to support full format from Windows // Accepts request to support full format from Windows
case SBC_VERIFY10: case SBC_VERIFY10:
udi_msc_sense_pass(); udi_msc_sense_pass();
udi_msc_csw_process(); udi_msc_csw_process();
break; break;
case SBC_READ10: case SBC_READ10:
udi_msc_sbc_trans(true); udi_msc_sbc_trans(true);
break; break;
case SBC_WRITE10: case SBC_WRITE10:
udi_msc_sbc_trans(false); udi_msc_sbc_trans(false);
break; break;
default: default:
udi_msc_sense_command_invalid(); udi_msc_sense_command_invalid();
udi_msc_csw_process(); udi_msc_csw_process();
break; break;
} }
} }
static bool udi_msc_cbw_validate(uint32_t alloc_len, uint8_t dir_flag) static bool udi_msc_cbw_validate(uint32_t alloc_len, uint8_t dir_flag)
{ {
/* /*
* The following cases should result in a phase error: * The following cases should result in a phase error:
* - Case 2: Hn < Di * - Case 2: Hn < Di
* - Case 3: Hn < Do * - Case 3: Hn < Do
* - Case 7: Hi < Di * - Case 7: Hi < Di
* - Case 8: Hi <> Do * - Case 8: Hi <> Do
* - Case 10: Ho <> Di * - Case 10: Ho <> Di
* - Case 13: Ho < Do * - Case 13: Ho < Do
*/ */
if (((udi_msc_cbw.bmCBWFlags ^ dir_flag) & USB_CBW_DIRECTION_IN) if (((udi_msc_cbw.bmCBWFlags ^ dir_flag) & USB_CBW_DIRECTION_IN)
|| (udi_msc_csw.dCSWDataResidue < alloc_len)) { || (udi_msc_csw.dCSWDataResidue < alloc_len)) {
udi_msc_sense_fail_cdb_invalid(); udi_msc_sense_fail_cdb_invalid();
udi_msc_csw_process(); udi_msc_csw_process();
return false; return false;
} }
/* /*
* The following cases should result in a stall and nonzero * The following cases should result in a stall and nonzero
* residue: * residue:
* - Case 4: Hi > Dn * - Case 4: Hi > Dn
* - Case 5: Hi > Di * - Case 5: Hi > Di
* - Case 9: Ho > Dn * - Case 9: Ho > Dn
* - Case 11: Ho > Do * - Case 11: Ho > Do
*/ */
return true; return true;
} }
@ -616,30 +618,30 @@ static bool udi_msc_cbw_validate(uint32_t alloc_len, uint8_t dir_flag)
static void udi_msc_data_send(uint8_t * buffer, uint8_t buf_size) static void udi_msc_data_send(uint8_t * buffer, uint8_t buf_size)
{ {
// Sends data on IN endpoint // Sends data on IN endpoint
if (!udd_ep_run(UDI_MSC_EP_IN, true, if (!udd_ep_run(UDI_MSC_EP_IN, true,
buffer, buf_size, udi_msc_data_sent)) { buffer, buf_size, udi_msc_data_sent)) {
// If endpoint not available, then exit process command // If endpoint not available, then exit process command
udi_msc_sense_fail_hardware(); udi_msc_sense_fail_hardware();
udi_msc_csw_process(); udi_msc_csw_process();
} }
} }
static void udi_msc_data_sent(udd_ep_status_t status, iram_size_t nb_sent, static void udi_msc_data_sent(udd_ep_status_t status, iram_size_t nb_sent,
udd_ep_id_t ep) udd_ep_id_t ep)
{ {
UNUSED(ep); UNUSED(ep);
if (UDD_EP_TRANSFER_OK != status) { if (UDD_EP_TRANSFER_OK != status) {
// Error protocol // Error protocol
// Now wait MSC setup reset to relaunch CBW reception // Now wait MSC setup reset to relaunch CBW reception
return; return;
} }
// Update sense data // Update sense data
udi_msc_sense_pass(); udi_msc_sense_pass();
// Update CSW // Update CSW
udi_msc_csw.dCSWDataResidue -= nb_sent; udi_msc_csw.dCSWDataResidue -= nb_sent;
udi_msc_csw_process(); udi_msc_csw_process();
} }
@ -648,44 +650,44 @@ static void udi_msc_data_sent(udd_ep_status_t status, iram_size_t nb_sent,
static void udi_msc_csw_process(void) static void udi_msc_csw_process(void)
{ {
if (0 != udi_msc_csw.dCSWDataResidue) { if (0 != udi_msc_csw.dCSWDataResidue) {
// Residue not NULL // Residue not NULL
// then STALL next request from USB host on corresponding endpoint // then STALL next request from USB host on corresponding endpoint
if (udi_msc_cbw.bmCBWFlags & USB_CBW_DIRECTION_IN) if (udi_msc_cbw.bmCBWFlags & USB_CBW_DIRECTION_IN)
udd_ep_set_halt(UDI_MSC_EP_IN); udd_ep_set_halt(UDI_MSC_EP_IN);
else else
udd_ep_set_halt(UDI_MSC_EP_OUT); udd_ep_set_halt(UDI_MSC_EP_OUT);
} }
// Prepare and send CSW // Prepare and send CSW
udi_msc_csw.dCSWTag = udi_msc_cbw.dCBWTag; udi_msc_csw.dCSWTag = udi_msc_cbw.dCBWTag;
udi_msc_csw.dCSWDataResidue = cpu_to_le32(udi_msc_csw.dCSWDataResidue); udi_msc_csw.dCSWDataResidue = cpu_to_le32(udi_msc_csw.dCSWDataResidue);
udi_msc_csw_send(); udi_msc_csw_send();
} }
void udi_msc_csw_send(void) void udi_msc_csw_send(void)
{ {
// Sends CSW on IN endpoint // Sends CSW on IN endpoint
if (!udd_ep_run(UDI_MSC_EP_IN, false, if (!udd_ep_run(UDI_MSC_EP_IN, false,
(uint8_t *) & udi_msc_csw, (uint8_t *) & udi_msc_csw,
sizeof(udi_msc_csw), sizeof(udi_msc_csw),
udi_msc_csw_sent)) { udi_msc_csw_sent)) {
// Endpoint not available // Endpoint not available
// then restart CSW sent when endpoint IN STALL will be cleared // then restart CSW sent when endpoint IN STALL will be cleared
udd_ep_wait_stall_clear(UDI_MSC_EP_IN, udi_msc_csw_send); udd_ep_wait_stall_clear(UDI_MSC_EP_IN, udi_msc_csw_send);
} }
} }
static void udi_msc_csw_sent(udd_ep_status_t status, iram_size_t nb_sent, static void udi_msc_csw_sent(udd_ep_status_t status, iram_size_t nb_sent,
udd_ep_id_t ep) udd_ep_id_t ep)
{ {
UNUSED(ep); UNUSED(ep);
UNUSED(status); UNUSED(status);
UNUSED(nb_sent); UNUSED(nb_sent);
// CSW is sent or not // CSW is sent or not
// In all case, restart process and wait CBW // In all case, restart process and wait CBW
udi_msc_cbw_wait(); udi_msc_cbw_wait();
} }
@ -694,64 +696,64 @@ static void udi_msc_csw_sent(udd_ep_status_t status, iram_size_t nb_sent,
static void udi_msc_clear_sense(void) static void udi_msc_clear_sense(void)
{ {
memset((uint8_t*)&udi_msc_sense, 0, sizeof(struct scsi_request_sense_data)); memset((uint8_t*)&udi_msc_sense, 0, sizeof(struct scsi_request_sense_data));
udi_msc_sense.valid_reponse_code = SCSI_SENSE_VALID | SCSI_SENSE_CURRENT; udi_msc_sense.valid_reponse_code = SCSI_SENSE_VALID | SCSI_SENSE_CURRENT;
udi_msc_sense.AddSenseLen = SCSI_SENSE_ADDL_LEN(sizeof(udi_msc_sense)); udi_msc_sense.AddSenseLen = SCSI_SENSE_ADDL_LEN(sizeof(udi_msc_sense));
} }
static void udi_msc_sense_fail(uint8_t sense_key, uint16_t add_sense, static void udi_msc_sense_fail(uint8_t sense_key, uint16_t add_sense,
uint32_t lba) uint32_t lba)
{ {
udi_msc_clear_sense(); udi_msc_clear_sense();
udi_msc_csw.bCSWStatus = USB_CSW_STATUS_FAIL; udi_msc_csw.bCSWStatus = USB_CSW_STATUS_FAIL;
udi_msc_sense.sense_flag_key = sense_key; udi_msc_sense.sense_flag_key = sense_key;
udi_msc_sense.information[0] = lba >> 24; udi_msc_sense.information[0] = lba >> 24;
udi_msc_sense.information[1] = lba >> 16; udi_msc_sense.information[1] = lba >> 16;
udi_msc_sense.information[2] = lba >> 8; udi_msc_sense.information[2] = lba >> 8;
udi_msc_sense.information[3] = lba; udi_msc_sense.information[3] = lba;
udi_msc_sense.AddSenseCode = add_sense >> 8; udi_msc_sense.AddSenseCode = add_sense >> 8;
udi_msc_sense.AddSnsCodeQlfr = add_sense; udi_msc_sense.AddSnsCodeQlfr = add_sense;
} }
static void udi_msc_sense_pass(void) static void udi_msc_sense_pass(void)
{ {
udi_msc_clear_sense(); udi_msc_clear_sense();
udi_msc_csw.bCSWStatus = USB_CSW_STATUS_PASS; udi_msc_csw.bCSWStatus = USB_CSW_STATUS_PASS;
} }
static void udi_msc_sense_fail_not_present(void) static void udi_msc_sense_fail_not_present(void)
{ {
udi_msc_sense_fail(SCSI_SK_NOT_READY, SCSI_ASC_MEDIUM_NOT_PRESENT, 0); udi_msc_sense_fail(SCSI_SK_NOT_READY, SCSI_ASC_MEDIUM_NOT_PRESENT, 0);
} }
static void udi_msc_sense_fail_busy_or_change(void) static void udi_msc_sense_fail_busy_or_change(void)
{ {
udi_msc_sense_fail(SCSI_SK_UNIT_ATTENTION, udi_msc_sense_fail(SCSI_SK_UNIT_ATTENTION,
SCSI_ASC_NOT_READY_TO_READY_CHANGE, 0); SCSI_ASC_NOT_READY_TO_READY_CHANGE, 0);
} }
static void udi_msc_sense_fail_hardware(void) static void udi_msc_sense_fail_hardware(void)
{ {
udi_msc_sense_fail(SCSI_SK_HARDWARE_ERROR, udi_msc_sense_fail(SCSI_SK_HARDWARE_ERROR,
SCSI_ASC_NO_ADDITIONAL_SENSE_INFO, 0); SCSI_ASC_NO_ADDITIONAL_SENSE_INFO, 0);
} }
static void udi_msc_sense_fail_protected(void) static void udi_msc_sense_fail_protected(void)
{ {
udi_msc_sense_fail(SCSI_SK_DATA_PROTECT, SCSI_ASC_WRITE_PROTECTED, 0); udi_msc_sense_fail(SCSI_SK_DATA_PROTECT, SCSI_ASC_WRITE_PROTECTED, 0);
} }
static void udi_msc_sense_fail_cdb_invalid(void) static void udi_msc_sense_fail_cdb_invalid(void)
{ {
udi_msc_sense_fail(SCSI_SK_ILLEGAL_REQUEST, udi_msc_sense_fail(SCSI_SK_ILLEGAL_REQUEST,
SCSI_ASC_INVALID_FIELD_IN_CDB, 0); SCSI_ASC_INVALID_FIELD_IN_CDB, 0);
} }
static void udi_msc_sense_command_invalid(void) static void udi_msc_sense_command_invalid(void)
{ {
udi_msc_sense_fail(SCSI_SK_ILLEGAL_REQUEST, udi_msc_sense_fail(SCSI_SK_ILLEGAL_REQUEST,
SCSI_ASC_INVALID_COMMAND_OPERATION_CODE, 0); SCSI_ASC_INVALID_COMMAND_OPERATION_CODE, 0);
} }
@ -760,369 +762,370 @@ static void udi_msc_sense_command_invalid(void)
static void udi_msc_spc_requestsense(void) static void udi_msc_spc_requestsense(void)
{ {
uint8_t length = udi_msc_cbw.CDB[4]; uint8_t length = udi_msc_cbw.CDB[4];
// Can't send more than sense data length // Can't send more than sense data length
if (length > sizeof(udi_msc_sense)) if (length > sizeof(udi_msc_sense))
length = sizeof(udi_msc_sense); length = sizeof(udi_msc_sense);
if (!udi_msc_cbw_validate(length, USB_CBW_DIRECTION_IN)) if (!udi_msc_cbw_validate(length, USB_CBW_DIRECTION_IN))
return; return;
// Send sense data // Send sense data
udi_msc_data_send((uint8_t*)&udi_msc_sense, length); udi_msc_data_send((uint8_t*)&udi_msc_sense, length);
} }
static void udi_msc_spc_inquiry(void) static void udi_msc_spc_inquiry(void)
{ {
uint8_t length, i; uint8_t length, i;
UDC_DATA(4) UDC_DATA(4)
// Constant inquiry data for all LUNs // Constant inquiry data for all LUNs
static struct scsi_inquiry_data udi_msc_inquiry_data = { static struct scsi_inquiry_data udi_msc_inquiry_data = {
.pq_pdt = SCSI_INQ_PQ_CONNECTED | SCSI_INQ_DT_DIR_ACCESS, .pq_pdt = SCSI_INQ_PQ_CONNECTED | SCSI_INQ_DT_DIR_ACCESS,
.version = SCSI_INQ_VER_SPC, .version = SCSI_INQ_VER_SPC,
.flags3 = SCSI_INQ_RSP_SPC2, .flags3 = SCSI_INQ_RSP_SPC2,
.addl_len = SCSI_INQ_ADDL_LEN(sizeof(struct scsi_inquiry_data)), .addl_len = SCSI_INQ_ADDL_LEN(sizeof(struct scsi_inquiry_data)),
.vendor_id = {UDI_MSC_GLOBAL_VENDOR_ID}, .vendor_id = {UDI_MSC_GLOBAL_VENDOR_ID},
.product_rev = {UDI_MSC_GLOBAL_PRODUCT_VERSION}, .product_rev = {UDI_MSC_GLOBAL_PRODUCT_VERSION},
}; };
length = udi_msc_cbw.CDB[4]; length = udi_msc_cbw.CDB[4];
// Can't send more than inquiry data length // Can't send more than inquiry data length
if (length > sizeof(udi_msc_inquiry_data)) if (length > sizeof(udi_msc_inquiry_data))
length = sizeof(udi_msc_inquiry_data); length = sizeof(udi_msc_inquiry_data);
if (!udi_msc_cbw_validate(length, USB_CBW_DIRECTION_IN)) if (!udi_msc_cbw_validate(length, USB_CBW_DIRECTION_IN))
return; return;
if ((0 != (udi_msc_cbw.CDB[1] & (SCSI_INQ_REQ_EVPD | SCSI_INQ_REQ_CMDT))) if ((0 != (udi_msc_cbw.CDB[1] & (SCSI_INQ_REQ_EVPD | SCSI_INQ_REQ_CMDT)))
|| (0 != udi_msc_cbw.CDB[2])) { || (0 != udi_msc_cbw.CDB[2])) {
// CMDT and EPVD bits are not at 0 // CMDT and EPVD bits are not at 0
// PAGE or OPERATION CODE fields are not empty // PAGE or OPERATION CODE fields are not empty
// = No standard inquiry asked // = No standard inquiry asked
udi_msc_sense_fail_cdb_invalid(); // Command is unsupported udi_msc_sense_fail_cdb_invalid(); // Command is unsupported
udi_msc_csw_process(); udi_msc_csw_process();
return; return;
} }
udi_msc_inquiry_data.flags1 = mem_removal(udi_msc_cbw.bCBWLUN) ? udi_msc_inquiry_data.flags1 = mem_removal(udi_msc_cbw.bCBWLUN) ?
SCSI_INQ_RMB : 0; SCSI_INQ_RMB : 0;
//* Fill product ID field //* Fill product ID field
// Copy name in product id field // Copy name in product id field
memcpy(udi_msc_inquiry_data.product_id, memcpy(udi_msc_inquiry_data.product_id,
mem_name(udi_msc_cbw.bCBWLUN)+1, // To remove first '"' mem_name(udi_msc_cbw.bCBWLUN)+1, // To remove first '"'
sizeof(udi_msc_inquiry_data.product_id)); sizeof(udi_msc_inquiry_data.product_id));
// Search end of name '/0' or '"' // Search end of name '/0' or '"'
i = 0; i = 0;
while (sizeof(udi_msc_inquiry_data.product_id) != i) { while (sizeof(udi_msc_inquiry_data.product_id) != i) {
if ((0 == udi_msc_inquiry_data.product_id[i]) if ((0 == udi_msc_inquiry_data.product_id[i])
|| ('"' == udi_msc_inquiry_data.product_id[i])) { || ('"' == udi_msc_inquiry_data.product_id[i])) {
break; break;
} }
i++; i++;
} }
// Padding with space char // Padding with space char
while (sizeof(udi_msc_inquiry_data.product_id) != i) { while (sizeof(udi_msc_inquiry_data.product_id) != i) {
udi_msc_inquiry_data.product_id[i] = ' '; udi_msc_inquiry_data.product_id[i] = ' ';
i++; i++;
} }
// Send inquiry data // Send inquiry data
udi_msc_data_send((uint8_t *) & udi_msc_inquiry_data, length); udi_msc_data_send((uint8_t *) & udi_msc_inquiry_data, length);
} }
static bool udi_msc_spc_testunitready_global(void) static bool udi_msc_spc_testunitready_global(void)
{ {
switch (mem_test_unit_ready(udi_msc_cbw.bCBWLUN)) { switch (mem_test_unit_ready(udi_msc_cbw.bCBWLUN)) {
case CTRL_GOOD: case CTRL_GOOD:
return true; // Don't change sense data return true; // Don't change sense data
case CTRL_BUSY: case CTRL_BUSY:
udi_msc_sense_fail_busy_or_change(); udi_msc_sense_fail_busy_or_change();
break; break;
case CTRL_NO_PRESENT: case CTRL_NO_PRESENT:
udi_msc_sense_fail_not_present(); udi_msc_sense_fail_not_present();
break; break;
case CTRL_FAIL: case CTRL_FAIL:
default: default:
udi_msc_sense_fail_hardware(); udi_msc_sense_fail_hardware();
break; break;
} }
return false; return false;
} }
static void udi_msc_spc_testunitready(void) static void udi_msc_spc_testunitready(void)
{ {
if (udi_msc_spc_testunitready_global()) { if (udi_msc_spc_testunitready_global()) {
// LUN ready, then update sense data with status pass // LUN ready, then update sense data with status pass
udi_msc_sense_pass(); udi_msc_sense_pass();
} }
// Send status in CSW packet // Send status in CSW packet
udi_msc_csw_process(); udi_msc_csw_process();
} }
static void udi_msc_spc_mode_sense(bool b_sense10) static void udi_msc_spc_mode_sense(bool b_sense10)
{ {
// Union of all mode sense structures // Union of all mode sense structures
union sense_6_10 { union sense_6_10 {
struct { struct {
struct scsi_mode_param_header6 header; struct scsi_mode_param_header6 header;
struct spc_control_page_info_execpt sense_data; struct spc_control_page_info_execpt sense_data;
} s6; } s6;
struct { struct {
struct scsi_mode_param_header10 header; struct scsi_mode_param_header10 header;
struct spc_control_page_info_execpt sense_data; struct spc_control_page_info_execpt sense_data;
} s10; } s10;
}; };
uint8_t data_sense_lgt; uint8_t data_sense_lgt;
uint8_t mode; uint8_t mode;
uint8_t request_lgt; uint8_t request_lgt;
uint8_t wp; uint8_t wp;
struct spc_control_page_info_execpt *ptr_mode; struct spc_control_page_info_execpt *ptr_mode;
UDC_BSS(4) static union sense_6_10 sense; UDC_BSS(4) static union sense_6_10 sense;
// Clear all fields // Clear all fields
memset(&sense, 0, sizeof(sense)); memset(&sense, 0, sizeof(sense));
// Initialize process // Initialize process
if (b_sense10) { if (b_sense10) {
request_lgt = udi_msc_cbw.CDB[8]; request_lgt = udi_msc_cbw.CDB[8];
ptr_mode = &sense.s10.sense_data; ptr_mode = &sense.s10.sense_data;
data_sense_lgt = sizeof(struct scsi_mode_param_header10); data_sense_lgt = sizeof(struct scsi_mode_param_header10);
} else { } else {
request_lgt = udi_msc_cbw.CDB[4]; request_lgt = udi_msc_cbw.CDB[4];
ptr_mode = &sense.s6.sense_data; ptr_mode = &sense.s6.sense_data;
data_sense_lgt = sizeof(struct scsi_mode_param_header6); data_sense_lgt = sizeof(struct scsi_mode_param_header6);
} }
// No Block descriptor // No Block descriptor
// Fill page(s) // Fill page(s)
mode = udi_msc_cbw.CDB[2] & SCSI_MS_MODE_ALL; mode = udi_msc_cbw.CDB[2] & SCSI_MS_MODE_ALL;
if ((SCSI_MS_MODE_INFEXP == mode) if ((SCSI_MS_MODE_INFEXP == mode)
|| (SCSI_MS_MODE_ALL == mode)) { || (SCSI_MS_MODE_ALL == mode)) {
// Informational exceptions control page (from SPC) // Informational exceptions control page (from SPC)
ptr_mode->page_code = ptr_mode->page_code =
SCSI_MS_MODE_INFEXP; SCSI_MS_MODE_INFEXP;
ptr_mode->page_length = ptr_mode->page_length =
SPC_MP_INFEXP_PAGE_LENGTH; SPC_MP_INFEXP_PAGE_LENGTH;
ptr_mode->mrie = ptr_mode->mrie =
SPC_MP_INFEXP_MRIE_NO_SENSE; SPC_MP_INFEXP_MRIE_NO_SENSE;
data_sense_lgt += sizeof(struct spc_control_page_info_execpt); data_sense_lgt += sizeof(struct spc_control_page_info_execpt);
} }
// Can't send more than mode sense data length // Can't send more than mode sense data length
if (request_lgt > data_sense_lgt) if (request_lgt > data_sense_lgt)
request_lgt = data_sense_lgt; request_lgt = data_sense_lgt;
if (!udi_msc_cbw_validate(request_lgt, USB_CBW_DIRECTION_IN)) if (!udi_msc_cbw_validate(request_lgt, USB_CBW_DIRECTION_IN))
return; return;
// Fill mode parameter header length // Fill mode parameter header length
wp = (mem_wr_protect(udi_msc_cbw.bCBWLUN)) ? SCSI_MS_SBC_WP : 0; wp = (mem_wr_protect(udi_msc_cbw.bCBWLUN)) ? SCSI_MS_SBC_WP : 0;
if (b_sense10) { if (b_sense10) {
sense.s10.header.mode_data_length = sense.s10.header.mode_data_length =
cpu_to_be16((data_sense_lgt - 2)); cpu_to_be16((data_sense_lgt - 2));
//sense.s10.header.medium_type = 0; //sense.s10.header.medium_type = 0;
sense.s10.header.device_specific_parameter = wp; sense.s10.header.device_specific_parameter = wp;
//sense.s10.header.block_descriptor_length = 0; //sense.s10.header.block_descriptor_length = 0;
} else { } else {
sense.s6.header.mode_data_length = data_sense_lgt - 1; sense.s6.header.mode_data_length = data_sense_lgt - 1;
//sense.s6.header.medium_type = 0; //sense.s6.header.medium_type = 0;
sense.s6.header.device_specific_parameter = wp; sense.s6.header.device_specific_parameter = wp;
//sense.s6.header.block_descriptor_length = 0; //sense.s6.header.block_descriptor_length = 0;
} }
// Send mode sense data // Send mode sense data
udi_msc_data_send((uint8_t *) & sense, request_lgt); udi_msc_data_send((uint8_t *) & sense, request_lgt);
} }
static void udi_msc_spc_prevent_allow_medium_removal(void) static void udi_msc_spc_prevent_allow_medium_removal(void)
{ {
uint8_t prevent = udi_msc_cbw.CDB[4]; uint8_t prevent = udi_msc_cbw.CDB[4];
if (0 == prevent) { if (0 == prevent) {
udi_msc_sense_pass(); udi_msc_sense_pass();
} else { } else {
udi_msc_sense_fail_cdb_invalid(); // Command is unsupported udi_msc_sense_fail_cdb_invalid(); // Command is unsupported
} }
udi_msc_csw_process(); udi_msc_csw_process();
} }
static void udi_msc_sbc_start_stop(void) static void udi_msc_sbc_start_stop(void)
{ {
bool start = 0x1 & udi_msc_cbw.CDB[4]; bool start = 0x1 & udi_msc_cbw.CDB[4];
bool loej = 0x2 & udi_msc_cbw.CDB[4]; bool loej = 0x2 & udi_msc_cbw.CDB[4];
if (loej) { if (loej) {
mem_unload(udi_msc_cbw.bCBWLUN, !start); mem_unload(udi_msc_cbw.bCBWLUN, !start);
} }
udi_msc_sense_pass(); udi_msc_sense_pass();
udi_msc_csw_process(); udi_msc_csw_process();
} }
static void udi_msc_sbc_read_capacity(void) static void udi_msc_sbc_read_capacity(void)
{ {
UDC_BSS(4) static struct sbc_read_capacity10_data udi_msc_capacity; UDC_BSS(4) static struct sbc_read_capacity10_data udi_msc_capacity;
if (!udi_msc_cbw_validate(sizeof(udi_msc_capacity), if (!udi_msc_cbw_validate(sizeof(udi_msc_capacity),
USB_CBW_DIRECTION_IN)) USB_CBW_DIRECTION_IN))
return; return;
// Get capacity of LUN // Get capacity of LUN
switch (mem_read_capacity(udi_msc_cbw.bCBWLUN, switch (mem_read_capacity(udi_msc_cbw.bCBWLUN,
&udi_msc_capacity.max_lba)) { &udi_msc_capacity.max_lba)) {
case CTRL_GOOD: case CTRL_GOOD:
break; break;
case CTRL_BUSY: case CTRL_BUSY:
udi_msc_sense_fail_busy_or_change(); udi_msc_sense_fail_busy_or_change();
udi_msc_csw_process(); udi_msc_csw_process();
return; return;
case CTRL_NO_PRESENT: case CTRL_NO_PRESENT:
udi_msc_sense_fail_not_present(); udi_msc_sense_fail_not_present();
udi_msc_csw_process(); udi_msc_csw_process();
return; return;
default: default:
udi_msc_sense_fail_hardware(); udi_msc_sense_fail_hardware();
udi_msc_csw_process(); udi_msc_csw_process();
return; return;
} }
// Format capacity data // Format capacity data
udi_msc_capacity.block_len = CPU_TO_BE32(UDI_MSC_BLOCK_SIZE); udi_msc_capacity.block_len = CPU_TO_BE32(UDI_MSC_BLOCK_SIZE);
udi_msc_capacity.max_lba = cpu_to_be32(udi_msc_capacity.max_lba); udi_msc_capacity.max_lba = cpu_to_be32(udi_msc_capacity.max_lba);
// Send the corresponding sense data // Send the corresponding sense data
udi_msc_data_send((uint8_t *) & udi_msc_capacity, udi_msc_data_send((uint8_t *) & udi_msc_capacity,
sizeof(udi_msc_capacity)); sizeof(udi_msc_capacity));
} }
static void udi_msc_sbc_trans(bool b_read) static void udi_msc_sbc_trans(bool b_read)
{ {
uint32_t trans_size; uint32_t trans_size;
if (!b_read) { if (!b_read) {
// Write operation then check Write Protect // Write operation then check Write Protect
if (mem_wr_protect(udi_msc_cbw.bCBWLUN)) { if (mem_wr_protect(udi_msc_cbw.bCBWLUN)) {
// Write not authorized // Write not authorized
udi_msc_sense_fail_protected(); udi_msc_sense_fail_protected();
udi_msc_csw_process(); udi_msc_csw_process();
return; return;
} }
} }
// Read/Write command fields (address and number of block) // Read/Write command fields (address and number of block)
MSB0(udi_msc_addr) = udi_msc_cbw.CDB[2]; MSB0(udi_msc_addr) = udi_msc_cbw.CDB[2];
MSB1(udi_msc_addr) = udi_msc_cbw.CDB[3]; MSB1(udi_msc_addr) = udi_msc_cbw.CDB[3];
MSB2(udi_msc_addr) = udi_msc_cbw.CDB[4]; MSB2(udi_msc_addr) = udi_msc_cbw.CDB[4];
MSB3(udi_msc_addr) = udi_msc_cbw.CDB[5]; MSB3(udi_msc_addr) = udi_msc_cbw.CDB[5];
MSB(udi_msc_nb_block) = udi_msc_cbw.CDB[7]; MSB(udi_msc_nb_block) = udi_msc_cbw.CDB[7];
LSB(udi_msc_nb_block) = udi_msc_cbw.CDB[8]; LSB(udi_msc_nb_block) = udi_msc_cbw.CDB[8];
// Compute number of byte to transfer and valid it // Compute number of byte to transfer and valid it
trans_size = (uint32_t) udi_msc_nb_block *UDI_MSC_BLOCK_SIZE; trans_size = (uint32_t) udi_msc_nb_block *UDI_MSC_BLOCK_SIZE;
if (!udi_msc_cbw_validate(trans_size, if (!udi_msc_cbw_validate(trans_size,
(b_read) ? USB_CBW_DIRECTION_IN : (b_read) ? USB_CBW_DIRECTION_IN :
USB_CBW_DIRECTION_OUT)) USB_CBW_DIRECTION_OUT))
return; return;
// Record transfer request to do it in a task and not under interrupt // Record transfer request to do it in a task and not under interrupt
udi_msc_b_read = b_read; udi_msc_b_read = b_read;
udi_msc_b_trans_req = true; udi_msc_b_trans_req = true;
UDI_MSC_NOTIFY_TRANS_EXT(); UDI_MSC_NOTIFY_TRANS_EXT();
} }
bool udi_msc_process_trans(void) bool udi_msc_process_trans(void)
{ {
Ctrl_status status; Ctrl_status status;
if (!udi_msc_b_trans_req) if (!udi_msc_b_trans_req)
return false; // No Transfer request to do return false; // No Transfer request to do
udi_msc_b_trans_req = false; udi_msc_b_trans_req = false;
udi_msc_b_reset_trans = false; udi_msc_b_reset_trans = false;
// Start transfer // Start transfer
if (udi_msc_b_read) { if (udi_msc_b_read) {
status = memory_2_usb(udi_msc_cbw.bCBWLUN, udi_msc_addr, status = memory_2_usb(udi_msc_cbw.bCBWLUN, udi_msc_addr,
udi_msc_nb_block); udi_msc_nb_block);
} else { } else {
status = usb_2_memory(udi_msc_cbw.bCBWLUN, udi_msc_addr, status = usb_2_memory(udi_msc_cbw.bCBWLUN, udi_msc_addr,
udi_msc_nb_block); udi_msc_nb_block);
} }
// Check if transfer is aborted by reset // Check if transfer is aborted by reset
if (udi_msc_b_reset_trans) { if (udi_msc_b_reset_trans) {
udi_msc_b_reset_trans = false; udi_msc_b_reset_trans = false;
return true; return true;
} }
// Check status of transfer // Check status of transfer
switch (status) { switch (status) {
case CTRL_GOOD: case CTRL_GOOD:
udi_msc_sense_pass(); udi_msc_sense_pass();
break; break;
case CTRL_BUSY: case CTRL_BUSY:
udi_msc_sense_fail_busy_or_change(); udi_msc_sense_fail_busy_or_change();
break; break;
case CTRL_NO_PRESENT: case CTRL_NO_PRESENT:
udi_msc_sense_fail_not_present(); udi_msc_sense_fail_not_present();
break; break;
default: default:
case CTRL_FAIL: case CTRL_FAIL:
udi_msc_sense_fail_hardware(); udi_msc_sense_fail_hardware();
break; break;
} }
// Send status of transfer in CSW packet // Send status of transfer in CSW packet
udi_msc_csw_process(); udi_msc_csw_process();
return true; return true;
} }
static void udi_msc_trans_ack(udd_ep_status_t status, iram_size_t n, static void udi_msc_trans_ack(udd_ep_status_t status, iram_size_t n,
udd_ep_id_t ep) udd_ep_id_t ep)
{ {
UNUSED(ep); UNUSED(ep);
UNUSED(n); UNUSED(n);
// Update variable to signal the end of transfer // Update variable to signal the end of transfer
udi_msc_b_abort_trans = (UDD_EP_TRANSFER_OK != status) ? true : false; udi_msc_b_abort_trans = (UDD_EP_TRANSFER_OK != status) ? true : false;
udi_msc_b_ack_trans = true; udi_msc_b_ack_trans = true;
} }
bool udi_msc_trans_block(bool b_read, uint8_t * block, iram_size_t block_size, bool udi_msc_trans_block(bool b_read, uint8_t * block, iram_size_t block_size,
void (*callback) (udd_ep_status_t status, iram_size_t n, udd_ep_id_t ep)) void (*callback) (udd_ep_status_t status, iram_size_t n, udd_ep_id_t ep))
{ {
if (!udi_msc_b_ack_trans) if (!udi_msc_b_ack_trans)
return false; // No possible, transfer on going return false; // No possible, transfer on going
// Start transfer Internal RAM<->USB line // Start transfer Internal RAM<->USB line
udi_msc_b_ack_trans = false; udi_msc_b_ack_trans = false;
if (!udd_ep_run((b_read) ? UDI_MSC_EP_IN : UDI_MSC_EP_OUT, if (!udd_ep_run((b_read) ? UDI_MSC_EP_IN : UDI_MSC_EP_OUT,
false, false,
block, block,
block_size, block_size,
(NULL == callback) ? udi_msc_trans_ack : (NULL == callback) ? udi_msc_trans_ack :
callback)) { callback)) {
udi_msc_b_ack_trans = true; udi_msc_b_ack_trans = true;
return false; return false;
} }
if (NULL == callback) { if (NULL == callback) {
while (!udi_msc_b_ack_trans); while (!udi_msc_b_ack_trans);
if (udi_msc_b_abort_trans) { if (udi_msc_b_abort_trans) {
return false; return false;
} }
udi_msc_csw.dCSWDataResidue -= block_size; udi_msc_csw.dCSWDataResidue -= block_size;
return (!udi_msc_b_abort_trans); return (!udi_msc_b_abort_trans);
} }
udi_msc_csw.dCSWDataResidue -= block_size; udi_msc_csw.dCSWDataResidue -= block_size;
return true; return true;
} }
//@} //@}
#endif
#endif #endif

View file

@ -50,24 +50,30 @@
#include <Arduino.h> #include <Arduino.h>
#include <Reset.h> #include <Reset.h>
static volatile bool main_b_msc_enable = false; #if ENABLED(SDSUPPORT)
static volatile bool main_b_msc_enable = false;
#endif
static volatile bool main_b_cdc_enable = false; static volatile bool main_b_cdc_enable = false;
static volatile bool main_b_dtr_active = false; static volatile bool main_b_dtr_active = false;
void HAL_idletask(void) { void HAL_idletask(void) {
// Attend SD card access from the USB MSD -- Prioritize access to improve speed #if ENABLED(SDSUPPORT)
int delay = 2; // Attend SD card access from the USB MSD -- Prioritize access to improve speed
while (main_b_msc_enable && --delay > 0) { int delay = 2;
if (udi_msc_process_trans()) delay = 10000; while (main_b_msc_enable && --delay > 0) {
if (udi_msc_process_trans()) delay = 10000;
// Reset the watchdog, just to be sure // Reset the watchdog, just to be sure
REG_WDT_CR = WDT_CR_WDRSTT | WDT_CR_KEY(0xA5); REG_WDT_CR = WDT_CR_WDRSTT | WDT_CR_KEY(0xA5);
} }
#endif
} }
bool usb_task_msc_enable(void) { return ((main_b_msc_enable = true)); } #if ENABLED(SDSUPPORT)
void usb_task_msc_disable(void) { main_b_msc_enable = false; } bool usb_task_msc_enable(void) { return ((main_b_msc_enable = true)); }
bool usb_task_msc_isenabled(void) { return main_b_msc_enable; } void usb_task_msc_disable(void) { main_b_msc_enable = false; }
bool usb_task_msc_isenabled(void) { return main_b_msc_enable; }
#endif
bool usb_task_cdc_enable(const uint8_t port) { return ((main_b_cdc_enable = true)); } bool usb_task_cdc_enable(const uint8_t port) { return ((main_b_cdc_enable = true)); }
void usb_task_cdc_disable(const uint8_t port) { main_b_cdc_enable = false; main_b_dtr_active = false; } void usb_task_cdc_disable(const uint8_t port) { main_b_cdc_enable = false; main_b_dtr_active = false; }
@ -192,11 +198,17 @@ static USB_MicrosoftExtendedPropertiesDescriptor microsoft_extended_properties_d
bool usb_task_extra_string(void) { bool usb_task_extra_string(void) {
static uint8_t udi_msft_magic[] = "MSFT100\xEE"; static uint8_t udi_msft_magic[] = "MSFT100\xEE";
static uint8_t udi_cdc_name[] = "CDC interface"; static uint8_t udi_cdc_name[] = "CDC interface";
static uint8_t udi_msc_name[] = "MSC interface"; #if ENABLED(SDSUPPORT)
static uint8_t udi_msc_name[] = "MSC interface";
#endif
struct extra_strings_desc_t { struct extra_strings_desc_t {
usb_str_desc_t header; usb_str_desc_t header;
le16_t string[Max(Max(sizeof(udi_cdc_name) - 1, sizeof(udi_msc_name) - 1), sizeof(udi_msft_magic) - 1)]; #if ENABLED(SDSUPPORT)
le16_t string[Max(Max(sizeof(udi_cdc_name) - 1, sizeof(udi_msc_name) - 1), sizeof(udi_msft_magic) - 1)];
#else
le16_t string[Max(sizeof(udi_cdc_name) - 1, sizeof(udi_msft_magic) - 1)];
#endif
}; };
static UDC_DESC_STORAGE struct extra_strings_desc_t extra_strings_desc = { static UDC_DESC_STORAGE struct extra_strings_desc_t extra_strings_desc = {
.header.bDescriptorType = USB_DT_STRING .header.bDescriptorType = USB_DT_STRING
@ -211,10 +223,12 @@ bool usb_task_extra_string(void) {
str_lgt = sizeof(udi_cdc_name) - 1; str_lgt = sizeof(udi_cdc_name) - 1;
str = udi_cdc_name; str = udi_cdc_name;
break; break;
case UDI_MSC_STRING_ID: #if ENABLED(SDSUPPORT)
str_lgt = sizeof(udi_msc_name) - 1; case UDI_MSC_STRING_ID:
str = udi_msc_name; str_lgt = sizeof(udi_msc_name) - 1;
break; str = udi_msc_name;
break;
#endif
case 0xEE: case 0xEE:
str_lgt = sizeof(udi_msft_magic) - 1; str_lgt = sizeof(udi_msft_magic) - 1;
str = udi_msft_magic; str = udi_msft_magic;