Revert "phy: merge and backport phy core from linux kernel 4.1"
[firefly-linux-kernel-4.4.55.git] / drivers / phy / phy-samsung-usb2.c
1 /*
2  * Samsung SoC USB 1.1/2.0 PHY driver
3  *
4  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
5  * Author: Kamil Debski <k.debski@samsung.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11
12 #include <linux/clk.h>
13 #include <linux/mfd/syscon.h>
14 #include <linux/module.h>
15 #include <linux/of.h>
16 #include <linux/of_address.h>
17 #include <linux/phy/phy.h>
18 #include <linux/platform_device.h>
19 #include <linux/spinlock.h>
20 #include "phy-samsung-usb2.h"
21
22 static int samsung_usb2_phy_power_on(struct phy *phy)
23 {
24         struct samsung_usb2_phy_instance *inst = phy_get_drvdata(phy);
25         struct samsung_usb2_phy_driver *drv = inst->drv;
26         int ret;
27
28         dev_dbg(drv->dev, "Request to power_on \"%s\" usb phy\n",
29                 inst->cfg->label);
30         ret = clk_prepare_enable(drv->clk);
31         if (ret)
32                 goto err_main_clk;
33         ret = clk_prepare_enable(drv->ref_clk);
34         if (ret)
35                 goto err_instance_clk;
36         if (inst->cfg->power_on) {
37                 spin_lock(&drv->lock);
38                 ret = inst->cfg->power_on(inst);
39                 spin_unlock(&drv->lock);
40         }
41
42         return 0;
43
44 err_instance_clk:
45         clk_disable_unprepare(drv->clk);
46 err_main_clk:
47         return ret;
48 }
49
50 static int samsung_usb2_phy_power_off(struct phy *phy)
51 {
52         struct samsung_usb2_phy_instance *inst = phy_get_drvdata(phy);
53         struct samsung_usb2_phy_driver *drv = inst->drv;
54         int ret = 0;
55
56         dev_dbg(drv->dev, "Request to power_off \"%s\" usb phy\n",
57                 inst->cfg->label);
58         if (inst->cfg->power_off) {
59                 spin_lock(&drv->lock);
60                 ret = inst->cfg->power_off(inst);
61                 spin_unlock(&drv->lock);
62         }
63         clk_disable_unprepare(drv->ref_clk);
64         clk_disable_unprepare(drv->clk);
65         return ret;
66 }
67
68 static struct phy_ops samsung_usb2_phy_ops = {
69         .power_on       = samsung_usb2_phy_power_on,
70         .power_off      = samsung_usb2_phy_power_off,
71         .owner          = THIS_MODULE,
72 };
73
74 static struct phy *samsung_usb2_phy_xlate(struct device *dev,
75                                         struct of_phandle_args *args)
76 {
77         struct samsung_usb2_phy_driver *drv;
78
79         drv = dev_get_drvdata(dev);
80         if (!drv)
81                 return ERR_PTR(-EINVAL);
82
83         if (WARN_ON(args->args[0] >= drv->cfg->num_phys))
84                 return ERR_PTR(-ENODEV);
85
86         return drv->instances[args->args[0]].phy;
87 }
88
89 static const struct of_device_id samsung_usb2_phy_of_match[] = {
90 #ifdef CONFIG_PHY_EXYNOS4X12_USB2
91         {
92                 .compatible = "samsung,exynos3250-usb2-phy",
93                 .data = &exynos3250_usb2_phy_config,
94         },
95 #endif
96 #ifdef CONFIG_PHY_EXYNOS4210_USB2
97         {
98                 .compatible = "samsung,exynos4210-usb2-phy",
99                 .data = &exynos4210_usb2_phy_config,
100         },
101 #endif
102 #ifdef CONFIG_PHY_EXYNOS4X12_USB2
103         {
104                 .compatible = "samsung,exynos4x12-usb2-phy",
105                 .data = &exynos4x12_usb2_phy_config,
106         },
107 #endif
108 #ifdef CONFIG_PHY_EXYNOS5250_USB2
109         {
110                 .compatible = "samsung,exynos5250-usb2-phy",
111                 .data = &exynos5250_usb2_phy_config,
112         },
113 #endif
114 #ifdef CONFIG_PHY_S5PV210_USB2
115         {
116                 .compatible = "samsung,s5pv210-usb2-phy",
117                 .data = &s5pv210_usb2_phy_config,
118         },
119 #endif
120         { },
121 };
122 MODULE_DEVICE_TABLE(of, samsung_usb2_phy_of_match);
123
124 static int samsung_usb2_phy_probe(struct platform_device *pdev)
125 {
126         const struct of_device_id *match;
127         const struct samsung_usb2_phy_config *cfg;
128         struct device *dev = &pdev->dev;
129         struct phy_provider *phy_provider;
130         struct resource *mem;
131         struct samsung_usb2_phy_driver *drv;
132         int i, ret;
133
134         if (!pdev->dev.of_node) {
135                 dev_err(dev, "This driver is required to be instantiated from device tree\n");
136                 return -EINVAL;
137         }
138
139         match = of_match_node(samsung_usb2_phy_of_match, pdev->dev.of_node);
140         if (!match) {
141                 dev_err(dev, "of_match_node() failed\n");
142                 return -EINVAL;
143         }
144         cfg = match->data;
145
146         drv = devm_kzalloc(dev, sizeof(struct samsung_usb2_phy_driver) +
147                 cfg->num_phys * sizeof(struct samsung_usb2_phy_instance),
148                                                                 GFP_KERNEL);
149         if (!drv)
150                 return -ENOMEM;
151
152         dev_set_drvdata(dev, drv);
153         spin_lock_init(&drv->lock);
154
155         drv->cfg = cfg;
156         drv->dev = dev;
157
158         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
159         drv->reg_phy = devm_ioremap_resource(dev, mem);
160         if (IS_ERR(drv->reg_phy)) {
161                 dev_err(dev, "Failed to map register memory (phy)\n");
162                 return PTR_ERR(drv->reg_phy);
163         }
164
165         drv->reg_pmu = syscon_regmap_lookup_by_phandle(pdev->dev.of_node,
166                 "samsung,pmureg-phandle");
167         if (IS_ERR(drv->reg_pmu)) {
168                 dev_err(dev, "Failed to map PMU registers (via syscon)\n");
169                 return PTR_ERR(drv->reg_pmu);
170         }
171
172         if (drv->cfg->has_mode_switch) {
173                 drv->reg_sys = syscon_regmap_lookup_by_phandle(
174                                 pdev->dev.of_node, "samsung,sysreg-phandle");
175                 if (IS_ERR(drv->reg_sys)) {
176                         dev_err(dev, "Failed to map system registers (via syscon)\n");
177                         return PTR_ERR(drv->reg_sys);
178                 }
179         }
180
181         drv->clk = devm_clk_get(dev, "phy");
182         if (IS_ERR(drv->clk)) {
183                 dev_err(dev, "Failed to get clock of phy controller\n");
184                 return PTR_ERR(drv->clk);
185         }
186
187         drv->ref_clk = devm_clk_get(dev, "ref");
188         if (IS_ERR(drv->ref_clk)) {
189                 dev_err(dev, "Failed to get reference clock for the phy controller\n");
190                 return PTR_ERR(drv->ref_clk);
191         }
192
193         drv->ref_rate = clk_get_rate(drv->ref_clk);
194         if (drv->cfg->rate_to_clk) {
195                 ret = drv->cfg->rate_to_clk(drv->ref_rate, &drv->ref_reg_val);
196                 if (ret)
197                         return ret;
198         }
199
200         for (i = 0; i < drv->cfg->num_phys; i++) {
201                 char *label = drv->cfg->phys[i].label;
202                 struct samsung_usb2_phy_instance *p = &drv->instances[i];
203
204                 dev_dbg(dev, "Creating phy \"%s\"\n", label);
205                 p->phy = devm_phy_create(dev, NULL, &samsung_usb2_phy_ops,
206                                          NULL);
207                 if (IS_ERR(p->phy)) {
208                         dev_err(drv->dev, "Failed to create usb2_phy \"%s\"\n",
209                                 label);
210                         return PTR_ERR(p->phy);
211                 }
212
213                 p->cfg = &drv->cfg->phys[i];
214                 p->drv = drv;
215                 phy_set_bus_width(p->phy, 8);
216                 phy_set_drvdata(p->phy, p);
217         }
218
219         phy_provider = devm_of_phy_provider_register(dev,
220                                                         samsung_usb2_phy_xlate);
221         if (IS_ERR(phy_provider)) {
222                 dev_err(drv->dev, "Failed to register phy provider\n");
223                 return PTR_ERR(phy_provider);
224         }
225
226         return 0;
227 }
228
229 static struct platform_driver samsung_usb2_phy_driver = {
230         .probe  = samsung_usb2_phy_probe,
231         .driver = {
232                 .of_match_table = samsung_usb2_phy_of_match,
233                 .name           = "samsung-usb2-phy",
234         }
235 };
236
237 module_platform_driver(samsung_usb2_phy_driver);
238 MODULE_DESCRIPTION("Samsung S5P/EXYNOS SoC USB PHY driver");
239 MODULE_AUTHOR("Kamil Debski <k.debski@samsung.com>");
240 MODULE_LICENSE("GPL v2");
241 MODULE_ALIAS("platform:samsung-usb2-phy");