nrf52 control transfer work reliably

3 files changed, 49 insertions, 41 deletions

diff --git a/tinyusb/class/cdc/cdc_device.c b/tinyusb/class/cdc/cdc_device.c
index 957026d79..837f4e8eb 100644
--- a/tinyusb/class/cdc/cdc_device.c
+++ b/tinyusb/class/cdc/cdc_device.c
@@ -212,52 +212,54 @@ void cdcd_close(uint8_t port)
 

 tusb_error_t cdcd_control_request_subtask(uint8_t port, tusb_control_request_t const * p_request)

 {

+  OSAL_SUBTASK_BEGIN

+

+  tusb_error_t err;

+

   //------------- Class Specific Request -------------//

   if (p_request->bmRequestType_bit.type != TUSB_REQ_TYPE_CLASS) return TUSB_ERROR_DCD_CONTROL_REQUEST_NOT_SUPPORT;

 

-  switch(p_request->bRequest)

+  if (CDC_REQUEST_GET_LINE_CODING == p_request->bRequest)

+  {

+    OSAL_SUBTASK_INVOKED( usbd_control_xfer_substak(port, (tusb_dir_t) p_request->bmRequestType_bit.direction,

+                                                    (uint8_t*) &cdcd_line_coding[port], min16_of(sizeof(cdc_line_coding_t), p_request->wLength)), err );

+  }

+  else if (CDC_REQUEST_SET_LINE_CODING == p_request->bRequest)

+  {

+    OSAL_SUBTASK_INVOKED( usbd_control_xfer_substak(port, (tusb_dir_t) p_request->bmRequestType_bit.direction,

+                                                    (uint8_t*) &cdcd_line_coding[port], min16_of(sizeof(cdc_line_coding_t), p_request->wLength)), err );

+    // TODO notify application on xfer completea

+  }

+  else if (CDC_REQUEST_SET_CONTROL_LINE_STATE == p_request->bRequest )

   {

-    case CDC_REQUEST_GET_LINE_CODING:

-      tusb_dcd_control_xfer(port, (tusb_dir_t) p_request->bmRequestType_bit.direction,

-                            (uint8_t*) &cdcd_line_coding[port], min16_of(sizeof(cdc_line_coding_t), p_request->wLength), false );

-    break;

+    enum {

+      ACTIVE_DTE_PRESENT     = 0x0003,

+      ACTIVE_DTE_NOT_PRESENT = 0x0002

+    };

 

-    case CDC_REQUEST_SET_LINE_CODING:

-      tusb_dcd_control_xfer(port, (tusb_dir_t) p_request->bmRequestType_bit.direction,

-                            (uint8_t*) &cdcd_line_coding[port], min16_of(sizeof(cdc_line_coding_t), p_request->wLength), false );

-      // TODO notify application on xfer completea

-    break;

+    cdcd_data_t * p_cdc = &cdcd_data[port];

 

-    case CDC_REQUEST_SET_CONTROL_LINE_STATE: // TODO extract DTE present

+    if (p_request->wValue == ACTIVE_DTE_PRESENT)

     {

-      enum {

-        ACTIVE_DTE_PRESENT     = 0x0003,

-        ACTIVE_DTE_NOT_PRESENT = 0x0002

-      };

-

-      cdcd_data_t * p_cdc = &cdcd_data[port];

-

-      if (p_request->wValue == ACTIVE_DTE_PRESENT)

-      {

-        // terminal connected

-        p_cdc->connected = true;

-      }

-      else if (p_request->wValue == ACTIVE_DTE_NOT_PRESENT)

-      {

-        // terminal disconnected

-        p_cdc->connected = false;

-      }else

-      {

-        // De-active --> disconnected

-        p_cdc->connected = false;

-      }

+      // terminal connected

+      p_cdc->connected = true;

+    }

+    else if (p_request->wValue == ACTIVE_DTE_NOT_PRESENT)

+    {

+      // terminal disconnected

+      p_cdc->connected = false;

+    }else

+    {

+      // De-active --> disconnected

+      p_cdc->connected = false;

     }

-    break;

-

-    default: return TUSB_ERROR_DCD_CONTROL_REQUEST_NOT_SUPPORT;

+  }

+  else

+  {

+    SUBTASK_RETURN(TUSB_ERROR_DCD_CONTROL_REQUEST_NOT_SUPPORT);

   }

 

-  return TUSB_ERROR_NONE;

+  OSAL_SUBTASK_END

 }

 

 tusb_error_t cdcd_xfer_cb(uint8_t port, uint8_t edpt_addr, tusb_event_t event, uint32_t xferred_bytes)

diff --git a/tinyusb/device/usbd.c b/tinyusb/device/usbd.c
index ed72a2000..f7500b6ed 100644
--- a/tinyusb/device/usbd.c
+++ b/tinyusb/device/usbd.c
@@ -302,7 +302,7 @@ tusb_error_t usbd_control_xfer_substak(uint8_t port, tusb_dir_t dir, uint8_t * b
   }

 

   // Status opposite direction with Zero Length

-  tusb_dcd_control_xfer(port, (tusb_dir_t) (1-dir), NULL, 0, true);

+  usbd_control_status(port, 1-dir);

 

   // no need to blocking wait for status to complete

 

@@ -329,7 +329,6 @@ tusb_error_t usbd_control_request_subtask(uint8_t port, tusb_control_request_t c
 

       if ( TUSB_ERROR_NONE == error )

       {

-//        tusb_dcd_control_xfer(port, (tusb_dir_t) p_request->bmRequestType_bit.direction, (uint8_t*) p_buffer, length, false);

         OSAL_SUBTASK_INVOKED ( usbd_control_xfer_substak(port, (tusb_dir_t) p_request->bmRequestType_bit.direction, (uint8_t*) p_buffer, length ), error );;

       }

     }

@@ -379,12 +378,12 @@ tusb_error_t usbd_control_request_subtask(uint8_t port, tusb_control_request_t c
   }

 

   if(TUSB_ERROR_NONE != error)

-  { // Response with Protocol Stall if request is not supported

+  {

+    // Response with Protocol Stall if request is not supported

     tusb_dcd_control_stall(port);

   }else if (p_request->wLength == 0)

   {

-    // zero length for non-data

-    tusb_dcd_control_xfer(port, (tusb_dir_t) p_request->bmRequestType_bit.direction, NULL, 0, false);

+    usbd_control_status(port, (tusb_dir_t) p_request->bmRequestType_bit.direction);

   }

 

   OSAL_SUBTASK_END

diff --git a/tinyusb/device/usbd.h b/tinyusb/device/usbd.h
index 8926d225c..cf607f645 100644
--- a/tinyusb/device/usbd.h
+++ b/tinyusb/device/usbd.h
@@ -130,6 +130,13 @@ void tud_umount_cb(uint8_t port);
 

 extern osal_semaphore_t usbd_control_xfer_sem_hdl;

 

+tusb_error_t usbd_control_xfer_substak(uint8_t port, tusb_dir_t dir, uint8_t * buffer, uint16_t length);

+

+static inline bool usbd_control_status(uint8_t port, tusb_dir_t dir)

+{

+  tusb_dcd_control_xfer(port , dir, NULL, 0, false);

+}

+

 tusb_error_t usbd_init(void);

 void usbd_task( void* param);