aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/usb/dwc3/dwc3-of-simple.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/usb/dwc3/dwc3-of-simple.c')
-rw-r--r--drivers/usb/dwc3/dwc3-of-simple.c95
1 files changed, 17 insertions, 78 deletions
diff --git a/drivers/usb/dwc3/dwc3-of-simple.c b/drivers/usb/dwc3/dwc3-of-simple.c
index 4c2771c5e727..c4da82dd15c7 100644
--- a/drivers/usb/dwc3/dwc3-of-simple.c
+++ b/drivers/usb/dwc3/dwc3-of-simple.c
@@ -24,59 +24,13 @@
24 24
25struct dwc3_of_simple { 25struct dwc3_of_simple {
26 struct device *dev; 26 struct device *dev;
27 struct clk **clks; 27 struct clk_bulk_data *clks;
28 int num_clocks; 28 int num_clocks;
29 struct reset_control *resets; 29 struct reset_control *resets;
30 bool pulse_resets; 30 bool pulse_resets;
31 bool need_reset; 31 bool need_reset;
32}; 32};
33 33
34static int dwc3_of_simple_clk_init(struct dwc3_of_simple *simple, int count)
35{
36 struct device *dev = simple->dev;
37 struct device_node *np = dev->of_node;
38 int i;
39
40 simple->num_clocks = count;
41
42 if (!count)
43 return 0;
44
45 simple->clks = devm_kcalloc(dev, simple->num_clocks,
46 sizeof(struct clk *), GFP_KERNEL);
47 if (!simple->clks)
48 return -ENOMEM;
49
50 for (i = 0; i < simple->num_clocks; i++) {
51 struct clk *clk;
52 int ret;
53
54 clk = of_clk_get(np, i);
55 if (IS_ERR(clk)) {
56 while (--i >= 0) {
57 clk_disable_unprepare(simple->clks[i]);
58 clk_put(simple->clks[i]);
59 }
60 return PTR_ERR(clk);
61 }
62
63 ret = clk_prepare_enable(clk);
64 if (ret < 0) {
65 while (--i >= 0) {
66 clk_disable_unprepare(simple->clks[i]);
67 clk_put(simple->clks[i]);
68 }
69 clk_put(clk);
70
71 return ret;
72 }
73
74 simple->clks[i] = clk;
75 }
76
77 return 0;
78}
79
80static int dwc3_of_simple_probe(struct platform_device *pdev) 34static int dwc3_of_simple_probe(struct platform_device *pdev)
81{ 35{
82 struct dwc3_of_simple *simple; 36 struct dwc3_of_simple *simple;
@@ -84,7 +38,6 @@ static int dwc3_of_simple_probe(struct platform_device *pdev)
84 struct device_node *np = dev->of_node; 38 struct device_node *np = dev->of_node;
85 39
86 int ret; 40 int ret;
87 int i;
88 bool shared_resets = false; 41 bool shared_resets = false;
89 42
90 simple = devm_kzalloc(dev, sizeof(*simple), GFP_KERNEL); 43 simple = devm_kzalloc(dev, sizeof(*simple), GFP_KERNEL);
@@ -124,20 +77,18 @@ static int dwc3_of_simple_probe(struct platform_device *pdev)
124 goto err_resetc_put; 77 goto err_resetc_put;
125 } 78 }
126 79
127 ret = dwc3_of_simple_clk_init(simple, of_count_phandle_with_args(np, 80 ret = clk_bulk_get_all(simple->dev, &simple->clks);
128 "clocks", "#clock-cells")); 81 if (ret < 0)
82 goto err_resetc_assert;
83
84 simple->num_clocks = ret;
85 ret = clk_bulk_prepare_enable(simple->num_clocks, simple->clks);
129 if (ret) 86 if (ret)
130 goto err_resetc_assert; 87 goto err_resetc_assert;
131 88
132 ret = of_platform_populate(np, NULL, NULL, dev); 89 ret = of_platform_populate(np, NULL, NULL, dev);
133 if (ret) { 90 if (ret)
134 for (i = 0; i < simple->num_clocks; i++) { 91 goto err_clk_put;
135 clk_disable_unprepare(simple->clks[i]);
136 clk_put(simple->clks[i]);
137 }
138
139 goto err_resetc_assert;
140 }
141 92
142 pm_runtime_set_active(dev); 93 pm_runtime_set_active(dev);
143 pm_runtime_enable(dev); 94 pm_runtime_enable(dev);
@@ -145,6 +96,10 @@ static int dwc3_of_simple_probe(struct platform_device *pdev)
145 96
146 return 0; 97 return 0;
147 98
99err_clk_put:
100 clk_bulk_disable_unprepare(simple->num_clocks, simple->clks);
101 clk_bulk_put_all(simple->num_clocks, simple->clks);
102
148err_resetc_assert: 103err_resetc_assert:
149 if (!simple->pulse_resets) 104 if (!simple->pulse_resets)
150 reset_control_assert(simple->resets); 105 reset_control_assert(simple->resets);
@@ -158,14 +113,11 @@ static int dwc3_of_simple_remove(struct platform_device *pdev)
158{ 113{
159 struct dwc3_of_simple *simple = platform_get_drvdata(pdev); 114 struct dwc3_of_simple *simple = platform_get_drvdata(pdev);
160 struct device *dev = &pdev->dev; 115 struct device *dev = &pdev->dev;
161 int i;
162 116
163 of_platform_depopulate(dev); 117 of_platform_depopulate(dev);
164 118
165 for (i = 0; i < simple->num_clocks; i++) { 119 clk_bulk_disable_unprepare(simple->num_clocks, simple->clks);
166 clk_disable_unprepare(simple->clks[i]); 120 clk_bulk_put_all(simple->num_clocks, simple->clks);
167 clk_put(simple->clks[i]);
168 }
169 simple->num_clocks = 0; 121 simple->num_clocks = 0;
170 122
171 if (!simple->pulse_resets) 123 if (!simple->pulse_resets)
@@ -183,10 +135,8 @@ static int dwc3_of_simple_remove(struct platform_device *pdev)
183static int __maybe_unused dwc3_of_simple_runtime_suspend(struct device *dev) 135static int __maybe_unused dwc3_of_simple_runtime_suspend(struct device *dev)
184{ 136{
185 struct dwc3_of_simple *simple = dev_get_drvdata(dev); 137 struct dwc3_of_simple *simple = dev_get_drvdata(dev);
186 int i;
187 138
188 for (i = 0; i < simple->num_clocks; i++) 139 clk_bulk_disable(simple->num_clocks, simple->clks);
189 clk_disable(simple->clks[i]);
190 140
191 return 0; 141 return 0;
192} 142}
@@ -194,19 +144,8 @@ static int __maybe_unused dwc3_of_simple_runtime_suspend(struct device *dev)
194static int __maybe_unused dwc3_of_simple_runtime_resume(struct device *dev) 144static int __maybe_unused dwc3_of_simple_runtime_resume(struct device *dev)
195{ 145{
196 struct dwc3_of_simple *simple = dev_get_drvdata(dev); 146 struct dwc3_of_simple *simple = dev_get_drvdata(dev);
197 int ret;
198 int i;
199
200 for (i = 0; i < simple->num_clocks; i++) {
201 ret = clk_enable(simple->clks[i]);
202 if (ret < 0) {
203 while (--i >= 0)
204 clk_disable(simple->clks[i]);
205 return ret;
206 }
207 }
208 147
209 return 0; 148 return clk_bulk_enable(simple->num_clocks, simple->clks);
210} 149}
211 150
212static int __maybe_unused dwc3_of_simple_suspend(struct device *dev) 151static int __maybe_unused dwc3_of_simple_suspend(struct device *dev)