In USB Host, fix bugs of device insertion and removal and isochronous transfer.

Bugs are as below.
- When user disconnect the USB during Audio playback, GR-PEACH may not recognize it.
- When running isochronous transfer multiple at the same time, GR-PEACH can not operate properly.
pull/1381/head
tomoyuki yamanaka 2015-10-16 13:41:46 +09:00
parent 3f2632bebc
commit 0046b63862
3 changed files with 78 additions and 83 deletions

View File

@ -199,7 +199,6 @@ static int32_t iso_trans_doing(hced_t *p_ed, uint32_t index);
static void chk_iso_td_done(genelal_ed_t *p_g_ed); static void chk_iso_td_done(genelal_ed_t *p_g_ed);
static int32_t chk_iso_ed(genelal_ed_t *p_g_ed); static int32_t chk_iso_ed(genelal_ed_t *p_g_ed);
static void iso_trans_setting(genelal_ed_t *p_g_ed, uint32_t index); static void iso_trans_setting(genelal_ed_t *p_g_ed, uint32_t index);
static uint32_t iso_chk_starting_frame(genelal_ed_t *p_g_ed);
static void iso_trans(genelal_ed_t *p_g_ed); static void iso_trans(genelal_ed_t *p_g_ed);
#endif #endif
static void connect_check(void); static void connect_check(void);
@ -215,6 +214,7 @@ static usb_ohci_reg_t *p_usb_reg = &usb_reg;
static usbisr_fnc_t *p_usbisr_cb = NULL; static usbisr_fnc_t *p_usbisr_cb = NULL;
static osSemaphoreId semid_cb = NULL; static osSemaphoreId semid_cb = NULL;
static uint32_t connect_change = 0xFFFFFFFF; static uint32_t connect_change = 0xFFFFFFFF;
static uint32_t connect_status = 0;
static uint32_t init_end = 0; static uint32_t init_end = 0;
static genelal_ed_t ctl_ed; static genelal_ed_t ctl_ed;
static genelal_ed_t blk_ed; static genelal_ed_t blk_ed;
@ -283,13 +283,13 @@ osThreadDef(int_ed_task_4, osPriorityNormal, 512);
static void iso_ed_task_1(void const * argument) { static void iso_ed_task_1(void const * argument) {
iso_ed_task(argument); iso_ed_task(argument);
} }
osThreadDef(iso_ed_task_1, osPriorityNormal, 512); osThreadDef(iso_ed_task_1, osPriorityAboveNormal, 512);
#endif #endif
#if (ISO_TRANS_MAX_NUM >= 2) #if (ISO_TRANS_MAX_NUM >= 2)
static void iso_ed_task_2(void const * argument) { static void iso_ed_task_2(void const * argument) {
iso_ed_task(argument); iso_ed_task(argument);
} }
osThreadDef(iso_ed_task_2, osPriorityNormal, 512); osThreadDef(iso_ed_task_2, osPriorityAboveNormal, 512);
#endif #endif
void ohciwrapp_init(usbisr_fnc_t *p_usbisr_fnc) { void ohciwrapp_init(usbisr_fnc_t *p_usbisr_fnc) {
@ -878,25 +878,28 @@ static void control_trans(genelal_ed_t *p_g_ed) {
p_g_ed->pipe_no = USB_HOST_PIPE0; p_g_ed->pipe_no = USB_HOST_PIPE0;
p_g_ed->trans_wait = 1; p_g_ed->trans_wait = 1;
if (connect_status == 0) {
if (td_info.direction == 0) { ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
uint16_t Req = (p_td->currBufPtr[1] << 8) + p_td->currBufPtr[0];
uint16_t Val = (p_td->currBufPtr[3] << 8) + p_td->currBufPtr[2];
uint16_t Indx = (p_td->currBufPtr[5] << 8) + p_td->currBufPtr[4];
uint16_t Len = (p_td->currBufPtr[7] << 8) + p_td->currBufPtr[6];
g_usbx_host_data_pointer[USB_HOST_PIPE0] = p_td->bufEnd;
usbx_host_SetupStage(Req, Val, Indx, Len);
} else if (td_info.direction == 1) {
usbx_host_CtrlWriteStart(td_info.count, p_td->currBufPtr);
} else { } else {
usbx_host_CtrlReadStart(td_info.count, p_td->currBufPtr); if (td_info.direction == 0) {
} uint16_t Req = (p_td->currBufPtr[1] << 8) + p_td->currBufPtr[0];
uint16_t Val = (p_td->currBufPtr[3] << 8) + p_td->currBufPtr[2];
uint16_t Indx = (p_td->currBufPtr[5] << 8) + p_td->currBufPtr[4];
uint16_t Len = (p_td->currBufPtr[7] << 8) + p_td->currBufPtr[6];
(void)osSemaphoreWait(p_g_ed->semid_wait, CTL_TRANS_TIMEOUT); g_usbx_host_data_pointer[USB_HOST_PIPE0] = p_td->bufEnd;
if (p_g_ed->trans_wait == 1) { usbx_host_SetupStage(Req, Val, Indx, Len);
p_g_ed->trans_wait = 0; } else if (td_info.direction == 1) {
RZA_IO_RegWrite_32(&p_td->control, TD_CC_DEVICENOTRESPONDING, TD_CTL_SHFT_CC, TD_CTL_MSK_CC); usbx_host_CtrlWriteStart(td_info.count, p_td->currBufPtr);
} else {
usbx_host_CtrlReadStart(td_info.count, p_td->currBufPtr);
}
(void)osSemaphoreWait(p_g_ed->semid_wait, CTL_TRANS_TIMEOUT);
if (p_g_ed->trans_wait == 1) {
p_g_ed->trans_wait = 0;
RZA_IO_RegWrite_32(&p_td->control, TD_CC_DEVICENOTRESPONDING, TD_CTL_SHFT_CC, TD_CTL_MSK_CC);
}
} }
g_usbx_host_CmdStage &= (~USB_HOST_CMD_FIELD); g_usbx_host_CmdStage &= (~USB_HOST_CMD_FIELD);
@ -928,14 +931,18 @@ static void bulk_trans(genelal_ed_t *p_g_ed) {
set_togle(p_g_ed->pipe_no, p_td, p_ed); set_togle(p_g_ed->pipe_no, p_td, p_ed);
p_g_ed->trans_wait = 1; p_g_ed->trans_wait = 1;
if (td_info.direction == 1) { if (connect_status == 0) {
usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr); ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
} else { } else {
usbx_host_start_receive_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr); if (td_info.direction == 1) {
} usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
} else {
usbx_host_start_receive_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
}
(void)osSemaphoreWait(p_g_ed->semid_wait, BLK_TRANS_TIMEOUT); (void)osSemaphoreWait(p_g_ed->semid_wait, BLK_TRANS_TIMEOUT);
usbx_host_stop_transfer(p_g_ed->pipe_no); usbx_host_stop_transfer(p_g_ed->pipe_no);
}
} }
static void int_trans_setting(genelal_ed_t *p_g_ed, uint32_t index) { static void int_trans_setting(genelal_ed_t *p_g_ed, uint32_t index) {
@ -1023,10 +1030,14 @@ static void int_trans(genelal_ed_t *p_g_ed) {
get_td_info(p_g_ed, &td_info); get_td_info(p_g_ed, &td_info);
p_g_ed->trans_wait = 1; p_g_ed->trans_wait = 1;
if (td_info.direction == 1) { if (connect_status == 0) {
usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr); ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
} else { } else {
usbx_host_start_receive_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr); if (td_info.direction == 1) {
usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
} else {
usbx_host_start_receive_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
}
} }
} }
@ -1089,7 +1100,6 @@ static void set_togle(uint32_t pipe, hctd_t *p_td, hced_t *p_ed) {
static void iso_ed_task(void const * argument) { static void iso_ed_task(void const * argument) {
genelal_ed_t *p_iso_ed = &iso_ed[(uint32_t)argument]; genelal_ed_t *p_iso_ed = &iso_ed[(uint32_t)argument];
uint32_t wait_cnt = 0; uint32_t wait_cnt = 0;
uint32_t wait_time = 0;
hcca_t *p_hcca; hcca_t *p_hcca;
hced_t *p_ed; hced_t *p_ed;
@ -1115,17 +1125,26 @@ static void iso_ed_task(void const * argument) {
if (p_iso_ed->p_curr_ed != NULL) { if (p_iso_ed->p_curr_ed != NULL) {
while ((p_usb_reg->HcControl & OR_CONTROL_IE) != 0) { while ((p_usb_reg->HcControl & OR_CONTROL_IE) != 0) {
if (chk_iso_ed(p_iso_ed) != 0) { if (chk_iso_ed(p_iso_ed) != 0) {
wait_time = iso_chk_starting_frame(p_iso_ed); hcisotd_t *p_isotd = (hcisotd_t *)p_iso_ed->p_curr_td;
if (wait_time != 0) { uint32_t starting_frame = p_isotd->control & 0x0000FFFF;
osDelay(wait_time); uint32_t wait_time = 0;
p_usb_reg->HcFmNumber += wait_time; uint32_t wk_HcFmNumber = p_usb_reg->HcFmNumber;
p_usb_reg->HcFmNumber &= 0x0000FFFF;
if (starting_frame > wk_HcFmNumber) {
wait_time = starting_frame - wk_HcFmNumber;
} else {
wait_time = (0xFFFF - wk_HcFmNumber) + starting_frame;
}
if ((wait_time >= 2) && (wait_time <= 1000)) {
for (int cnt = 0; cnt < (wait_time - 1); cnt++) {
osDelay(1);
p_usb_reg->HcFmNumber = (wk_HcFmNumber + cnt) & 0x0000FFFF;
}
} }
p_iso_ed->psw_idx = 0; p_iso_ed->psw_idx = 0;
iso_trans(p_iso_ed); iso_trans(p_iso_ed);
(void)osSemaphoreWait(p_iso_ed->semid_wait, osWaitForever); (void)osSemaphoreWait(p_iso_ed->semid_wait, osWaitForever);
usbx_host_stop_transfer(p_iso_ed->pipe_no); wait_cnt = 8;
wait_cnt = 1;
} else { } else {
if (wait_cnt > 0) { if (wait_cnt > 0) {
wait_cnt--; wait_cnt--;
@ -1234,18 +1253,6 @@ static void iso_trans_setting(genelal_ed_t *p_g_ed, uint32_t index) {
usbx_api_host_SetEndpointTable(td_info.devadr, user_table, wk_table); usbx_api_host_SetEndpointTable(td_info.devadr, user_table, wk_table);
} }
static uint32_t iso_chk_starting_frame(genelal_ed_t *p_g_ed) {
hcisotd_t *p_isotd = (hcisotd_t *)p_g_ed->p_curr_td;
uint32_t starting_frame = p_isotd->control & 0x0000FFFF;
uint32_t wait_time = 0;
if ((p_g_ed->psw_idx == 0) && (starting_frame > p_usb_reg->HcFmNumber)) {
wait_time = starting_frame - p_usb_reg->HcFmNumber;
}
return wait_time;
}
static void iso_trans(genelal_ed_t *p_g_ed) { static void iso_trans(genelal_ed_t *p_g_ed) {
hcisotd_t *p_isotd = (hcisotd_t *)p_g_ed->p_curr_td; hcisotd_t *p_isotd = (hcisotd_t *)p_g_ed->p_curr_td;
tdinfo_t td_info; tdinfo_t td_info;
@ -1268,10 +1275,14 @@ static void iso_trans(genelal_ed_t *p_g_ed) {
get_td_info(p_g_ed, &td_info); get_td_info(p_g_ed, &td_info);
p_g_ed->trans_wait = 1; p_g_ed->trans_wait = 1;
if (td_info.direction == 1) { if (connect_status == 0) {
usbx_host_start_send_transfer(p_g_ed->pipe_no, data_size, (uint8_t *)buff_addr); ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
} else { } else {
usbx_host_start_receive_transfer(p_g_ed->pipe_no, data_size, (uint8_t *)buff_addr); if (td_info.direction == 1) {
usbx_host_start_send_transfer(p_g_ed->pipe_no, data_size, (uint8_t *)buff_addr);
} else {
usbx_host_start_receive_transfer(p_g_ed->pipe_no, data_size, (uint8_t *)buff_addr);
}
} }
} }
#endif #endif
@ -1326,6 +1337,7 @@ static void connect_check(void) {
void ohciwrapp_loc_Connect(uint32_t type) { void ohciwrapp_loc_Connect(uint32_t type) {
uint32_t cnt; uint32_t cnt;
connect_status = type;
connect_change = type; connect_change = type;
if (type == 0) { if (type == 0) {
if (ctl_ed.trans_wait == 1) { if (ctl_ed.trans_wait == 1) {
@ -1445,11 +1457,7 @@ void ohciwrapp_loc_TransEnd(uint32_t pipe, uint32_t ConditionCode) {
if (p_isotd != NULL) { if (p_isotd != NULL) {
usbx_host_stop_transfer(pipe); usbx_host_stop_transfer(pipe);
if (p_usb_reg->HcFmNumber < 0x0000FFFF) { p_usb_reg->HcFmNumber = ((p_isotd->control & 0x0000FFFF) + p_wait_ed->psw_idx) & 0x0000FFFF;
p_usb_reg->HcFmNumber++;
} else {
p_usb_reg->HcFmNumber = 0;
}
/* Size of packet */ /* Size of packet */
p_isotd->offsetPSW[p_wait_ed->psw_idx] -= g_usbx_host_data_count[pipe]; p_isotd->offsetPSW[p_wait_ed->psw_idx] -= g_usbx_host_data_count[pipe];
@ -1469,10 +1477,8 @@ void ohciwrapp_loc_TransEnd(uint32_t pipe, uint32_t ConditionCode) {
p_wait_ed->psw_idx++; p_wait_ed->psw_idx++;
} }
if (chk_iso_ed(p_wait_ed) != 0) { if (chk_iso_ed(p_wait_ed) != 0) {
if (iso_chk_starting_frame(p_wait_ed) == 0) { iso_trans(p_wait_ed);
iso_trans(p_wait_ed); next_trans = 1;
next_trans = 1;
}
} }
if (next_trans == 0) { if (next_trans == 0) {
p_wait_ed->trans_wait = 0; p_wait_ed->trans_wait = 0;

View File

@ -51,12 +51,12 @@ Exported global variables and functions (to be accessed by other files)
/* Endpoint Configuration Data Format */ /* Endpoint Configuration Data Format */
/********************************************************************************************************/ /********************************************************************************************************/
/* LINE1: Pipe Window Select Register */ /* LINE1: Pipe Window Select Register */
/* CPU Access PIPE : PIPE1 to PIPE9 [ ### SET ### ] */ /* CPU Access PIPE : USB_HOST_PIPE1 to USB_HOST_PIPE9 [ ### SET ### ] */
/* LINE2: Pipe Configuration Register */ /* LINE2: Pipe Configuration Register */
/* Transfer Type : USB_HOST_NONE [ USB_HOST_NONE ] */ /* Transfer Type : USB_HOST_NONE [ USB_HOST_NONE ] */
/* Buffer Ready interrupt : USB_HOST_NONE [ USB_HOST_NONE ] */ /* Buffer Ready interrupt : USB_HOST_NONE [ USB_HOST_NONE ] */
/* Double Buffer Mode : USB_HOST_CNT_ON / USB_HOST_CNT_OFF [ ### SET ### ] */ /* Double Buffer Mode : USB_HOST_DBLBON / USB_HOST_DBLBOFF [ ### SET ### ] */
/* Continuous Transmit: : USB_HOST_CNT_ON / USB_HOST_CNT_OFF [ ### SET ### ] */ /* Continuous Transmit: : USB_HOST_CNTMDON / USB_HOST_CNTMDOFF [ ### SET ### ] */
/* Short NAK : USB_HOST_NONE [ USB_HOST_NONE ] */ /* Short NAK : USB_HOST_NONE [ USB_HOST_NONE ] */
/* Transfer Direction : USB_HOST_NONE [ USB_HOST_NONE ] */ /* Transfer Direction : USB_HOST_NONE [ USB_HOST_NONE ] */
/* Endpoint Number : USB_HOST_NONE [ USB_HOST_NONE ] */ /* Endpoint Number : USB_HOST_NONE [ USB_HOST_NONE ] */
@ -72,8 +72,7 @@ Exported global variables and functions (to be accessed by other files)
/* LINE6: use FIFO port */ /* LINE6: use FIFO port */
/* : USB_HOST_CUSE [ ### SET ### ] */ /* : USB_HOST_CUSE [ ### SET ### ] */
/* : USB_HOST_D0USE / USB_HOST_D1USE */ /* : USB_HOST_D0USE / USB_HOST_D1USE */
/* : USB_HOST_D0DMA / USB_HOST_D0DMA */ /* : USB_HOST_D0DMA / USB_HOST_D0DMA */
/* LINE7: use FIFO port Endian : USB_HOST_FIFO_BIG / USB_HOST_FIFO_LITTLE [ #SET# ] */
/********************************************************************************************************/ /********************************************************************************************************/
/* Device Address 1 */ /* Device Address 1 */
@ -105,7 +104,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
{ {
USB_HOST_PIPE6, USB_HOST_PIPE6,
/* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */ /* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */
USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDON | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE, USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBOFF | USB_HOST_CNTMDOFF | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE,
(uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(40), (uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(40),
USB_HOST_NONE, USB_HOST_NONE,
USB_HOST_NONE, USB_HOST_NONE,
@ -115,7 +114,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
{ {
USB_HOST_PIPE7, USB_HOST_PIPE7,
/* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */ /* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */
USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDON | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE, USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBOFF | USB_HOST_CNTMDOFF | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE,
(uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(41), (uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(41),
USB_HOST_NONE, USB_HOST_NONE,
USB_HOST_NONE, USB_HOST_NONE,
@ -125,7 +124,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
{ {
USB_HOST_PIPE8, USB_HOST_PIPE8,
/* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */ /* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */
USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDON | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE, USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBOFF | USB_HOST_CNTMDOFF | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE,
(uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(42), (uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(42),
USB_HOST_NONE, USB_HOST_NONE,
USB_HOST_NONE, USB_HOST_NONE,
@ -135,7 +134,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
{ {
USB_HOST_PIPE9, USB_HOST_PIPE9,
/* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */ /* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */
USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDON | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE, USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBOFF | USB_HOST_CNTMDOFF | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE,
(uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(43), (uint16_t)((uint16_t)(((64) / 64) - 1) << 10) | (uint16_t)(43),
USB_HOST_NONE, USB_HOST_NONE,
USB_HOST_NONE, USB_HOST_NONE,
@ -158,7 +157,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_iso_ep_tbl1[ ] =
{ {
USB_HOST_PIPE1, USB_HOST_PIPE1,
/* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */ /* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */
USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDON | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE, USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDOFF | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE,
(uint16_t)((uint16_t)(((1024) / 64) - 1) << 10) | (uint16_t)(44), (uint16_t)((uint16_t)(((1024) / 64) - 1) << 10) | (uint16_t)(44),
USB_HOST_NONE, USB_HOST_NONE,
USB_HOST_NONE, USB_HOST_NONE,
@ -168,8 +167,8 @@ USB_HOST_CFG_PIPETBL_t usb_host_iso_ep_tbl1[ ] =
{ {
USB_HOST_PIPE2, USB_HOST_PIPE2,
/* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */ /* TYPE / BFRE / DBLB / CNTMD / SHTNAK / DIR / EPNUM */
USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDON | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE, USB_HOST_NONE | USB_HOST_NONE | USB_HOST_DBLBON | USB_HOST_CNTMDOFF | USB_HOST_NONE | USB_HOST_NONE | USB_HOST_NONE,
(uint16_t)((uint16_t)(((1024) / 64) - 1) << 10) | (uint16_t)(60), (uint16_t)((uint16_t)(((1024) / 64) - 1) << 10) | (uint16_t)(76),
USB_HOST_NONE, USB_HOST_NONE,
USB_HOST_NONE, USB_HOST_NONE,
USB_HOST_D1USE USB_HOST_D1USE

View File

@ -261,17 +261,7 @@ void USBHALHost::UsbIrqhandler() {
//Root device disconnected //Root device disconnected
else { else {
if (!(int_status & OR_INTR_STATUS_WDH)) {
usb_hcca->DoneHead = 0;
}
deviceDisconnected(0, 1, NULL, usb_hcca->DoneHead & 0xFFFFFFFE); deviceDisconnected(0, 1, NULL, usb_hcca->DoneHead & 0xFFFFFFFE);
if (int_status & OR_INTR_STATUS_WDH) {
usb_hcca->DoneHead = 0;
ohciwrapp_reg_w(OHCI_REG_INTERRUPTSTATUS, OR_INTR_STATUS_WDH);
}
} }
} }
ohciwrapp_reg_w(OHCI_REG_RHPORTSTATUS1, OR_RH_PORT_CSC); ohciwrapp_reg_w(OHCI_REG_RHPORTSTATUS1, OR_RH_PORT_CSC);