Merge "dwc3-msm: Fix dwc3_drd_state_string for undefined state"
This commit is contained in:
commit
9c3d573678
1 changed files with 79 additions and 33 deletions
|
@ -1,4 +1,4 @@
|
|||
/* Copyright (c) 2012-2018, The Linux Foundation. All rights reserved.
|
||||
/* Copyright (c) 2012-2019, The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 and
|
||||
|
@ -130,6 +130,34 @@ struct dwc3_msm_req_complete {
|
|||
struct usb_request *req);
|
||||
};
|
||||
|
||||
enum dwc3_drd_state {
|
||||
DRD_STATE_UNDEFINED = 0,
|
||||
|
||||
DRD_STATE_IDLE,
|
||||
DRD_STATE_PERIPHERAL,
|
||||
DRD_STATE_PERIPHERAL_SUSPEND,
|
||||
|
||||
DRD_STATE_HOST_IDLE,
|
||||
DRD_STATE_HOST,
|
||||
};
|
||||
|
||||
static const char *const state_names[] = {
|
||||
[DRD_STATE_UNDEFINED] = "undefined",
|
||||
[DRD_STATE_IDLE] = "idle",
|
||||
[DRD_STATE_PERIPHERAL] = "peripheral",
|
||||
[DRD_STATE_PERIPHERAL_SUSPEND] = "peripheral_suspend",
|
||||
[DRD_STATE_HOST_IDLE] = "host_idle",
|
||||
[DRD_STATE_HOST] = "host",
|
||||
};
|
||||
|
||||
static const char *dwc3_drd_state_string(enum dwc3_drd_state state)
|
||||
{
|
||||
if (state < 0 || state >= ARRAY_SIZE(state_names))
|
||||
return "UNKNOWN";
|
||||
|
||||
return state_names[state];
|
||||
}
|
||||
|
||||
enum dwc3_id_state {
|
||||
DWC3_ID_GROUND = 0,
|
||||
DWC3_ID_FLOAT,
|
||||
|
@ -147,6 +175,7 @@ enum plug_orientation {
|
|||
#define ID 0
|
||||
#define B_SESS_VLD 1
|
||||
#define B_SUSPEND 2
|
||||
#define WAIT_FOR_LPM 3
|
||||
|
||||
#define PM_QOS_SAMPLE_SEC 2
|
||||
#define PM_QOS_THRESHOLD 400
|
||||
|
@ -193,7 +222,7 @@ struct dwc3_msm {
|
|||
unsigned long inputs;
|
||||
unsigned max_power;
|
||||
bool charging_disabled;
|
||||
enum usb_otg_state otg_state;
|
||||
enum dwc3_drd_state drd_state;
|
||||
enum usb_chg_state chg_state;
|
||||
struct work_struct bus_vote_w;
|
||||
unsigned int bus_vote;
|
||||
|
@ -1928,7 +1957,7 @@ static void dwc3_msm_power_collapse_por(struct dwc3_msm *mdwc)
|
|||
atomic_set(&mdwc->in_p3, val == DWC3_LINK_STATE_U3);
|
||||
dwc3_msm_write_reg_field(mdwc->base, PWR_EVNT_IRQ_MASK_REG,
|
||||
PWR_EVNT_POWERDOWN_IN_P3_MASK, 1);
|
||||
if (mdwc->otg_state == OTG_STATE_A_HOST) {
|
||||
if (mdwc->drd_state == DRD_STATE_HOST) {
|
||||
dev_dbg(mdwc->dev, "%s: set the core in host mode\n",
|
||||
__func__);
|
||||
dwc3_set_mode(dwc, DWC3_GCTL_PRTCAP_HOST);
|
||||
|
@ -2052,7 +2081,7 @@ static int dwc3_msm_suspend(struct dwc3_msm *mdwc, bool hibernation)
|
|||
}
|
||||
|
||||
if (!mdwc->vbus_active && dwc->is_drd &&
|
||||
mdwc->otg_state == OTG_STATE_B_PERIPHERAL) {
|
||||
mdwc->drd_state == DRD_STATE_PERIPHERAL) {
|
||||
/*
|
||||
* In some cases, the pm_runtime_suspend may be called by
|
||||
* usb_bam when there is pending lpm flag. However, if this is
|
||||
|
@ -2074,7 +2103,7 @@ static int dwc3_msm_suspend(struct dwc3_msm *mdwc, bool hibernation)
|
|||
* then check controller state of L2 and break
|
||||
* LPM sequence. Check this for device bus suspend case.
|
||||
*/
|
||||
if ((dwc->is_drd && mdwc->otg_state == OTG_STATE_B_SUSPEND) &&
|
||||
if ((dwc->is_drd && mdwc->drd_state == DRD_STATE_PERIPHERAL_SUSPEND) &&
|
||||
(dwc->gadget.state != USB_STATE_CONFIGURED)) {
|
||||
pr_err("%s(): Trying to go in LPM with state:%d\n",
|
||||
__func__, dwc->gadget.state);
|
||||
|
@ -2187,7 +2216,13 @@ static int dwc3_msm_suspend(struct dwc3_msm *mdwc, bool hibernation)
|
|||
}
|
||||
|
||||
dev_info(mdwc->dev, "DWC3 in low power mode\n");
|
||||
|
||||
/* kick_sm if it is waiting for lpm sequence to finish */
|
||||
if (test_and_clear_bit(WAIT_FOR_LPM, &mdwc->inputs))
|
||||
schedule_delayed_work(&mdwc->sm_work, 0);
|
||||
|
||||
mutex_unlock(&mdwc->suspend_resume_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -3697,6 +3732,9 @@ static int dwc3_otg_start_host(struct dwc3_msm *mdwc, int on)
|
|||
if (!mdwc->host_only_mode)
|
||||
dwc3_post_host_reset_core_init(dwc);
|
||||
|
||||
/* wait for LPM, to ensure h/w is reset after stop_host */
|
||||
set_bit(WAIT_FOR_LPM, &mdwc->inputs);
|
||||
|
||||
pm_runtime_mark_last_busy(mdwc->dev);
|
||||
pm_runtime_put_sync_autosuspend(mdwc->dev);
|
||||
dbg_event(0xFF, "StopHost psync",
|
||||
|
@ -3777,6 +3815,9 @@ static int dwc3_otg_start_peripheral(struct dwc3_msm *mdwc, int on)
|
|||
usb_phy_notify_disconnect(mdwc->ss_phy, USB_SPEED_SUPER);
|
||||
dwc3_override_vbus_status(mdwc, false);
|
||||
dwc3_usb3_phy_suspend(dwc, false);
|
||||
|
||||
/* wait for LPM, to ensure h/w is reset after stop_peripheral */
|
||||
set_bit(WAIT_FOR_LPM, &mdwc->inputs);
|
||||
}
|
||||
|
||||
pm_runtime_put_sync(mdwc->dev);
|
||||
|
@ -3846,7 +3887,7 @@ set_prop:
|
|||
*
|
||||
* @w: Pointer to the dwc3 otg workqueue
|
||||
*
|
||||
* NOTE: After any change in otg_state, we must reschdule the state machine.
|
||||
* NOTE: After any change in drd_state, we must reschdule the state machine.
|
||||
*/
|
||||
static void dwc3_otg_sm_work(struct work_struct *w)
|
||||
{
|
||||
|
@ -3865,13 +3906,13 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
return;
|
||||
}
|
||||
|
||||
state = usb_otg_state_string(mdwc->otg_state);
|
||||
state = dwc3_drd_state_string(mdwc->drd_state);
|
||||
dev_dbg(mdwc->dev, "%s state\n", state);
|
||||
dbg_event(0xFF, state, 0);
|
||||
|
||||
/* Check OTG state */
|
||||
switch (mdwc->otg_state) {
|
||||
case OTG_STATE_UNDEFINED:
|
||||
switch (mdwc->drd_state) {
|
||||
case DRD_STATE_UNDEFINED:
|
||||
/* put controller and phy in suspend if no cable connected */
|
||||
if (test_bit(ID, &mdwc->inputs) &&
|
||||
!test_bit(B_SESS_VLD, &mdwc->inputs)) {
|
||||
|
@ -3883,19 +3924,24 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
pm_runtime_put_sync(mdwc->dev);
|
||||
dbg_event(0xFF, "Undef NoUSB",
|
||||
atomic_read(&mdwc->dev->power.usage_count));
|
||||
mdwc->otg_state = OTG_STATE_B_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_IDLE;
|
||||
break;
|
||||
}
|
||||
|
||||
dbg_event(0xFF, "Exit UNDEF", 0);
|
||||
mdwc->otg_state = OTG_STATE_B_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_IDLE;
|
||||
pm_runtime_set_suspended(mdwc->dev);
|
||||
pm_runtime_enable(mdwc->dev);
|
||||
/* fall-through */
|
||||
case OTG_STATE_B_IDLE:
|
||||
case DRD_STATE_IDLE:
|
||||
if (test_bit(WAIT_FOR_LPM, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "still not in lpm, wait.\n");
|
||||
break;
|
||||
}
|
||||
|
||||
if (!test_bit(ID, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "!id\n");
|
||||
mdwc->otg_state = OTG_STATE_A_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_HOST_IDLE;
|
||||
work = 1;
|
||||
} else if (test_bit(B_SESS_VLD, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "b_sess_vld\n");
|
||||
|
@ -3905,14 +3951,14 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
msecs_to_jiffies(SDP_CONNETION_CHECK_TIME));
|
||||
/*
|
||||
* Increment pm usage count upon cable connect. Count
|
||||
* is decremented in OTG_STATE_B_PERIPHERAL state on
|
||||
* is decremented in DRD_STATE_PERIPHERAL state on
|
||||
* cable disconnect or in bus suspend.
|
||||
*/
|
||||
pm_runtime_get_sync(mdwc->dev);
|
||||
dbg_event(0xFF, "BIDLE gsync",
|
||||
atomic_read(&mdwc->dev->power.usage_count));
|
||||
dwc3_otg_start_peripheral(mdwc, 1);
|
||||
mdwc->otg_state = OTG_STATE_B_PERIPHERAL;
|
||||
mdwc->drd_state = DRD_STATE_PERIPHERAL;
|
||||
work = 1;
|
||||
break;
|
||||
} else {
|
||||
|
@ -3922,17 +3968,17 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
}
|
||||
break;
|
||||
|
||||
case OTG_STATE_B_PERIPHERAL:
|
||||
case DRD_STATE_PERIPHERAL:
|
||||
if (!test_bit(B_SESS_VLD, &mdwc->inputs) ||
|
||||
!test_bit(ID, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "!id || !bsv\n");
|
||||
mdwc->otg_state = OTG_STATE_B_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_IDLE;
|
||||
cancel_delayed_work_sync(&mdwc->sdp_check);
|
||||
dwc3_otg_start_peripheral(mdwc, 0);
|
||||
/*
|
||||
* Decrement pm usage count upon cable disconnect
|
||||
* which was incremented upon cable connect in
|
||||
* OTG_STATE_B_IDLE state
|
||||
* DRD_STATE_IDLE state
|
||||
*/
|
||||
pm_runtime_put_sync(mdwc->dev);
|
||||
dbg_event(0xFF, "!BSV psync",
|
||||
|
@ -3941,13 +3987,13 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
} else if (test_bit(B_SUSPEND, &mdwc->inputs) &&
|
||||
test_bit(B_SESS_VLD, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "BPER bsv && susp\n");
|
||||
mdwc->otg_state = OTG_STATE_B_SUSPEND;
|
||||
mdwc->drd_state = DRD_STATE_PERIPHERAL_SUSPEND;
|
||||
/*
|
||||
* Decrement pm usage count upon bus suspend.
|
||||
* Count was incremented either upon cable
|
||||
* connect in OTG_STATE_B_IDLE or host
|
||||
* connect in DRD_STATE_IDLE or host
|
||||
* initiated resume after bus suspend in
|
||||
* OTG_STATE_B_SUSPEND state
|
||||
* DRD_STATE_PERIPHERAL_SUSPEND state
|
||||
*/
|
||||
pm_runtime_mark_last_busy(mdwc->dev);
|
||||
pm_runtime_put_autosuspend(mdwc->dev);
|
||||
|
@ -3956,20 +4002,20 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
}
|
||||
break;
|
||||
|
||||
case OTG_STATE_B_SUSPEND:
|
||||
case DRD_STATE_PERIPHERAL_SUSPEND:
|
||||
if (!test_bit(B_SESS_VLD, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "BSUSP: !bsv\n");
|
||||
mdwc->otg_state = OTG_STATE_B_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_IDLE;
|
||||
cancel_delayed_work_sync(&mdwc->sdp_check);
|
||||
dwc3_otg_start_peripheral(mdwc, 0);
|
||||
} else if (!test_bit(B_SUSPEND, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "BSUSP !susp\n");
|
||||
mdwc->otg_state = OTG_STATE_B_PERIPHERAL;
|
||||
mdwc->drd_state = DRD_STATE_PERIPHERAL;
|
||||
/*
|
||||
* Increment pm usage count upon host
|
||||
* initiated resume. Count was decremented
|
||||
* upon bus suspend in
|
||||
* OTG_STATE_B_PERIPHERAL state.
|
||||
* DRD_STATE_PERIPHERAL state.
|
||||
*/
|
||||
pm_runtime_get_sync(mdwc->dev);
|
||||
dbg_event(0xFF, "!SUSP gsync",
|
||||
|
@ -3977,15 +4023,15 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
}
|
||||
break;
|
||||
|
||||
case OTG_STATE_A_IDLE:
|
||||
case DRD_STATE_HOST_IDLE:
|
||||
/* Switch to A-Device*/
|
||||
if (test_bit(ID, &mdwc->inputs)) {
|
||||
dev_dbg(mdwc->dev, "id\n");
|
||||
mdwc->otg_state = OTG_STATE_B_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_IDLE;
|
||||
mdwc->vbus_retry_count = 0;
|
||||
work = 1;
|
||||
} else {
|
||||
mdwc->otg_state = OTG_STATE_A_HOST;
|
||||
mdwc->drd_state = DRD_STATE_HOST;
|
||||
ret = dwc3_otg_start_host(mdwc, 1);
|
||||
if ((ret == -EPROBE_DEFER) &&
|
||||
mdwc->vbus_retry_count < 3) {
|
||||
|
@ -3993,14 +4039,14 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
* Get regulator failed as regulator driver is
|
||||
* not up yet. Will try to start host after 1sec
|
||||
*/
|
||||
mdwc->otg_state = OTG_STATE_A_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_HOST_IDLE;
|
||||
dev_dbg(mdwc->dev, "Unable to get vbus regulator. Retrying...\n");
|
||||
delay = VBUS_REG_CHECK_DELAY;
|
||||
work = 1;
|
||||
mdwc->vbus_retry_count++;
|
||||
} else if (ret) {
|
||||
dev_err(mdwc->dev, "unable to start host\n");
|
||||
mdwc->otg_state = OTG_STATE_A_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_HOST_IDLE;
|
||||
goto ret;
|
||||
}
|
||||
if (mdwc->no_wakeup_src_in_hostmode) {
|
||||
|
@ -4010,12 +4056,12 @@ static void dwc3_otg_sm_work(struct work_struct *w)
|
|||
}
|
||||
break;
|
||||
|
||||
case OTG_STATE_A_HOST:
|
||||
case DRD_STATE_HOST:
|
||||
if (test_bit(ID, &mdwc->inputs) || mdwc->hc_died) {
|
||||
dbg_event(0xFF, "id || hc_died", 0);
|
||||
dev_dbg(mdwc->dev, "%s state id || hc_died\n", state);
|
||||
dwc3_otg_start_host(mdwc, 0);
|
||||
mdwc->otg_state = OTG_STATE_B_IDLE;
|
||||
mdwc->drd_state = DRD_STATE_IDLE;
|
||||
mdwc->vbus_retry_count = 0;
|
||||
mdwc->hc_died = false;
|
||||
work = 1;
|
||||
|
@ -4162,7 +4208,7 @@ static int dwc3_msm_pm_restore(struct device *dev)
|
|||
pm_runtime_enable(dev);
|
||||
|
||||
/* Restore PHY flags if hibernated in host mode */
|
||||
if (mdwc->otg_state == OTG_STATE_A_HOST) {
|
||||
if (mdwc->drd_state == DRD_STATE_HOST) {
|
||||
mdwc->hs_phy->flags |= PHY_HOST_MODE;
|
||||
if (mdwc->ss_phy) {
|
||||
mdwc->ss_phy->flags |= PHY_HOST_MODE;
|
||||
|
|
Loading…
Add table
Reference in a new issue