mirror of https://github.com/ARMmbed/mbed-os.git
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
parent
3f2632bebc
commit
0046b63862
|
@ -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 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 uint32_t iso_chk_starting_frame(genelal_ed_t *p_g_ed);
|
||||
static void iso_trans(genelal_ed_t *p_g_ed);
|
||||
#endif
|
||||
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 osSemaphoreId semid_cb = NULL;
|
||||
static uint32_t connect_change = 0xFFFFFFFF;
|
||||
static uint32_t connect_status = 0;
|
||||
static uint32_t init_end = 0;
|
||||
static genelal_ed_t ctl_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) {
|
||||
iso_ed_task(argument);
|
||||
}
|
||||
osThreadDef(iso_ed_task_1, osPriorityNormal, 512);
|
||||
osThreadDef(iso_ed_task_1, osPriorityAboveNormal, 512);
|
||||
#endif
|
||||
#if (ISO_TRANS_MAX_NUM >= 2)
|
||||
static void iso_ed_task_2(void const * argument) {
|
||||
iso_ed_task(argument);
|
||||
}
|
||||
osThreadDef(iso_ed_task_2, osPriorityNormal, 512);
|
||||
osThreadDef(iso_ed_task_2, osPriorityAboveNormal, 512);
|
||||
#endif
|
||||
|
||||
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->trans_wait = 1;
|
||||
|
||||
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];
|
||||
|
||||
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);
|
||||
if (connect_status == 0) {
|
||||
ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
|
||||
} 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);
|
||||
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_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 {
|
||||
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);
|
||||
|
@ -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);
|
||||
|
||||
p_g_ed->trans_wait = 1;
|
||||
if (td_info.direction == 1) {
|
||||
usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
|
||||
if (connect_status == 0) {
|
||||
ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
|
||||
} 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);
|
||||
usbx_host_stop_transfer(p_g_ed->pipe_no);
|
||||
(void)osSemaphoreWait(p_g_ed->semid_wait, BLK_TRANS_TIMEOUT);
|
||||
usbx_host_stop_transfer(p_g_ed->pipe_no);
|
||||
}
|
||||
}
|
||||
|
||||
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);
|
||||
p_g_ed->trans_wait = 1;
|
||||
if (td_info.direction == 1) {
|
||||
usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
|
||||
if (connect_status == 0) {
|
||||
ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
|
||||
} 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) {
|
||||
genelal_ed_t *p_iso_ed = &iso_ed[(uint32_t)argument];
|
||||
uint32_t wait_cnt = 0;
|
||||
uint32_t wait_time = 0;
|
||||
hcca_t *p_hcca;
|
||||
hced_t *p_ed;
|
||||
|
||||
|
@ -1115,17 +1125,26 @@ static void iso_ed_task(void const * argument) {
|
|||
if (p_iso_ed->p_curr_ed != NULL) {
|
||||
while ((p_usb_reg->HcControl & OR_CONTROL_IE) != 0) {
|
||||
if (chk_iso_ed(p_iso_ed) != 0) {
|
||||
wait_time = iso_chk_starting_frame(p_iso_ed);
|
||||
if (wait_time != 0) {
|
||||
osDelay(wait_time);
|
||||
p_usb_reg->HcFmNumber += wait_time;
|
||||
p_usb_reg->HcFmNumber &= 0x0000FFFF;
|
||||
hcisotd_t *p_isotd = (hcisotd_t *)p_iso_ed->p_curr_td;
|
||||
uint32_t starting_frame = p_isotd->control & 0x0000FFFF;
|
||||
uint32_t wait_time = 0;
|
||||
uint32_t wk_HcFmNumber = p_usb_reg->HcFmNumber;
|
||||
|
||||
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;
|
||||
iso_trans(p_iso_ed);
|
||||
(void)osSemaphoreWait(p_iso_ed->semid_wait, osWaitForever);
|
||||
usbx_host_stop_transfer(p_iso_ed->pipe_no);
|
||||
wait_cnt = 1;
|
||||
wait_cnt = 8;
|
||||
} else {
|
||||
if (wait_cnt > 0) {
|
||||
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);
|
||||
}
|
||||
|
||||
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) {
|
||||
hcisotd_t *p_isotd = (hcisotd_t *)p_g_ed->p_curr_td;
|
||||
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);
|
||||
p_g_ed->trans_wait = 1;
|
||||
if (td_info.direction == 1) {
|
||||
usbx_host_start_send_transfer(p_g_ed->pipe_no, data_size, (uint8_t *)buff_addr);
|
||||
if (connect_status == 0) {
|
||||
ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
|
||||
} 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
|
||||
|
@ -1326,6 +1337,7 @@ static void connect_check(void) {
|
|||
void ohciwrapp_loc_Connect(uint32_t type) {
|
||||
uint32_t cnt;
|
||||
|
||||
connect_status = type;
|
||||
connect_change = type;
|
||||
if (type == 0) {
|
||||
if (ctl_ed.trans_wait == 1) {
|
||||
|
@ -1445,11 +1457,7 @@ void ohciwrapp_loc_TransEnd(uint32_t pipe, uint32_t ConditionCode) {
|
|||
|
||||
if (p_isotd != NULL) {
|
||||
usbx_host_stop_transfer(pipe);
|
||||
if (p_usb_reg->HcFmNumber < 0x0000FFFF) {
|
||||
p_usb_reg->HcFmNumber++;
|
||||
} else {
|
||||
p_usb_reg->HcFmNumber = 0;
|
||||
}
|
||||
p_usb_reg->HcFmNumber = ((p_isotd->control & 0x0000FFFF) + p_wait_ed->psw_idx) & 0x0000FFFF;
|
||||
|
||||
/* Size of packet */
|
||||
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++;
|
||||
}
|
||||
if (chk_iso_ed(p_wait_ed) != 0) {
|
||||
if (iso_chk_starting_frame(p_wait_ed) == 0) {
|
||||
iso_trans(p_wait_ed);
|
||||
next_trans = 1;
|
||||
}
|
||||
iso_trans(p_wait_ed);
|
||||
next_trans = 1;
|
||||
}
|
||||
if (next_trans == 0) {
|
||||
p_wait_ed->trans_wait = 0;
|
||||
|
|
|
@ -51,12 +51,12 @@ Exported global variables and functions (to be accessed by other files)
|
|||
/* Endpoint Configuration Data Format */
|
||||
/********************************************************************************************************/
|
||||
/* 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 */
|
||||
/* Transfer Type : 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 ### ] */
|
||||
/* Continuous Transmit: : USB_HOST_CNT_ON / USB_HOST_CNT_OFF [ ### SET ### ] */
|
||||
/* Double Buffer Mode : USB_HOST_DBLBON / USB_HOST_DBLBOFF [ ### SET ### ] */
|
||||
/* Continuous Transmit: : USB_HOST_CNTMDON / USB_HOST_CNTMDOFF [ ### SET ### ] */
|
||||
/* Short NAK : USB_HOST_NONE [ USB_HOST_NONE ] */
|
||||
/* Transfer Direction : 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 */
|
||||
/* : USB_HOST_CUSE [ ### SET ### ] */
|
||||
/* : USB_HOST_D0USE / USB_HOST_D1USE */
|
||||
/* : USB_HOST_D0DMA / USB_HOST_D0DMA */
|
||||
/* LINE7: use FIFO port Endian : USB_HOST_FIFO_BIG / USB_HOST_FIFO_LITTLE [ #SET# ] */
|
||||
/* : USB_HOST_D0DMA / USB_HOST_D0DMA */
|
||||
/********************************************************************************************************/
|
||||
|
||||
/* Device Address 1 */
|
||||
|
@ -105,7 +104,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
|
|||
{
|
||||
USB_HOST_PIPE6,
|
||||
/* 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),
|
||||
USB_HOST_NONE,
|
||||
USB_HOST_NONE,
|
||||
|
@ -115,7 +114,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
|
|||
{
|
||||
USB_HOST_PIPE7,
|
||||
/* 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),
|
||||
USB_HOST_NONE,
|
||||
USB_HOST_NONE,
|
||||
|
@ -125,7 +124,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
|
|||
{
|
||||
USB_HOST_PIPE8,
|
||||
/* 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),
|
||||
USB_HOST_NONE,
|
||||
USB_HOST_NONE,
|
||||
|
@ -135,7 +134,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[ ] =
|
|||
{
|
||||
USB_HOST_PIPE9,
|
||||
/* 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),
|
||||
USB_HOST_NONE,
|
||||
USB_HOST_NONE,
|
||||
|
@ -158,7 +157,7 @@ USB_HOST_CFG_PIPETBL_t usb_host_iso_ep_tbl1[ ] =
|
|||
{
|
||||
USB_HOST_PIPE1,
|
||||
/* 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),
|
||||
USB_HOST_NONE,
|
||||
USB_HOST_NONE,
|
||||
|
@ -168,8 +167,8 @@ USB_HOST_CFG_PIPETBL_t usb_host_iso_ep_tbl1[ ] =
|
|||
{
|
||||
USB_HOST_PIPE2,
|
||||
/* 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,
|
||||
(uint16_t)((uint16_t)(((1024) / 64) - 1) << 10) | (uint16_t)(60),
|
||||
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)(76),
|
||||
USB_HOST_NONE,
|
||||
USB_HOST_NONE,
|
||||
USB_HOST_D1USE
|
||||
|
|
|
@ -261,17 +261,7 @@ void USBHALHost::UsbIrqhandler() {
|
|||
|
||||
//Root device disconnected
|
||||
else {
|
||||
|
||||
if (!(int_status & OR_INTR_STATUS_WDH)) {
|
||||
usb_hcca->DoneHead = 0;
|
||||
}
|
||||
|
||||
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);
|
||||
|
|
Loading…
Reference in New Issue