LUFA/Drivers/USB/HighLevel/Template/Template_Endpoint_Control_W.c

   1 uint8_t TEMPLATE_FUNC_NAME (const void* Buffer,
   2                             uint16_t Length)
   3 {
   4         uint8_t* DataStream     = ((uint8_t*)Buffer + TEMPLATE_BUFFER_OFFSET(Length));
   5         bool     LastPacketFull = false;
   6
   7         if (Length > USB_ControlRequest.wLength)
   8           Length = USB_ControlRequest.wLength;
   9         else if (!(Length))
  10           Endpoint_ClearIN();
  11
  12         while (Length || LastPacketFull)
  13         {
  14                 uint8_t USB_DeviceState_LCL = USB_DeviceState;
  15
  16                 if (USB_DeviceState_LCL == DEVICE_STATE_Unattached)
  17                   return ENDPOINT_RWCSTREAM_DeviceDisconnected;
  18                 else if (USB_DeviceState_LCL == DEVICE_STATE_Suspended)
  19                   return ENDPOINT_RWCSTREAM_BusSuspended;
  20                 else if (Endpoint_IsSETUPReceived())
  21                   return ENDPOINT_RWCSTREAM_HostAborted;
  22                 else if (Endpoint_IsOUTReceived())
  23                   break;
  24
  25                 if (Endpoint_IsINReady())
  26                 {
  27                         uint16_t BytesInEndpoint = Endpoint_BytesInEndpoint();
  28
  29                         while (Length && (BytesInEndpoint < USB_ControlEndpointSize))
  30                         {
  31                                 TEMPLATE_TRANSFER_BYTE(DataStream);
  32                                 Length--;
  33                                 BytesInEndpoint++;
  34                         }
  35
  36                         LastPacketFull = (BytesInEndpoint == USB_ControlEndpointSize);
  37                         Endpoint_ClearIN();
  38                 }
  39         }
  40
  41         while (!(Endpoint_IsOUTReceived()))
  42         {
  43                 uint8_t USB_DeviceState_LCL = USB_DeviceState;
  44
  45                 if (USB_DeviceState_LCL == DEVICE_STATE_Unattached)
  46                   return ENDPOINT_RWCSTREAM_DeviceDisconnected;
  47                 else if (USB_DeviceState_LCL == DEVICE_STATE_Suspended)
  48                   return ENDPOINT_RWCSTREAM_BusSuspended;
  49         }
  50
  51         return ENDPOINT_RWCSTREAM_NoError;
  52 }
  53
  54 #undef TEMPLATE_BUFFER_OFFSET
  55 #undef TEMPLATE_FUNC_NAME
  56 #undef TEMPLATE_TRANSFER_BYTE