Added CDC_Device_Flush() command to the CDC Device mode class driver.

[pub/USBasp.git] / LUFA / Drivers / USB / Class / Host / MassStorage.c

diff --git a/LUFA/Drivers/USB/Class/Host/MassStorage.c b/LUFA/Drivers/USB/Class/Host/MassStorage.c
index 17b3939..6332d3a 100644 (file)
--- a/LUFA/Drivers/USB/Class/Host/MassStorage.c
+++ b/LUFA/Drivers/USB/Class/Host/MassStorage.c
@@ -36,4 +36,99 @@
 \r
 #warning The Mass Storage Host mode Class driver is currently incomplete and is for preview purposes only.\r
 \r
+uint8_t MS_Host_ConfigurePipes(USB_ClassInfo_MS_Host_t* MSInterfaceInfo, uint16_t ConfigDescriptorLength,\r
+                                                          uint8_t* DeviceConfigDescriptor)\r
+{\r
+       uint8_t FoundEndpoints = 0;\r
+       \r
+       memset(&MSInterfaceInfo->State, 0x00, sizeof(MSInterfaceInfo->State));\r
+\r
+       if (DESCRIPTOR_TYPE(DeviceConfigDescriptor) != DTYPE_Configuration)\r
+         return MS_ENUMERROR_InvalidConfigDescriptor;\r
+       \r
+       if (USB_GetNextDescriptorComp(&ConfigDescriptorLength, &DeviceConfigDescriptor,\r
+                                     DComp_NextMassStorageInterface) != DESCRIPTOR_SEARCH_COMP_Found)\r
+       {\r
+               return MS_ENUMERROR_NoMSInterfaceFound;\r
+       }\r
+\r
+       MSInterfaceInfo->State.InterfaceNumber       =\r
+       #if defined(USE_NONSTANDARD_DESCRIPTOR_NAMES)\r
+                            DESCRIPTOR_PCAST(DeviceConfigDescriptor, USB_Descriptor_Interface_t)->InterfaceNumber;\r
+       #else\r
+                            DESCRIPTOR_PCAST(DeviceConfigDescriptor, USB_Descriptor_Interface_t)->bInterfaceNumber;\r
+       #endif\r
+       \r
+       while (FoundEndpoints != (MS_FOUND_DATAPIPE_IN | MS_FOUND_DATAPIPE_OUT))\r
+       {\r
+               if (USB_GetNextDescriptorComp(&ConfigDescriptorLength, &DeviceConfigDescriptor,\r
+                                             DComp_NextInterfaceBulkDataEndpoint) != DESCRIPTOR_SEARCH_COMP_Found)\r
+               {\r
+                       return MS_ENUMERROR_EndpointsNotFound;\r
+               }\r
+               \r
+               USB_Descriptor_Endpoint_t* EndpointData = DESCRIPTOR_PCAST(DeviceConfigDescriptor, USB_Descriptor_Endpoint_t);\r
+\r
+               if (EndpointData->EndpointAddress & ENDPOINT_DESCRIPTOR_DIR_IN)\r
+               {\r
+                       Pipe_ConfigurePipe(MSInterfaceInfo->Config.DataINPipeNumber, EP_TYPE_BULK, PIPE_TOKEN_IN,\r
+                                          EndpointData->EndpointAddress, EndpointData->EndpointSize,\r
+                                          PIPE_BANK_DOUBLE);\r
+                       MSInterfaceInfo->State.DataINPipeSize = EndpointData->EndpointSize;\r
+\r
+                       FoundEndpoints |= MS_FOUND_DATAPIPE_IN;\r
+               }\r
+               else\r
+               {\r
+                       Pipe_ConfigurePipe(MSInterfaceInfo->Config.DataOUTPipeNumber, EP_TYPE_BULK, PIPE_TOKEN_OUT,\r
+                                          EndpointData->EndpointAddress, EndpointData->EndpointSize,\r
+                                          PIPE_BANK_DOUBLE);\r
+                       MSInterfaceInfo->State.DataOUTPipeSize = EndpointData->EndpointSize;\r
+\r
+                       FoundEndpoints |= MS_FOUND_DATAPIPE_OUT;\r
+               }               \r
+       }\r
+\r
+       MSInterfaceInfo->State.Active = true;\r
+       return MS_ENUMERROR_NoError;\r
+}\r
+\r
+static uint8_t DComp_NextMassStorageInterface(void* CurrentDescriptor)\r
+{\r
+       if (DESCRIPTOR_TYPE(CurrentDescriptor) == DTYPE_Interface)\r
+       {\r
+               if ((DESCRIPTOR_CAST(CurrentDescriptor, USB_Descriptor_Interface_t).Class    == MASS_STORE_CLASS)    &&\r
+                   (DESCRIPTOR_CAST(CurrentDescriptor, USB_Descriptor_Interface_t).SubClass == MASS_STORE_SUBCLASS) &&\r
+                   (DESCRIPTOR_CAST(CurrentDescriptor, USB_Descriptor_Interface_t).Protocol == MASS_STORE_PROTOCOL))\r
+               {\r
+                       return DESCRIPTOR_SEARCH_Found;\r
+               }\r
+       }\r
+       \r
+       return DESCRIPTOR_SEARCH_NotFound;\r
+}\r
+\r
+static uint8_t DComp_NextInterfaceBulkDataEndpoint(void* CurrentDescriptor)\r
+{\r
+       if (DESCRIPTOR_TYPE(CurrentDescriptor) == DTYPE_Endpoint)\r
+       {\r
+               uint8_t EndpointType = (DESCRIPTOR_CAST(CurrentDescriptor,\r
+                                                       USB_Descriptor_Endpoint_t).Attributes & EP_TYPE_MASK);\r
+\r
+               if (EndpointType == EP_TYPE_BULK)\r
+                 return DESCRIPTOR_SEARCH_Found;\r
+       }\r
+       else if (DESCRIPTOR_TYPE(CurrentDescriptor) == DTYPE_Interface)\r
+       {\r
+               return DESCRIPTOR_SEARCH_Fail;\r
+       }\r
+\r
+       return DESCRIPTOR_SEARCH_NotFound;\r
+}\r
+\r
+void MS_Host_USBTask(USB_ClassInfo_MS_Host_t* MSInterfaceInfo)\r
+{\r
+       \r
+}\r
+\r
 #endif\r