1 /* 2 * Copyright 2012 Freescale Semiconductor, Inc. 3 * Copyright (C) 2012 Marek Vasut <marex@denx.de> 4 * on behalf of DENX Software Engineering GmbH 5 * 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: 9 * 10 * http://www.opensource.org/licenses/gpl-license.html 11 * http://www.gnu.org/copyleft/gpl.html 12 */ 13 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> 23 24 #define DRIVER_NAME "mxs_phy" 25 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 30 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) 36 37 struct mxs_phy { 38 struct usb_phy phy; 39 struct clk *clk; 40 }; 41 42 #define to_mxs_phy(p) container_of((p), struct mxs_phy, phy) 43 44 static int mxs_phy_hw_init(struct mxs_phy *mxs_phy) 45 { 46 int ret; 47 void __iomem *base = mxs_phy->phy.io_priv; 48 49 ret = stmp_reset_block(base + HW_USBPHY_CTRL); 50 if (ret) 51 return ret; 52 53 /* Power up the PHY */ 54 writel(0, base + HW_USBPHY_PWD); 55 56 /* enable FS/LS device */ 57 writel(BM_USBPHY_CTRL_ENUTMILEVEL2 | 58 BM_USBPHY_CTRL_ENUTMILEVEL3, 59 base + HW_USBPHY_CTRL_SET); 60 61 return 0; 62 } 63 64 static int mxs_phy_init(struct usb_phy *phy) 65 { 66 int ret; 67 struct mxs_phy *mxs_phy = to_mxs_phy(phy); 68 69 ret = clk_prepare_enable(mxs_phy->clk); 70 if (ret) 71 return ret; 72 73 return mxs_phy_hw_init(mxs_phy); 74 } 75 76 static void mxs_phy_shutdown(struct usb_phy *phy) 77 { 78 struct mxs_phy *mxs_phy = to_mxs_phy(phy); 79 80 writel(BM_USBPHY_CTRL_CLKGATE, 81 phy->io_priv + HW_USBPHY_CTRL_SET); 82 83 clk_disable_unprepare(mxs_phy->clk); 84 } 85 86 static int mxs_phy_suspend(struct usb_phy *x, int suspend) 87 { 88 int ret; 89 struct mxs_phy *mxs_phy = to_mxs_phy(x); 90 91 if (suspend) { 92 writel(0xffffffff, x->io_priv + HW_USBPHY_PWD); 93 writel(BM_USBPHY_CTRL_CLKGATE, 94 x->io_priv + HW_USBPHY_CTRL_SET); 95 clk_disable_unprepare(mxs_phy->clk); 96 } else { 97 ret = clk_prepare_enable(mxs_phy->clk); 98 if (ret) 99 return ret; 100 writel(BM_USBPHY_CTRL_CLKGATE, 101 x->io_priv + HW_USBPHY_CTRL_CLR); 102 writel(0, x->io_priv + HW_USBPHY_PWD); 103 } 104 105 return 0; 106 } 107 108 static int mxs_phy_on_connect(struct usb_phy *phy, 109 enum usb_device_speed speed) 110 { 111 dev_dbg(phy->dev, "%s speed device has connected\n", 112 (speed == USB_SPEED_HIGH) ? "high" : "non-high"); 113 114 if (speed == USB_SPEED_HIGH) 115 writel(BM_USBPHY_CTRL_ENHOSTDISCONDETECT, 116 phy->io_priv + HW_USBPHY_CTRL_SET); 117 118 return 0; 119 } 120 121 static int mxs_phy_on_disconnect(struct usb_phy *phy, 122 enum usb_device_speed speed) 123 { 124 dev_dbg(phy->dev, "%s speed device has disconnected\n", 125 (speed == USB_SPEED_HIGH) ? "high" : "non-high"); 126 127 if (speed == USB_SPEED_HIGH) 128 writel(BM_USBPHY_CTRL_ENHOSTDISCONDETECT, 129 phy->io_priv + HW_USBPHY_CTRL_CLR); 130 131 return 0; 132 } 133 134 static int mxs_phy_probe(struct platform_device *pdev) 135 { 136 struct resource *res; 137 void __iomem *base; 138 struct clk *clk; 139 struct mxs_phy *mxs_phy; 140 int ret; 141 142 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 143 base = devm_ioremap_resource(&pdev->dev, res); 144 if (IS_ERR(base)) 145 return PTR_ERR(base); 146 147 clk = devm_clk_get(&pdev->dev, NULL); 148 if (IS_ERR(clk)) { 149 dev_err(&pdev->dev, 150 "can't get the clock, err=%ld", PTR_ERR(clk)); 151 return PTR_ERR(clk); 152 } 153 154 mxs_phy = devm_kzalloc(&pdev->dev, sizeof(*mxs_phy), GFP_KERNEL); 155 if (!mxs_phy) { 156 dev_err(&pdev->dev, "Failed to allocate USB PHY structure!\n"); 157 return -ENOMEM; 158 } 159 160 mxs_phy->phy.io_priv = base; 161 mxs_phy->phy.dev = &pdev->dev; 162 mxs_phy->phy.label = DRIVER_NAME; 163 mxs_phy->phy.init = mxs_phy_init; 164 mxs_phy->phy.shutdown = mxs_phy_shutdown; 165 mxs_phy->phy.set_suspend = mxs_phy_suspend; 166 mxs_phy->phy.notify_connect = mxs_phy_on_connect; 167 mxs_phy->phy.notify_disconnect = mxs_phy_on_disconnect; 168 mxs_phy->phy.type = USB_PHY_TYPE_USB2; 169 170 mxs_phy->clk = clk; 171 172 platform_set_drvdata(pdev, mxs_phy); 173 174 ret = usb_add_phy_dev(&mxs_phy->phy); 175 if (ret) 176 return ret; 177 178 return 0; 179 } 180 181 static int mxs_phy_remove(struct platform_device *pdev) 182 { 183 struct mxs_phy *mxs_phy = platform_get_drvdata(pdev); 184 185 usb_remove_phy(&mxs_phy->phy); 186 187 return 0; 188 } 189 190 static const struct of_device_id mxs_phy_dt_ids[] = { 191 { .compatible = "fsl,imx23-usbphy", }, 192 { /* sentinel */ } 193 }; 194 MODULE_DEVICE_TABLE(of, mxs_phy_dt_ids); 195 196 static struct platform_driver mxs_phy_driver = { 197 .probe = mxs_phy_probe, 198 .remove = mxs_phy_remove, 199 .driver = { 200 .name = DRIVER_NAME, 201 .owner = THIS_MODULE, 202 .of_match_table = mxs_phy_dt_ids, 203 }, 204 }; 205 206 static int __init mxs_phy_module_init(void) 207 { 208 return platform_driver_register(&mxs_phy_driver); 209 } 210 postcore_initcall(mxs_phy_module_init); 211 212 static void __exit mxs_phy_module_exit(void) 213 { 214 platform_driver_unregister(&mxs_phy_driver); 215 } 216 module_exit(mxs_phy_module_exit); 217 218 MODULE_ALIAS("platform:mxs-usb-phy"); 219 MODULE_AUTHOR("Marek Vasut <marex@denx.de>"); 220 MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>"); 221 MODULE_DESCRIPTION("Freescale MXS USB PHY driver"); 222 MODULE_LICENSE("GPL"); 223