usb: dwc3: exynos: Fix remove() function
[platform/kernel/linux-starfive.git] / drivers / usb / dwc3 / dwc3-exynos.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * dwc3-exynos.c - Samsung Exynos DWC3 Specific Glue layer
4  *
5  * Copyright (c) 2012 Samsung Electronics Co., Ltd.
6  *              http://www.samsung.com
7  *
8  * Author: Anton Tikhomirov <av.tikhomirov@samsung.com>
9  */
10
11 #include <linux/module.h>
12 #include <linux/kernel.h>
13 #include <linux/slab.h>
14 #include <linux/platform_device.h>
15 #include <linux/clk.h>
16 #include <linux/of.h>
17 #include <linux/of_platform.h>
18 #include <linux/regulator/consumer.h>
19
20 #define DWC3_EXYNOS_MAX_CLOCKS  4
21
22 struct dwc3_exynos_driverdata {
23         const char              *clk_names[DWC3_EXYNOS_MAX_CLOCKS];
24         int                     num_clks;
25         int                     suspend_clk_idx;
26 };
27
28 struct dwc3_exynos {
29         struct device           *dev;
30
31         const char              **clk_names;
32         struct clk              *clks[DWC3_EXYNOS_MAX_CLOCKS];
33         int                     num_clks;
34         int                     suspend_clk_idx;
35
36         struct regulator        *vdd33;
37         struct regulator        *vdd10;
38 };
39
40 static int dwc3_exynos_probe(struct platform_device *pdev)
41 {
42         struct dwc3_exynos      *exynos;
43         struct device           *dev = &pdev->dev;
44         struct device_node      *node = dev->of_node;
45         const struct dwc3_exynos_driverdata *driver_data;
46         int                     i, ret;
47
48         exynos = devm_kzalloc(dev, sizeof(*exynos), GFP_KERNEL);
49         if (!exynos)
50                 return -ENOMEM;
51
52         driver_data = of_device_get_match_data(dev);
53         exynos->dev = dev;
54         exynos->num_clks = driver_data->num_clks;
55         exynos->clk_names = (const char **)driver_data->clk_names;
56         exynos->suspend_clk_idx = driver_data->suspend_clk_idx;
57
58         platform_set_drvdata(pdev, exynos);
59
60         for (i = 0; i < exynos->num_clks; i++) {
61                 exynos->clks[i] = devm_clk_get(dev, exynos->clk_names[i]);
62                 if (IS_ERR(exynos->clks[i])) {
63                         dev_err(dev, "failed to get clock: %s\n",
64                                 exynos->clk_names[i]);
65                         return PTR_ERR(exynos->clks[i]);
66                 }
67         }
68
69         for (i = 0; i < exynos->num_clks; i++) {
70                 ret = clk_prepare_enable(exynos->clks[i]);
71                 if (ret) {
72                         while (i-- > 0)
73                                 clk_disable_unprepare(exynos->clks[i]);
74                         return ret;
75                 }
76         }
77
78         if (exynos->suspend_clk_idx >= 0)
79                 clk_prepare_enable(exynos->clks[exynos->suspend_clk_idx]);
80
81         exynos->vdd33 = devm_regulator_get(dev, "vdd33");
82         if (IS_ERR(exynos->vdd33)) {
83                 ret = PTR_ERR(exynos->vdd33);
84                 goto vdd33_err;
85         }
86         ret = regulator_enable(exynos->vdd33);
87         if (ret) {
88                 dev_err(dev, "Failed to enable VDD33 supply\n");
89                 goto vdd33_err;
90         }
91
92         exynos->vdd10 = devm_regulator_get(dev, "vdd10");
93         if (IS_ERR(exynos->vdd10)) {
94                 ret = PTR_ERR(exynos->vdd10);
95                 goto vdd10_err;
96         }
97         ret = regulator_enable(exynos->vdd10);
98         if (ret) {
99                 dev_err(dev, "Failed to enable VDD10 supply\n");
100                 goto vdd10_err;
101         }
102
103         if (node) {
104                 ret = of_platform_populate(node, NULL, NULL, dev);
105                 if (ret) {
106                         dev_err(dev, "failed to add dwc3 core\n");
107                         goto populate_err;
108                 }
109         } else {
110                 dev_err(dev, "no device node, failed to add dwc3 core\n");
111                 ret = -ENODEV;
112                 goto populate_err;
113         }
114
115         return 0;
116
117 populate_err:
118         regulator_disable(exynos->vdd10);
119 vdd10_err:
120         regulator_disable(exynos->vdd33);
121 vdd33_err:
122         for (i = exynos->num_clks - 1; i >= 0; i--)
123                 clk_disable_unprepare(exynos->clks[i]);
124
125         if (exynos->suspend_clk_idx >= 0)
126                 clk_disable_unprepare(exynos->clks[exynos->suspend_clk_idx]);
127
128         return ret;
129 }
130
131 static int dwc3_exynos_remove(struct platform_device *pdev)
132 {
133         struct dwc3_exynos      *exynos = platform_get_drvdata(pdev);
134         int i;
135
136         of_platform_depopulate(&pdev->dev);
137
138         for (i = exynos->num_clks - 1; i >= 0; i--)
139                 clk_disable_unprepare(exynos->clks[i]);
140
141         if (exynos->suspend_clk_idx >= 0)
142                 clk_disable_unprepare(exynos->clks[exynos->suspend_clk_idx]);
143
144         regulator_disable(exynos->vdd33);
145         regulator_disable(exynos->vdd10);
146
147         return 0;
148 }
149
150 static const struct dwc3_exynos_driverdata exynos5250_drvdata = {
151         .clk_names = { "usbdrd30" },
152         .num_clks = 1,
153         .suspend_clk_idx = -1,
154 };
155
156 static const struct dwc3_exynos_driverdata exynos5433_drvdata = {
157         .clk_names = { "aclk", "susp_clk", "pipe_pclk", "phyclk" },
158         .num_clks = 4,
159         .suspend_clk_idx = 1,
160 };
161
162 static const struct dwc3_exynos_driverdata exynos7_drvdata = {
163         .clk_names = { "usbdrd30", "usbdrd30_susp_clk", "usbdrd30_axius_clk" },
164         .num_clks = 3,
165         .suspend_clk_idx = 1,
166 };
167
168 static const struct of_device_id exynos_dwc3_match[] = {
169         {
170                 .compatible = "samsung,exynos5250-dwusb3",
171                 .data = &exynos5250_drvdata,
172         }, {
173                 .compatible = "samsung,exynos5433-dwusb3",
174                 .data = &exynos5433_drvdata,
175         }, {
176                 .compatible = "samsung,exynos7-dwusb3",
177                 .data = &exynos7_drvdata,
178         }, {
179         }
180 };
181 MODULE_DEVICE_TABLE(of, exynos_dwc3_match);
182
183 #ifdef CONFIG_PM_SLEEP
184 static int dwc3_exynos_suspend(struct device *dev)
185 {
186         struct dwc3_exynos *exynos = dev_get_drvdata(dev);
187         int i;
188
189         for (i = exynos->num_clks - 1; i >= 0; i--)
190                 clk_disable_unprepare(exynos->clks[i]);
191
192         regulator_disable(exynos->vdd33);
193         regulator_disable(exynos->vdd10);
194
195         return 0;
196 }
197
198 static int dwc3_exynos_resume(struct device *dev)
199 {
200         struct dwc3_exynos *exynos = dev_get_drvdata(dev);
201         int i, ret;
202
203         ret = regulator_enable(exynos->vdd33);
204         if (ret) {
205                 dev_err(dev, "Failed to enable VDD33 supply\n");
206                 return ret;
207         }
208         ret = regulator_enable(exynos->vdd10);
209         if (ret) {
210                 dev_err(dev, "Failed to enable VDD10 supply\n");
211                 return ret;
212         }
213
214         for (i = 0; i < exynos->num_clks; i++) {
215                 ret = clk_prepare_enable(exynos->clks[i]);
216                 if (ret) {
217                         while (i-- > 0)
218                                 clk_disable_unprepare(exynos->clks[i]);
219                         return ret;
220                 }
221         }
222
223         return 0;
224 }
225
226 static const struct dev_pm_ops dwc3_exynos_dev_pm_ops = {
227         SET_SYSTEM_SLEEP_PM_OPS(dwc3_exynos_suspend, dwc3_exynos_resume)
228 };
229
230 #define DEV_PM_OPS      (&dwc3_exynos_dev_pm_ops)
231 #else
232 #define DEV_PM_OPS      NULL
233 #endif /* CONFIG_PM_SLEEP */
234
235 static struct platform_driver dwc3_exynos_driver = {
236         .probe          = dwc3_exynos_probe,
237         .remove         = dwc3_exynos_remove,
238         .driver         = {
239                 .name   = "exynos-dwc3",
240                 .of_match_table = exynos_dwc3_match,
241                 .pm     = DEV_PM_OPS,
242         },
243 };
244
245 module_platform_driver(dwc3_exynos_driver);
246
247 MODULE_AUTHOR("Anton Tikhomirov <av.tikhomirov@samsung.com>");
248 MODULE_LICENSE("GPL v2");
249 MODULE_DESCRIPTION("DesignWare USB3 Exynos Glue Layer");