1 // SPDX-License-Identifier: GPL-2.0
2 /**
3 * cdns3-imx.c - NXP i.MX specific Glue layer for Cadence USB Controller
4 *
5 * Copyright (C) 2019 NXP
6 */
7
8 #include <linux/bits.h>
9 #include <linux/clk.h>
10 #include <linux/module.h>
11 #include <linux/kernel.h>
12 #include <linux/interrupt.h>
13 #include <linux/platform_device.h>
14 #include <linux/dma-mapping.h>
15 #include <linux/io.h>
16 #include <linux/of_platform.h>
17 #include <linux/iopoll.h>
18 #include <linux/pm_runtime.h>
19 #include "core.h"
20
21 #define USB3_CORE_CTRL1 0x00
22 #define USB3_CORE_CTRL2 0x04
23 #define USB3_INT_REG 0x08
24 #define USB3_CORE_STATUS 0x0c
25 #define XHCI_DEBUG_LINK_ST 0x10
26 #define XHCI_DEBUG_BUS 0x14
27 #define USB3_SSPHY_CTRL1 0x40
28 #define USB3_SSPHY_CTRL2 0x44
29 #define USB3_SSPHY_STATUS 0x4c
30 #define USB2_PHY_CTRL1 0x50
31 #define USB2_PHY_CTRL2 0x54
32 #define USB2_PHY_STATUS 0x5c
33
34 /* Register bits definition */
35
36 /* USB3_CORE_CTRL1 */
37 #define SW_RESET_MASK GENMASK(31, 26)
38 #define PWR_SW_RESET BIT(31)
39 #define APB_SW_RESET BIT(30)
40 #define AXI_SW_RESET BIT(29)
41 #define RW_SW_RESET BIT(28)
42 #define PHY_SW_RESET BIT(27)
43 #define PHYAHB_SW_RESET BIT(26)
44 #define ALL_SW_RESET (PWR_SW_RESET | APB_SW_RESET | AXI_SW_RESET | \
45 RW_SW_RESET | PHY_SW_RESET | PHYAHB_SW_RESET)
46 #define OC_DISABLE BIT(9)
47 #define MDCTRL_CLK_SEL BIT(7)
48 #define MODE_STRAP_MASK (0x7)
49 #define DEV_MODE (1 << 2)
50 #define HOST_MODE (1 << 1)
51 #define OTG_MODE (1 << 0)
52
53 /* USB3_INT_REG */
54 #define CLK_125_REQ BIT(29)
55 #define LPM_CLK_REQ BIT(28)
56 #define DEVU3_WAEKUP_EN BIT(14)
57 #define OTG_WAKEUP_EN BIT(12)
58 #define DEV_INT_EN (3 << 8) /* DEV INT b9:8 */
59 #define HOST_INT1_EN (1 << 0) /* HOST INT b7:0 */
60
61 /* USB3_CORE_STATUS */
62 #define MDCTRL_CLK_STATUS BIT(15)
63 #define DEV_POWER_ON_READY BIT(13)
64 #define HOST_POWER_ON_READY BIT(12)
65
66 /* USB3_SSPHY_STATUS */
67 #define CLK_VALID_MASK (0x3f << 26)
68 #define CLK_VALID_COMPARE_BITS (0xf << 28)
69 #define PHY_REFCLK_REQ (1 << 0)
70
71 /* OTG registers definition */
72 #define OTGSTS 0x4
73 /* OTGSTS */
74 #define OTG_NRDY BIT(11)
75
76 /* xHCI registers definition */
77 #define XECP_PM_PMCSR 0x8018
78 #define XECP_AUX_CTRL_REG1 0x8120
79
80 /* Register bits definition */
81 /* XECP_AUX_CTRL_REG1 */
82 #define CFG_RXDET_P3_EN BIT(15)
83
84 /* XECP_PM_PMCSR */
85 #define PS_MASK GENMASK(1, 0)
86 #define PS_D0 0
87 #define PS_D1 1
88
89 struct cdns_imx {
90 struct device *dev;
91 void __iomem *noncore;
92 struct clk_bulk_data *clks;
93 int num_clks;
94 struct platform_device *cdns3_pdev;
95 };
96
cdns_imx_readl(struct cdns_imx * data,u32 offset)97 static inline u32 cdns_imx_readl(struct cdns_imx *data, u32 offset)
98 {
99 return readl(data->noncore + offset);
100 }
101
cdns_imx_writel(struct cdns_imx * data,u32 offset,u32 value)102 static inline void cdns_imx_writel(struct cdns_imx *data, u32 offset, u32 value)
103 {
104 writel(value, data->noncore + offset);
105 }
106
107 static const struct clk_bulk_data imx_cdns3_core_clks[] = {
108 { .id = "usb3_lpm_clk" },
109 { .id = "usb3_bus_clk" },
110 { .id = "usb3_aclk" },
111 { .id = "usb3_ipg_clk" },
112 { .id = "usb3_core_pclk" },
113 };
114
cdns_imx_noncore_init(struct cdns_imx * data)115 static int cdns_imx_noncore_init(struct cdns_imx *data)
116 {
117 u32 value;
118 int ret;
119 struct device *dev = data->dev;
120
121 cdns_imx_writel(data, USB3_SSPHY_STATUS, CLK_VALID_MASK);
122 udelay(1);
123 ret = readl_poll_timeout(data->noncore + USB3_SSPHY_STATUS, value,
124 (value & CLK_VALID_COMPARE_BITS) == CLK_VALID_COMPARE_BITS,
125 10, 100000);
126 if (ret) {
127 dev_err(dev, "wait clkvld timeout\n");
128 return ret;
129 }
130
131 value = cdns_imx_readl(data, USB3_CORE_CTRL1);
132 value |= ALL_SW_RESET;
133 cdns_imx_writel(data, USB3_CORE_CTRL1, value);
134 udelay(1);
135
136 value = cdns_imx_readl(data, USB3_CORE_CTRL1);
137 value = (value & ~MODE_STRAP_MASK) | OTG_MODE | OC_DISABLE;
138 cdns_imx_writel(data, USB3_CORE_CTRL1, value);
139
140 value = cdns_imx_readl(data, USB3_INT_REG);
141 value |= HOST_INT1_EN | DEV_INT_EN;
142 cdns_imx_writel(data, USB3_INT_REG, value);
143
144 value = cdns_imx_readl(data, USB3_CORE_CTRL1);
145 value &= ~ALL_SW_RESET;
146 cdns_imx_writel(data, USB3_CORE_CTRL1, value);
147 return ret;
148 }
149
150 static int cdns_imx_platform_suspend(struct device *dev,
151 bool suspend, bool wakeup);
152 static struct cdns3_platform_data cdns_imx_pdata = {
153 .platform_suspend = cdns_imx_platform_suspend,
154 };
155
156 static const struct of_dev_auxdata cdns_imx_auxdata[] = {
157 {
158 .compatible = "cdns,usb3",
159 .platform_data = &cdns_imx_pdata,
160 },
161 {},
162 };
163
cdns_imx_probe(struct platform_device * pdev)164 static int cdns_imx_probe(struct platform_device *pdev)
165 {
166 struct device *dev = &pdev->dev;
167 struct device_node *node = dev->of_node;
168 struct cdns_imx *data;
169 int ret;
170
171 if (!node)
172 return -ENODEV;
173
174 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
175 if (!data)
176 return -ENOMEM;
177
178 platform_set_drvdata(pdev, data);
179 data->dev = dev;
180 data->noncore = devm_platform_ioremap_resource(pdev, 0);
181 if (IS_ERR(data->noncore)) {
182 dev_err(dev, "can't map IOMEM resource\n");
183 return PTR_ERR(data->noncore);
184 }
185
186 data->num_clks = ARRAY_SIZE(imx_cdns3_core_clks);
187 data->clks = devm_kmemdup(dev, imx_cdns3_core_clks,
188 sizeof(imx_cdns3_core_clks), GFP_KERNEL);
189 if (!data->clks)
190 return -ENOMEM;
191
192 ret = devm_clk_bulk_get(dev, data->num_clks, data->clks);
193 if (ret)
194 return ret;
195
196 ret = clk_bulk_prepare_enable(data->num_clks, data->clks);
197 if (ret)
198 return ret;
199
200 ret = cdns_imx_noncore_init(data);
201 if (ret)
202 goto err;
203
204 ret = of_platform_populate(node, NULL, cdns_imx_auxdata, dev);
205 if (ret) {
206 dev_err(dev, "failed to create children: %d\n", ret);
207 goto err;
208 }
209
210 device_set_wakeup_capable(dev, true);
211 pm_runtime_set_active(dev);
212 pm_runtime_enable(dev);
213 pm_runtime_forbid(dev);
214
215 return ret;
216 err:
217 clk_bulk_disable_unprepare(data->num_clks, data->clks);
218 return ret;
219 }
220
cdns_imx_remove(struct platform_device * pdev)221 static int cdns_imx_remove(struct platform_device *pdev)
222 {
223 struct device *dev = &pdev->dev;
224
225 of_platform_depopulate(dev);
226 platform_set_drvdata(pdev, NULL);
227
228 return 0;
229 }
230
231 #ifdef CONFIG_PM
cdns3_set_wakeup(struct cdns_imx * data,bool enable)232 static void cdns3_set_wakeup(struct cdns_imx *data, bool enable)
233 {
234 u32 value;
235
236 value = cdns_imx_readl(data, USB3_INT_REG);
237 if (enable)
238 value |= OTG_WAKEUP_EN | DEVU3_WAEKUP_EN;
239 else
240 value &= ~(OTG_WAKEUP_EN | DEVU3_WAEKUP_EN);
241
242 cdns_imx_writel(data, USB3_INT_REG, value);
243 }
244
cdns_imx_platform_suspend(struct device * dev,bool suspend,bool wakeup)245 static int cdns_imx_platform_suspend(struct device *dev,
246 bool suspend, bool wakeup)
247 {
248 struct cdns3 *cdns = dev_get_drvdata(dev);
249 struct device *parent = dev->parent;
250 struct cdns_imx *data = dev_get_drvdata(parent);
251 void __iomem *otg_regs = (void __iomem *)(cdns->otg_regs);
252 void __iomem *xhci_regs = cdns->xhci_regs;
253 u32 value;
254 int ret = 0;
255
256 if (cdns->role != USB_ROLE_HOST)
257 return 0;
258
259 if (suspend) {
260 /* SW request low power when all usb ports allow to it ??? */
261 value = readl(xhci_regs + XECP_PM_PMCSR);
262 value &= ~PS_MASK;
263 value |= PS_D1;
264 writel(value, xhci_regs + XECP_PM_PMCSR);
265
266 /* mdctrl_clk_sel */
267 value = cdns_imx_readl(data, USB3_CORE_CTRL1);
268 value |= MDCTRL_CLK_SEL;
269 cdns_imx_writel(data, USB3_CORE_CTRL1, value);
270
271 /* wait for mdctrl_clk_status */
272 value = cdns_imx_readl(data, USB3_CORE_STATUS);
273 ret = readl_poll_timeout(data->noncore + USB3_CORE_STATUS, value,
274 (value & MDCTRL_CLK_STATUS) == MDCTRL_CLK_STATUS,
275 10, 100000);
276 if (ret)
277 dev_warn(parent, "wait mdctrl_clk_status timeout\n");
278
279 /* wait lpm_clk_req to be 0 */
280 value = cdns_imx_readl(data, USB3_INT_REG);
281 ret = readl_poll_timeout(data->noncore + USB3_INT_REG, value,
282 (value & LPM_CLK_REQ) != LPM_CLK_REQ,
283 10, 100000);
284 if (ret)
285 dev_warn(parent, "wait lpm_clk_req timeout\n");
286
287 /* wait phy_refclk_req to be 0 */
288 value = cdns_imx_readl(data, USB3_SSPHY_STATUS);
289 ret = readl_poll_timeout(data->noncore + USB3_SSPHY_STATUS, value,
290 (value & PHY_REFCLK_REQ) != PHY_REFCLK_REQ,
291 10, 100000);
292 if (ret)
293 dev_warn(parent, "wait phy_refclk_req timeout\n");
294
295 cdns3_set_wakeup(data, wakeup);
296 } else {
297 cdns3_set_wakeup(data, false);
298
299 /* SW request D0 */
300 value = readl(xhci_regs + XECP_PM_PMCSR);
301 value &= ~PS_MASK;
302 value |= PS_D0;
303 writel(value, xhci_regs + XECP_PM_PMCSR);
304
305 /* clr CFG_RXDET_P3_EN */
306 value = readl(xhci_regs + XECP_AUX_CTRL_REG1);
307 value &= ~CFG_RXDET_P3_EN;
308 writel(value, xhci_regs + XECP_AUX_CTRL_REG1);
309
310 /* clear mdctrl_clk_sel */
311 value = cdns_imx_readl(data, USB3_CORE_CTRL1);
312 value &= ~MDCTRL_CLK_SEL;
313 cdns_imx_writel(data, USB3_CORE_CTRL1, value);
314
315 /* wait CLK_125_REQ to be 1 */
316 value = cdns_imx_readl(data, USB3_INT_REG);
317 ret = readl_poll_timeout(data->noncore + USB3_INT_REG, value,
318 (value & CLK_125_REQ) == CLK_125_REQ,
319 10, 100000);
320 if (ret)
321 dev_warn(parent, "wait CLK_125_REQ timeout\n");
322
323 /* wait for mdctrl_clk_status is cleared */
324 value = cdns_imx_readl(data, USB3_CORE_STATUS);
325 ret = readl_poll_timeout(data->noncore + USB3_CORE_STATUS, value,
326 (value & MDCTRL_CLK_STATUS) != MDCTRL_CLK_STATUS,
327 10, 100000);
328 if (ret)
329 dev_warn(parent, "wait mdctrl_clk_status cleared timeout\n");
330
331 /* Wait until OTG_NRDY is 0 */
332 value = readl(otg_regs + OTGSTS);
333 ret = readl_poll_timeout(otg_regs + OTGSTS, value,
334 (value & OTG_NRDY) != OTG_NRDY,
335 10, 100000);
336 if (ret)
337 dev_warn(parent, "wait OTG ready timeout\n");
338 }
339
340 return ret;
341
342 }
343
cdns_imx_resume(struct device * dev)344 static int cdns_imx_resume(struct device *dev)
345 {
346 struct cdns_imx *data = dev_get_drvdata(dev);
347
348 return clk_bulk_prepare_enable(data->num_clks, data->clks);
349 }
350
cdns_imx_suspend(struct device * dev)351 static int cdns_imx_suspend(struct device *dev)
352 {
353 struct cdns_imx *data = dev_get_drvdata(dev);
354
355 clk_bulk_disable_unprepare(data->num_clks, data->clks);
356
357 return 0;
358 }
359 #else
cdns_imx_platform_suspend(struct device * dev,bool suspend,bool wakeup)360 static int cdns_imx_platform_suspend(struct device *dev,
361 bool suspend, bool wakeup)
362 {
363 return 0;
364 }
365
366 #endif /* CONFIG_PM */
367
368 static const struct dev_pm_ops cdns_imx_pm_ops = {
369 SET_RUNTIME_PM_OPS(cdns_imx_suspend, cdns_imx_resume, NULL)
370 };
371
372 static const struct of_device_id cdns_imx_of_match[] = {
373 { .compatible = "fsl,imx8qm-usb3", },
374 {},
375 };
376 MODULE_DEVICE_TABLE(of, cdns_imx_of_match);
377
378 static struct platform_driver cdns_imx_driver = {
379 .probe = cdns_imx_probe,
380 .remove = cdns_imx_remove,
381 .driver = {
382 .name = "cdns3-imx",
383 .of_match_table = cdns_imx_of_match,
384 .pm = &cdns_imx_pm_ops,
385 },
386 };
387 module_platform_driver(cdns_imx_driver);
388
389 MODULE_ALIAS("platform:cdns3-imx");
390 MODULE_AUTHOR("Peter Chen <peter.chen@nxp.com>");
391 MODULE_LICENSE("GPL v2");
392 MODULE_DESCRIPTION("Cadence USB3 i.MX Glue Layer");
393