usb: phy: mxs-phy: add set_suspend API
authorPeter Chen <peter.chen@freescale.com>
Thu, 10 Jan 2013 08:35:53 +0000 (16:35 +0800)
committerFelipe Balbi <balbi@ti.com>
Fri, 18 Jan 2013 13:03:25 +0000 (15:03 +0200)
It needs to call set_suspend during USB suspend/resume

Signed-off-by: Peter Chen <peter.chen@freescale.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>
drivers/usb/otg/mxs-phy.c

index 7630272..5158332 100644 (file)
@@ -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;