usb: musb: Return error value from musb_mailbox

At least on n900 we have phy-twl4030-usb only generating cable
interrupts, and then have a separate USB PHY.

In order for musb to know the real cable status, we need to
clear any cached state until musb is ready. Otherwise the cable
status interrupts will get just ignored if the status does
not change from the initial state.

To do this, let's add a return value to musb_mailbox(), and
reset cached linkstat to MUSB_UNKNOWN on error. Sorry to cause
a bit of churn here, I should have added that already last time
patching musb_mailbox().

Signed-off-by: Tony Lindgren <tony@atomide.com>
Signed-off-by: Bin Liu <b-liu@ti.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
Tony Lindgren 2016-05-31 10:05:19 -05:00 committed by Greg Kroah-Hartman
parent a118df07f5
commit 12b7db2bf8
6 changed files with 32 additions and 16 deletions

View File

@ -463,7 +463,8 @@ static int twl4030_phy_power_on(struct phy *phy)
twl4030_usb_set_mode(twl, twl->usb_mode); twl4030_usb_set_mode(twl, twl->usb_mode);
if (twl->usb_mode == T2_USB_MODE_ULPI) if (twl->usb_mode == T2_USB_MODE_ULPI)
twl4030_i2c_access(twl, 0); twl4030_i2c_access(twl, 0);
schedule_delayed_work(&twl->id_workaround_work, 0); twl->linkstat = MUSB_UNKNOWN;
schedule_delayed_work(&twl->id_workaround_work, HZ);
return 0; return 0;
} }
@ -537,6 +538,7 @@ static irqreturn_t twl4030_usb_irq(int irq, void *_twl)
struct twl4030_usb *twl = _twl; struct twl4030_usb *twl = _twl;
enum musb_vbus_id_status status; enum musb_vbus_id_status status;
bool status_changed = false; bool status_changed = false;
int err;
status = twl4030_usb_linkstat(twl); status = twl4030_usb_linkstat(twl);
@ -567,7 +569,9 @@ static irqreturn_t twl4030_usb_irq(int irq, void *_twl)
pm_runtime_mark_last_busy(twl->dev); pm_runtime_mark_last_busy(twl->dev);
pm_runtime_put_autosuspend(twl->dev); pm_runtime_put_autosuspend(twl->dev);
} }
musb_mailbox(status); err = musb_mailbox(status);
if (err)
twl->linkstat = MUSB_UNKNOWN;
} }
/* don't schedule during sleep - irq works right then */ /* don't schedule during sleep - irq works right then */
@ -595,7 +599,8 @@ static int twl4030_phy_init(struct phy *phy)
struct twl4030_usb *twl = phy_get_drvdata(phy); struct twl4030_usb *twl = phy_get_drvdata(phy);
pm_runtime_get_sync(twl->dev); pm_runtime_get_sync(twl->dev);
schedule_delayed_work(&twl->id_workaround_work, 0); twl->linkstat = MUSB_UNKNOWN;
schedule_delayed_work(&twl->id_workaround_work, HZ);
pm_runtime_mark_last_busy(twl->dev); pm_runtime_mark_last_busy(twl->dev);
pm_runtime_put_autosuspend(twl->dev); pm_runtime_put_autosuspend(twl->dev);
@ -763,7 +768,8 @@ static int twl4030_usb_remove(struct platform_device *pdev)
if (cable_present(twl->linkstat)) if (cable_present(twl->linkstat))
pm_runtime_put_noidle(twl->dev); pm_runtime_put_noidle(twl->dev);
pm_runtime_mark_last_busy(twl->dev); pm_runtime_mark_last_busy(twl->dev);
pm_runtime_put_sync_suspend(twl->dev); pm_runtime_dont_use_autosuspend(&pdev->dev);
pm_runtime_put_sync(twl->dev);
pm_runtime_disable(twl->dev); pm_runtime_disable(twl->dev);
/* autogate 60MHz ULPI clock, /* autogate 60MHz ULPI clock,

View File

@ -1679,7 +1679,7 @@ EXPORT_SYMBOL_GPL(musb_dma_completion);
#define use_dma 0 #define use_dma 0
#endif #endif
static void (*musb_phy_callback)(enum musb_vbus_id_status status); static int (*musb_phy_callback)(enum musb_vbus_id_status status);
/* /*
* musb_mailbox - optional phy notifier function * musb_mailbox - optional phy notifier function
@ -1688,11 +1688,12 @@ static void (*musb_phy_callback)(enum musb_vbus_id_status status);
* Optionally gets called from the USB PHY. Note that the USB PHY must be * Optionally gets called from the USB PHY. Note that the USB PHY must be
* disabled at the point the phy_callback is registered or unregistered. * disabled at the point the phy_callback is registered or unregistered.
*/ */
void musb_mailbox(enum musb_vbus_id_status status) int musb_mailbox(enum musb_vbus_id_status status)
{ {
if (musb_phy_callback) if (musb_phy_callback)
musb_phy_callback(status); return musb_phy_callback(status);
return -ENODEV;
}; };
EXPORT_SYMBOL_GPL(musb_mailbox); EXPORT_SYMBOL_GPL(musb_mailbox);

View File

@ -215,7 +215,7 @@ struct musb_platform_ops {
dma_addr_t *dma_addr, u32 *len); dma_addr_t *dma_addr, u32 *len);
void (*pre_root_reset_end)(struct musb *musb); void (*pre_root_reset_end)(struct musb *musb);
void (*post_root_reset_end)(struct musb *musb); void (*post_root_reset_end)(struct musb *musb);
void (*phy_callback)(enum musb_vbus_id_status status); int (*phy_callback)(enum musb_vbus_id_status status);
}; };
/* /*

View File

@ -180,22 +180,24 @@ static void omap2430_set_power(struct musb *musb, bool enabled, bool cable)
} }
} }
static void omap2430_musb_mailbox(enum musb_vbus_id_status status) static int omap2430_musb_mailbox(enum musb_vbus_id_status status)
{ {
struct omap2430_glue *glue = _glue; struct omap2430_glue *glue = _glue;
if (!glue) { if (!glue) {
pr_err("%s: musb core is not yet initialized\n", __func__); pr_err("%s: musb core is not yet initialized\n", __func__);
return; return -EPROBE_DEFER;
} }
glue->status = status; glue->status = status;
if (!glue_to_musb(glue)) { if (!glue_to_musb(glue)) {
pr_err("%s: musb core is not yet ready\n", __func__); pr_err("%s: musb core is not yet ready\n", __func__);
return; return -EPROBE_DEFER;
} }
schedule_work(&glue->omap_musb_mailbox_work); schedule_work(&glue->omap_musb_mailbox_work);
return 0;
} }
static void omap_musb_set_mailbox(struct omap2430_glue *glue) static void omap_musb_set_mailbox(struct omap2430_glue *glue)

View File

@ -227,12 +227,16 @@ static irqreturn_t twl6030_usb_irq(int irq, void *_twl)
twl->asleep = 1; twl->asleep = 1;
status = MUSB_VBUS_VALID; status = MUSB_VBUS_VALID;
twl->linkstat = status; twl->linkstat = status;
musb_mailbox(status); ret = musb_mailbox(status);
if (ret)
twl->linkstat = MUSB_UNKNOWN;
} else { } else {
if (twl->linkstat != MUSB_UNKNOWN) { if (twl->linkstat != MUSB_UNKNOWN) {
status = MUSB_VBUS_OFF; status = MUSB_VBUS_OFF;
twl->linkstat = status; twl->linkstat = status;
musb_mailbox(status); ret = musb_mailbox(status);
if (ret)
twl->linkstat = MUSB_UNKNOWN;
if (twl->asleep) { if (twl->asleep) {
regulator_disable(twl->usb3v3); regulator_disable(twl->usb3v3);
twl->asleep = 0; twl->asleep = 0;
@ -264,7 +268,9 @@ static irqreturn_t twl6030_usbotg_irq(int irq, void *_twl)
twl6030_writeb(twl, TWL_MODULE_USB, 0x10, USB_ID_INT_EN_HI_SET); twl6030_writeb(twl, TWL_MODULE_USB, 0x10, USB_ID_INT_EN_HI_SET);
status = MUSB_ID_GROUND; status = MUSB_ID_GROUND;
twl->linkstat = status; twl->linkstat = status;
musb_mailbox(status); ret = musb_mailbox(status);
if (ret)
twl->linkstat = MUSB_UNKNOWN;
} else { } else {
twl6030_writeb(twl, TWL_MODULE_USB, 0x10, USB_ID_INT_EN_HI_CLR); twl6030_writeb(twl, TWL_MODULE_USB, 0x10, USB_ID_INT_EN_HI_CLR);
twl6030_writeb(twl, TWL_MODULE_USB, 0x1, USB_ID_INT_EN_HI_SET); twl6030_writeb(twl, TWL_MODULE_USB, 0x1, USB_ID_INT_EN_HI_SET);

View File

@ -142,10 +142,11 @@ enum musb_vbus_id_status {
}; };
#if IS_ENABLED(CONFIG_USB_MUSB_HDRC) #if IS_ENABLED(CONFIG_USB_MUSB_HDRC)
void musb_mailbox(enum musb_vbus_id_status status); int musb_mailbox(enum musb_vbus_id_status status);
#else #else
static inline void musb_mailbox(enum musb_vbus_id_status status) static inline int musb_mailbox(enum musb_vbus_id_status status)
{ {
return 0;
} }
#endif #endif