add control xfer for ehci controller fake: ehci_controller_control_xfer_proceed
refractor test code
This commit is contained in:
@@ -44,6 +44,8 @@
|
||||
#include "binary.h"
|
||||
#include "hal.h"
|
||||
#include "ehci.h"
|
||||
#include "usbh_hcd.h"
|
||||
|
||||
|
||||
//--------------------------------------------------------------------+
|
||||
// MACRO CONSTANT TYPEDEF
|
||||
@@ -52,9 +54,35 @@ ehci_data_t ehci_data;
|
||||
LPC_USB0_Type lpc_usb0;
|
||||
LPC_USB1_Type lpc_usb1;
|
||||
|
||||
extern usbh_device_info_t usbh_devices[TUSB_CFG_HOST_DEVICE_MAX+1];
|
||||
|
||||
//--------------------------------------------------------------------+
|
||||
// IMPLEMENTATION
|
||||
//--------------------------------------------------------------------+
|
||||
void ehci_controller_control_xfer_proceed(uint8_t dev_addr, uint8_t p_data[])
|
||||
{
|
||||
ehci_registers_t* const regs = get_operational_register( usbh_devices[dev_addr].core_id );
|
||||
ehci_qhd_t * p_qhd = get_control_qhd(dev_addr);
|
||||
ehci_qtd_t * p_qtd_setup = get_control_qtds(dev_addr);
|
||||
ehci_qtd_t * p_qtd_data = p_qtd_setup + 1;
|
||||
ehci_qtd_t * p_qtd_status = p_qtd_setup + 2;
|
||||
|
||||
tusb_std_request_t const *p_request = (tusb_std_request_t *) p_qtd_setup->buffer[0];
|
||||
|
||||
if (p_request->wLength > 0 && p_request->bmRequestType.direction == TUSB_DIR_DEV_TO_HOST)
|
||||
{
|
||||
memcpy(p_qtd_data, p_data, p_request->wLength);
|
||||
}
|
||||
|
||||
//------------- retire all QTDs -------------//
|
||||
p_qtd_setup->active = p_qtd_data->active = p_qtd_status->active = 0;
|
||||
p_qhd->qtd_overlay = *p_qtd_status;
|
||||
|
||||
regs->usb_sts = EHCI_INT_MASK_NXP_ASYNC | EHCI_INT_MASK_NXP_PERIODIC;
|
||||
|
||||
hcd_isr( usbh_devices[dev_addr].core_id );
|
||||
}
|
||||
|
||||
bool complete_all_qtd_in_list(ehci_qhd_t *head)
|
||||
{
|
||||
ehci_qhd_t *p_qhd = head;
|
||||
@@ -90,7 +118,7 @@ void ehci_controller_run(uint8_t hostid)
|
||||
complete_all_qtd_in_list((ehci_qhd_t*) regs->async_list_base);
|
||||
|
||||
//------------- Period List -------------//
|
||||
complete_all_qtd_in_list( get_period_head(hostid) );
|
||||
complete_all_qtd_in_list( get_period_head(hostid) );
|
||||
regs->usb_sts = EHCI_INT_MASK_NXP_ASYNC | EHCI_INT_MASK_NXP_PERIODIC;
|
||||
|
||||
hcd_isr(hostid);
|
||||
@@ -131,6 +159,8 @@ void ehci_controller_device_plug(uint8_t hostid, tusb_speed_t speed)
|
||||
regs->portsc_bit.connect_status_change = 1;
|
||||
regs->portsc_bit.current_connect_status = 1;
|
||||
regs->portsc_bit.nxp_port_speed = speed;
|
||||
|
||||
hcd_isr(hostid);
|
||||
}
|
||||
|
||||
void ehci_controller_device_unplug(uint8_t hostid)
|
||||
|
||||
Reference in New Issue
Block a user