1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456 |
- /*
- * Copyright (c) 2006-2021, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2012-12-24 heyuanjie87 first version
- * 2013-04-13 aozima update ethernet driver.
- * 2013-04-26 aozima align the desc to 4byte.
- * 2013-05-08 aozima pad a dummy when send MAX_PKT_SIZE.
- * 2013-05-09 aozima add delay linkup feature.
- * 2013-07-09 aozima support respone chain list.
- * 2013-07-18 aozima re-initial respone chain list when RNDIS restart.
- * 2017-11-25 ZYH fix it and add OS descriptor
- * 2019-06-10 ZYH fix hot plug and delay linkup
- */
- #include <rtdevice.h>
- #ifdef RT_USB_DEVICE_RNDIS
- #include "cdc.h"
- #include "rndis.h"
- #include "ndis.h"
- /* define RNDIS_DELAY_LINK_UP by menuconfig for delay linkup */
- #define DBG_LEVEL DBG_WARNING
- #define DBG_SECTION_NAME "RNDIS"
- #include <rtdbg.h>
- #define RNDIS_INTF_STR_INDEX 12
- /* RT-Thread LWIP ethernet interface */
- #include <netif/ethernetif.h>
- struct rt_rndis_response
- {
- struct rt_list_node list;
- const void * buffer;
- };
- #define MAX_ADDR_LEN 6
- struct rt_rndis_eth
- {
- /* inherit from ethernet device */
- struct eth_device parent;
- struct ufunction *func;
- /* interface address info */
- rt_uint8_t host_addr[MAX_ADDR_LEN];
- rt_uint8_t dev_addr[MAX_ADDR_LEN];
- #ifdef RNDIS_DELAY_LINK_UP
- struct rt_timer timer;
- #endif /* RNDIS_DELAY_LINK_UP */
- ALIGN(4)
- rt_uint8_t rx_pool[512];
- ALIGN(4)
- rt_uint8_t tx_pool[512];
- rt_uint32_t cmd_pool[2];
- ALIGN(4)
- char rx_buffer[sizeof(struct rndis_packet_msg) + USB_ETH_MTU + 14];
- rt_size_t rx_offset;
- rt_size_t rx_length;
- rt_bool_t rx_flag;
- rt_bool_t rx_frist;
- ALIGN(4)
- char tx_buffer[sizeof(struct rndis_packet_msg) + USB_ETH_MTU + 14];
- struct rt_semaphore tx_buffer_free;
- struct rt_list_node response_list;
- rt_bool_t need_notify;
- struct cdc_eps eps;
- };
- typedef struct rt_rndis_eth * rt_rndis_eth_t;
- static rt_uint32_t oid_packet_filter = 0x0000000;
- ALIGN(4)
- static struct udevice_descriptor _dev_desc =
- {
- USB_DESC_LENGTH_DEVICE, /* bLength */
- USB_DESC_TYPE_DEVICE, /* type */
- USB_BCD_VERSION, /* bcdUSB */
- 0xEF, /* bDeviceClass */
- 0x04, /* bDeviceSubClass */
- 0x01, /* bDeviceProtocol */
- USB_CDC_BUFSIZE, /* bMaxPacketSize0 */
- _VENDOR_ID, /* idVendor */
- _PRODUCT_ID, /* idProduct */
- USB_BCD_DEVICE, /* bcdDevice */
- USB_STRING_MANU_INDEX, /* iManufacturer */
- USB_STRING_PRODUCT_INDEX, /* iProduct */
- USB_STRING_SERIAL_INDEX, /* iSerialNumber */
- USB_DYNAMIC /* bNumConfigurations */
- };
- /* communcation interface descriptor */
- ALIGN(4)
- const static struct ucdc_comm_descriptor _comm_desc =
- {
- #ifdef RT_USB_DEVICE_COMPOSITE
- /* Interface Association Descriptor */
- {
- USB_DESC_LENGTH_IAD,
- USB_DESC_TYPE_IAD,
- USB_DYNAMIC,
- 0x02,
- USB_CDC_CLASS_COMM,
- USB_CDC_SUBCLASS_ACM,
- USB_CDC_PROTOCOL_VENDOR,
- 0x00,
- },
- #endif
- /* Interface Descriptor */
- {
- USB_DESC_LENGTH_INTERFACE,
- USB_DESC_TYPE_INTERFACE,
- USB_DYNAMIC,
- 0x00,
- 0x01,
- USB_CDC_CLASS_COMM,
- USB_CDC_SUBCLASS_ACM,
- USB_CDC_PROTOCOL_VENDOR,
- #ifdef RT_USB_DEVICE_COMPOSITE
- RNDIS_INTF_STR_INDEX,
- #else
- 0x00,
- #endif
- },
- /* Header Functional Descriptor */
- {
- 0x05,
- USB_CDC_CS_INTERFACE,
- USB_CDC_SCS_HEADER,
- 0x0110,
- },
- /* Call Management Functional Descriptor */
- {
- 0x05,
- USB_CDC_CS_INTERFACE,
- USB_CDC_SCS_CALL_MGMT,
- 0x00,
- USB_DYNAMIC,
- },
- /* Abstract Control Management Functional Descriptor */
- {
- 0x04,
- USB_CDC_CS_INTERFACE,
- USB_CDC_SCS_ACM,
- 0x02,
- },
- /* Union Functional Descriptor */
- {
- 0x05,
- USB_CDC_CS_INTERFACE,
- USB_CDC_SCS_UNION,
- USB_DYNAMIC,
- USB_DYNAMIC,
- },
- /* Endpoint Descriptor */
- {
- USB_DESC_LENGTH_ENDPOINT,
- USB_DESC_TYPE_ENDPOINT,
- USB_DIR_IN | USB_DYNAMIC,
- USB_EP_ATTR_INT,
- 0x08,
- 0x0A,
- },
- };
- /* data interface descriptor */
- ALIGN(4)
- const static struct ucdc_data_descriptor _data_desc =
- {
- /* interface descriptor */
- {
- USB_DESC_LENGTH_INTERFACE,
- USB_DESC_TYPE_INTERFACE,
- USB_DYNAMIC,
- 0x00,
- 0x02,
- USB_CDC_CLASS_DATA,
- 0x00,
- 0x00,
- 0x00,
- },
- /* endpoint, bulk out */
- {
- USB_DESC_LENGTH_ENDPOINT,
- USB_DESC_TYPE_ENDPOINT,
- USB_DIR_OUT | USB_DYNAMIC,
- USB_EP_ATTR_BULK,
- USB_DYNAMIC,
- 0x00,
- },
- /* endpoint, bulk in */
- {
- USB_DESC_LENGTH_ENDPOINT,
- USB_DESC_TYPE_ENDPOINT,
- USB_DYNAMIC | USB_DIR_IN,
- USB_EP_ATTR_BULK,
- USB_DYNAMIC,
- 0x00,
- },
- };
- ALIGN(4)
- const static char* _ustring[] =
- {
- "Language", /* LANGID */
- "RT-Thread Team.", /* MANU */
- "RT-Thread RNDIS device", /* PRODUCT */
- "1.1.0", /* SERIAL */
- "Configuration", /* CONFIG */
- "Interface", /* INTERFACE */
- USB_STRING_OS
- };
- ALIGN(4)
- struct usb_os_function_comp_id_descriptor rndis_func_comp_id_desc =
- {
- .bFirstInterfaceNumber = USB_DYNAMIC,
- .reserved1 = 0x01,
- .compatibleID = {'R', 'N', 'D', 'I', 'S', 0x00, 0x00, 0x00},
- .subCompatibleID = {'5', '1', '6', '2', '0', '0', '1', 0x00},
- .reserved2 = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}
- };
- //FS and HS needed
- ALIGN(4)
- static struct usb_qualifier_descriptor dev_qualifier =
- {
- sizeof(dev_qualifier), //bLength
- USB_DESC_TYPE_DEVICEQUALIFIER, //bDescriptorType
- 0x0200, //bcdUSB
- USB_CLASS_CDC, //bDeviceClass
- USB_CDC_SUBCLASS_ACM, //bDeviceSubClass
- USB_CDC_PROTOCOL_VENDOR, //bDeviceProtocol
- 64, //bMaxPacketSize0
- 0x01, //bNumConfigurations
- 0,
- };
- /* supported OIDs */
- ALIGN(4)
- const static rt_uint32_t oid_supported_list[] =
- {
- /* General OIDs */
- OID_GEN_SUPPORTED_LIST,
- OID_GEN_HARDWARE_STATUS,
- OID_GEN_MEDIA_SUPPORTED,
- OID_GEN_MEDIA_IN_USE,
- OID_GEN_MAXIMUM_FRAME_SIZE,
- OID_GEN_LINK_SPEED,
- OID_GEN_TRANSMIT_BLOCK_SIZE,
- OID_GEN_RECEIVE_BLOCK_SIZE,
- OID_GEN_VENDOR_ID,
- OID_GEN_VENDOR_DESCRIPTION,
- OID_GEN_VENDOR_DRIVER_VERSION,
- OID_GEN_CURRENT_PACKET_FILTER,
- OID_GEN_MAXIMUM_TOTAL_SIZE,
- OID_GEN_MEDIA_CONNECT_STATUS,
- OID_GEN_PHYSICAL_MEDIUM,
- /* General Statistic OIDs */
- OID_GEN_XMIT_OK,
- OID_GEN_RCV_OK,
- OID_GEN_XMIT_ERROR,
- OID_GEN_RCV_ERROR,
- OID_GEN_RCV_NO_BUFFER,
- /* Please configure us */
- OID_GEN_RNDIS_CONFIG_PARAMETER,
- /* 802.3 OIDs */
- OID_802_3_PERMANENT_ADDRESS,
- OID_802_3_CURRENT_ADDRESS,
- OID_802_3_MULTICAST_LIST,
- OID_802_3_MAXIMUM_LIST_SIZE,
- /* 802.3 Statistic OIDs */
- OID_802_3_RCV_ERROR_ALIGNMENT,
- OID_802_3_XMIT_ONE_COLLISION,
- OID_802_3_XMIT_MORE_COLLISIONS,
- OID_802_3_MAC_OPTIONS,
- };
- static rt_uint8_t rndis_message_buffer[RNDIS_MESSAGE_BUFFER_SIZE];
- static void _rndis_response_available(ufunction_t func)
- {
- rt_rndis_eth_t device = (rt_rndis_eth_t)func->user_data;
- rt_uint32_t * data;
- if(device->need_notify == RT_TRUE)
- {
- device->need_notify = RT_FALSE;
- data = (rt_uint32_t *)device->eps.ep_cmd->buffer;
- data[0] = RESPONSE_AVAILABLE;
- data[1] = 0;
- device->eps.ep_cmd->request.buffer = device->eps.ep_cmd->buffer;
- device->eps.ep_cmd->request.size = 8;
- device->eps.ep_cmd->request.req_type = UIO_REQUEST_WRITE;
- rt_usbd_io_request(func->device, device->eps.ep_cmd, &device->eps.ep_cmd->request);
- }
- }
- static rt_err_t _rndis_init_response(ufunction_t func, rndis_init_msg_t msg)
- {
- rndis_init_cmplt_t resp;
- struct rt_rndis_response * response;
- response = rt_malloc(sizeof(struct rt_rndis_response));
- resp = rt_malloc(sizeof(struct rndis_init_cmplt));
- if( (response == RT_NULL) || (resp == RT_NULL) )
- {
- LOG_E("%s,%d: no memory!", __func__, __LINE__);
- if(response != RT_NULL)
- rt_free(response);
- if(resp != RT_NULL)
- rt_free(resp);
- return -RT_ENOMEM;
- }
- resp->RequestId = msg->RequestId;
- resp->MessageType = REMOTE_NDIS_INITIALIZE_CMPLT;
- resp->MessageLength = sizeof(struct rndis_init_cmplt);
- resp->MajorVersion = RNDIS_MAJOR_VERSION;
- resp->MinorVersion = RNDIS_MAJOR_VERSION;
- resp->Status = RNDIS_STATUS_SUCCESS;
- resp->DeviceFlags = RNDIS_DF_CONNECTIONLESS;
- resp->Medium = RNDIS_MEDIUM_802_3;
- resp->MaxPacketsPerTransfer = 1;
- resp->MaxTransferSize = USB_ETH_MTU + 58; /* Space for 1280 IP buffer, Ethernet Header,
- RNDIS messages */
- resp->PacketAlignmentFactor = 3;
- resp->AfListOffset = 0;
- resp->AfListSize = 0;
- response->buffer = resp;
- {
- rt_base_t level = rt_hw_interrupt_disable();
- rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
- rt_hw_interrupt_enable(level);
- }
- return RT_EOK;
- }
- static rndis_query_cmplt_t _create_resp(rt_size_t size)
- {
- rndis_query_cmplt_t resp;
- resp = rt_malloc(sizeof(struct rndis_query_cmplt) + size);
- if(resp == RT_NULL)
- {
- LOG_E("%s,%d: no memory!", __func__, __LINE__);
- return RT_NULL;
- }
- resp->InformationBufferLength = size;
- return resp;
- }
- static void _copy_resp(rndis_query_cmplt_t resp, const void * buffer)
- {
- char * resp_buffer = (char *)resp + sizeof(struct rndis_query_cmplt);
- rt_memcpy(resp_buffer, buffer, resp->InformationBufferLength);
- }
- static void _set_resp(rndis_query_cmplt_t resp, rt_uint32_t value)
- {
- rt_uint32_t * response = (rt_uint32_t *)((char *)resp + sizeof(struct rndis_query_cmplt));
- *response = value;
- }
- static rt_err_t _rndis_query_response(ufunction_t func,rndis_query_msg_t msg)
- {
- rndis_query_cmplt_t resp = RT_NULL;
- struct rt_rndis_response * response;
- rt_err_t ret = RT_EOK;
- switch (msg->Oid)
- {
- /*
- * general OIDs
- */
- case OID_GEN_SUPPORTED_LIST:
- resp = _create_resp(sizeof(oid_supported_list));
- if(resp == RT_NULL) break;
- _copy_resp(resp, oid_supported_list);
- break;
- case OID_GEN_PHYSICAL_MEDIUM:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, NDIS_MEDIUM_802_3);
- break;
- case OID_GEN_MAXIMUM_FRAME_SIZE:
- case OID_GEN_TRANSMIT_BLOCK_SIZE:
- case OID_GEN_RECEIVE_BLOCK_SIZE:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, USB_ETH_MTU);
- break;
- case OID_GEN_MAXIMUM_TOTAL_SIZE:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, USB_ETH_MTU + RNDIS_MESSAGE_BUFFER_SIZE);
- break;
- case OID_GEN_LINK_SPEED:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, (func->device->dcd->device_is_hs ? (480UL * 1000 *1000) : (12UL * 1000 * 1000)) / 100);
- break;
- case OID_GEN_MEDIA_CONNECT_STATUS:
- /* link_status */
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- #ifdef RNDIS_DELAY_LINK_UP
- if(((rt_rndis_eth_t)func->user_data)->parent.link_status)
- {
- _set_resp(resp, NDIS_MEDIA_STATE_CONNECTED);
- }
- else
- {
- _set_resp(resp, NDIS_MEDIA_STATE_DISCONNECTED);
- }
- #else
- _set_resp(resp, NDIS_MEDIA_STATE_CONNECTED);
- #endif /* RNDIS_DELAY_LINK_UP */
- break;
- case OID_GEN_VENDOR_ID:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, 0x12345678); /* only for test */
- break;
- case OID_GEN_VENDOR_DESCRIPTION:
- {
- const char vendor_desc[] = "RT-Thread RNDIS";
- resp = _create_resp(sizeof(vendor_desc));
- if(resp == RT_NULL) break;
- _copy_resp(resp, vendor_desc);
- }
- break;
- case OID_GEN_VENDOR_DRIVER_VERSION:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, 0x0000200);
- break;
- /* statistics OIDs */
- case OID_GEN_XMIT_OK:
- case OID_GEN_RCV_OK:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, 1);
- break;
- case OID_GEN_XMIT_ERROR:
- case OID_GEN_RCV_ERROR:
- case OID_GEN_RCV_NO_BUFFER:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, 0);
- break;
- /*
- * ieee802.3 OIDs
- */
- case OID_802_3_MAXIMUM_LIST_SIZE:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, 1);
- break;
- case OID_802_3_PERMANENT_ADDRESS:
- case OID_802_3_CURRENT_ADDRESS:
- resp = _create_resp(sizeof(((rt_rndis_eth_t)func->user_data)->host_addr));
- if(resp == RT_NULL) break;
- _copy_resp(resp, ((rt_rndis_eth_t)func->user_data)->host_addr);
- break;
- case OID_802_3_MULTICAST_LIST:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, 0xE000000);
- break;
- case OID_802_3_MAC_OPTIONS:
- resp = _create_resp(4);
- if(resp == RT_NULL) break;
- _set_resp(resp, 0);
- break;
- default:
- LOG_W("Not support OID %X", msg->Oid);
- ret = -RT_ERROR;
- break;
- }
- response = rt_malloc(sizeof(struct rt_rndis_response));
- if( (response == RT_NULL) || (resp == RT_NULL) )
- {
- LOG_E("%s,%d: no memory!", __func__, __LINE__);
- if(response != RT_NULL)
- rt_free(response);
- if(resp != RT_NULL)
- rt_free(resp);
- return -RT_ENOMEM;
- }
- resp->RequestId = msg->RequestId;
- resp->MessageType = REMOTE_NDIS_QUERY_CMPLT;
- resp->InformationBufferOffset = 16;
- resp->Status = RNDIS_STATUS_SUCCESS;
- resp->MessageLength = sizeof(struct rndis_query_cmplt) + resp->InformationBufferLength;
- response->buffer = resp;
- {
- rt_base_t level = rt_hw_interrupt_disable();
- rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
- rt_hw_interrupt_enable(level);
- }
- return ret;
- }
- static rt_err_t _rndis_set_response(ufunction_t func,rndis_set_msg_t msg)
- {
- rndis_set_cmplt_t resp;
- struct rt_rndis_response * response;
- response = rt_malloc(sizeof(struct rt_rndis_response));
- resp = rt_malloc(sizeof(struct rndis_set_cmplt));
- if( (response == RT_NULL) || (resp == RT_NULL) )
- {
- LOG_E("%s,%d: no memory!", __func__, __LINE__);
- if(response != RT_NULL)
- rt_free(response);
- if(resp != RT_NULL)
- rt_free(resp);
- return -RT_ENOMEM;
- }
- resp->RequestId = msg->RequestId;
- resp->MessageType = REMOTE_NDIS_SET_CMPLT;
- resp->MessageLength = sizeof(struct rndis_set_cmplt);
- switch (msg->Oid)
- {
- case OID_GEN_CURRENT_PACKET_FILTER:
- oid_packet_filter = *((rt_uint32_t *)((rt_uint8_t *)&(msg->RequestId) + \
- msg->InformationBufferOffset));
- /* TODO: make complier happy */
- oid_packet_filter = oid_packet_filter;
- LOG_D("OID_GEN_CURRENT_PACKET_FILTER");
- #ifdef RNDIS_DELAY_LINK_UP
- /* link up. */
- rt_timer_start(&((rt_rndis_eth_t)func->user_data)->timer);
- #else
- eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_TRUE);
- #endif /* RNDIS_DELAY_LINK_UP */
- break;
- case OID_802_3_MULTICAST_LIST:
- break;
- default:
- LOG_W("Unknow rndis set 0x%02X", msg->Oid);
- resp->Status = RNDIS_STATUS_FAILURE;
- return RT_EOK;
- }
- resp->Status = RNDIS_STATUS_SUCCESS;
- response->buffer = resp;
- {
- rt_base_t level = rt_hw_interrupt_disable();
- rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
- rt_hw_interrupt_enable(level);
- }
- return RT_EOK;
- }
- static rt_err_t _rndis_reset_response(ufunction_t func,rndis_set_msg_t msg)
- {
- struct rndis_reset_cmplt * resp;
- struct rt_rndis_response * response;
- response = rt_malloc(sizeof(struct rt_rndis_response));
- resp = rt_malloc(sizeof(struct rndis_reset_cmplt));
- if( (response == RT_NULL) || (resp == RT_NULL) )
- {
- LOG_E("%s,%d: no memory!", __func__, __LINE__);
- if(response != RT_NULL)
- rt_free(response);
- if(resp != RT_NULL)
- rt_free(resp);
- return -RT_ENOMEM;
- }
- /* reset packet filter */
- oid_packet_filter = 0x0000000;
- /* link down eth */
- eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_FALSE);
- /* reset eth rx tx */
- ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
- ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
- resp->MessageType = REMOTE_NDIS_RESET_CMPLT;
- resp->MessageLength = sizeof(struct rndis_reset_cmplt);
- resp->Status = RNDIS_STATUS_SUCCESS;
- resp->AddressingReset = 1;
- response->buffer = resp;
- {
- rt_base_t level = rt_hw_interrupt_disable();
- rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
- rt_hw_interrupt_enable(level);
- }
- return RT_EOK;
- }
- static rt_err_t _rndis_keepalive_response(ufunction_t func,rndis_keepalive_msg_t msg)
- {
- rndis_keepalive_cmplt_t resp;
- struct rt_rndis_response * response;
- response = rt_malloc(sizeof(struct rt_rndis_response));
- resp = rt_malloc(sizeof(struct rndis_keepalive_cmplt));
- if( (response == RT_NULL) || (resp == RT_NULL) )
- {
- LOG_E("%s,%d: no memory!", __func__, __LINE__);
- if(response != RT_NULL)
- rt_free(response);
- if(resp != RT_NULL)
- rt_free(resp);
- return -RT_ENOMEM;
- }
- resp->MessageType = REMOTE_NDIS_KEEPALIVE_CMPLT;
- resp->MessageLength = sizeof(struct rndis_keepalive_cmplt);
- resp->Status = RNDIS_STATUS_SUCCESS;
- response->buffer = resp;
- {
- rt_base_t level = rt_hw_interrupt_disable();
- rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
- rt_hw_interrupt_enable(level);
- }
- return RT_EOK;
- }
- static rt_err_t _rndis_msg_parser(ufunction_t func, rt_uint8_t *msg)
- {
- rt_err_t ret = -RT_ERROR;
- switch (((rndis_gen_msg_t) msg)->MessageType)
- {
- case REMOTE_NDIS_INITIALIZE_MSG:
- LOG_D("REMOTE_NDIS_INITIALIZE_MSG");
- ret = _rndis_init_response(func, (rndis_init_msg_t) msg);
- break;
- case REMOTE_NDIS_HALT_MSG:
- LOG_D("REMOTE_NDIS_HALT_MSG");
- /* link down. */
- eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_FALSE);
- /* reset eth rx tx */
- ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
- ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
- break;
- case REMOTE_NDIS_QUERY_MSG:
- LOG_D("REMOTE_NDIS_QUERY_MSG");
- ret = _rndis_query_response(func,(rndis_query_msg_t) msg);
- break;
- case REMOTE_NDIS_SET_MSG:
- LOG_D("REMOTE_NDIS_SET_MSG");
- ret = _rndis_set_response(func,(rndis_set_msg_t) msg);
- break;
- case REMOTE_NDIS_RESET_MSG:
- LOG_D("REMOTE_NDIS_RESET_MSG");
- ret = _rndis_reset_response(func,(rndis_set_msg_t) msg);
- break;
- case REMOTE_NDIS_KEEPALIVE_MSG:
- LOG_D("REMOTE_NDIS_KEEPALIVE_MSG");
- ret = _rndis_keepalive_response(func,(rndis_keepalive_msg_t) msg);
- break;
- default:
- LOG_W("not support RNDIS msg %X", ((rndis_gen_msg_t) msg)->MessageType);
- ret = -RT_ERROR;
- break;
- }
- if (ret == RT_EOK)
- _rndis_response_available(func);
- return ret;
- }
- static ufunction_t function = RT_NULL;
- static rt_err_t send_encapsulated_command_done(udevice_t device, rt_size_t size)
- {
- if(function != RT_NULL)
- {
- dcd_ep0_send_status(device->dcd);
- _rndis_msg_parser(function, rndis_message_buffer);
- function = RT_NULL;
- }
- return RT_EOK;
- }
- //#error here have bug ep 0x82 send failed
- static rt_err_t _rndis_send_encapsulated_command(ufunction_t func, ureq_t setup)
- {
- RT_ASSERT(setup->wLength <= sizeof(rndis_message_buffer));
- function = func;
- rt_usbd_ep0_read(func->device,rndis_message_buffer,setup->wLength,send_encapsulated_command_done);
- return RT_EOK;
- }
- static rt_err_t _rndis_get_encapsulated_response(ufunction_t func, ureq_t setup)
- {
- rndis_gen_msg_t msg;
- struct rt_rndis_response * response;
- if(rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
- {
- LOG_D("response_list is empty!");
- ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
- return RT_EOK;
- }
- response = (struct rt_rndis_response *)((rt_rndis_eth_t)func->user_data)->response_list.next;
- msg = (rndis_gen_msg_t)response->buffer;
- rt_usbd_ep0_write(func->device, (void*)msg, msg->MessageLength);
- {
- rt_base_t level = rt_hw_interrupt_disable();
- rt_list_remove(&response->list);
- rt_hw_interrupt_enable(level);
- }
- rt_free((void *)response->buffer);
- rt_free(response);
- if(!rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
- {
- rt_uint32_t * data;
- LOG_I("auto append next response!");
- data = (rt_uint32_t *)((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->buffer;
- data[0] = RESPONSE_AVAILABLE;
- data[1] = 0;
- ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request.buffer = ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->buffer;
- ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request.size = 8;
- ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request.req_type = UIO_REQUEST_WRITE;
- rt_usbd_io_request(func->device, ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd, &((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request);
- }
- else
- {
- ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
- }
- return RT_EOK;
- }
- /**
- * This function will handle rndis interface request.
- *
- * @param device the usb device object.
- * @param setup the setup request.
- *
- * @return RT_EOK on successful.
- */
- static rt_err_t _interface_handler(ufunction_t func, ureq_t setup)
- {
- RT_ASSERT(func != RT_NULL);
- RT_ASSERT(setup != RT_NULL);
- switch(setup->bRequest)
- {
- case CDC_SEND_ENCAPSULATED_COMMAND:
- _rndis_send_encapsulated_command(func, setup);
- break;
- case CDC_GET_ENCAPSULATED_RESPONSE:
- _rndis_get_encapsulated_response(func, setup);
- break;
- default:
- LOG_W("unkown setup->request 0x%02X !", setup->bRequest);
- break;
- }
- return RT_EOK;
- }
- /**
- * This function will handle rndis bulk in endpoint request.
- *
- * @param device the usb device object.
- * @param size request size.
- *
- * @return RT_EOK.
- */
- static rt_err_t _ep_in_handler(ufunction_t func, rt_size_t size)
- {
- rt_sem_release(&((rt_rndis_eth_t)func->user_data)->tx_buffer_free);
- return RT_EOK;
- }
- /**
- * This function will handle RNDIS bulk out endpoint request.
- *
- * @param device the usb device object.
- * @param size request size.
- *
- * @return RT_EOK.
- */
- static rt_err_t _ep_out_handler(ufunction_t func, rt_size_t size)
- {
- cdc_eps_t eps;
- char* data = RT_NULL;
- eps = (cdc_eps_t)&((rt_rndis_eth_t)func->user_data)->eps;
- data = (char*)eps->ep_out->buffer;
- if(((rt_rndis_eth_t)func->user_data)->rx_frist == RT_TRUE)
- {
- rndis_packet_msg_t msg = (rndis_packet_msg_t)data;
- ((rt_rndis_eth_t)func->user_data)->rx_length = msg->DataLength;
- ((rt_rndis_eth_t)func->user_data)->rx_offset = 0;
- if (size >= 44)
- {
- data += sizeof(struct rndis_packet_msg);
- size -= sizeof(struct rndis_packet_msg);
- ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_FALSE;
- rt_memcpy(&((rt_rndis_eth_t)func->user_data)->rx_buffer[((rt_rndis_eth_t)func->user_data)->rx_offset], data, size);
- ((rt_rndis_eth_t)func->user_data)->rx_offset += size;
- }
- }
- else
- {
- rt_memcpy(&((rt_rndis_eth_t)func->user_data)->rx_buffer[((rt_rndis_eth_t)func->user_data)->rx_offset], data, size);
- ((rt_rndis_eth_t)func->user_data)->rx_offset += size;
- }
- if(((rt_rndis_eth_t)func->user_data)->rx_offset >= ((rt_rndis_eth_t)func->user_data)->rx_length)
- {
- ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
- ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_TRUE;
- eth_device_ready(&(((rt_rndis_eth_t)func->user_data)->parent));
- }
- else
- {
- eps->ep_out->request.buffer = eps->ep_out->buffer;
- eps->ep_out->request.size = EP_MAXPACKET(eps->ep_out);
- eps->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
- rt_usbd_io_request(func->device, eps->ep_out, &eps->ep_out->request);
- }
- return RT_EOK;
- }
- /**
- * This function will handle RNDIS interrupt in endpoint request.
- *
- * @param device the usb device object.
- * @param size request size.
- *
- * @return RT_EOK.
- */
- static rt_err_t _ep_cmd_handler(ufunction_t func, rt_size_t size)
- {
- // _rndis_response_available(func);
- return RT_EOK;
- }
- /**
- * This function will run cdc class, it will be called on handle set configuration request.
- *
- * @param device the usb device object.
- *
- * @return RT_EOK on successful.
- */
- static rt_err_t _function_enable(ufunction_t func)
- {
- cdc_eps_t eps;
- LOG_I("plugged in");
- eps = (cdc_eps_t)&((rt_rndis_eth_t)func->user_data)->eps;
- eps->ep_in->buffer = ((rt_rndis_eth_t)func->user_data)->tx_pool;
- eps->ep_out->buffer = ((rt_rndis_eth_t)func->user_data)->rx_pool;
- eps->ep_cmd->buffer = (rt_uint8_t*)((rt_rndis_eth_t)func->user_data)->cmd_pool;
- eps->ep_out->request.buffer = eps->ep_out->buffer;
- eps->ep_out->request.size = EP_MAXPACKET(eps->ep_out);
- eps->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
- rt_usbd_io_request(func->device, eps->ep_out, &eps->ep_out->request);
- ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
- ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
- // eth_device_ready(&(((rt_rndis_eth_t)func->user_data)->parent));
- #ifdef RNDIS_DELAY_LINK_UP
- /* stop link up timer. */
- rt_timer_stop(&((rt_rndis_eth_t)func->user_data)->timer);
- #endif /* RNDIS_DELAY_LINK_UP */
- /* clean resp chain list. */
- {
- struct rt_rndis_response * response;
- rt_base_t level = rt_hw_interrupt_disable();
- while(!rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
- {
- response = (struct rt_rndis_response *)((rt_rndis_eth_t)func->user_data)->response_list.next;
- rt_list_remove(&response->list);
- rt_free((void *)response->buffer);
- rt_free(response);
- }
- ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
- rt_hw_interrupt_enable(level);
- }
- return RT_EOK;
- }
- /**
- * This function will stop cdc class, it will be called on handle set configuration request.
- *
- * @param device the usb device object.
- *
- * @return RT_EOK on successful.
- */
- static rt_err_t _function_disable(ufunction_t func)
- {
- LOG_I("plugged out");
- #ifdef RNDIS_DELAY_LINK_UP
- /* stop link up timer. */
- rt_timer_stop(&((rt_rndis_eth_t)func->user_data)->timer);
- #endif /* RNDIS_DELAY_LINK_UP */
- /* clean resp chain list. */
- {
- struct rt_rndis_response * response;
- rt_base_t level = rt_hw_interrupt_disable();
- while(!rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
- {
- response = (struct rt_rndis_response *)((rt_rndis_eth_t)func->user_data)->response_list.next;
- LOG_D("remove resp chain list!");
- rt_list_remove(&response->list);
- rt_free((void *)response->buffer);
- rt_free(response);
- }
- ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
- rt_hw_interrupt_enable(level);
- }
- /* link down. */
- eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_FALSE);
- /* reset eth rx tx */
- ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
- ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
- return RT_EOK;
- }
- static struct ufunction_ops ops =
- {
- _function_enable,
- _function_disable,
- RT_NULL,
- };
- /**
- * This function will configure cdc descriptor.
- *
- * @param comm the communication interface number.
- * @param data the data interface number.
- *
- * @return RT_EOK on successful.
- */
- static rt_err_t _cdc_descriptor_config(ucdc_comm_desc_t comm, rt_uint8_t cintf_nr, ucdc_data_desc_t data, rt_uint8_t dintf_nr, rt_uint8_t device_is_hs)
- {
- comm->call_mgmt_desc.data_interface = dintf_nr;
- comm->union_desc.master_interface = cintf_nr;
- comm->union_desc.slave_interface0 = dintf_nr;
- #ifdef RT_USB_DEVICE_COMPOSITE
- comm->iad_desc.bFirstInterface = cintf_nr;
- #endif
- data->ep_out_desc.wMaxPacketSize = device_is_hs ? 512 : 64;
- data->ep_in_desc.wMaxPacketSize = device_is_hs ? 512 : 64;
- return RT_EOK;
- }
- #ifdef RT_USING_LWIP
- /* initialize the interface */
- static rt_err_t rt_rndis_eth_init(rt_device_t dev)
- {
- return RT_EOK;
- }
- static rt_err_t rt_rndis_eth_open(rt_device_t dev, rt_uint16_t oflag)
- {
- return RT_EOK;
- }
- static rt_err_t rt_rndis_eth_close(rt_device_t dev)
- {
- return RT_EOK;
- }
- static rt_size_t rt_rndis_eth_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
- {
- rt_set_errno(-RT_ENOSYS);
- return 0;
- }
- static rt_size_t rt_rndis_eth_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
- {
- rt_set_errno(-RT_ENOSYS);
- return 0;
- }
- static rt_err_t rt_rndis_eth_control(rt_device_t dev, int cmd, void *args)
- {
- rt_rndis_eth_t rndis_eth_dev = (rt_rndis_eth_t)dev;
- switch(cmd)
- {
- case NIOCTL_GADDR:
- /* get mac address */
- if(args) rt_memcpy(args, rndis_eth_dev->dev_addr, MAX_ADDR_LEN);
- else return -RT_ERROR;
- break;
- default :
- break;
- }
- return RT_EOK;
- }
- /* ethernet device interface */
- /* reception packet. */
- struct pbuf *rt_rndis_eth_rx(rt_device_t dev)
- {
- struct pbuf* p = RT_NULL;
- rt_uint32_t offset = 0;
- rt_rndis_eth_t device = (rt_rndis_eth_t)dev;
- if(device->rx_flag == RT_FALSE)
- {
- return p;
- }
- if(device->rx_length != 0)
- {
- /* allocate buffer */
- p = pbuf_alloc(PBUF_LINK, device->rx_length, PBUF_RAM);
- if (p != RT_NULL)
- {
- struct pbuf* q;
- for (q = p; q != RT_NULL; q= q->next)
- {
- /* Copy the received frame into buffer from memory pointed by the current ETHERNET DMA Rx descriptor */
- rt_memcpy(q->payload,
- (rt_uint8_t *)((device->rx_buffer) + offset),
- q->len);
- offset += q->len;
- }
- }
- }
- {
- device->rx_flag = RT_FALSE;
- device->eps.ep_out->request.buffer = device->eps.ep_out->buffer;
- device->eps.ep_out->request.size = EP_MAXPACKET(device->eps.ep_out);
- device->eps.ep_out->request.req_type = UIO_REQUEST_READ_BEST;
- rt_usbd_io_request(device->func->device, device->eps.ep_out, &device->eps.ep_out->request);
- }
- return p;
- }
- /* transmit packet. */
- rt_err_t rt_rndis_eth_tx(rt_device_t dev, struct pbuf* p)
- {
- struct pbuf* q;
- char * buffer;
- rt_err_t result = RT_EOK;
- rt_rndis_eth_t device = (rt_rndis_eth_t)dev;
- if(!device->parent.link_status)
- {
- LOG_I("linkdown, drop pkg");
- return RT_EOK;
- }
- //RT_ASSERT(p->tot_len < sizeof(device->tx_buffer));
- if(p->tot_len > sizeof(device->tx_buffer))
- {
- LOG_W("RNDIS MTU is:%d, but the send packet size is %d",
- sizeof(device->tx_buffer), p->tot_len);
- p->tot_len = sizeof(device->tx_buffer);
- }
- /* wait for buffer free. */
- result = rt_sem_take(&device->tx_buffer_free, rt_tick_from_millisecond(1000));
- if(result != RT_EOK)
- {
- LOG_W("wait for buffer free timeout");
- /* if cost 1s to wait send done it said that connection is close . drop it */
- rt_sem_release(&device->tx_buffer_free);
- return result;
- }
- buffer = (char *)&device->tx_buffer + sizeof(struct rndis_packet_msg);
- for (q = p; q != NULL; q = q->next)
- {
- rt_memcpy(buffer, q->payload, q->len);
- buffer += q->len;
- }
- /* send */
- {
- rndis_packet_msg_t msg;
- msg = (rndis_packet_msg_t)&device->tx_buffer;
- msg->MessageType = REMOTE_NDIS_PACKET_MSG;
- msg->DataOffset = sizeof(struct rndis_packet_msg) - 8;
- msg->DataLength = p->tot_len;
- msg->OOBDataLength = 0;
- msg->OOBDataOffset = 0;
- msg->NumOOBDataElements = 0;
- msg->PerPacketInfoOffset = 0;
- msg->PerPacketInfoLength = 0;
- msg->VcHandle = 0;
- msg->Reserved = 0;
- msg->MessageLength = sizeof(struct rndis_packet_msg) + p->tot_len;
- if((msg->MessageLength & 0x3F) == 0)
- {
- /* pad a dummy. */
- msg->MessageLength += 1;
- }
- device->eps.ep_in->request.buffer = (void *)&device->tx_buffer;
- device->eps.ep_in->request.size = msg->MessageLength;
- device->eps.ep_in->request.req_type = UIO_REQUEST_WRITE;
- rt_usbd_io_request(device->func->device, device->eps.ep_in, &device->eps.ep_in->request);
- }
- return result;
- }
- #ifdef RT_USING_DEVICE_OPS
- const static struct rt_device_ops rndis_device_ops =
- {
- rt_rndis_eth_init,
- rt_rndis_eth_open,
- rt_rndis_eth_close,
- rt_rndis_eth_read,
- rt_rndis_eth_write,
- rt_rndis_eth_control
- };
- #endif
- #endif /* RT_USING_LWIP */
- #ifdef RNDIS_DELAY_LINK_UP
- /**
- * This function will set rndis connect status.
- *
- * @param device the usb device object.
- * @param status the connect status.
- *
- * @return RT_EOK on successful.
- */
- static rt_err_t _rndis_indicate_status_msg(ufunction_t func, rt_uint32_t status)
- {
- rndis_indicate_status_msg_t resp;
- struct rt_rndis_response * response;
- response = rt_malloc(sizeof(struct rt_rndis_response));
- resp = rt_malloc(sizeof(struct rndis_indicate_status_msg));
- if( (response == RT_NULL) || (resp == RT_NULL) )
- {
- LOG_E("%s,%d: no memory!", __func__, __LINE__);
- if(response != RT_NULL)
- rt_free(response);
- if(resp != RT_NULL)
- rt_free(resp);
- return -RT_ENOMEM;
- }
- resp->MessageType = REMOTE_NDIS_INDICATE_STATUS_MSG;
- resp->MessageLength = 20; /* sizeof(struct rndis_indicate_status_msg) */
- resp->Status = status;
- resp->StatusBufferLength = 0;
- resp->StatusBufferOffset = 0;
- response->buffer = resp;
- {
- rt_base_t level = rt_hw_interrupt_disable();
- rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
- rt_hw_interrupt_enable(level);
- }
- _rndis_response_available(func);
- return RT_EOK;
- }
- /* the delay linkup timer handler. */
- static void timer_timeout(void* parameter)
- {
- LOG_I("delay link up!");
- _rndis_indicate_status_msg(((rt_rndis_eth_t)parameter)->func,
- RNDIS_STATUS_MEDIA_CONNECT);
- eth_device_linkchange(&((rt_rndis_eth_t)parameter)->parent, RT_TRUE);
- }
- #endif /* RNDIS_DELAY_LINK_UP */
- /**
- * This function will create a cdc rndis class instance.
- *
- * @param device the usb device object.
- *
- * @return RT_EOK on successful.
- */
- ufunction_t rt_usbd_function_rndis_create(udevice_t device)
- {
- ufunction_t cdc;
- rt_rndis_eth_t _rndis;
- cdc_eps_t eps;
- uintf_t intf_comm, intf_data;
- ualtsetting_t comm_setting, data_setting;
- ucdc_data_desc_t data_desc;
- ucdc_comm_desc_t comm_desc;
- /* parameter check */
- RT_ASSERT(device != RT_NULL);
- /* set usb device string description */
- #ifdef RT_USB_DEVICE_COMPOSITE
- rt_usbd_device_set_interface_string(device, RNDIS_INTF_STR_INDEX, _ustring[2]);
- #else
- rt_usbd_device_set_string(device, _ustring);
- #endif
- /* create a cdc class */
- cdc = rt_usbd_function_new(device, &_dev_desc, &ops);
- rt_usbd_device_set_qualifier(device, &dev_qualifier);
- _rndis= rt_malloc(sizeof(struct rt_rndis_eth));
- rt_memset(_rndis, 0, sizeof(struct rt_rndis_eth));
- cdc->user_data = _rndis;
- _rndis->func = cdc;
- /* create a cdc class endpoints collection */
- eps = &_rndis->eps;
- /* create a cdc communication interface and a cdc data interface */
- intf_comm = rt_usbd_interface_new(device, _interface_handler);
- intf_data = rt_usbd_interface_new(device, _interface_handler);
- /* create a communication alternate setting and a data alternate setting */
- comm_setting = rt_usbd_altsetting_new(sizeof(struct ucdc_comm_descriptor));
- data_setting = rt_usbd_altsetting_new(sizeof(struct ucdc_data_descriptor));
- /* config desc in alternate setting */
- rt_usbd_altsetting_config_descriptor(comm_setting, &_comm_desc,
- (rt_off_t)&((ucdc_comm_desc_t)0)->intf_desc);
- rt_usbd_altsetting_config_descriptor(data_setting, &_data_desc, 0);
- /* configure the cdc interface descriptor */
- _cdc_descriptor_config(comm_setting->desc, intf_comm->intf_num, data_setting->desc, intf_data->intf_num, device->dcd->device_is_hs);
- /* create a command endpoint */
- comm_desc = (ucdc_comm_desc_t)comm_setting->desc;
- eps->ep_cmd = rt_usbd_endpoint_new(&comm_desc->ep_desc, _ep_cmd_handler);
- /* add the command endpoint to the cdc communication interface */
- rt_usbd_altsetting_add_endpoint(comm_setting, eps->ep_cmd);
- /* add the communication alternate setting to the communication interface,
- then set default setting of the interface */
- rt_usbd_interface_add_altsetting(intf_comm, comm_setting);
- rt_usbd_set_altsetting(intf_comm, 0);
- /* add the communication interface to the cdc class */
- rt_usbd_function_add_interface(cdc, intf_comm);
- /* create a bulk in and a bulk out endpoint */
- data_desc = (ucdc_data_desc_t)data_setting->desc;
- eps->ep_out = rt_usbd_endpoint_new(&data_desc->ep_out_desc, _ep_out_handler);
- eps->ep_in = rt_usbd_endpoint_new(&data_desc->ep_in_desc, _ep_in_handler);
- /* add the bulk out and bulk in endpoints to the data alternate setting */
- rt_usbd_altsetting_add_endpoint(data_setting, eps->ep_in);
- rt_usbd_altsetting_add_endpoint(data_setting, eps->ep_out);
- /* add the data alternate setting to the data interface
- then set default setting of the interface */
- rt_usbd_interface_add_altsetting(intf_data, data_setting);
- rt_usbd_set_altsetting(intf_data, 0);
- /* add the cdc data interface to cdc class */
- rt_usbd_function_add_interface(cdc, intf_data);
- rt_usbd_os_comp_id_desc_add_os_func_comp_id_desc(device->os_comp_id_desc, &rndis_func_comp_id_desc);
- #ifdef RT_USING_LWIP
- rt_list_init(&_rndis->response_list);
- _rndis->need_notify = RT_TRUE;
- rt_sem_init(&_rndis->tx_buffer_free, "ue_tx", 1, RT_IPC_FLAG_FIFO);
- #ifdef RNDIS_DELAY_LINK_UP
- rt_timer_init(&_rndis->timer,
- "RNDIS",
- timer_timeout,
- _rndis,
- RT_TICK_PER_SECOND * 2,
- RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER);
- #endif /* RNDIS_DELAY_LINK_UP */
- /* OUI 00-00-00, only for test. */
- _rndis->dev_addr[0] = 0x34;
- _rndis->dev_addr[1] = 0x97;
- _rndis->dev_addr[2] = 0xF6;
- /* generate random MAC. */
- _rndis->dev_addr[3] = 0x94;//*(const rt_uint8_t *)(0x1fff7a10);
- _rndis->dev_addr[4] = 0xEA;//*(const rt_uint8_t *)(0x1fff7a14);
- _rndis->dev_addr[5] = 0x12;//(const rt_uint8_t *)(0x1fff7a18);
- /* OUI 00-00-00, only for test. */
- _rndis->host_addr[0] = 0x34;
- _rndis->host_addr[1] = 0x97;
- _rndis->host_addr[2] = 0xF6;
- /* generate random MAC. */
- _rndis->host_addr[3] = 0x94;//*(const rt_uint8_t *)(0x0FE081F0);
- _rndis->host_addr[4] = 0xEA;//*(const rt_uint8_t *)(0x0FE081F1);
- _rndis->host_addr[5] = 0x13;//*(const rt_uint8_t *)(0x0FE081F2);
- #ifdef RT_USING_DEVICE_OPS
- _rndis->parent.parent.ops = &rndis_device_ops;
- #else
- _rndis->parent.parent.init = rt_rndis_eth_init;
- _rndis->parent.parent.open = rt_rndis_eth_open;
- _rndis->parent.parent.close = rt_rndis_eth_close;
- _rndis->parent.parent.read = rt_rndis_eth_read;
- _rndis->parent.parent.write = rt_rndis_eth_write;
- _rndis->parent.parent.control = rt_rndis_eth_control;
- #endif
- _rndis->parent.parent.user_data = device;
- _rndis->parent.eth_rx = rt_rndis_eth_rx;
- _rndis->parent.eth_tx = rt_rndis_eth_tx;
- /* register eth device */
- eth_device_init(&((rt_rndis_eth_t)cdc->user_data)->parent, "u0");
- #endif /* RT_USING_LWIP */
- return cdc;
- }
- struct udclass rndis_class =
- {
- .rt_usbd_function_create = rt_usbd_function_rndis_create
- };
- int rt_usbd_rndis_class_register(void)
- {
- rt_usbd_class_register(&rndis_class);
- return 0;
- }
- INIT_PREV_EXPORT(rt_usbd_rndis_class_register);
- #endif /* RT_USB_DEVICE_RNDIS */
|