Merged the USB branch and made the needed adjustments, not tested yet.

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@2695 35acf78f-673a-0410-8e92-d51de3d6d3f4

3 files changed, 877 insertions, 2 deletions

diff --git a/os/hal/src/hal.c b/os/hal/src/hal.c
index 0913ad7a4..bfbaa3e84 100644
--- a/os/hal/src/hal.c
+++ b/os/hal/src/hal.c
@@ -81,11 +81,17 @@ void halInit(void) {
 #if HAL_USE_SPI || defined(__DOXYGEN__)

   spiInit();

 #endif

+#if HAL_USE_UART || defined(__DOXYGEN__)

+  uartInit();

+#endif

+#if HAL_USE_USB || defined(__DOXYGEN__)

+  usbInit();

+#endif

 #if HAL_USE_MMC_SPI || defined(__DOXYGEN__)

   mmcInit();

 #endif

-#if HAL_USE_UART || defined(__DOXYGEN__)

-  uartInit();

+#if HAL_USE_SERIAL_USB || defined(__DOXYGEN__)

+  sduInit();

 #endif

   /* Board specific initialization.*/

   boardInit();

diff --git a/os/hal/src/serial_usb.c b/os/hal/src/serial_usb.c
new file mode 100644
index 000000000..62a901162
--- /dev/null
+++ b/os/hal/src/serial_usb.c
@@ -0,0 +1,328 @@
+/*

+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010 Giovanni Di Sirio.

+

+    This file is part of ChibiOS/RT.

+

+    ChibiOS/RT is free software; you can redistribute it and/or modify

+    it under the terms of the GNU General Public License as published by

+    the Free Software Foundation; either version 3 of the License, or

+    (at your option) any later version.

+

+    ChibiOS/RT is distributed in the hope that it will be useful,

+    but WITHOUT ANY WARRANTY; without even the implied warranty of

+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

+    GNU General Public License for more details.

+

+    You should have received a copy of the GNU General Public License

+    along with this program.  If not, see <http://www.gnu.org/licenses/>.

+*/

+

+/**

+ * @file    serial_usb.c

+ * @brief   Serial over USB Driver code.

+ *

+ * @addtogroup SERIAL_USB

+ * @{

+ */

+

+#include "ch.h"

+#include "hal.h"

+

+#include "usb_cdc.h"

+

+#if HAL_USE_SERIAL_USB || defined(__DOXYGEN__)

+

+/*===========================================================================*/

+/* Driver exported variables.                                                */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver local variables.                                                   */

+/*===========================================================================*/

+

+/*

+ * Current Line Coding.

+ */

+static cdc_linecoding_t linecoding = {

+  {0x00, 0x96, 0x00, 0x00},             /* 38400.                           */

+  LC_STOP_1, LC_PARITY_NONE, 8

+};

+

+/*===========================================================================*/

+/* Driver local functions.                                                   */

+/*===========================================================================*/

+

+/*

+ * Interface implementation.

+ */

+

+static size_t writes(void *ip, const uint8_t *bp, size_t n) {

+

+  return chOQWriteTimeout(&((SerialDriver *)ip)->oqueue, bp,

+                          n, TIME_INFINITE);

+}

+

+static size_t reads(void *ip, uint8_t *bp, size_t n) {

+

+  return chIQReadTimeout(&((SerialDriver *)ip)->iqueue, bp,

+                         n, TIME_INFINITE);

+}

+

+static bool_t putwouldblock(void *ip) {

+

+  return chOQIsFullI(&((SerialDriver *)ip)->oqueue);

+}

+

+static bool_t getwouldblock(void *ip) {

+

+  return chIQIsEmptyI(&((SerialDriver *)ip)->iqueue);

+}

+

+static msg_t putt(void *ip, uint8_t b, systime_t timeout) {

+

+  return chOQPutTimeout(&((SerialDriver *)ip)->oqueue, b, timeout);

+}

+

+static msg_t gett(void *ip, systime_t timeout) {

+

+  return chIQGetTimeout(&((SerialDriver *)ip)->iqueue, timeout);

+}

+

+static size_t writet(void *ip, const uint8_t *bp, size_t n, systime_t time) {

+

+  return chOQWriteTimeout(&((SerialDriver *)ip)->oqueue, bp, n, time);

+}

+

+static size_t readt(void *ip, uint8_t *bp, size_t n, systime_t time) {

+

+  return chIQReadTimeout(&((SerialDriver *)ip)->iqueue, bp, n, time);

+}

+

+static ioflags_t getflags(void *ip) {

+  _ch_get_and_clear_flags_impl(ip);

+}

+

+static const struct SerialUSBDriverVMT vmt = {

+  writes, reads, putwouldblock, getwouldblock,

+  putt, gett, writet, readt,

+  getflags

+};

+

+/**

+ * @brief   Notification of data removed from the input queue.

+ */

+static void inotify(GenericQueue *qp) {

+  SerialUSBDriver *sdup = (SerialUSBDriver *)qp->q_wrptr;

+  size_t n;

+

+  /* Writes to the input queue can only happen when the queue has been

+     emptied, then a whole packet is loaded in the queue.*/

+  if (chIQIsEmptyI(&sdup->iqueue)) {

+

+    n = usbReadI(sdup->config->usbp, sdup->config->data_available_ep,

+                 sdup->iqueue.q_buffer, SERIAL_USB_BUFFERS_SIZE);

+    if (n > 0) {

+      sdup->iqueue.q_rdptr = sdup->iqueue.q_buffer;

+      chSemSetCounterI(&sdup->iqueue.q_sem, n);

+    }

+  }

+}

+

+/**

+ * @brief   Notification of data inserted into the output queue.

+ */

+static void onotify(GenericQueue *qp) {

+  SerialUSBDriver *sdup = (SerialUSBDriver *)qp->q_rdptr;

+  size_t n;

+

+  /* If there is any data in the output queue then it is sent within a

+     single packet and the queue is emptied.*/

+  n = usbWriteI(sdup->config->usbp, sdup->config->data_request_ep,

+                sdup->oqueue.q_buffer, chOQGetFullI(&sdup->oqueue));

+  if (n > 0) {

+    sdup->oqueue.q_wrptr = sdup->oqueue.q_buffer;

+    chSemSetCounterI(&sdup->oqueue.q_sem, SERIAL_USB_BUFFERS_SIZE);

+  }

+}

+

+/*===========================================================================*/

+/* Driver exported functions.                                                */

+/*===========================================================================*/

+

+/**

+ * @brief   Serial Driver initialization.

+ * @note    This function is implicitly invoked by @p halInit(), there is

+ *          no need to explicitly initialize the driver.

+ *

+ * @init

+ */

+void sduInit(void) {

+}

+

+/**

+ * @brief   Initializes a generic full duplex driver object.

+ * @details The HW dependent part of the initialization has to be performed

+ *          outside, usually in the hardware initialization code.

+ *

+ * @param[out] sdup     pointer to a @p SerialUSBDriver structure

+ * @param[in] inotify   pointer to a callback function that is invoked when

+ *                      some data is read from the Queue. The value can be

+ *                      @p NULL.

+ * @param[in] onotify   pointer to a callback function that is invoked when

+ *                      some data is written in the Queue. The value can be

+ *                      @p NULL.

+ *

+ * @init

+ */

+void sduObjectInit(SerialUSBDriver *sdup) {

+

+  sdup->vmt = &vmt;

+  chEvtInit(&sdup->event);

+  sdup->flags = IO_NO_ERROR;

+  sdup->state = SDU_STOP;

+  chIQInit(&sdup->iqueue, sdup->ib, SERIAL_USB_BUFFERS_SIZE, inotify);

+  chOQInit(&sdup->oqueue, sdup->ob, SERIAL_USB_BUFFERS_SIZE, onotify);

+  /* This is a dirty trick but those pointers are never used because queues

+     are accessed in block mode from the low level.*/

+  sdup->iqueue.q_wrptr = (uint8_t *)sdup;

+  sdup->oqueue.q_rdptr = (uint8_t *)sdup;

+}

+

+/**

+ * @brief   Configures and starts the driver.

+ *

+ * @param[in] sdup      pointer to a @p SerialUSBDriver object

+ * @param[in] config    the serial over USB driver configuration

+ *

+ * @api

+ */

+void sduStart(SerialUSBDriver *sdup, const SerialUSBConfig *config) {

+

+  chDbgCheck(sdup != NULL, "sduStart");

+

+  chSysLock();

+  chDbgAssert((sdup->state == SDU_STOP) || (sdup->state == SDU_READY),

+              "sduStart(), #1",

+              "invalid state");

+  sdup->config = config;

+  usbStart(config->usbp, &config->usb_config);

+  config->usbp->usb_param = sdup;

+  sdup->state = SDU_READY;

+  chSysUnlock();

+}

+

+/**

+ * @brief   Stops the driver.

+ * @details Any thread waiting on the driver's queues will be awakened with

+ *          the message @p Q_RESET.

+ *

+ * @param[in] sdup      pointer to a @p SerialUSBDriver object

+ *

+ * @api

+ */

+void sduStop(SerialUSBDriver *sdup) {

+

+  chDbgCheck(sdup != NULL, "sdStop");

+

+  chSysLock();

+  chDbgAssert((sdup->state == SDU_STOP) || (sdup->state == SDU_READY),

+              "sduStop(), #1",

+              "invalid state");

+  usbStop(sdup->config->usbp);

+  sdup->state = SDU_STOP;

+  chSysUnlock();

+}

+

+/**

+ * @brief   Default requests hook.

+ * @details Applications wanting to use the Serial over USB driver can use

+ *          this function as requests hook in the USB configuration.

+ *          The following requests are emulated:

+ *          - CDC_GET_LINE_CODING.

+ *          - CDC_SET_LINE_CODING.

+ *          - CDC_SET_CONTROL_LINE_STATE.

+ *          .

+ */

+bool_t sduRequestsHook(USBDriver *usbp) {

+

+  if ((usbp->usb_setup[0] & USB_RTYPE_TYPE_MASK) == USB_RTYPE_TYPE_CLASS) {

+    switch (usbp->usb_setup[1]) {

+    case CDC_GET_LINE_CODING:

+      usbSetupTransfer(usbp, (uint8_t *)&linecoding, sizeof(linecoding), NULL);

+      return TRUE;

+    case CDC_SET_LINE_CODING:

+      usbSetupTransfer(usbp, (uint8_t *)&linecoding, sizeof(linecoding), NULL);

+      return TRUE;

+    case CDC_SET_CONTROL_LINE_STATE:

+      /* Nothing to do, there are no control lines.*/

+      usbSetupTransfer(usbp, NULL, 0, NULL);

+      return TRUE;

+    default:

+      return FALSE;

+    }

+  }

+  return FALSE;

+}

+

+/**

+ * @brief   Default data request callback.

+ * @details The application must use this function as callback for the IN

+ *          data endpoint.

+ */

+void sduDataRequest(USBDriver *usbp, usbep_t ep) {

+  SerialUSBDriver *sdup = usbp->usb_param;

+  size_t n;

+

+  chSysLockFromIsr();

+  /* If there is any data in the output queue then it is sent within a

+     single packet and the queue is emptied.*/

+  n = chOQGetFullI(&sdup->oqueue);

+  if (n > 0) {

+    n = usbWriteI(usbp, ep, sdup->oqueue.q_buffer, n);

+    if (n > 0) {

+      sdup->oqueue.q_wrptr = sdup->oqueue.q_buffer;

+      chSemSetCounterI(&sdup->oqueue.q_sem, SERIAL_USB_BUFFERS_SIZE);

+      chIOAddFlagsI(sdup, IO_OUTPUT_EMPTY);

+    }

+  }

+  chSysUnlockFromIsr();

+}

+

+/**

+ * @brief   Default data available callback.

+ * @details The application must use this function as callback for the OUT

+ *          data endpoint.

+ */

+void sduDataAvailable(USBDriver *usbp, usbep_t ep) {

+  SerialUSBDriver *sdup = usbp->usb_param;

+

+  chSysLockFromIsr();

+  /* Writes to the input queue can only happen when the queue has been

+     emptied, then a whole packet is loaded in the queue.*/

+  if (chIQIsEmptyI(&sdup->iqueue)) {

+    size_t n;

+

+    n = usbReadI(usbp, ep, sdup->iqueue.q_buffer, SERIAL_USB_BUFFERS_SIZE);

+    if (n > 0) {

+      sdup->iqueue.q_rdptr = sdup->iqueue.q_buffer;

+      chSemSetCounterI(&sdup->iqueue.q_sem, n);

+      chIOAddFlagsI(sdup, IO_INPUT_AVAILABLE);

+    }

+  }

+  chSysUnlockFromIsr();

+}

+

+/**

+ * @brief   Default data received callback.

+ * @details The application must use this function as callback for the IN

+ *          interrupt endpoint.

+ */

+void sduInterruptRequest(USBDriver *usbp, usbep_t ep) {

+

+  (void)usbp;

+  (void)ep;

+}

+

+#endif /* HAL_USE_SERIAL */

+

+/** @} */

diff --git a/os/hal/src/usb.c b/os/hal/src/usb.c
new file mode 100644
index 000000000..c89d5a8e9
--- /dev/null
+++ b/os/hal/src/usb.c
@@ -0,0 +1,541 @@
+/*

+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010 Giovanni Di Sirio.

+

+    This file is part of ChibiOS/RT.

+

+    ChibiOS/RT is free software; you can redistribute it and/or modify

+    it under the terms of the GNU General Public License as published by

+    the Free Software Foundation; either version 3 of the License, or

+    (at your option) any later version.

+

+    ChibiOS/RT is distributed in the hope that it will be useful,

+    but WITHOUT ANY WARRANTY; without even the implied warranty of

+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

+    GNU General Public License for more details.

+

+    You should have received a copy of the GNU General Public License

+    along with this program.  If not, see <http://www.gnu.org/licenses/>.

+*/

+

+/**

+ * @file    usb.c

+ * @brief   USB Driver code.

+ *

+ * @addtogroup USB

+ * @{

+ */

+

+#include "ch.h"

+#include "hal.h"

+#include "usb.h"

+

+#if HAL_USE_USB || defined(__DOXYGEN__)

+

+/*===========================================================================*/

+/* Driver exported variables.                                                */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver local variables.                                                   */

+/*===========================================================================*/

+

+static const uint8_t zero_status[] = {0x00, 0x00};

+static const uint8_t active_status[] ={0x00, 0x00};

+static const uint8_t halted_status[] = {0x01, 0x00};

+

+/*===========================================================================*/

+/* Driver local functions.                                                   */

+/*===========================================================================*/

+

+/**

+ * @brief  SET ADDRESS transaction callback.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ */

+void set_address(USBDriver *usbp) {

+

+  usbp->usb_address = usbp->usb_setup[2];

+  usb_lld_set_address(usbp, usbp->usb_address);

+  if (usbp->usb_config->uc_event_cb)

+    usbp->usb_config->uc_event_cb(usbp, USB_EVENT_ADDRESS);

+  usbp->usb_state = USB_SELECTED;

+}

+

+/**

+ * @brief   Starts a receive phase on the endpoint zero.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ */

+static void start_rx_ep0(USBDriver *usbp) {

+

+  if (usbp->usb_ep0n > 0) {

+    /* The received data cannot exceed the available amount.*/

+    if (usbp->usb_ep0n > usbp->usb_ep0max)

+      usbp->usb_ep0n = usbp->usb_ep0max;

+

+    /* Determines the maximum amount that can be received using a

+       single packet.*/

+    if (usbp->usb_ep0n > usb_lld_ep0config.uepc_out_maxsize)

+      usbp->usb_ep0lastsize = usb_lld_ep0config.uepc_out_maxsize;

+    else

+      usbp->usb_ep0lastsize = usbp->usb_ep0n;

+    usbp->usb_ep0state = USB_EP0_RX;

+  }

+  else {

+    /* Sending zero sized status packet.*/

+    usb_lld_write(usbp, 0, NULL, 0);

+    usbp->usb_ep0state = USB_EP0_SENDING_STS;

+  }

+}

+

+/**

+ * @brief   Starts a transmission phase on the endpoint zero.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ */

+static void start_tx_ep0(USBDriver *usbp) {

+

+  if (usbp->usb_ep0n > 0) {

+    /* The transmitted data cannot exceed the requested amount.*/

+    if (usbp->usb_ep0n > usbp->usb_ep0max)

+      usbp->usb_ep0n = usbp->usb_ep0max;

+

+    /* Determines the maximum amount that can be transmitted using a

+       single packet.*/

+    if (usbp->usb_ep0n > usb_lld_ep0config.uepc_in_maxsize)

+      usbp->usb_ep0lastsize = usb_lld_ep0config.uepc_in_maxsize;

+    else

+      usbp->usb_ep0lastsize = usbp->usb_ep0n;

+

+    /* Starts transmission.*/

+    usb_lld_write(usbp, 0, usbp->usb_ep0next, usbp->usb_ep0lastsize);

+    usbp->usb_ep0state = USB_EP0_TX;

+  }

+  else

+    usbp->usb_ep0state = USB_EP0_WAITING_STS;

+}

+

+/**

+ * @brief   Standard requests handler.

+ * @details This is the standard requests default handler, most standard

+ *          requests are handled here, the user can override the standard

+ *          handling using the @p uc_requests_hook_cb hook in the

+ *          @p USBConfig structure.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ * @return              The request handling exit code.

+ * @retval FALSE        Request not recognized by the handler or error.

+ * @retval TRUE         Request handled.

+ */

+static bool_t default_handler(USBDriver *usbp) {

+  const USBDescriptor *dp;

+

+  /* Decoding the request.*/

+  switch (((usbp->usb_setup[0] & (USB_RTYPE_RECIPIENT_MASK |

+                                 USB_RTYPE_TYPE_MASK)) |

+           (usbp->usb_setup[1] << 8))) {

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_GET_STATUS << 8):

+    /* Just returns the current status word.*/

+    usbSetupTransfer(usbp, (uint8_t *)&usbp->usb_status, 2, NULL);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_CLEAR_FEATURE << 8):

+    /* Only the DEVICE_REMOTE_WAKEUP is handled here, any other feature

+       number is handled as an error.*/

+    if (usbp->usb_setup[2] == USB_FEATURE_DEVICE_REMOTE_WAKEUP) {

+      usbp->usb_status &= ~2;

+      usbSetupTransfer(usbp, NULL, 0, NULL);

+      return TRUE;

+    }

+    return FALSE;

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_SET_FEATURE << 8):

+    /* Only the DEVICE_REMOTE_WAKEUP is handled here, any other feature

+       number is handled as an error.*/

+    if (usbp->usb_setup[2] == USB_FEATURE_DEVICE_REMOTE_WAKEUP) {

+      usbp->usb_status |= 2;

+      usbSetupTransfer(usbp, NULL, 0, NULL);

+      return TRUE;

+    }

+    return FALSE;

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_SET_ADDRESS << 8):

+    /* The handling is posponed to after the status phase in order to allow

+       the proper completion of the transaction.*/

+    usbSetupTransfer(usbp, NULL, 0, set_address);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_GET_DESCRIPTOR << 8):

+    /* Handling descriptor requests from the host.*/

+    dp = usbp->usb_config->uc_get_descriptor_cb(

+           usbp, usbp->usb_setup[3], usbp->usb_setup[2],

+           usb_lld_fetch_word(&usbp->usb_setup[4]));

+    if (dp == NULL)

+      return FALSE;

+    usbSetupTransfer(usbp, (uint8_t *)dp->ud_string, dp->ud_size, NULL);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_GET_CONFIGURATION << 8):

+    /* Returning the last selected configuration.*/

+    usbSetupTransfer(usbp, &usbp->usb_configuration, 1, NULL);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_SET_CONFIGURATION << 8):

+    /* Handling configuration selection from the host.*/

+    usbp->usb_configuration = usbp->usb_setup[2];

+    if (usbp->usb_configuration == 0)

+      usbp->usb_state = USB_SELECTED;

+    else

+      usbp->usb_state = USB_ACTIVE;

+    if (usbp->usb_config->uc_event_cb)

+      usbp->usb_config->uc_event_cb(usbp, USB_EVENT_CONFIGURED);

+    usbSetupTransfer(usbp, NULL, 0, NULL);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_INTERFACE | (USB_REQ_GET_STATUS << 8):

+  case USB_RTYPE_RECIPIENT_ENDPOINT | (USB_REQ_SYNCH_FRAME << 8):

+    /* Just sending two zero bytes, the application can change the behavior

+       using a hook..*/

+    usbSetupTransfer(usbp, (uint8_t *)zero_status, 2, NULL);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_ENDPOINT | (USB_REQ_GET_STATUS << 8):

+    /* Sending the EP status.*/

+    if (usbp->usb_setup[4] & 0x80) {

+      switch (usb_lld_get_status_in(usbp, usbp->usb_setup[4] & 0x0F)) {

+      case EP_STATUS_STALLED:

+        usbSetupTransfer(usbp, (uint8_t *)halted_status, 2, NULL);

+        return TRUE;

+      case EP_STATUS_ACTIVE:

+        usbSetupTransfer(usbp, (uint8_t *)active_status, 2, NULL);

+        return TRUE;

+      default:

+        return FALSE;

+      }

+    }

+    else {

+      switch (usb_lld_get_status_out(usbp, usbp->usb_setup[4] & 0x0F)) {

+      case EP_STATUS_STALLED:

+        usbSetupTransfer(usbp, (uint8_t *)halted_status, 2, NULL);

+        return TRUE;

+      case EP_STATUS_ACTIVE:

+        usbSetupTransfer(usbp, (uint8_t *)active_status, 2, NULL);

+        return TRUE;

+      default:

+        return FALSE;

+      }

+    }

+  case USB_RTYPE_RECIPIENT_ENDPOINT | (USB_REQ_CLEAR_FEATURE << 8):

+    /* Only ENDPOINT_HALT is handled as feature.*/

+    if (usbp->usb_setup[2] != USB_FEATURE_ENDPOINT_HALT)

+      return FALSE;

+    /* Clearing the EP status, not valid for EP0, it is ignored in that case.*/

+    if ((usbp->usb_setup[4] & 0x0F) > 0) {

+      if (usbp->usb_setup[4] & 0x80)

+        usb_lld_clear_in(usbp, usbp->usb_setup[4] & 0x0F);

+      else

+        usb_lld_clear_out(usbp, usbp->usb_setup[4] & 0x0F);

+    }

+    usbSetupTransfer(usbp, NULL, 0, NULL);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_ENDPOINT | (USB_REQ_SET_FEATURE << 8):

+    /* Only ENDPOINT_HALT is handled as feature.*/

+    if (usbp->usb_setup[2] != USB_FEATURE_ENDPOINT_HALT)

+      return FALSE;

+    /* Stalling the EP, not valid for EP0, it is ignored in that case.*/

+    if ((usbp->usb_setup[4] & 0x0F) > 0) {

+      if (usbp->usb_setup[4] & 0x80)

+        usb_lld_stall_in(usbp, usbp->usb_setup[4] & 0x0F);

+      else

+        usb_lld_stall_out(usbp, usbp->usb_setup[4] & 0x0F);

+    }

+    usbSetupTransfer(usbp, NULL, 0, NULL);

+    return TRUE;

+  case USB_RTYPE_RECIPIENT_DEVICE | (USB_REQ_SET_DESCRIPTOR << 8):

+  case USB_RTYPE_RECIPIENT_INTERFACE | (USB_REQ_CLEAR_FEATURE << 8):

+  case USB_RTYPE_RECIPIENT_INTERFACE | (USB_REQ_SET_FEATURE << 8):

+  case USB_RTYPE_RECIPIENT_INTERFACE | (USB_REQ_GET_INTERFACE << 8):

+  case USB_RTYPE_RECIPIENT_INTERFACE | (USB_REQ_SET_INTERFACE << 8):

+    /* All the above requests are not handled here, if you need them then

+       use the hook mechanism and provide handling.*/

+  default:

+    return FALSE;

+  }

+}

+

+/*===========================================================================*/

+/* Driver exported functions.                                                */

+/*===========================================================================*/

+

+/**

+ * @brief   USB Driver initialization.

+ * @note    This function is implicitly invoked by @p halInit(), there is

+ *          no need to explicitly initialize the driver.

+ *

+ * @init

+ */

+void usbInit(void) {

+

+  usb_lld_init();

+}

+

+/**

+ * @brief   Initializes the standard part of a @p USBDriver structure.

+ *

+ * @param[out] usbp     pointer to the @p USBDriver object

+ *

+ * @init

+ */

+void usbObjectInit(USBDriver *usbp) {

+

+  usbp->usb_state    = USB_STOP;

+  usbp->usb_config   = NULL;

+  usbp->usb_param    = NULL;

+}

+

+/**

+ * @brief   Configures and activates the USB peripheral.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ * @param[in] config    pointer to the @p USBConfig object

+ *

+ * @api

+ */

+void usbStart(USBDriver *usbp, const USBConfig *config) {

+

+  chDbgCheck((usbp != NULL) && (config != NULL), "usbStart");

+

+  chSysLock();

+  chDbgAssert((usbp->usb_state == USB_STOP) || (usbp->usb_state == USB_READY),

+              "usbStart(), #1",

+              "invalid state");

+  usbp->usb_config = config;

+  usb_lld_start(usbp);

+  usbp->usb_state = USB_READY;

+  chSysUnlock();

+}

+

+/**

+ * @brief   Deactivates the USB peripheral.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ *

+ * @api

+ */

+void usbStop(USBDriver *usbp) {

+

+  chDbgCheck(usbp != NULL, "usbStop");

+

+  chSysLock();

+  chDbgAssert((usbp->usb_state == USB_STOP) || (usbp->usb_state == USB_READY),

+              "usbStop(), #1",

+              "invalid state");

+  usb_lld_stop(usbp);

+  usbp->usb_state = USB_STOP;

+  chSysUnlock();

+}

+

+/**

+ * @brief   Enables an endpoint.

+ * @details This function enables an endpoint, both IN and/or OUT directions

+ *          depending on the configuration structure.

+ * @note    This function must be invoked in response of a SET_CONFIGURATION

+ *          or SET_INTERFACE message.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ * @param[in] ep        endpoint number

+ * @param[in] epcp      the endpoint configuration

+ *

+ * @iclass

+ */

+void usbEnableEndpointI(USBDriver *usbp, usbep_t ep,

+                        const USBEndpointConfig *epcp) {

+

+  chDbgAssert(usbp->usb_state == USB_ACTIVE,

+              "usbEnableEndpointI(), #1", "invalid state");

+  chDbgAssert(usbp->usb_epc[ep] != NULL,

+              "usbEnableEndpointI(), #2", "already enabled");

+

+  /* Logically enabling the endpoint in the USBDriver structure.*/

+  usbp->usb_epc[ep] = epcp;

+

+  /* Low level endpoint activation.*/

+  usb_lld_enable_endpoint(usbp, ep, epcp);

+}

+

+/**

+ * @brief   Disables all the active endpoints.

+ * @details This function disables all the active endpoints except the

+ *          endpoint zero.

+ * @note    This function must be invoked in response of a SET_CONFIGURATION

+ *          message with configuration number zero.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ *

+ * @iclass

+ */

+void usbDisableEndpointsI(USBDriver *usbp) {

+  unsigned i;

+

+  chDbgAssert(usbp->usb_state == USB_SELECTED,

+              "usbDisableEndpointsI(), #1", "invalid state");

+

+  for (i = 1; i <= USB_MAX_ENDPOINTS; i++)

+    usbp->usb_epc[i] = NULL;

+

+  /* Low level endpoints deactivation.*/

+  usb_lld_disable_endpoints(usbp);

+}

+

+/**

+ * @brief   USB reset routine.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ *

+ * @notapi

+ */

+void _usb_reset(USBDriver *usbp) {

+  unsigned i;

+

+  usbp->usb_state         = USB_READY;

+  usbp->usb_status        = 0;

+  usbp->usb_address       = 0;

+  usbp->usb_configuration = 0;

+

+  /* Invalidates all endpoints into the USBDriver structure.*/

+  for (i = 0; i <= USB_MAX_ENDPOINTS; i++)

+    usbp->usb_epc[i] = NULL;

+

+  /* EP0 state machine initialization.*/

+  usbp->usb_ep0state     = USB_EP0_WAITING_SETUP;

+

+  /* Low level reset.*/

+  usb_lld_reset(usbp);

+

+  /* Low level endpoint zero activation.*/

+  usbp->usb_epc[0] = &usb_lld_ep0config;

+  usb_lld_enable_endpoint(usbp, 0, &usb_lld_ep0config);

+}

+

+/**

+ * @brief   Default EP0 IN callback.

+ * @details This function is used by the low level driver as default handler

+ *          for EP0 IN events.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ * @param[in] ep        endpoint number, always zero

+ *

+ * @notapi

+ */

+void _usb_ep0in(USBDriver *usbp, usbep_t ep) {

+

+  (void)ep;

+  switch (usbp->usb_ep0state) {

+  case USB_EP0_TX:

+    usbp->usb_ep0next += usbp->usb_ep0lastsize;

+    usbp->usb_ep0max  -= usbp->usb_ep0lastsize;

+    usbp->usb_ep0n    -= usbp->usb_ep0lastsize;

+

+    /* The final condition is when the requested size has been transmitted or

+       when a packet has been sent with size less than the maximum packet

+       size.*/

+    if ((usbp->usb_ep0max == 0) ||

+        (usbp->usb_ep0lastsize < usb_lld_ep0config.uepc_in_maxsize))

+      usbp->usb_ep0state = USB_EP0_WAITING_STS;

+    else {

+      usbp->usb_ep0lastsize = usbp->usb_ep0n > usb_lld_ep0config.uepc_in_maxsize ?

+                              usb_lld_ep0config.uepc_in_maxsize : usbp->usb_ep0n;

+      usb_lld_write(usbp, 0, usbp->usb_ep0next, usbp->usb_ep0lastsize);

+    }

+    return;

+  case USB_EP0_SENDING_STS:

+    if (usbp->usb_ep0endcb)

+      usbp->usb_ep0endcb(usbp);

+

+    usbp->usb_ep0state = USB_EP0_WAITING_SETUP;

+    return;

+  default:

+    ;

+  }

+  /* Error response.*/

+  usb_lld_stall_in(usbp, 0);

+  usb_lld_stall_out(usbp, 0);

+  if (usbp->usb_config->uc_event_cb)

+    usbp->usb_config->uc_event_cb(usbp, USB_EVENT_STALLED);

+  usbp->usb_ep0state = USB_EP0_WAITING_SETUP;

+}

+

+/**

+ * @brief   Default EP0 OUT callback.

+ * @details This function is used by the low level driver as default handler

+ *          for EP0 OUT events.

+ *

+ * @param[in] usbp      pointer to the @p USBDriver object

+ * @param[in] ep        endpoint number, always zero

+ *

+ * @notapi

+ */

+void _usb_ep0out(USBDriver *usbp, usbep_t ep) {

+  size_t n, size;

+  uint8_t buf[1];

+

+  (void)ep;

+  switch (usbp->usb_ep0state) {

+  case USB_EP0_WAITING_SETUP:

+    /* SETUP packet handling.*/

+    n = usb_lld_read(usbp, 0, usbp->usb_setup, 8);

+    if (n != 8)

+      break;

+

+    /* First verify if the application has an handler installed for this

+       request.*/

+    if (!(usbp->usb_config->uc_requests_hook_cb) ||

+        !(usbp->usb_config->uc_requests_hook_cb(usbp))) {

+      /* Invoking the default handler, if this fails then stalls the

+         endpoint zero as error.*/

+      if (((usbp->usb_setup[0] & USB_RTYPE_TYPE_MASK) != USB_RTYPE_TYPE_STD) ||

+          !default_handler(usbp))

+        break;

+    }

+

+    /* Transfer preparation. The request handler must have populated

+       correctly the fields usb_ep0next, usb_ep0n and usb_ep0endcb using

+       the macro usbSetupTransfer().*/

+    usbp->usb_ep0max = usb_lld_fetch_word(&usbp->usb_setup[6]);

+    if ((usbp->usb_setup[0] & USB_RTYPE_DIR_MASK) == USB_RTYPE_DIR_DEV2HOST)

+      start_tx_ep0(usbp);

+    else

+      start_rx_ep0(usbp);

+    return;

+  case USB_EP0_RX:

+    /* Check for buffer overflow.*/

+    n = size = usb_lld_get_readable(usbp, 0);

+    if (n > usbp->usb_ep0n)

+      n = usbp->usb_ep0n;

+    /* Fetching received data packet.*/

+    n = usb_lld_read(usbp, 0, usbp->usb_ep0next, n);

+    if (n > usbp->usb_ep0max)

+      break;

+    usbp->usb_ep0max  -= size;

+    usbp->usb_ep0n    -= n;

+    usbp->usb_ep0next += n;

+    if (usbp->usb_ep0max == 0) {

+      usb_lld_write(usbp, 0, NULL, 0);

+      usbp->usb_ep0state = USB_EP0_SENDING_STS;

+    }

+    return;

+  case USB_EP0_WAITING_STS:

+    /* STATUS received packet handling, it must be zero sized.*/

+    n = usb_lld_read(usbp, 0, buf, 1);

+    if (n != 0)

+      break;

+    if (usbp->usb_ep0endcb)

+      usbp->usb_ep0endcb(usbp);

+    usbp->usb_ep0state = USB_EP0_WAITING_SETUP;

+    return;

+  default:

+    ;

+  }

+  /* Error response.*/

+  usb_lld_stall_in(usbp, 0);

+  usb_lld_stall_out(usbp, 0);

+  if (usbp->usb_config->uc_event_cb)

+    usbp->usb_config->uc_event_cb(usbp, USB_EVENT_STALLED);

+  usbp->usb_ep0state = USB_EP0_WAITING_SETUP;

+}

+

+#endif /* HAL_USE_USB */

+

+/** @} */