incubator-nuttx/drivers/usbdev/usbdev_desc.c

/****************************************************************************
 * drivers/usbdev/usbdev_desc.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 <string.h>

#include <nuttx/usb/usbdev.h>

/****************************************************************************
 * Public Functions
 ****************************************************************************/

/****************************************************************************
 * Name: usbdev_copy_devdesc
 *
 * Description:
 *   Copies the requested device Description into the dest buffer given.
 *   Returns the number of Bytes filled in (USB_SIZEOF_DEVDESC).
 *   This function is provided by various classes.
 *
 ****************************************************************************/

int usbdev_copy_devdesc(FAR void *dest,
                        FAR const struct usb_devdesc_s *src,
                        uint8_t speed)
{
#ifdef CONFIG_USBDEV_SUPERSPEED
  FAR struct usb_devdesc_s *p_desc =
                (struct usb_devdesc_s *)dest;
#endif

  memcpy(dest, src, USB_SIZEOF_DEVDESC);

#ifdef CONFIG_USBDEV_SUPERSPEED
  if (speed >= USB_SPEED_SUPER)
    {
      p_desc->usb[0] = LSBYTE(0x0320),
      p_desc->usb[1] = MSBYTE(0x0320);
      p_desc->mxpacketsize = 9;
    }
#endif

  return USB_SIZEOF_DEVDESC;
}

/****************************************************************************
 * Name: usbdev_copy_epcompdesc
 *
 * Description:
 *   Copies the Endpoint Companion Description into the buffer given.
 *   Returns the number of Bytes filled in.
 *   This function is provided by various classes.
 *
 ****************************************************************************/

#ifdef CONFIG_USBDEV_SUPERSPEED
static void
usbdev_copy_epcompdesc(FAR struct usb_ss_epcompdesc_s *epcompdesc,
                       FAR const struct usbdev_epinfo_s *epinfo)
{
  uint8_t transtpye;

  memcpy(epcompdesc, &epinfo->compdesc, sizeof(struct usb_ss_epcompdesc_s));

  transtpye = epinfo->desc.attr & USB_EP_ATTR_XFERTYPE_MASK;
  if (transtpye == USB_EP_ATTR_XFER_BULK)
    {
      if (epcompdesc->mxburst >= USB_SS_BULK_EP_MAXBURST)
        {
          epcompdesc->mxburst = USB_SS_BULK_EP_MAXBURST - 1;
        }

      if (epcompdesc->attr > USB_SS_BULK_EP_MAXSTREAM)
        {
          epcompdesc->attr = USB_SS_BULK_EP_MAXSTREAM;
        }

      epcompdesc->wbytes[0] = 0;
      epcompdesc->wbytes[1] = 0;
    }
  else if(transtpye == USB_EP_ATTR_XFER_INT)
    {
      if (epcompdesc->mxburst >= USB_SS_INT_EP_MAXBURST)
        {
          epcompdesc->mxburst   = USB_SS_INT_EP_MAXBURST - 1;
          epcompdesc->wbytes[0] = LSBYTE((epcompdesc->mxburst + 1) *
                                          epinfo->sssize);
          epcompdesc->wbytes[1] = MSBYTE((epcompdesc->mxburst + 1) *
                                          epinfo->sssize);
        }

      epcompdesc->attr = 0;
    }
}
#endif

/****************************************************************************
 * Name: usbdev_copy_epdesc
 *
 * Description:
 *   Copies the requested Endpoint Description into the buffer given.
 *   Returns the number of Bytes filled in ( sizeof(struct usb_epdesc_s) ).
 *   This function is provided by various classes.
 *
 ****************************************************************************/

int usbdev_copy_epdesc(FAR struct usb_epdesc_s *epdesc,
                       uint8_t epno, uint8_t speed,
                       FAR const struct usbdev_epinfo_s *epinfo)
{
#if !defined(CONFIG_USBDEV_DUALSPEED) && !defined(CONFIG_USBDEV_SUPERSPEED)
  UNUSED(speed);
#endif

  int len = sizeof(struct usb_epdesc_s);

#ifdef CONFIG_USBDEV_SUPERSPEED
  if (speed == USB_SPEED_SUPER || speed == USB_SPEED_SUPER_PLUS)
    {
      len += sizeof(struct usb_ss_epcompdesc_s);
    }
#endif

  if (epdesc == NULL)
    {
      return len;
    }

  memcpy(epdesc, &epinfo->desc, sizeof(struct usb_epdesc_s));
  epdesc->addr |= epno;

#ifdef CONFIG_USBDEV_SUPERSPEED
  if (speed == USB_SPEED_SUPER || speed == USB_SPEED_SUPER_PLUS)
    {
      /* Maximum packet size (super speed) */

      epdesc->mxpacketsize[0] = LSBYTE(epinfo->sssize);
      epdesc->mxpacketsize[1] = MSBYTE(epinfo->sssize);

      /* Copy endpoint companion description */

      epdesc++;
      usbdev_copy_epcompdesc((FAR struct usb_ss_epcompdesc_s *)epdesc,
                             epinfo);
    }
  else
#endif
#ifdef CONFIG_USBDEV_DUALSPEED
  if (speed == USB_SPEED_HIGH)
    {
      /* Maximum packet size (high speed) */

      epdesc->mxpacketsize[0] = LSBYTE(epinfo->hssize);
      epdesc->mxpacketsize[1] = MSBYTE(epinfo->hssize);
    }
  else
#endif
    {
      /* Maximum packet size (full speed) */

      epdesc->mxpacketsize[0] = LSBYTE(epinfo->fssize);
      epdesc->mxpacketsize[1] = MSBYTE(epinfo->fssize);
    }

  return len;
}