294 lines
12 KiB
C
294 lines
12 KiB
C
/**************************************************************************/
|
|
/*!
|
|
@file cdc_rndis_host.c
|
|
@author hathach (tinyusb.org)
|
|
|
|
@section LICENSE
|
|
|
|
Software License Agreement (BSD License)
|
|
|
|
Copyright (c) 2013, hathach (tinyusb.org)
|
|
All rights reserved.
|
|
|
|
Redistribution and use in source and binary forms, with or without
|
|
modification, are permitted provided that the following conditions are met:
|
|
1. Redistributions of source code must retain the above copyright
|
|
notice, this list of conditions and the following disclaimer.
|
|
2. Redistributions in binary form must reproduce the above copyright
|
|
notice, this list of conditions and the following disclaimer in the
|
|
documentation and/or other materials provided with the distribution.
|
|
3. Neither the name of the copyright holders nor the
|
|
names of its contributors may be used to endorse or promote products
|
|
derived from this software without specific prior written permission.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ''AS IS'' AND ANY
|
|
EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
|
WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER BE LIABLE FOR ANY
|
|
DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
|
ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
This file is part of the tinyusb stack.
|
|
*/
|
|
/**************************************************************************/
|
|
|
|
#include "tusb_option.h"
|
|
|
|
#if (MODE_HOST_SUPPORTED && CFG_TUH_CDC && CFG_TUH_CDC_RNDIS)
|
|
|
|
#define _TINY_USB_SOURCE_FILE_
|
|
|
|
//--------------------------------------------------------------------+
|
|
// INCLUDE
|
|
//--------------------------------------------------------------------+
|
|
#include "common/tusb_common.h"
|
|
#include "cdc_host.h"
|
|
#include "cdc_rndis_host.h"
|
|
|
|
//--------------------------------------------------------------------+
|
|
// MACRO CONSTANT TYPEDEF
|
|
//--------------------------------------------------------------------+
|
|
#define RNDIS_MSG_PAYLOAD_MAX (1024*4)
|
|
|
|
CFG_TUSB_MEM_SECTION static uint8_t msg_notification[CFG_TUSB_HOST_DEVICE_MAX][8];
|
|
CFG_TUSB_MEM_SECTION ATTR_ALIGNED(4) static uint8_t msg_payload[RNDIS_MSG_PAYLOAD_MAX];
|
|
|
|
STATIC_VAR rndish_data_t rndish_data[CFG_TUSB_HOST_DEVICE_MAX];
|
|
|
|
// TODO Microsoft requires message length for any get command must be at least 4096 bytes
|
|
|
|
//--------------------------------------------------------------------+
|
|
// INTERNAL OBJECT & FUNCTION DECLARATION
|
|
//--------------------------------------------------------------------+
|
|
static tusb_error_t rndis_body_subtask(void);
|
|
static tusb_error_t send_message_get_response_subtask( uint8_t dev_addr, cdch_data_t *p_cdc,
|
|
uint8_t * p_mess, uint32_t mess_length,
|
|
uint8_t *p_response );
|
|
|
|
//--------------------------------------------------------------------+
|
|
// APPLICATION API
|
|
//--------------------------------------------------------------------+
|
|
tusb_error_t tusbh_cdc_rndis_get_mac_addr(uint8_t dev_addr, uint8_t mac_address[6])
|
|
{
|
|
TU_ASSERT( tusbh_cdc_rndis_is_mounted(dev_addr), TUSB_ERROR_CDCH_DEVICE_NOT_MOUNTED);
|
|
TU_VERIFY( mac_address, TUSB_ERROR_INVALID_PARA);
|
|
|
|
memcpy(mac_address, rndish_data[dev_addr-1].mac_address, 6);
|
|
|
|
return TUSB_ERROR_NONE;
|
|
}
|
|
|
|
//--------------------------------------------------------------------+
|
|
// IMPLEMENTATION
|
|
//--------------------------------------------------------------------+
|
|
|
|
// To enable the TASK_ASSERT style (quick return on false condition) in a real RTOS, a task must act as a wrapper
|
|
// and is used mainly to call subtasks. Within a subtask return statement can be called freely, the task with
|
|
// forever loop cannot have any return at all.
|
|
OSAL_TASK_FUNCTION(cdch_rndis_task) (void* param;)
|
|
{
|
|
OSAL_TASK_BEGIN
|
|
rndis_body_subtask();
|
|
OSAL_TASK_END
|
|
}
|
|
|
|
static tusb_error_t rndis_body_subtask(void)
|
|
{
|
|
static uint8_t relative_addr;
|
|
|
|
OSAL_SUBTASK_BEGIN
|
|
|
|
for (relative_addr = 0; relative_addr < CFG_TUSB_HOST_DEVICE_MAX; relative_addr++)
|
|
{
|
|
|
|
}
|
|
|
|
osal_task_delay(100);
|
|
|
|
OSAL_SUBTASK_END
|
|
}
|
|
|
|
//--------------------------------------------------------------------+
|
|
// RNDIS-CDC Driver API
|
|
//--------------------------------------------------------------------+
|
|
void rndish_init(void)
|
|
{
|
|
tu_memclr(rndish_data, sizeof(rndish_data_t)*CFG_TUSB_HOST_DEVICE_MAX);
|
|
|
|
//------------- Task creation -------------//
|
|
|
|
//------------- semaphore creation for notificaiton pipe -------------//
|
|
for(uint8_t i=0; i<CFG_TUSB_HOST_DEVICE_MAX; i++)
|
|
{
|
|
rndish_data[i].sem_notification_hdl = osal_semaphore_create( OSAL_SEM_REF(rndish_data[i].semaphore_notification) );
|
|
}
|
|
}
|
|
|
|
void rndish_close(uint8_t dev_addr)
|
|
{
|
|
osal_semaphore_reset( rndish_data[dev_addr-1].sem_notification_hdl );
|
|
// tu_memclr(&rndish_data[dev_addr-1], sizeof(rndish_data_t)); TODO need to move semaphore & its handle out before memclr
|
|
}
|
|
|
|
|
|
static rndis_msg_initialize_t const msg_init =
|
|
{
|
|
.type = RNDIS_MSG_INITIALIZE,
|
|
.length = sizeof(rndis_msg_initialize_t),
|
|
.request_id = 1, // TODO should use some magic number
|
|
.major_version = 1,
|
|
.minor_version = 0,
|
|
.max_xfer_size = 0x4000 // TODO mimic windows
|
|
};
|
|
|
|
static rndis_msg_query_t const msg_query_permanent_addr =
|
|
{
|
|
.type = RNDIS_MSG_QUERY,
|
|
.length = sizeof(rndis_msg_query_t)+6,
|
|
.request_id = 1,
|
|
.oid = RNDIS_OID_802_3_PERMANENT_ADDRESS,
|
|
.buffer_length = 6,
|
|
.buffer_offset = 20,
|
|
};
|
|
|
|
static rndis_msg_set_t const msg_set_packet_filter =
|
|
{
|
|
.type = RNDIS_MSG_SET,
|
|
.length = sizeof(rndis_msg_set_t)+4,
|
|
.request_id = 1,
|
|
.oid = RNDIS_OID_GEN_CURRENT_PACKET_FILTER,
|
|
.buffer_length = 4,
|
|
.buffer_offset = 20,
|
|
};
|
|
|
|
tusb_error_t rndish_open_subtask(uint8_t dev_addr, cdch_data_t *p_cdc)
|
|
{
|
|
tusb_error_t error;
|
|
|
|
OSAL_SUBTASK_BEGIN
|
|
|
|
//------------- Message Initialize -------------//
|
|
memcpy(msg_payload, &msg_init, sizeof(rndis_msg_initialize_t));
|
|
STASK_INVOKE(
|
|
send_message_get_response_subtask( dev_addr, p_cdc,
|
|
msg_payload, sizeof(rndis_msg_initialize_t),
|
|
msg_payload),
|
|
error
|
|
);
|
|
if ( TUSB_ERROR_NONE != error ) STASK_RETURN(error);
|
|
|
|
// TODO currently not support multiple data packets per xfer
|
|
rndis_msg_initialize_cmplt_t * const p_init_cmpt = (rndis_msg_initialize_cmplt_t *) msg_payload;
|
|
STASK_ASSERT(p_init_cmpt->type == RNDIS_MSG_INITIALIZE_CMPLT && p_init_cmpt->status == RNDIS_STATUS_SUCCESS &&
|
|
p_init_cmpt->max_packet_per_xfer == 1 && p_init_cmpt->max_xfer_size <= RNDIS_MSG_PAYLOAD_MAX);
|
|
rndish_data[dev_addr-1].max_xfer_size = p_init_cmpt->max_xfer_size;
|
|
|
|
//------------- Message Query 802.3 Permanent Address -------------//
|
|
memcpy(msg_payload, &msg_query_permanent_addr, sizeof(rndis_msg_query_t));
|
|
tu_memclr(msg_payload + sizeof(rndis_msg_query_t), 6); // 6 bytes for MAC address
|
|
|
|
STASK_INVOKE(
|
|
send_message_get_response_subtask( dev_addr, p_cdc,
|
|
msg_payload, sizeof(rndis_msg_query_t) + 6,
|
|
msg_payload),
|
|
error
|
|
);
|
|
if ( TUSB_ERROR_NONE != error ) STASK_RETURN(error);
|
|
|
|
rndis_msg_query_cmplt_t * const p_query_cmpt = (rndis_msg_query_cmplt_t *) msg_payload;
|
|
STASK_ASSERT(p_query_cmpt->type == RNDIS_MSG_QUERY_CMPLT && p_query_cmpt->status == RNDIS_STATUS_SUCCESS);
|
|
memcpy(rndish_data[dev_addr-1].mac_address, msg_payload + 8 + p_query_cmpt->buffer_offset, 6);
|
|
|
|
//------------- Set OID_GEN_CURRENT_PACKET_FILTER to (DIRECTED | MULTICAST | BROADCAST) -------------//
|
|
memcpy(msg_payload, &msg_set_packet_filter, sizeof(rndis_msg_set_t));
|
|
tu_memclr(msg_payload + sizeof(rndis_msg_set_t), 4); // 4 bytes for filter flags
|
|
((rndis_msg_set_t*) msg_payload)->oid_buffer[0] = (RNDIS_PACKET_TYPE_DIRECTED | RNDIS_PACKET_TYPE_MULTICAST | RNDIS_PACKET_TYPE_BROADCAST);
|
|
|
|
STASK_INVOKE(
|
|
send_message_get_response_subtask( dev_addr, p_cdc,
|
|
msg_payload, sizeof(rndis_msg_set_t) + 4,
|
|
msg_payload),
|
|
error
|
|
);
|
|
if ( TUSB_ERROR_NONE != error ) STASK_RETURN(error);
|
|
|
|
rndis_msg_set_cmplt_t * const p_set_cmpt = (rndis_msg_set_cmplt_t *) msg_payload;
|
|
STASK_ASSERT(p_set_cmpt->type == RNDIS_MSG_SET_CMPLT && p_set_cmpt->status == RNDIS_STATUS_SUCCESS);
|
|
|
|
tusbh_cdc_rndis_mounted_cb(dev_addr);
|
|
|
|
OSAL_SUBTASK_END
|
|
}
|
|
|
|
void rndish_xfer_isr(cdch_data_t *p_cdc, pipe_handle_t pipe_hdl, xfer_result_t event, uint32_t xferred_bytes)
|
|
{
|
|
if ( pipehandle_is_equal(pipe_hdl, p_cdc->pipe_notification) )
|
|
{
|
|
osal_semaphore_post( rndish_data[pipe_hdl.dev_addr-1].sem_notification_hdl );
|
|
}
|
|
}
|
|
|
|
//--------------------------------------------------------------------+
|
|
// INTERNAL & HELPER
|
|
//--------------------------------------------------------------------+
|
|
static tusb_error_t send_message_get_response_subtask( uint8_t dev_addr, cdch_data_t *p_cdc,
|
|
uint8_t * p_mess, uint32_t mess_length,
|
|
uint8_t *p_response)
|
|
{
|
|
tusb_error_t error;
|
|
|
|
OSAL_SUBTASK_BEGIN
|
|
|
|
//------------- Send RNDIS Control Message -------------//
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( dev_addr, bm_request_type(TUSB_DIR_OUT, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_INTERFACE),
|
|
CDC_REQUEST_SEND_ENCAPSULATED_COMMAND, 0, p_cdc->interface_number,
|
|
mess_length, p_mess),
|
|
error
|
|
);
|
|
if ( TUSB_ERROR_NONE != error ) STASK_RETURN(error);
|
|
|
|
//------------- waiting for Response Available notification -------------//
|
|
(void) hcd_pipe_xfer(p_cdc->pipe_notification, msg_notification[dev_addr-1], 8, true);
|
|
osal_semaphore_wait(rndish_data[dev_addr-1].sem_notification_hdl, OSAL_TIMEOUT_NORMAL, &error);
|
|
if ( TUSB_ERROR_NONE != error ) STASK_RETURN(error);
|
|
STASK_ASSERT(msg_notification[dev_addr-1][0] == 1);
|
|
|
|
//------------- Get RNDIS Message Initialize Complete -------------//
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( dev_addr, bm_request_type(TUSB_DIR_IN, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_INTERFACE),
|
|
CDC_REQUEST_GET_ENCAPSULATED_RESPONSE, 0, p_cdc->interface_number,
|
|
RNDIS_MSG_PAYLOAD_MAX, p_response),
|
|
error
|
|
);
|
|
if ( TUSB_ERROR_NONE != error ) STASK_RETURN(error);
|
|
|
|
OSAL_SUBTASK_END
|
|
}
|
|
|
|
//static tusb_error_t send_process_msg_initialize_subtask(uint8_t dev_addr, cdch_data_t *p_cdc)
|
|
//{
|
|
// tusb_error_t error;
|
|
//
|
|
// OSAL_SUBTASK_BEGIN
|
|
//
|
|
// *((rndis_msg_initialize_t*) msg_payload) = (rndis_msg_initialize_t)
|
|
// {
|
|
// .type = RNDIS_MSG_INITIALIZE,
|
|
// .length = sizeof(rndis_msg_initialize_t),
|
|
// .request_id = 1, // TODO should use some magic number
|
|
// .major_version = 1,
|
|
// .minor_version = 0,
|
|
// .max_xfer_size = 0x4000 // TODO mimic windows
|
|
// };
|
|
//
|
|
//
|
|
//
|
|
// OSAL_SUBTASK_END
|
|
//}
|
|
#endif
|