mm, vmalloc: remove useless variable in vmap_block
[linux/fpc-iii.git] / drivers / usb / phy / phy-mxs-usb.c
blobfdd33b44dbd31b929eb13a2c0bd138570ccebc37
1 /*
2 * Copyright 2012 Freescale Semiconductor, Inc.
3 * Copyright (C) 2012 Marek Vasut <marex@denx.de>
4 * on behalf of DENX Software Engineering GmbH
6 * The code contained herein is licensed under the GNU General Public
7 * License. You may obtain a copy of the GNU General Public License
8 * Version 2 or later at the following locations:
10 * http://www.opensource.org/licenses/gpl-license.html
11 * http://www.gnu.org/copyleft/gpl.html
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/platform_device.h>
17 #include <linux/clk.h>
18 #include <linux/usb/otg.h>
19 #include <linux/stmp_device.h>
20 #include <linux/delay.h>
21 #include <linux/err.h>
22 #include <linux/io.h>
24 #define DRIVER_NAME "mxs_phy"
26 #define HW_USBPHY_PWD 0x00
27 #define HW_USBPHY_CTRL 0x30
28 #define HW_USBPHY_CTRL_SET 0x34
29 #define HW_USBPHY_CTRL_CLR 0x38
31 #define BM_USBPHY_CTRL_SFTRST BIT(31)
32 #define BM_USBPHY_CTRL_CLKGATE BIT(30)
33 #define BM_USBPHY_CTRL_ENUTMILEVEL3 BIT(15)
34 #define BM_USBPHY_CTRL_ENUTMILEVEL2 BIT(14)
35 #define BM_USBPHY_CTRL_ENHOSTDISCONDETECT BIT(1)
37 struct mxs_phy {
38 struct usb_phy phy;
39 struct clk *clk;
42 #define to_mxs_phy(p) container_of((p), struct mxs_phy, phy)
44 static int mxs_phy_hw_init(struct mxs_phy *mxs_phy)
46 int ret;
47 void __iomem *base = mxs_phy->phy.io_priv;
49 ret = stmp_reset_block(base + HW_USBPHY_CTRL);
50 if (ret)
51 return ret;
53 /* Power up the PHY */
54 writel(0, base + HW_USBPHY_PWD);
56 /* enable FS/LS device */
57 writel(BM_USBPHY_CTRL_ENUTMILEVEL2 |
58 BM_USBPHY_CTRL_ENUTMILEVEL3,
59 base + HW_USBPHY_CTRL_SET);
61 return 0;
64 static int mxs_phy_init(struct usb_phy *phy)
66 struct mxs_phy *mxs_phy = to_mxs_phy(phy);
68 clk_prepare_enable(mxs_phy->clk);
69 return mxs_phy_hw_init(mxs_phy);
72 static void mxs_phy_shutdown(struct usb_phy *phy)
74 struct mxs_phy *mxs_phy = to_mxs_phy(phy);
76 writel(BM_USBPHY_CTRL_CLKGATE,
77 phy->io_priv + HW_USBPHY_CTRL_SET);
79 clk_disable_unprepare(mxs_phy->clk);
82 static int mxs_phy_suspend(struct usb_phy *x, int suspend)
84 struct mxs_phy *mxs_phy = to_mxs_phy(x);
86 if (suspend) {
87 writel(0xffffffff, x->io_priv + HW_USBPHY_PWD);
88 writel(BM_USBPHY_CTRL_CLKGATE,
89 x->io_priv + HW_USBPHY_CTRL_SET);
90 clk_disable_unprepare(mxs_phy->clk);
91 } else {
92 clk_prepare_enable(mxs_phy->clk);
93 writel(BM_USBPHY_CTRL_CLKGATE,
94 x->io_priv + HW_USBPHY_CTRL_CLR);
95 writel(0, x->io_priv + HW_USBPHY_PWD);
98 return 0;
101 static int mxs_phy_on_connect(struct usb_phy *phy,
102 enum usb_device_speed speed)
104 dev_dbg(phy->dev, "%s speed device has connected\n",
105 (speed == USB_SPEED_HIGH) ? "high" : "non-high");
107 if (speed == USB_SPEED_HIGH)
108 writel(BM_USBPHY_CTRL_ENHOSTDISCONDETECT,
109 phy->io_priv + HW_USBPHY_CTRL_SET);
111 return 0;
114 static int mxs_phy_on_disconnect(struct usb_phy *phy,
115 enum usb_device_speed speed)
117 dev_dbg(phy->dev, "%s speed device has disconnected\n",
118 (speed == USB_SPEED_HIGH) ? "high" : "non-high");
120 if (speed == USB_SPEED_HIGH)
121 writel(BM_USBPHY_CTRL_ENHOSTDISCONDETECT,
122 phy->io_priv + HW_USBPHY_CTRL_CLR);
124 return 0;
127 static int mxs_phy_probe(struct platform_device *pdev)
129 struct resource *res;
130 void __iomem *base;
131 struct clk *clk;
132 struct mxs_phy *mxs_phy;
133 int ret;
135 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
136 base = devm_ioremap_resource(&pdev->dev, res);
137 if (IS_ERR(base))
138 return PTR_ERR(base);
140 clk = devm_clk_get(&pdev->dev, NULL);
141 if (IS_ERR(clk)) {
142 dev_err(&pdev->dev,
143 "can't get the clock, err=%ld", PTR_ERR(clk));
144 return PTR_ERR(clk);
147 mxs_phy = devm_kzalloc(&pdev->dev, sizeof(*mxs_phy), GFP_KERNEL);
148 if (!mxs_phy) {
149 dev_err(&pdev->dev, "Failed to allocate USB PHY structure!\n");
150 return -ENOMEM;
153 mxs_phy->phy.io_priv = base;
154 mxs_phy->phy.dev = &pdev->dev;
155 mxs_phy->phy.label = DRIVER_NAME;
156 mxs_phy->phy.init = mxs_phy_init;
157 mxs_phy->phy.shutdown = mxs_phy_shutdown;
158 mxs_phy->phy.set_suspend = mxs_phy_suspend;
159 mxs_phy->phy.notify_connect = mxs_phy_on_connect;
160 mxs_phy->phy.notify_disconnect = mxs_phy_on_disconnect;
161 mxs_phy->phy.type = USB_PHY_TYPE_USB2;
163 ATOMIC_INIT_NOTIFIER_HEAD(&mxs_phy->phy.notifier);
165 mxs_phy->clk = clk;
167 platform_set_drvdata(pdev, &mxs_phy->phy);
169 ret = usb_add_phy_dev(&mxs_phy->phy);
170 if (ret)
171 return ret;
173 return 0;
176 static int mxs_phy_remove(struct platform_device *pdev)
178 struct mxs_phy *mxs_phy = platform_get_drvdata(pdev);
180 usb_remove_phy(&mxs_phy->phy);
182 return 0;
185 static const struct of_device_id mxs_phy_dt_ids[] = {
186 { .compatible = "fsl,imx23-usbphy", },
187 { /* sentinel */ }
189 MODULE_DEVICE_TABLE(of, mxs_phy_dt_ids);
191 static struct platform_driver mxs_phy_driver = {
192 .probe = mxs_phy_probe,
193 .remove = mxs_phy_remove,
194 .driver = {
195 .name = DRIVER_NAME,
196 .owner = THIS_MODULE,
197 .of_match_table = mxs_phy_dt_ids,
201 static int __init mxs_phy_module_init(void)
203 return platform_driver_register(&mxs_phy_driver);
205 postcore_initcall(mxs_phy_module_init);
207 static void __exit mxs_phy_module_exit(void)
209 platform_driver_unregister(&mxs_phy_driver);
211 module_exit(mxs_phy_module_exit);
213 MODULE_ALIAS("platform:mxs-usb-phy");
214 MODULE_AUTHOR("Marek Vasut <marex@denx.de>");
215 MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>");
216 MODULE_DESCRIPTION("Freescale MXS USB PHY driver");
217 MODULE_LICENSE("GPL");