Moved all source to the trunk directory.

[pub/lufa.git] / LUFA / Drivers / USB / Class / ConfigDescriptor.c

diff --git a/LUFA/Drivers/USB/Class/ConfigDescriptor.c b/LUFA/Drivers/USB/Class/ConfigDescriptor.c
new file mode 100644 (file)
index 0000000..d791069
--- /dev/null
+++ b/LUFA/Drivers/USB/Class/ConfigDescriptor.c
@@ -0,0 +1,138 @@
+/*\r
+             LUFA Library\r
+     Copyright (C) Dean Camera, 2009.\r
+              \r
+  dean [at] fourwalledcubicle [dot] com\r
+      www.fourwalledcubicle.com\r
+*/\r
+\r
+/*\r
+  Copyright 2009  Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
+\r
+  Permission to use, copy, modify, and distribute this software\r
+  and its documentation for any purpose and without fee is hereby\r
+  granted, provided that the above copyright notice appear in all\r
+  copies and that both that the copyright notice and this\r
+  permission notice and warranty disclaimer appear in supporting\r
+  documentation, and that the name of the author not be used in\r
+  advertising or publicity pertaining to distribution of the\r
+  software without specific, written prior permission.\r
+\r
+  The author disclaim all warranties with regard to this\r
+  software, including all implied warranties of merchantability\r
+  and fitness.  In no event shall the author be liable for any\r
+  special, indirect or consequential damages or any damages\r
+  whatsoever resulting from loss of use, data or profits, whether\r
+  in an action of contract, negligence or other tortious action,\r
+  arising out of or in connection with the use or performance of\r
+  this software.\r
+*/\r
+\r
+#include "ConfigDescriptor.h"\r
+\r
+uint8_t USB_Host_GetDeviceConfigDescriptor(uint16_t* const ConfigSizePtr, void* BufferPtr)\r
+{\r
+       uint8_t ErrorCode;\r
+\r
+       USB_HostRequest = (USB_Host_Request_Header_t)\r
+               {\r
+                       bmRequestType: (REQDIR_DEVICETOHOST | REQTYPE_STANDARD | REQREC_DEVICE),\r
+                       bRequest:      REQ_GetDescriptor,\r
+                       wValue:        (DTYPE_Configuration << 8),\r
+                       wIndex:        0,\r
+                       wLength:       sizeof(USB_Descriptor_Configuration_Header_t),\r
+               };\r
+       \r
+       if (BufferPtr == NULL)\r
+       {\r
+               uint8_t ConfigHeader[sizeof(USB_Descriptor_Configuration_Header_t)];\r
+\r
+               ErrorCode      = USB_Host_SendControlRequest(ConfigHeader);\r
+\r
+               #if defined(USE_NONSTANDARD_DESCRIPTOR_NAMES)\r
+               *ConfigSizePtr = DESCRIPTOR_CAST(ConfigHeader, USB_Descriptor_Configuration_Header_t).TotalConfigurationSize;\r
+               #else\r
+               *ConfigSizePtr = DESCRIPTOR_CAST(ConfigHeader, USB_Descriptor_Configuration_Header_t).wTotalLength;             \r
+               #endif\r
+       }\r
+       else\r
+       {\r
+               USB_HostRequest.wLength = *ConfigSizePtr;\r
+               \r
+               ErrorCode      = USB_Host_SendControlRequest(BufferPtr);                                \r
+       }\r
+\r
+       return ErrorCode;\r
+}\r
+\r
+void USB_Host_GetNextDescriptorOfType(uint16_t* const BytesRem,\r
+                                      uint8_t** const CurrConfigLoc,\r
+                                      const uint8_t Type)\r
+{\r
+       while (*BytesRem)\r
+       {\r
+               USB_Host_GetNextDescriptor(BytesRem, CurrConfigLoc);      \r
+\r
+               if (DESCRIPTOR_TYPE(*CurrConfigLoc) == Type)\r
+                 return;\r
+       }\r
+}\r
+\r
+void USB_Host_GetNextDescriptorOfTypeBefore(uint16_t* const BytesRem,\r
+                                            uint8_t** const CurrConfigLoc,\r
+                                            const uint8_t Type,\r
+                                            const uint8_t BeforeType)\r
+{\r
+       while (*BytesRem)\r
+       {\r
+               USB_Host_GetNextDescriptor(BytesRem, CurrConfigLoc);\r
+\r
+               if (DESCRIPTOR_TYPE(*CurrConfigLoc) == Type)\r
+               {\r
+                       return;\r
+               }\r
+               else if (DESCRIPTOR_TYPE(*CurrConfigLoc) == BeforeType)\r
+               {\r
+                       *BytesRem = 0;\r
+                       return;\r
+               }\r
+       }\r
+}\r
+\r
+void USB_Host_GetNextDescriptorOfTypeAfter(uint16_t* const BytesRem,\r
+                                           uint8_t** const CurrConfigLoc,\r
+                                           const uint8_t Type,\r
+                                           const uint8_t AfterType)\r
+{\r
+       USB_Host_GetNextDescriptorOfType(BytesRem, CurrConfigLoc, AfterType);\r
+       \r
+       if (*BytesRem)\r
+         USB_Host_GetNextDescriptorOfType(BytesRem, CurrConfigLoc, Type);\r
+}\r
+                       \r
+uint8_t USB_Host_GetNextDescriptorComp_P(uint16_t* BytesRem, uint8_t** CurrConfigLoc,\r
+                                         uint8_t (* const ComparatorRoutine)(void*))\r
+{\r
+       uint8_t ErrorCode;\r
+               \r
+       while (*BytesRem)\r
+       {\r
+               uint8_t*  PrevDescLoc = *CurrConfigLoc;\r
+               uint16_t  PrevBytesRem = *BytesRem;\r
+\r
+               USB_Host_GetNextDescriptor(BytesRem, CurrConfigLoc);\r
+\r
+               if ((ErrorCode = ComparatorRoutine(*CurrConfigLoc)) != Descriptor_Search_NotFound)\r
+               {\r
+                       if (ErrorCode == Descriptor_Search_Fail)\r
+                       {\r
+                               *CurrConfigLoc = PrevDescLoc;\r
+                               *BytesRem      = PrevBytesRem;\r
+                       }\r
+               \r
+                       return ErrorCode;\r
+               }\r
+       }\r
+       \r
+       return Descriptor_Search_Comp_EndOfDescriptor;\r
+}\r