+++ /dev/null
-/*\r
- LUFA Library\r
- Copyright (C) Dean Camera, 2012.\r
-\r
- dean [at] fourwalledcubicle [dot] com\r
- www.lufa-lib.org\r
-*/\r
-\r
-/*\r
- Copyright 2012 Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
-\r
- Permission to use, copy, modify, distribute, and sell this\r
- software and its documentation for any purpose is hereby granted\r
- without fee, provided that the above copyright notice appear in\r
- all 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
-#define __INCLUDE_FROM_USB_DRIVER\r
-#include "../../Core/USBMode.h"\r
-\r
-#if defined(USB_CAN_BE_DEVICE)\r
-\r
-#define __INCLUDE_FROM_RNDIS_DRIVER\r
-#define __INCLUDE_FROM_RNDIS_DEVICE_C\r
-#include "RNDISClassDevice.h"\r
-\r
-static const uint32_t PROGMEM AdapterSupportedOIDList[] =\r
- {\r
- CPU_TO_LE32(OID_GEN_SUPPORTED_LIST),\r
- CPU_TO_LE32(OID_GEN_PHYSICAL_MEDIUM),\r
- CPU_TO_LE32(OID_GEN_HARDWARE_STATUS),\r
- CPU_TO_LE32(OID_GEN_MEDIA_SUPPORTED),\r
- CPU_TO_LE32(OID_GEN_MEDIA_IN_USE),\r
- CPU_TO_LE32(OID_GEN_MAXIMUM_FRAME_SIZE),\r
- CPU_TO_LE32(OID_GEN_MAXIMUM_TOTAL_SIZE),\r
- CPU_TO_LE32(OID_GEN_LINK_SPEED),\r
- CPU_TO_LE32(OID_GEN_TRANSMIT_BLOCK_SIZE),\r
- CPU_TO_LE32(OID_GEN_RECEIVE_BLOCK_SIZE),\r
- CPU_TO_LE32(OID_GEN_VENDOR_ID),\r
- CPU_TO_LE32(OID_GEN_VENDOR_DESCRIPTION),\r
- CPU_TO_LE32(OID_GEN_CURRENT_PACKET_FILTER),\r
- CPU_TO_LE32(OID_GEN_MAXIMUM_TOTAL_SIZE),\r
- CPU_TO_LE32(OID_GEN_MEDIA_CONNECT_STATUS),\r
- CPU_TO_LE32(OID_GEN_XMIT_OK),\r
- CPU_TO_LE32(OID_GEN_RCV_OK),\r
- CPU_TO_LE32(OID_GEN_XMIT_ERROR),\r
- CPU_TO_LE32(OID_GEN_RCV_ERROR),\r
- CPU_TO_LE32(OID_GEN_RCV_NO_BUFFER),\r
- CPU_TO_LE32(OID_802_3_PERMANENT_ADDRESS),\r
- CPU_TO_LE32(OID_802_3_CURRENT_ADDRESS),\r
- CPU_TO_LE32(OID_802_3_MULTICAST_LIST),\r
- CPU_TO_LE32(OID_802_3_MAXIMUM_LIST_SIZE),\r
- CPU_TO_LE32(OID_802_3_RCV_ERROR_ALIGNMENT),\r
- CPU_TO_LE32(OID_802_3_XMIT_ONE_COLLISION),\r
- CPU_TO_LE32(OID_802_3_XMIT_MORE_COLLISIONS),\r
- };\r
-\r
-void RNDIS_Device_ProcessControlRequest(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo)\r
-{\r
- if (!(Endpoint_IsSETUPReceived()))\r
- return;\r
-\r
- if (USB_ControlRequest.wIndex != RNDISInterfaceInfo->Config.ControlInterfaceNumber)\r
- return;\r
-\r
- switch (USB_ControlRequest.bRequest)\r
- {\r
- case RNDIS_REQ_SendEncapsulatedCommand:\r
- if (USB_ControlRequest.bmRequestType == (REQDIR_HOSTTODEVICE | REQTYPE_CLASS | REQREC_INTERFACE))\r
- {\r
- Endpoint_ClearSETUP();\r
- Endpoint_Read_Control_Stream_LE(RNDISInterfaceInfo->State.RNDISMessageBuffer, USB_ControlRequest.wLength);\r
- Endpoint_ClearIN();\r
-\r
- RNDIS_Device_ProcessRNDISControlMessage(RNDISInterfaceInfo);\r
- }\r
-\r
- break;\r
- case RNDIS_REQ_GetEncapsulatedResponse:\r
- if (USB_ControlRequest.bmRequestType == (REQDIR_DEVICETOHOST | REQTYPE_CLASS | REQREC_INTERFACE))\r
- {\r
- RNDIS_Message_Header_t* MessageHeader = (RNDIS_Message_Header_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
-\r
- if (!(MessageHeader->MessageLength))\r
- {\r
- RNDISInterfaceInfo->State.RNDISMessageBuffer[0] = 0;\r
- MessageHeader->MessageLength = CPU_TO_LE32(1);\r
- }\r
-\r
- Endpoint_ClearSETUP();\r
- Endpoint_Write_Control_Stream_LE(RNDISInterfaceInfo->State.RNDISMessageBuffer, le32_to_cpu(MessageHeader->MessageLength));\r
- Endpoint_ClearOUT();\r
-\r
- MessageHeader->MessageLength = CPU_TO_LE32(0);\r
- }\r
-\r
- break;\r
- }\r
-}\r
-\r
-bool RNDIS_Device_ConfigureEndpoints(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo)\r
-{\r
- memset(&RNDISInterfaceInfo->State, 0x00, sizeof(RNDISInterfaceInfo->State));\r
-\r
- RNDISInterfaceInfo->Config.DataINEndpoint.Type = EP_TYPE_BULK;\r
- RNDISInterfaceInfo->Config.DataOUTEndpoint.Type = EP_TYPE_BULK;\r
- RNDISInterfaceInfo->Config.NotificationEndpoint.Type = EP_TYPE_INTERRUPT;\r
-\r
- if (!(Endpoint_ConfigureEndpointTable(&RNDISInterfaceInfo->Config.DataINEndpoint, 1)))\r
- return false;\r
-\r
- if (!(Endpoint_ConfigureEndpointTable(&RNDISInterfaceInfo->Config.DataOUTEndpoint, 1)))\r
- return false;\r
-\r
- if (!(Endpoint_ConfigureEndpointTable(&RNDISInterfaceInfo->Config.NotificationEndpoint, 1)))\r
- return false;\r
-\r
- return true;\r
-}\r
-\r
-void RNDIS_Device_USBTask(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo)\r
-{\r
- if (USB_DeviceState != DEVICE_STATE_Configured)\r
- return;\r
-\r
- Endpoint_SelectEndpoint(RNDISInterfaceInfo->Config.NotificationEndpoint.Address);\r
-\r
- if (Endpoint_IsINReady() && RNDISInterfaceInfo->State.ResponseReady)\r
- {\r
- USB_Request_Header_t Notification = (USB_Request_Header_t)\r
- {\r
- .bmRequestType = (REQDIR_DEVICETOHOST | REQTYPE_CLASS | REQREC_INTERFACE),\r
- .bRequest = RNDIS_NOTIF_ResponseAvailable,\r
- .wValue = CPU_TO_LE16(0),\r
- .wIndex = CPU_TO_LE16(0),\r
- .wLength = CPU_TO_LE16(0),\r
- };\r
-\r
- Endpoint_Write_Stream_LE(&Notification, sizeof(USB_Request_Header_t), NULL);\r
-\r
- Endpoint_ClearIN();\r
-\r
- RNDISInterfaceInfo->State.ResponseReady = false;\r
- }\r
-}\r
-\r
-void RNDIS_Device_ProcessRNDISControlMessage(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo)\r
-{\r
- /* Note: Only a single buffer is used for both the received message and its response to save SRAM. Because of\r
- this, response bytes should be filled in order so that they do not clobber unread data in the buffer. */\r
-\r
- RNDIS_Message_Header_t* MessageHeader = (RNDIS_Message_Header_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
-\r
- switch (le32_to_cpu(MessageHeader->MessageType))\r
- {\r
- case REMOTE_NDIS_INITIALIZE_MSG:\r
- RNDISInterfaceInfo->State.ResponseReady = true;\r
-\r
- RNDIS_Initialize_Message_t* INITIALIZE_Message =\r
- (RNDIS_Initialize_Message_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
- RNDIS_Initialize_Complete_t* INITIALIZE_Response =\r
- (RNDIS_Initialize_Complete_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
-\r
- INITIALIZE_Response->MessageType = CPU_TO_LE32(REMOTE_NDIS_INITIALIZE_CMPLT);\r
- INITIALIZE_Response->MessageLength = CPU_TO_LE32(sizeof(RNDIS_Initialize_Complete_t));\r
- INITIALIZE_Response->RequestId = INITIALIZE_Message->RequestId;\r
- INITIALIZE_Response->Status = CPU_TO_LE32(REMOTE_NDIS_STATUS_SUCCESS);\r
-\r
- INITIALIZE_Response->MajorVersion = CPU_TO_LE32(REMOTE_NDIS_VERSION_MAJOR);\r
- INITIALIZE_Response->MinorVersion = CPU_TO_LE32(REMOTE_NDIS_VERSION_MINOR);\r
- INITIALIZE_Response->DeviceFlags = CPU_TO_LE32(REMOTE_NDIS_DF_CONNECTIONLESS);\r
- INITIALIZE_Response->Medium = CPU_TO_LE32(REMOTE_NDIS_MEDIUM_802_3);\r
- INITIALIZE_Response->MaxPacketsPerTransfer = CPU_TO_LE32(1);\r
- INITIALIZE_Response->MaxTransferSize = CPU_TO_LE32(sizeof(RNDIS_Packet_Message_t) + ETHERNET_FRAME_SIZE_MAX);\r
- INITIALIZE_Response->PacketAlignmentFactor = CPU_TO_LE32(0);\r
- INITIALIZE_Response->AFListOffset = CPU_TO_LE32(0);\r
- INITIALIZE_Response->AFListSize = CPU_TO_LE32(0);\r
-\r
- RNDISInterfaceInfo->State.CurrRNDISState = RNDIS_Initialized;\r
- break;\r
- case REMOTE_NDIS_HALT_MSG:\r
- RNDISInterfaceInfo->State.ResponseReady = false;\r
-\r
- MessageHeader->MessageLength = CPU_TO_LE32(0);\r
-\r
- RNDISInterfaceInfo->State.CurrRNDISState = RNDIS_Uninitialized;\r
- break;\r
- case REMOTE_NDIS_QUERY_MSG:\r
- RNDISInterfaceInfo->State.ResponseReady = true;\r
-\r
- RNDIS_Query_Message_t* QUERY_Message = (RNDIS_Query_Message_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
- RNDIS_Query_Complete_t* QUERY_Response = (RNDIS_Query_Complete_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
- uint32_t Query_Oid = CPU_TO_LE32(QUERY_Message->Oid);\r
-\r
- void* QueryData = &RNDISInterfaceInfo->State.RNDISMessageBuffer[sizeof(RNDIS_Message_Header_t) +\r
- le32_to_cpu(QUERY_Message->InformationBufferOffset)];\r
- void* ResponseData = &RNDISInterfaceInfo->State.RNDISMessageBuffer[sizeof(RNDIS_Query_Complete_t)];\r
- uint16_t ResponseSize;\r
-\r
- QUERY_Response->MessageType = CPU_TO_LE32(REMOTE_NDIS_QUERY_CMPLT);\r
-\r
- if (RNDIS_Device_ProcessNDISQuery(RNDISInterfaceInfo, Query_Oid, QueryData, le32_to_cpu(QUERY_Message->InformationBufferLength),\r
- ResponseData, &ResponseSize))\r
- {\r
- QUERY_Response->Status = CPU_TO_LE32(REMOTE_NDIS_STATUS_SUCCESS);\r
- QUERY_Response->MessageLength = cpu_to_le32(sizeof(RNDIS_Query_Complete_t) + ResponseSize);\r
-\r
- QUERY_Response->InformationBufferLength = CPU_TO_LE32(ResponseSize);\r
- QUERY_Response->InformationBufferOffset = CPU_TO_LE32(sizeof(RNDIS_Query_Complete_t) - sizeof(RNDIS_Message_Header_t));\r
- }\r
- else\r
- {\r
- QUERY_Response->Status = CPU_TO_LE32(REMOTE_NDIS_STATUS_NOT_SUPPORTED);\r
- QUERY_Response->MessageLength = CPU_TO_LE32(sizeof(RNDIS_Query_Complete_t));\r
-\r
- QUERY_Response->InformationBufferLength = CPU_TO_LE32(0);\r
- QUERY_Response->InformationBufferOffset = CPU_TO_LE32(0);\r
- }\r
-\r
- break;\r
- case REMOTE_NDIS_SET_MSG:\r
- RNDISInterfaceInfo->State.ResponseReady = true;\r
-\r
- RNDIS_Set_Message_t* SET_Message = (RNDIS_Set_Message_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
- RNDIS_Set_Complete_t* SET_Response = (RNDIS_Set_Complete_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
- uint32_t SET_Oid = le32_to_cpu(SET_Message->Oid);\r
-\r
- SET_Response->MessageType = CPU_TO_LE32(REMOTE_NDIS_SET_CMPLT);\r
- SET_Response->MessageLength = CPU_TO_LE32(sizeof(RNDIS_Set_Complete_t));\r
- SET_Response->RequestId = SET_Message->RequestId;\r
-\r
- void* SetData = &RNDISInterfaceInfo->State.RNDISMessageBuffer[sizeof(RNDIS_Message_Header_t) +\r
- le32_to_cpu(SET_Message->InformationBufferOffset)];\r
-\r
- SET_Response->Status = RNDIS_Device_ProcessNDISSet(RNDISInterfaceInfo, SET_Oid, SetData,\r
- le32_to_cpu(SET_Message->InformationBufferLength)) ?\r
- REMOTE_NDIS_STATUS_SUCCESS : REMOTE_NDIS_STATUS_NOT_SUPPORTED;\r
- break;\r
- case REMOTE_NDIS_RESET_MSG:\r
- RNDISInterfaceInfo->State.ResponseReady = true;\r
-\r
- RNDIS_Reset_Complete_t* RESET_Response = (RNDIS_Reset_Complete_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
-\r
- RESET_Response->MessageType = CPU_TO_LE32(REMOTE_NDIS_RESET_CMPLT);\r
- RESET_Response->MessageLength = CPU_TO_LE32(sizeof(RNDIS_Reset_Complete_t));\r
- RESET_Response->Status = CPU_TO_LE32(REMOTE_NDIS_STATUS_SUCCESS);\r
- RESET_Response->AddressingReset = CPU_TO_LE32(0);\r
-\r
- break;\r
- case REMOTE_NDIS_KEEPALIVE_MSG:\r
- RNDISInterfaceInfo->State.ResponseReady = true;\r
-\r
- RNDIS_KeepAlive_Message_t* KEEPALIVE_Message =\r
- (RNDIS_KeepAlive_Message_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
- RNDIS_KeepAlive_Complete_t* KEEPALIVE_Response =\r
- (RNDIS_KeepAlive_Complete_t*)&RNDISInterfaceInfo->State.RNDISMessageBuffer;\r
-\r
- KEEPALIVE_Response->MessageType = CPU_TO_LE32(REMOTE_NDIS_KEEPALIVE_CMPLT);\r
- KEEPALIVE_Response->MessageLength = CPU_TO_LE32(sizeof(RNDIS_KeepAlive_Complete_t));\r
- KEEPALIVE_Response->RequestId = KEEPALIVE_Message->RequestId;\r
- KEEPALIVE_Response->Status = CPU_TO_LE32(REMOTE_NDIS_STATUS_SUCCESS);\r
-\r
- break;\r
- }\r
-}\r
-\r
-static bool RNDIS_Device_ProcessNDISQuery(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo,\r
- const uint32_t OId,\r
- void* const QueryData,\r
- const uint16_t QuerySize,\r
- void* ResponseData,\r
- uint16_t* const ResponseSize)\r
-{\r
- (void)QueryData;\r
- (void)QuerySize;\r
-\r
- switch (OId)\r
- {\r
- case OID_GEN_SUPPORTED_LIST:\r
- *ResponseSize = sizeof(AdapterSupportedOIDList);\r
-\r
- memcpy_P(ResponseData, AdapterSupportedOIDList, sizeof(AdapterSupportedOIDList));\r
-\r
- return true;\r
- case OID_GEN_PHYSICAL_MEDIUM:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- /* Indicate that the device is a true ethernet link */\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(0);\r
-\r
- return true;\r
- case OID_GEN_HARDWARE_STATUS:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(NDIS_HardwareStatus_Ready);\r
-\r
- return true;\r
- case OID_GEN_MEDIA_SUPPORTED:\r
- case OID_GEN_MEDIA_IN_USE:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(REMOTE_NDIS_MEDIUM_802_3);\r
-\r
- return true;\r
- case OID_GEN_VENDOR_ID:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- /* Vendor ID 0x0xFFFFFF is reserved for vendors who have not purchased a NDIS VID */\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(0x00FFFFFF);\r
-\r
- return true;\r
- case OID_GEN_MAXIMUM_FRAME_SIZE:\r
- case OID_GEN_TRANSMIT_BLOCK_SIZE:\r
- case OID_GEN_RECEIVE_BLOCK_SIZE:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(ETHERNET_FRAME_SIZE_MAX);\r
-\r
- return true;\r
- case OID_GEN_VENDOR_DESCRIPTION:\r
- *ResponseSize = (strlen(RNDISInterfaceInfo->Config.AdapterVendorDescription) + 1);\r
-\r
- memcpy(ResponseData, RNDISInterfaceInfo->Config.AdapterVendorDescription, *ResponseSize);\r
-\r
- return true;\r
- case OID_GEN_MEDIA_CONNECT_STATUS:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(REMOTE_NDIS_MEDIA_STATE_CONNECTED);\r
-\r
- return true;\r
- case OID_GEN_LINK_SPEED:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- /* Indicate 10Mb/s link speed */\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(100000);\r
-\r
- return true;\r
- case OID_802_3_PERMANENT_ADDRESS:\r
- case OID_802_3_CURRENT_ADDRESS:\r
- *ResponseSize = sizeof(MAC_Address_t);\r
-\r
- memcpy(ResponseData, &RNDISInterfaceInfo->Config.AdapterMACAddress, sizeof(MAC_Address_t));\r
-\r
- return true;\r
- case OID_802_3_MAXIMUM_LIST_SIZE:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- /* Indicate only one multicast address supported */\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(1);\r
-\r
- return true;\r
- case OID_GEN_CURRENT_PACKET_FILTER:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- *((uint32_t*)ResponseData) = cpu_to_le32(RNDISInterfaceInfo->State.CurrPacketFilter);\r
-\r
- return true;\r
- case OID_GEN_XMIT_OK:\r
- case OID_GEN_RCV_OK:\r
- case OID_GEN_XMIT_ERROR:\r
- case OID_GEN_RCV_ERROR:\r
- case OID_GEN_RCV_NO_BUFFER:\r
- case OID_802_3_RCV_ERROR_ALIGNMENT:\r
- case OID_802_3_XMIT_ONE_COLLISION:\r
- case OID_802_3_XMIT_MORE_COLLISIONS:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- /* Unused statistic OIDs - always return 0 for each */\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(0);\r
-\r
- return true;\r
- case OID_GEN_MAXIMUM_TOTAL_SIZE:\r
- *ResponseSize = sizeof(uint32_t);\r
-\r
- /* Indicate maximum overall buffer (Ethernet frame and RNDIS header) the adapter can handle */\r
- *((uint32_t*)ResponseData) = CPU_TO_LE32(RNDIS_MESSAGE_BUFFER_SIZE + ETHERNET_FRAME_SIZE_MAX);\r
-\r
- return true;\r
- default:\r
- return false;\r
- }\r
-}\r
-\r
-static bool RNDIS_Device_ProcessNDISSet(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo,\r
- const uint32_t OId,\r
- const void* SetData,\r
- const uint16_t SetSize)\r
-{\r
- (void)SetSize;\r
-\r
- switch (OId)\r
- {\r
- case OID_GEN_CURRENT_PACKET_FILTER:\r
- RNDISInterfaceInfo->State.CurrPacketFilter = le32_to_cpu(*((uint32_t*)SetData));\r
- RNDISInterfaceInfo->State.CurrRNDISState = (RNDISInterfaceInfo->State.CurrPacketFilter) ? RNDIS_Data_Initialized : RNDIS_Initialized;\r
-\r
- return true;\r
- case OID_802_3_MULTICAST_LIST:\r
- /* Do nothing - throw away the value from the host as it is unused */\r
-\r
- return true;\r
- default:\r
- return false;\r
- }\r
-}\r
-\r
-bool RNDIS_Device_IsPacketReceived(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo)\r
-{\r
- if ((USB_DeviceState != DEVICE_STATE_Configured) ||\r
- (RNDISInterfaceInfo->State.CurrRNDISState != RNDIS_Data_Initialized))\r
- {\r
- return false;\r
- }\r
-\r
- Endpoint_SelectEndpoint(RNDISInterfaceInfo->Config.DataOUTEndpoint.Address);\r
- return Endpoint_IsOUTReceived();\r
-}\r
-\r
-uint8_t RNDIS_Device_ReadPacket(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo,\r
- void* Buffer,\r
- uint16_t* const PacketLength)\r
-{\r
- if ((USB_DeviceState != DEVICE_STATE_Configured) ||\r
- (RNDISInterfaceInfo->State.CurrRNDISState != RNDIS_Data_Initialized))\r
- {\r
- return ENDPOINT_RWSTREAM_DeviceDisconnected;\r
- }\r
-\r
- Endpoint_SelectEndpoint(RNDISInterfaceInfo->Config.DataOUTEndpoint.Address);\r
-\r
- *PacketLength = 0;\r
-\r
- if (!(Endpoint_IsOUTReceived()))\r
- return ENDPOINT_RWSTREAM_NoError;\r
-\r
- RNDIS_Packet_Message_t RNDISPacketHeader;\r
- Endpoint_Read_Stream_LE(&RNDISPacketHeader, sizeof(RNDIS_Packet_Message_t), NULL);\r
-\r
- if (le32_to_cpu(RNDISPacketHeader.DataLength) > ETHERNET_FRAME_SIZE_MAX)\r
- {\r
- Endpoint_StallTransaction();\r
-\r
- return RNDIS_ERROR_LOGICAL_CMD_FAILED;\r
- }\r
-\r
- *PacketLength = (uint16_t)le32_to_cpu(RNDISPacketHeader.DataLength);\r
-\r
- Endpoint_Read_Stream_LE(Buffer, *PacketLength, NULL);\r
- Endpoint_ClearOUT();\r
-\r
- return ENDPOINT_RWSTREAM_NoError;\r
-}\r
-\r
-uint8_t RNDIS_Device_SendPacket(USB_ClassInfo_RNDIS_Device_t* const RNDISInterfaceInfo,\r
- void* Buffer,\r
- const uint16_t PacketLength)\r
-{\r
- uint8_t ErrorCode;\r
-\r
- if ((USB_DeviceState != DEVICE_STATE_Configured) ||\r
- (RNDISInterfaceInfo->State.CurrRNDISState != RNDIS_Data_Initialized))\r
- {\r
- return ENDPOINT_RWSTREAM_DeviceDisconnected;\r
- }\r
-\r
- Endpoint_SelectEndpoint(RNDISInterfaceInfo->Config.DataINEndpoint.Address);\r
-\r
- if ((ErrorCode = Endpoint_WaitUntilReady()) != ENDPOINT_READYWAIT_NoError)\r
- return ErrorCode;\r
-\r
- RNDIS_Packet_Message_t RNDISPacketHeader;\r
-\r
- memset(&RNDISPacketHeader, 0, sizeof(RNDIS_Packet_Message_t));\r
-\r
- RNDISPacketHeader.MessageType = CPU_TO_LE32(REMOTE_NDIS_PACKET_MSG);\r
- RNDISPacketHeader.MessageLength = cpu_to_le32(sizeof(RNDIS_Packet_Message_t) + PacketLength);\r
- RNDISPacketHeader.DataOffset = CPU_TO_LE32(sizeof(RNDIS_Packet_Message_t) - sizeof(RNDIS_Message_Header_t));\r
- RNDISPacketHeader.DataLength = cpu_to_le32(PacketLength);\r
-\r
- Endpoint_Write_Stream_LE(&RNDISPacketHeader, sizeof(RNDIS_Packet_Message_t), NULL);\r
- Endpoint_Write_Stream_LE(Buffer, PacketLength, NULL);\r
- Endpoint_ClearIN();\r
-\r
- return ENDPOINT_RWSTREAM_NoError;\r
-}\r
-\r
-#endif\r
-\r
projects / qmk_firmware.git / blobdiff