|
@@ -76,6 +76,25 @@ static void mxs_phy_shutdown(struct usb_phy *phy)
|
|
|
clk_disable_unprepare(mxs_phy->clk);
|
|
|
}
|
|
|
|
|
|
+static int mxs_phy_suspend(struct usb_phy *x, int suspend)
|
|
|
+{
|
|
|
+ struct mxs_phy *mxs_phy = to_mxs_phy(x);
|
|
|
+
|
|
|
+ if (suspend) {
|
|
|
+ writel_relaxed(0xffffffff, x->io_priv + HW_USBPHY_PWD);
|
|
|
+ writel_relaxed(BM_USBPHY_CTRL_CLKGATE,
|
|
|
+ x->io_priv + HW_USBPHY_CTRL_SET);
|
|
|
+ clk_disable_unprepare(mxs_phy->clk);
|
|
|
+ } else {
|
|
|
+ clk_prepare_enable(mxs_phy->clk);
|
|
|
+ writel_relaxed(BM_USBPHY_CTRL_CLKGATE,
|
|
|
+ x->io_priv + HW_USBPHY_CTRL_CLR);
|
|
|
+ writel_relaxed(0, x->io_priv + HW_USBPHY_PWD);
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
static int mxs_phy_on_connect(struct usb_phy *phy,
|
|
|
enum usb_device_speed speed)
|
|
|
{
|
|
@@ -137,6 +156,7 @@ static int mxs_phy_probe(struct platform_device *pdev)
|
|
|
mxs_phy->phy.label = DRIVER_NAME;
|
|
|
mxs_phy->phy.init = mxs_phy_init;
|
|
|
mxs_phy->phy.shutdown = mxs_phy_shutdown;
|
|
|
+ mxs_phy->phy.set_suspend = mxs_phy_suspend;
|
|
|
mxs_phy->phy.notify_connect = mxs_phy_on_connect;
|
|
|
mxs_phy->phy.notify_disconnect = mxs_phy_on_disconnect;
|
|
|
|