static int _complete(dwc_otg_pcd_t * pcd, void *ep_handle, void *req_handle, int32_t status, uint32_t actual) { struct usb_request *req = (struct usb_request *)req_handle; if (req && req->complete) { switch (status) { case -DWC_E_SHUTDOWN: req->status = -ESHUTDOWN; break; case -DWC_E_RESTART: req->status = -ECONNRESET; break; case -DWC_E_INVALID: req->status = -EINVAL; break; case -DWC_E_TIMEOUT: req->status = -ETIMEDOUT; break; default: req->status = status; } req->actual = actual; DWC_SPINUNLOCK(pcd->lock); req->complete(ep_handle, req); DWC_SPINLOCK(pcd->lock); } return 0; }
/** * This function handles the OTG Interrupts. It reads the OTG * Interrupt Register (GOTGINT) to determine what interrupt has * occurred. * * @param core_if Programming view of DWC_otg controller. */ int32_t dwc_otg_handle_otg_intr(dwc_otg_core_if_t * core_if) { dwc_otg_core_global_regs_t *global_regs = core_if->core_global_regs; gotgint_data_t gotgint; gotgctl_data_t gotgctl; gintmsk_data_t gintmsk; gpwrdn_data_t gpwrdn; gotgint.d32 = DWC_READ_REG32(&global_regs->gotgint); gotgctl.d32 = DWC_READ_REG32(&global_regs->gotgctl); DWC_DEBUGPL(DBG_CIL, "++OTG Interrupt gotgint=%0x [%s]\n", gotgint.d32, op_state_str(core_if)); if (gotgint.b.sesenddet) { DWC_DEBUGPL(DBG_ANY, " ++OTG Interrupt: " "Session End Detected++ (%s)\n", op_state_str(core_if)); gotgctl.d32 = DWC_READ_REG32(&global_regs->gotgctl); if (core_if->op_state == B_HOST) { cil_pcd_start(core_if); core_if->op_state = B_PERIPHERAL; } else { /* If not B_HOST and Device HNP still set. HNP * Did not succeed!*/ if (gotgctl.b.devhnpen) { DWC_DEBUGPL(DBG_ANY, "Session End Detected\n"); __DWC_ERROR("Device Not Connected/Responding!\n"); } /* If Session End Detected the B-Cable has * been disconnected. */ /* Reset PCD and Gadget driver to a * clean state. */ core_if->lx_state = DWC_OTG_L0; DWC_SPINUNLOCK(core_if->lock); cil_pcd_stop(core_if); DWC_SPINLOCK(core_if->lock); if (core_if->adp_enable) { if (core_if->power_down == 2) { gpwrdn.d32 = 0; gpwrdn.b.pwrdnswtch = 1; DWC_MODIFY_REG32(&core_if-> core_global_regs-> gpwrdn, gpwrdn.d32, 0); } gpwrdn.d32 = 0; gpwrdn.b.pmuintsel = 1; gpwrdn.b.pmuactv = 1; DWC_MODIFY_REG32(&core_if->core_global_regs-> gpwrdn, 0, gpwrdn.d32); dwc_otg_adp_sense_start(core_if); } } gotgctl.d32 = 0; gotgctl.b.devhnpen = 1; DWC_MODIFY_REG32(&global_regs->gotgctl, gotgctl.d32, 0); } if (gotgint.b.sesreqsucstschng) { DWC_DEBUGPL(DBG_ANY, " ++OTG Interrupt: " "Session Reqeust Success Status Change++\n"); gotgctl.d32 = DWC_READ_REG32(&global_regs->gotgctl); if (gotgctl.b.sesreqscs) { if ((core_if->core_params->phy_type == DWC_PHY_TYPE_PARAM_FS) && (core_if->core_params->i2c_enable)) { core_if->srp_success = 1; } else { DWC_SPINUNLOCK(core_if->lock); cil_pcd_resume(core_if); DWC_SPINLOCK(core_if->lock); /* Clear Session Request */ gotgctl.d32 = 0; gotgctl.b.sesreq = 1; DWC_MODIFY_REG32(&global_regs->gotgctl, gotgctl.d32, 0); } } } if (gotgint.b.hstnegsucstschng) { /* Print statements during the HNP interrupt handling * can cause it to fail.*/ gotgctl.d32 = DWC_READ_REG32(&global_regs->gotgctl); /* WA for 3.00a- HW is not setting cur_mode, even sometimes * this does not help*/ if (core_if->snpsid >= OTG_CORE_REV_3_00a) dwc_udelay(100); if (gotgctl.b.hstnegscs) { if (dwc_otg_is_host_mode(core_if)) { core_if->op_state = B_HOST; /* * Need to disable SOF interrupt immediately. * When switching from device to host, the PCD * interrupt handler won't handle the * interrupt if host mode is already set. The * HCD interrupt handler won't get called if * the HCD state is HALT. This means that the * interrupt does not get handled and Linux * complains loudly. */ gintmsk.d32 = 0; gintmsk.b.sofintr = 1; DWC_MODIFY_REG32(&global_regs->gintmsk, gintmsk.d32, 0); /* Call callback function with spin lock released */ DWC_SPINUNLOCK(core_if->lock); cil_pcd_stop(core_if); /* * Initialize the Core for Host mode. */ cil_hcd_start(core_if); DWC_SPINLOCK(core_if->lock); core_if->op_state = B_HOST; } } else { gotgctl.d32 = 0; gotgctl.b.hnpreq = 1; gotgctl.b.devhnpen = 1; DWC_MODIFY_REG32(&global_regs->gotgctl, gotgctl.d32, 0); DWC_DEBUGPL(DBG_ANY, "HNP Failed\n"); __DWC_ERROR("Device Not Connected/Responding\n"); } } if (gotgint.b.hstnegdet) { /* The disconnect interrupt is set at the same time as * Host Negotiation Detected. During the mode * switch all interrupts are cleared so the disconnect * interrupt handler will not get executed. */ DWC_DEBUGPL(DBG_ANY, " ++OTG Interrupt: " "Host Negotiation Detected++ (%s)\n", (dwc_otg_is_host_mode(core_if) ? "Host" : "Device")); if (dwc_otg_is_device_mode(core_if)) { DWC_DEBUGPL(DBG_ANY, "a_suspend->a_peripheral (%d)\n", core_if->op_state); DWC_SPINUNLOCK(core_if->lock); cil_hcd_disconnect(core_if); cil_pcd_start(core_if); DWC_SPINLOCK(core_if->lock); core_if->op_state = A_PERIPHERAL; } else { /* * Need to disable SOF interrupt immediately. When * switching from device to host, the PCD interrupt * handler won't handle the interrupt if host mode is * already set. The HCD interrupt handler won't get * called if the HCD state is HALT. This means that * the interrupt does not get handled and Linux * complains loudly. */ gintmsk.d32 = 0; gintmsk.b.sofintr = 1; DWC_MODIFY_REG32(&global_regs->gintmsk, gintmsk.d32, 0); DWC_SPINUNLOCK(core_if->lock); cil_pcd_stop(core_if); cil_hcd_start(core_if); DWC_SPINLOCK(core_if->lock); core_if->op_state = A_HOST; } } if (gotgint.b.adevtoutchng) { DWC_DEBUGPL(DBG_ANY, " ++OTG Interrupt: " "A-Device Timeout Change++\n"); } if (gotgint.b.debdone) { DWC_DEBUGPL(DBG_ANY, " ++OTG Interrupt: " "Debounce Done++\n"); } /* Clear GOTGINT */ DWC_WRITE_REG32(&core_if->core_global_regs->gotgint, gotgint.d32); return 1; }
void w_conn_id_status_change(void *p) { dwc_otg_core_if_t *core_if = p; uint32_t count = 0; gotgctl_data_t gotgctl = {.d32 = 0 }; gotgctl.d32 = DWC_READ_REG32(&core_if->core_global_regs->gotgctl); DWC_DEBUGPL(DBG_CIL, "gotgctl=%0x\n", gotgctl.d32); DWC_DEBUGPL(DBG_CIL, "gotgctl.b.conidsts=%d\n", gotgctl.b.conidsts); /* B-Device connector (Device Mode) */ if (gotgctl.b.conidsts) { /* Wait for switch to device mode. */ while (!dwc_otg_is_device_mode(core_if)) { DWC_PRINTF("Waiting for Peripheral Mode, Mode=%s\n", (dwc_otg_is_host_mode(core_if) ? "Host" : "Peripheral")); dwc_mdelay(100); if (++count > 10000) break; } DWC_ASSERT(++count < 10000, "Connection id status change timed out"); core_if->op_state = B_PERIPHERAL; #if defined(CONFIG_BATTERY_NXE2000) otgid_power_control_by_dwc(0); #elif defined(CONFIG_KP_AXP22) axp_otg_power_control(0); #endif dwc_otg_set_prtpower(core_if, 0); core_if->host_flag = 0; dwc_otg_core_init(core_if); dwc_otg_enable_global_interrupts(core_if); cil_pcd_start(core_if); } else { /* A-Device connector (Host Mode) */ while (!dwc_otg_is_host_mode(core_if)) { DWC_PRINTF("Waiting for Host Mode, Mode=%s\n", (dwc_otg_is_host_mode(core_if) ? "Host" : "Peripheral")); dwc_mdelay(100); if (++count > 10000) break; } DWC_ASSERT(++count < 10000, "Connection id status change timed out"); core_if->op_state = A_HOST; /* * Initialize the Core for Host mode. */ core_if->host_flag = 1; dwc_otg_core_init(core_if); dwc_otg_enable_global_interrupts(core_if); cil_hcd_start(core_if); } } /** * This function handles the Connector ID Status Change Interrupt. It * reads the OTG Interrupt Register (GOTCTL) to determine whether this * is a Device to Host Mode transition or a Host Mode to Device * Transition. * * This only occurs when the cable is connected/removed from the PHY * connector. * * @param core_if Programming view of DWC_otg controller. */ int32_t dwc_otg_handle_conn_id_status_change_intr(dwc_otg_core_if_t * core_if) { /* * Need to disable SOF interrupt immediately. If switching from device * to host, the PCD interrupt handler won't handle the interrupt if * host mode is already set. The HCD interrupt handler won't get * called if the HCD state is HALT. This means that the interrupt does * not get handled and Linux complains loudly. */ gintmsk_data_t gintmsk = {.d32 = 0 }; gintsts_data_t gintsts = {.d32 = 0 }; gintmsk.b.sofintr = 1; DWC_MODIFY_REG32(&core_if->core_global_regs->gintmsk, gintmsk.d32, 0); DWC_DEBUGPL(DBG_CIL, " ++Connector ID Status Change Interrupt++ (%s)\n", (dwc_otg_is_host_mode(core_if) ? "Host" : "Device")); DWC_SPINUNLOCK(core_if->lock); /* * Need to schedule a work, as there are possible DELAY function calls * Release lock before scheduling workq as it holds spinlock during scheduling */ DWC_WORKQ_SCHEDULE(core_if->wq_otg, w_conn_id_status_change, core_if, "connection id status change"); DWC_SPINLOCK(core_if->lock); /* Set flag and clear interrupt */ gintsts.b.conidstschng = 1; DWC_WRITE_REG32(&core_if->core_global_regs->gintsts, gintsts.d32); return 1; } /** * This interrupt indicates that a device is initiating the Session * Request Protocol to request the host to turn on bus power so a new * session can begin. The handler responds by turning on bus power. If * the DWC_otg controller is in low power mode, the handler brings the * controller out of low power mode before turning on bus power. * * @param core_if Programming view of DWC_otg controller. */ int32_t dwc_otg_handle_session_req_intr(dwc_otg_core_if_t * core_if) { gintsts_data_t gintsts; #ifndef DWC_HOST_ONLY DWC_DEBUGPL(DBG_ANY, "++Session Request Interrupt++\n"); if (dwc_otg_is_device_mode(core_if)) { DWC_PRINTF("SRP: Device mode\n"); } else { hprt0_data_t hprt0; DWC_PRINTF("SRP: Host mode\n"); /* Turn on the port power bit. */ hprt0.d32 = dwc_otg_read_hprt0(core_if); hprt0.b.prtpwr = 1; DWC_WRITE_REG32(core_if->host_if->hprt0, hprt0.d32); /* Start the Connection timer. So a message can be displayed * if connect does not occur within 10 seconds. */ cil_hcd_session_start(core_if); } #endif /* Clear interrupt */ gintsts.d32 = 0; gintsts.b.sessreqintr = 1; DWC_WRITE_REG32(&core_if->core_global_regs->gintsts, gintsts.d32); return 1; } void w_wakeup_detected(void *p) { dwc_otg_core_if_t *core_if = (dwc_otg_core_if_t *) p; /* * Clear the Resume after 70ms. (Need 20 ms minimum. Use 70 ms * so that OPT tests pass with all PHYs). */ hprt0_data_t hprt0 = {.d32 = 0 }; #if 0 pcgcctl_data_t pcgcctl = {.d32 = 0 }; /* Restart the Phy Clock */ pcgcctl.b.stoppclk = 1; DWC_MODIFY_REG32(core_if->pcgcctl, pcgcctl.d32, 0); dwc_udelay(10); #endif //0 hprt0.d32 = dwc_otg_read_hprt0(core_if); DWC_DEBUGPL(DBG_ANY, "Resume: HPRT0=%0x\n", hprt0.d32); // dwc_mdelay(70); hprt0.b.prtres = 0; /* Resume */ DWC_WRITE_REG32(core_if->host_if->hprt0, hprt0.d32); DWC_DEBUGPL(DBG_ANY, "Clear Resume: HPRT0=%0x\n", DWC_READ_REG32(core_if->host_if->hprt0)); cil_hcd_resume(core_if); /** Change to L0 state*/ core_if->lx_state = DWC_OTG_L0; } /** * This interrupt indicates that the DWC_otg controller has detected a * resume or remote wakeup sequence. If the DWC_otg controller is in * low power mode, the handler must brings the controller out of low * power mode. The controller automatically begins resume * signaling. The handler schedules a time to stop resume signaling. */ int32_t dwc_otg_handle_wakeup_detected_intr(dwc_otg_core_if_t * core_if) { gintsts_data_t gintsts; DWC_DEBUGPL(DBG_ANY, "++Resume and Remote Wakeup Detected Interrupt++\n"); DWC_PRINTF("%s lxstate = %d\n", __func__, core_if->lx_state); if (dwc_otg_is_device_mode(core_if)) { dctl_data_t dctl = {.d32 = 0 }; DWC_DEBUGPL(DBG_PCD, "DSTS=0x%0x\n", DWC_READ_REG32(&core_if->dev_if->dev_global_regs-> dsts)); if (core_if->lx_state == DWC_OTG_L2) { #ifdef PARTIAL_POWER_DOWN if (core_if->hwcfg4.b.power_optimiz) { pcgcctl_data_t power = {.d32 = 0 }; power.d32 = DWC_READ_REG32(core_if->pcgcctl); DWC_DEBUGPL(DBG_CIL, "PCGCCTL=%0x\n", power.d32); power.b.stoppclk = 0; DWC_WRITE_REG32(core_if->pcgcctl, power.d32); power.b.pwrclmp = 0; DWC_WRITE_REG32(core_if->pcgcctl, power.d32); power.b.rstpdwnmodule = 0; DWC_WRITE_REG32(core_if->pcgcctl, power.d32); } #endif /* Clear the Remote Wakeup Signaling */ dctl.b.rmtwkupsig = 1; DWC_MODIFY_REG32(&core_if->dev_if->dev_global_regs-> dctl, dctl.d32, 0); DWC_SPINUNLOCK(core_if->lock); if (core_if->pcd_cb && core_if->pcd_cb->resume_wakeup) { core_if->pcd_cb->resume_wakeup(core_if->pcd_cb->p); } DWC_SPINLOCK(core_if->lock); } else { glpmcfg_data_t lpmcfg; lpmcfg.d32 = DWC_READ_REG32(&core_if->core_global_regs->glpmcfg); lpmcfg.b.hird_thres &= (~(1 << 4)); DWC_WRITE_REG32(&core_if->core_global_regs->glpmcfg, lpmcfg.d32); } /** Change to L0 state*/ core_if->lx_state = DWC_OTG_L0; } else { if (core_if->lx_state != DWC_OTG_L1) { pcgcctl_data_t pcgcctl = {.d32 = 0 }; /* Restart the Phy Clock */ pcgcctl.b.stoppclk = 1; DWC_MODIFY_REG32(core_if->pcgcctl, pcgcctl.d32, 0); DWC_TIMER_SCHEDULE(core_if->wkp_timer, 71); } else { /** Change to L0 state*/ core_if->lx_state = DWC_OTG_L0; } }