Dean Camera
5de364163f
Fix pointer arithmetic on void byte buffers by explicitly typecasting the buffer pointers to uint8_t* before altering them.
44 lines
1.1 KiB
C
44 lines
1.1 KiB
C
uint8_t TEMPLATE_FUNC_NAME (const void* Buffer, uint16_t Length)
|
|
{
|
|
uint8_t* DataStream = ((uint8_t*)Buffer + TEMPLATE_BUFFER_OFFSET(Length));
|
|
bool LastPacketFull = false;
|
|
|
|
if (Length > USB_ControlRequest.wLength)
|
|
Length = USB_ControlRequest.wLength;
|
|
|
|
while (Length || LastPacketFull)
|
|
{
|
|
if (Endpoint_IsSETUPReceived())
|
|
return ENDPOINT_RWCSTREAM_HostAborted;
|
|
|
|
if (Endpoint_IsOUTReceived())
|
|
break;
|
|
|
|
if (USB_DeviceState == DEVICE_STATE_Unattached)
|
|
return ENDPOINT_RWCSTREAM_DeviceDisconnected;
|
|
|
|
if (Endpoint_IsINReady())
|
|
{
|
|
while (Length && (Endpoint_BytesInEndpoint() < USB_ControlEndpointSize))
|
|
{
|
|
TEMPLATE_TRANSFER_BYTE(DataStream);
|
|
Length--;
|
|
}
|
|
|
|
LastPacketFull = (Endpoint_BytesInEndpoint() == USB_ControlEndpointSize);
|
|
Endpoint_ClearIN();
|
|
}
|
|
}
|
|
|
|
while (!(Endpoint_IsOUTReceived()))
|
|
{
|
|
if (USB_DeviceState == DEVICE_STATE_Unattached)
|
|
return ENDPOINT_RWCSTREAM_DeviceDisconnected;
|
|
}
|
|
|
|
return ENDPOINT_RWCSTREAM_NoError;
|
|
}
|
|
|
|
#undef TEMPLATE_BUFFER_OFFSET
|
|
#undef TEMPLATE_FUNC_NAME
|
|
#undef TEMPLATE_TRANSFER_BYTE |