Initial restructuring of the core USB driver module to support multiple architectures...

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

diff --git a/LUFA/Drivers/USB/Core/ConfigDescriptor.c b/LUFA/Drivers/USB/Core/ConfigDescriptor.c
new file mode 100644 (file)
index 0000000..9671659
--- /dev/null
+++ b/LUFA/Drivers/USB/Core/ConfigDescriptor.c
@@ -0,0 +1,142 @@
+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2011.
+
+  dean [at] fourwalledcubicle [dot] com
+           www.lufa-lib.org
+*/
+
+/*
+  Copyright 2011  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting
+  documentation, and that the name of the author not be used in
+  advertising or publicity pertaining to distribution of the
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+#define  __INCLUDE_FROM_USB_DRIVER
+#include "ConfigDescriptor.h"
+
+#if defined(USB_CAN_BE_HOST)
+uint8_t USB_Host_GetDeviceConfigDescriptor(uint8_t ConfigNumber, uint16_t* const ConfigSizePtr,
+                                           void* BufferPtr, uint16_t BufferSize)
+{
+       uint8_t ErrorCode;
+       uint8_t ConfigHeader[sizeof(USB_Descriptor_Configuration_Header_t)];
+
+       USB_ControlRequest = (USB_Request_Header_t)
+               {
+                       .bmRequestType = (REQDIR_DEVICETOHOST | REQTYPE_STANDARD | REQREC_DEVICE),
+                       .bRequest      = REQ_GetDescriptor,
+                       .wValue        = ((DTYPE_Configuration << 8) | (ConfigNumber - 1)),
+                       .wIndex        = 0,
+                       .wLength       = sizeof(USB_Descriptor_Configuration_Header_t),
+               };
+
+       Pipe_SelectPipe(PIPE_CONTROLPIPE);
+
+       if ((ErrorCode = USB_Host_SendControlRequest(ConfigHeader)) != HOST_SENDCONTROL_Successful)
+         return ErrorCode;
+
+       *ConfigSizePtr = DESCRIPTOR_PCAST(ConfigHeader, USB_Descriptor_Configuration_Header_t)->TotalConfigurationSize;
+
+       if (*ConfigSizePtr > BufferSize)
+         return HOST_GETCONFIG_BuffOverflow;
+
+       USB_ControlRequest.wLength = *ConfigSizePtr;
+
+       if ((ErrorCode = USB_Host_SendControlRequest(BufferPtr)) != HOST_SENDCONTROL_Successful)
+         return ErrorCode;
+
+       if (DESCRIPTOR_TYPE(BufferPtr) != DTYPE_Configuration)
+         return HOST_GETCONFIG_InvalidData;
+
+       return HOST_GETCONFIG_Successful;
+}
+#endif
+
+void USB_GetNextDescriptorOfType(uint16_t* const BytesRem,
+                                 void** const CurrConfigLoc,
+                                 const uint8_t Type)
+{
+       while (*BytesRem)
+       {
+               USB_GetNextDescriptor(BytesRem, CurrConfigLoc);
+
+               if (DESCRIPTOR_TYPE(*CurrConfigLoc) == Type)
+                 return;
+       }
+}
+
+void USB_GetNextDescriptorOfTypeBefore(uint16_t* const BytesRem,
+                                       void** const CurrConfigLoc,
+                                       const uint8_t Type,
+                                       const uint8_t BeforeType)
+{
+       while (*BytesRem)
+       {
+               USB_GetNextDescriptor(BytesRem, CurrConfigLoc);
+
+               if (DESCRIPTOR_TYPE(*CurrConfigLoc) == Type)
+               {
+                       return;
+               }
+               else if (DESCRIPTOR_TYPE(*CurrConfigLoc) == BeforeType)
+               {
+                       *BytesRem = 0;
+                       return;
+               }
+       }
+}
+
+void USB_GetNextDescriptorOfTypeAfter(uint16_t* const BytesRem,
+                                      void** const CurrConfigLoc,
+                                      const uint8_t Type,
+                                      const uint8_t AfterType)
+{
+       USB_GetNextDescriptorOfType(BytesRem, CurrConfigLoc, AfterType);
+
+       if (*BytesRem)
+         USB_GetNextDescriptorOfType(BytesRem, CurrConfigLoc, Type);
+}
+
+uint8_t USB_GetNextDescriptorComp(uint16_t* const BytesRem, void** const CurrConfigLoc, ConfigComparatorPtr_t const ComparatorRoutine)
+{
+       uint8_t ErrorCode;
+
+       while (*BytesRem)
+       {
+               uint8_t* PrevDescLoc  = *CurrConfigLoc;
+               uint16_t PrevBytesRem = *BytesRem;
+
+               USB_GetNextDescriptor(BytesRem, CurrConfigLoc);
+
+               if ((ErrorCode = ComparatorRoutine(*CurrConfigLoc)) != DESCRIPTOR_SEARCH_NotFound)
+               {
+                       if (ErrorCode == DESCRIPTOR_SEARCH_Fail)
+                       {
+                               *CurrConfigLoc = PrevDescLoc;
+                               *BytesRem      = PrevBytesRem;
+                       }
+
+                       return ErrorCode;
+               }
+       }
+
+       return DESCRIPTOR_SEARCH_COMP_EndOfDescriptor;
+}
+