252 lines
9.9 KiB
C
252 lines
9.9 KiB
C
/**************************************************************************/
|
|
/*!
|
|
@file hub.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 && TUSB_CFG_HOST_HUB)
|
|
|
|
#define _TINY_USB_SOURCE_FILE_
|
|
|
|
//--------------------------------------------------------------------+
|
|
// INCLUDE
|
|
//--------------------------------------------------------------------+
|
|
#include "hub.h"
|
|
#include "usbh_hub.h"
|
|
|
|
//--------------------------------------------------------------------+
|
|
// MACRO CONSTANT TYPEDEF
|
|
//--------------------------------------------------------------------+
|
|
typedef struct {
|
|
pipe_handle_t pipe_status;
|
|
uint8_t interface_number;
|
|
uint8_t port_number;
|
|
uint8_t status_change; // data from status change interrupt endpoint
|
|
}usbh_hub_t;
|
|
|
|
TUSB_CFG_ATTR_USBRAM STATIC_VAR usbh_hub_t hub_data[TUSB_CFG_HOST_DEVICE_MAX];
|
|
ATTR_ALIGNED(4) TUSB_CFG_ATTR_USBRAM STATIC_VAR uint8_t hub_enum_buffer[sizeof(descriptor_hub_desc_t)];
|
|
|
|
//OSAL_SEM_DEF(hub_enum_semaphore);
|
|
//static osal_semaphore_handle_t hub_enum_sem_hdl;
|
|
|
|
//--------------------------------------------------------------------+
|
|
// HUB
|
|
//--------------------------------------------------------------------+
|
|
tusb_error_t hub_port_clear_feature_subtask(uint8_t hub_addr, uint8_t hub_port, uint8_t feature)
|
|
{
|
|
tusb_error_t error;
|
|
|
|
OSAL_SUBTASK_BEGIN
|
|
|
|
STASK_ASSERT(HUB_FEATURE_PORT_CONNECTION_CHANGE <= feature &&
|
|
feature <= HUB_FEATURE_PORT_RESET_CHANGE);
|
|
|
|
//------------- Clear Port Feature request -------------//
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( hub_addr, bm_request_type(TUSB_DIR_OUT, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_OTHER),
|
|
HUB_REQUEST_CLEAR_FEATURE, feature, hub_port,
|
|
0, NULL ),
|
|
error
|
|
);
|
|
STASK_ASSERT_ERR( error );
|
|
|
|
//------------- Get Port Status to check if feature is cleared -------------//
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( hub_addr, bm_request_type(TUSB_DIR_IN, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_OTHER),
|
|
HUB_REQUEST_GET_STATUS, 0, hub_port,
|
|
4, hub_enum_buffer ),
|
|
error
|
|
);
|
|
STASK_ASSERT_ERR( error );
|
|
|
|
//------------- Check if feature is cleared -------------//
|
|
hub_port_status_response_t * p_port_status;
|
|
p_port_status = (hub_port_status_response_t *) hub_enum_buffer;
|
|
|
|
STASK_ASSERT( !BIT_TEST_(p_port_status->status_change.value, feature-16) );
|
|
|
|
OSAL_SUBTASK_END
|
|
}
|
|
|
|
tusb_error_t hub_port_reset_subtask(uint8_t hub_addr, uint8_t hub_port)
|
|
{
|
|
enum { RESET_DELAY = 200 }; // USB specs say only 50ms but many devices require much longer
|
|
tusb_error_t error;
|
|
|
|
OSAL_SUBTASK_BEGIN
|
|
|
|
//------------- Set Port Reset -------------//
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( hub_addr, bm_request_type(TUSB_DIR_OUT, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_OTHER),
|
|
HUB_REQUEST_SET_FEATURE, HUB_FEATURE_PORT_RESET, hub_port,
|
|
0, NULL ),
|
|
error
|
|
);
|
|
STASK_ASSERT_ERR( error );
|
|
|
|
osal_task_delay(RESET_DELAY); // TODO Hub wait for Status Endpoint on Reset Change
|
|
|
|
//------------- Get Port Status to check if port is enabled, powered and reset_change -------------//
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( hub_addr, bm_request_type(TUSB_DIR_IN, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_OTHER),
|
|
HUB_REQUEST_GET_STATUS, 0, hub_port,
|
|
4, hub_enum_buffer ),
|
|
error
|
|
);
|
|
STASK_ASSERT_ERR( error );
|
|
|
|
hub_port_status_response_t * p_port_status;
|
|
p_port_status = (hub_port_status_response_t *) hub_enum_buffer;
|
|
|
|
STASK_ASSERT ( p_port_status->status_change.reset && p_port_status->status_current.connect_status &&
|
|
p_port_status->status_current.port_power && p_port_status->status_current.port_enable);
|
|
|
|
OSAL_SUBTASK_END
|
|
}
|
|
|
|
// can only get the speed RIGHT AFTER hub_port_reset_subtask call
|
|
tusb_speed_t hub_port_get_speed(void)
|
|
{
|
|
hub_port_status_response_t * p_port_status = (hub_port_status_response_t *) hub_enum_buffer;
|
|
return (p_port_status->status_current.high_speed_device_attached) ? TUSB_SPEED_HIGH :
|
|
(p_port_status->status_current.low_speed_device_attached ) ? TUSB_SPEED_LOW : TUSB_SPEED_FULL;
|
|
}
|
|
|
|
//--------------------------------------------------------------------+
|
|
// CLASS-USBH API (don't require to verify parameters)
|
|
//--------------------------------------------------------------------+
|
|
void hub_init(void)
|
|
{
|
|
memclr_(hub_data, TUSB_CFG_HOST_DEVICE_MAX*sizeof(usbh_hub_t));
|
|
// hub_enum_sem_hdl = osal_semaphore_create( OSAL_SEM_REF(hub_enum_semaphore) );
|
|
}
|
|
|
|
tusb_error_t hub_open_subtask(uint8_t dev_addr, tusb_desc_interface_t const *p_interface_desc, uint16_t *p_length)
|
|
{
|
|
tusb_error_t error;
|
|
|
|
OSAL_SUBTASK_BEGIN
|
|
|
|
// not support multiple TT yet
|
|
if ( p_interface_desc->bInterfaceProtocol > 1 ) return TUSB_ERROR_HUB_FEATURE_NOT_SUPPORTED;
|
|
|
|
//------------- Open Interrupt Status Pipe -------------//
|
|
tusb_desc_endpoint_t const *p_endpoint;
|
|
p_endpoint = (tusb_desc_endpoint_t const *) descriptor_next( (uint8_t const*) p_interface_desc );
|
|
|
|
STASK_ASSERT(TUSB_DESC_ENDPOINT == p_endpoint->bDescriptorType);
|
|
STASK_ASSERT(TUSB_XFER_INTERRUPT == p_endpoint->bmAttributes.xfer);
|
|
|
|
hub_data[dev_addr-1].pipe_status = hcd_pipe_open(dev_addr, p_endpoint, TUSB_CLASS_HUB);
|
|
STASK_ASSERT( pipehandle_is_valid(hub_data[dev_addr-1].pipe_status) );
|
|
hub_data[dev_addr-1].interface_number = p_interface_desc->bInterfaceNumber;
|
|
|
|
(*p_length) = sizeof(tusb_desc_interface_t) + sizeof(tusb_desc_endpoint_t);
|
|
|
|
//------------- Get Hub Descriptor -------------//
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( dev_addr, bm_request_type(TUSB_DIR_IN, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_DEVICE),
|
|
HUB_REQUEST_GET_DESCRIPTOR, 0, 0,
|
|
sizeof(descriptor_hub_desc_t), hub_enum_buffer ),
|
|
error
|
|
);
|
|
STASK_ASSERT_ERR(error);
|
|
|
|
// only care about this field in hub descriptor
|
|
hub_data[dev_addr-1].port_number = ((descriptor_hub_desc_t*) hub_enum_buffer)->bNbrPorts;
|
|
|
|
//------------- Set Port_Power on all ports -------------//
|
|
static uint8_t i;
|
|
for(i=1; i <= hub_data[dev_addr-1].port_number; i++)
|
|
{
|
|
STASK_INVOKE(
|
|
usbh_control_xfer_subtask( dev_addr, bm_request_type(TUSB_DIR_OUT, TUSB_REQ_TYPE_CLASS, TUSB_REQ_RCPT_OTHER),
|
|
HUB_REQUEST_SET_FEATURE, HUB_FEATURE_PORT_POWER, i,
|
|
0, NULL ),
|
|
error
|
|
);
|
|
}
|
|
|
|
//------------- Queue the initial Status endpoint transfer -------------//
|
|
STASK_ASSERT_ERR ( hcd_pipe_xfer(hub_data[dev_addr-1].pipe_status, &hub_data[dev_addr-1].status_change, 1, true) );
|
|
|
|
OSAL_SUBTASK_END
|
|
}
|
|
|
|
// is the response of interrupt endpoint polling
|
|
void hub_isr(pipe_handle_t pipe_hdl, tusb_event_t event, uint32_t xferred_bytes)
|
|
{
|
|
(void) xferred_bytes; // TODO can be more than 1 for hub with lots of ports
|
|
|
|
usbh_hub_t * p_hub = &hub_data[pipe_hdl.dev_addr-1];
|
|
|
|
if ( event == TUSB_EVENT_XFER_COMPLETE )
|
|
{
|
|
for (uint8_t port=1; port <= p_hub->port_number; port++)
|
|
{ // TODO HUB ignore bit0 hub_status_change
|
|
if ( BIT_TEST_(p_hub->status_change, port) )
|
|
{
|
|
usbh_hub_port_plugged_isr(pipe_hdl.dev_addr, port);
|
|
break; // handle one port at a time, next port if any will be handled in the next cycle
|
|
}
|
|
}
|
|
// NOTE: next status transfer is queued by usbh.c after handling this request
|
|
}
|
|
else
|
|
{
|
|
// TODO [HUB] check if hub is still plugged before polling status endpoint since failed usually mean hub unplugged
|
|
// TU_ASSERT ( TUSB_ERROR_NONE == hcd_pipe_xfer(pipe_hdl, &p_hub->status_change, 1, true) );
|
|
}
|
|
}
|
|
|
|
void hub_close(uint8_t dev_addr)
|
|
{
|
|
(void) hcd_pipe_close(hub_data[dev_addr-1].pipe_status);
|
|
memclr_(&hub_data[dev_addr-1], sizeof(usbh_hub_t));
|
|
|
|
// osal_semaphore_reset(hub_enum_sem_hdl);
|
|
}
|
|
|
|
tusb_error_t hub_status_pipe_queue(uint8_t dev_addr)
|
|
{
|
|
return hcd_pipe_xfer(hub_data[dev_addr-1].pipe_status, &hub_data[dev_addr-1].status_change, 1, true);
|
|
}
|
|
|
|
|
|
#endif
|