2 * phy-ti-pipe3 - PIPE3 PHY driver.
4 * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * Author: Kishon Vijay Abraham I <kishon@ti.com>
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
19 #include <linux/module.h>
20 #include <linux/platform_device.h>
21 #include <linux/slab.h>
22 #include <linux/phy/phy.h>
24 #include <linux/clk.h>
25 #include <linux/err.h>
27 #include <linux/pm_runtime.h>
28 #include <linux/delay.h>
29 #include <linux/phy/omap_control_phy.h>
30 #include <linux/of_platform.h>
32 #define PLL_STATUS 0x00000004
33 #define PLL_GO 0x00000008
34 #define PLL_CONFIGURATION1 0x0000000C
35 #define PLL_CONFIGURATION2 0x00000010
36 #define PLL_CONFIGURATION3 0x00000014
37 #define PLL_CONFIGURATION4 0x00000020
39 #define PLL_REGM_MASK 0x001FFE00
40 #define PLL_REGM_SHIFT 0x9
41 #define PLL_REGM_F_MASK 0x0003FFFF
42 #define PLL_REGM_F_SHIFT 0x0
43 #define PLL_REGN_MASK 0x000001FE
44 #define PLL_REGN_SHIFT 0x1
45 #define PLL_SELFREQDCO_MASK 0x0000000E
46 #define PLL_SELFREQDCO_SHIFT 0x1
47 #define PLL_SD_MASK 0x0003FC00
48 #define PLL_SD_SHIFT 0x9
49 #define SET_PLL_GO 0x1
50 #define PLL_TICOPWDN 0x10000
55 * This is an Empirical value that works, need to confirm the actual
56 * value required for the PIPE3PHY_PLL_CONFIGURATION2.PLL_IDLE status
57 * to be correctly reflected in the PIPE3PHY_PLL_STATUS register.
59 # define PLL_IDLE_TIME 100;
61 struct pipe3_dpll_params
{
70 void __iomem
*pll_ctrl_base
;
72 struct device
*control_dev
;
78 struct pipe3_dpll_map
{
80 struct pipe3_dpll_params params
;
83 static struct pipe3_dpll_map dpll_map
[] = {
84 {12000000, {1250, 5, 4, 20, 0} }, /* 12 MHz */
85 {16800000, {3125, 20, 4, 20, 0} }, /* 16.8 MHz */
86 {19200000, {1172, 8, 4, 20, 65537} }, /* 19.2 MHz */
87 {20000000, {1000, 7, 4, 10, 0} }, /* 20 MHz */
88 {26000000, {1250, 12, 4, 20, 0} }, /* 26 MHz */
89 {38400000, {3125, 47, 4, 20, 92843} }, /* 38.4 MHz */
92 static inline u32
ti_pipe3_readl(void __iomem
*addr
, unsigned offset
)
94 return __raw_readl(addr
+ offset
);
97 static inline void ti_pipe3_writel(void __iomem
*addr
, unsigned offset
,
100 __raw_writel(data
, addr
+ offset
);
103 static struct pipe3_dpll_params
*ti_pipe3_get_dpll_params(unsigned long rate
)
107 for (i
= 0; i
< ARRAY_SIZE(dpll_map
); i
++) {
108 if (rate
== dpll_map
[i
].rate
)
109 return &dpll_map
[i
].params
;
115 static int ti_pipe3_power_off(struct phy
*x
)
117 struct ti_pipe3
*phy
= phy_get_drvdata(x
);
119 int timeout
= PLL_IDLE_TIME
;
121 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_CONFIGURATION2
);
123 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_CONFIGURATION2
, val
);
126 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_STATUS
);
127 if (val
& PLL_TICOPWDN
)
133 dev_err(phy
->dev
, "power off failed\n");
137 omap_control_phy_power(phy
->control_dev
, 0);
142 static int ti_pipe3_power_on(struct phy
*x
)
144 struct ti_pipe3
*phy
= phy_get_drvdata(x
);
146 int timeout
= PLL_IDLE_TIME
;
148 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_CONFIGURATION2
);
150 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_CONFIGURATION2
, val
);
153 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_STATUS
);
154 if (!(val
& PLL_TICOPWDN
))
160 dev_err(phy
->dev
, "power on failed\n");
167 static void ti_pipe3_dpll_relock(struct ti_pipe3
*phy
)
170 unsigned long timeout
;
172 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_GO
, SET_PLL_GO
);
174 timeout
= jiffies
+ msecs_to_jiffies(20);
176 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_STATUS
);
179 } while (!WARN_ON(time_after(jiffies
, timeout
)));
182 static int ti_pipe3_dpll_lock(struct ti_pipe3
*phy
)
186 struct pipe3_dpll_params
*dpll_params
;
188 rate
= clk_get_rate(phy
->sys_clk
);
189 dpll_params
= ti_pipe3_get_dpll_params(rate
);
192 "No DPLL configuration for %lu Hz SYS CLK\n", rate
);
196 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_CONFIGURATION1
);
197 val
&= ~PLL_REGN_MASK
;
198 val
|= dpll_params
->n
<< PLL_REGN_SHIFT
;
199 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_CONFIGURATION1
, val
);
201 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_CONFIGURATION2
);
202 val
&= ~PLL_SELFREQDCO_MASK
;
203 val
|= dpll_params
->freq
<< PLL_SELFREQDCO_SHIFT
;
204 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_CONFIGURATION2
, val
);
206 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_CONFIGURATION1
);
207 val
&= ~PLL_REGM_MASK
;
208 val
|= dpll_params
->m
<< PLL_REGM_SHIFT
;
209 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_CONFIGURATION1
, val
);
211 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_CONFIGURATION4
);
212 val
&= ~PLL_REGM_F_MASK
;
213 val
|= dpll_params
->mf
<< PLL_REGM_F_SHIFT
;
214 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_CONFIGURATION4
, val
);
216 val
= ti_pipe3_readl(phy
->pll_ctrl_base
, PLL_CONFIGURATION3
);
218 val
|= dpll_params
->sd
<< PLL_SD_SHIFT
;
219 ti_pipe3_writel(phy
->pll_ctrl_base
, PLL_CONFIGURATION3
, val
);
221 ti_pipe3_dpll_relock(phy
);
226 static int ti_pipe3_init(struct phy
*x
)
228 struct ti_pipe3
*phy
= phy_get_drvdata(x
);
231 ret
= ti_pipe3_dpll_lock(phy
);
235 omap_control_phy_power(phy
->control_dev
, 1);
240 static struct phy_ops ops
= {
241 .init
= ti_pipe3_init
,
242 .power_on
= ti_pipe3_power_on
,
243 .power_off
= ti_pipe3_power_off
,
244 .owner
= THIS_MODULE
,
247 static int ti_pipe3_probe(struct platform_device
*pdev
)
249 struct ti_pipe3
*phy
;
250 struct phy
*generic_phy
;
251 struct phy_provider
*phy_provider
;
252 struct resource
*res
;
253 struct device_node
*node
= pdev
->dev
.of_node
;
254 struct device_node
*control_node
;
255 struct platform_device
*control_pdev
;
260 phy
= devm_kzalloc(&pdev
->dev
, sizeof(*phy
), GFP_KERNEL
);
262 dev_err(&pdev
->dev
, "unable to alloc mem for TI PIPE3 PHY\n");
266 res
= platform_get_resource_byname(pdev
, IORESOURCE_MEM
, "pll_ctrl");
267 phy
->pll_ctrl_base
= devm_ioremap_resource(&pdev
->dev
, res
);
268 if (IS_ERR(phy
->pll_ctrl_base
))
269 return PTR_ERR(phy
->pll_ctrl_base
);
271 phy
->dev
= &pdev
->dev
;
273 phy
->wkupclk
= devm_clk_get(phy
->dev
, "usb_phy_cm_clk32k");
274 if (IS_ERR(phy
->wkupclk
)) {
275 dev_err(&pdev
->dev
, "unable to get usb_phy_cm_clk32k\n");
276 return PTR_ERR(phy
->wkupclk
);
278 clk_prepare(phy
->wkupclk
);
280 phy
->optclk
= devm_clk_get(phy
->dev
, "usb_otg_ss_refclk960m");
281 if (IS_ERR(phy
->optclk
)) {
282 dev_err(&pdev
->dev
, "unable to get usb_otg_ss_refclk960m\n");
283 return PTR_ERR(phy
->optclk
);
285 clk_prepare(phy
->optclk
);
287 phy
->sys_clk
= devm_clk_get(phy
->dev
, "sys_clkin");
288 if (IS_ERR(phy
->sys_clk
)) {
289 pr_err("%s: unable to get sys_clkin\n", __func__
);
293 control_node
= of_parse_phandle(node
, "ctrl-module", 0);
295 dev_err(&pdev
->dev
, "Failed to get control device phandle\n");
299 control_pdev
= of_find_device_by_node(control_node
);
301 dev_err(&pdev
->dev
, "Failed to get control device\n");
305 phy
->control_dev
= &control_pdev
->dev
;
307 omap_control_phy_power(phy
->control_dev
, 0);
309 platform_set_drvdata(pdev
, phy
);
310 pm_runtime_enable(phy
->dev
);
312 generic_phy
= devm_phy_create(phy
->dev
, &ops
, NULL
);
313 if (IS_ERR(generic_phy
))
314 return PTR_ERR(generic_phy
);
316 phy_set_drvdata(generic_phy
, phy
);
317 phy_provider
= devm_of_phy_provider_register(phy
->dev
,
318 of_phy_simple_xlate
);
319 if (IS_ERR(phy_provider
))
320 return PTR_ERR(phy_provider
);
322 pm_runtime_get(&pdev
->dev
);
327 static int ti_pipe3_remove(struct platform_device
*pdev
)
329 struct ti_pipe3
*phy
= platform_get_drvdata(pdev
);
331 clk_unprepare(phy
->wkupclk
);
332 clk_unprepare(phy
->optclk
);
333 if (!pm_runtime_suspended(&pdev
->dev
))
334 pm_runtime_put(&pdev
->dev
);
335 pm_runtime_disable(&pdev
->dev
);
340 #ifdef CONFIG_PM_RUNTIME
342 static int ti_pipe3_runtime_suspend(struct device
*dev
)
344 struct ti_pipe3
*phy
= dev_get_drvdata(dev
);
346 clk_disable(phy
->wkupclk
);
347 clk_disable(phy
->optclk
);
352 static int ti_pipe3_runtime_resume(struct device
*dev
)
355 struct ti_pipe3
*phy
= dev_get_drvdata(dev
);
357 ret
= clk_enable(phy
->optclk
);
359 dev_err(phy
->dev
, "Failed to enable optclk %d\n", ret
);
363 ret
= clk_enable(phy
->wkupclk
);
365 dev_err(phy
->dev
, "Failed to enable wkupclk %d\n", ret
);
372 clk_disable(phy
->optclk
);
378 static const struct dev_pm_ops ti_pipe3_pm_ops
= {
379 SET_RUNTIME_PM_OPS(ti_pipe3_runtime_suspend
,
380 ti_pipe3_runtime_resume
, NULL
)
383 #define DEV_PM_OPS (&ti_pipe3_pm_ops)
385 #define DEV_PM_OPS NULL
389 static const struct of_device_id ti_pipe3_id_table
[] = {
390 { .compatible
= "ti,phy-usb3" },
391 { .compatible
= "ti,omap-usb3" },
394 MODULE_DEVICE_TABLE(of
, ti_pipe3_id_table
);
397 static struct platform_driver ti_pipe3_driver
= {
398 .probe
= ti_pipe3_probe
,
399 .remove
= ti_pipe3_remove
,
402 .owner
= THIS_MODULE
,
404 .of_match_table
= of_match_ptr(ti_pipe3_id_table
),
408 module_platform_driver(ti_pipe3_driver
);
410 MODULE_ALIAS("platform: ti_pipe3");
411 MODULE_AUTHOR("Texas Instruments Inc.");
412 MODULE_DESCRIPTION("TI PIPE3 phy driver");
413 MODULE_LICENSE("GPL v2");