mirror of
https://github.com/dougg3/mac-rom-simm-programmer.git
synced 2024-12-01 04:49:22 +00:00
147 lines
4.6 KiB
C
147 lines
4.6 KiB
C
/*
|
|
LUFA Library
|
|
Copyright (C) Dean Camera, 2012.
|
|
|
|
dean [at] fourwalledcubicle [dot] com
|
|
www.lufa-lib.org
|
|
*/
|
|
|
|
/*
|
|
Copyright 2012 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(const uint8_t ConfigNumber,
|
|
uint16_t* const ConfigSizePtr,
|
|
void* const BufferPtr,
|
|
const 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 = le16_to_cpu(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;
|
|
}
|
|
|