video: tegra: nvhost: move camera clks to nvhost
[linux-3.10.git] / drivers / video / tegra / host / vi / vi.c
1 /*
2  * drivers/video/tegra/host/vi/vi.c
3  *
4  * Tegra Graphics Host VI
5  *
6  * Copyright (c) 2012-2013, NVIDIA Corporation.
7  *
8  * This program is free software; you can redistribute it and/or modify it
9  * under the terms and conditions of the GNU General Public License,
10  * version 2, as published by the Free Software Foundation.
11  *
12  * This program is distributed in the hope it will be useful, but WITHOUT
13  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
14  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
15  * more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
19  */
20
21 #include <linux/export.h>
22 #include <linux/resource.h>
23 #include <linux/pm_runtime.h>
24 #include <linux/of.h>
25 #include <linux/of_device.h>
26 #include <linux/of_platform.h>
27
28 #include <mach/pm_domains.h>
29
30 #include "dev.h"
31 #include "bus_client.h"
32 #include "nvhost_acm.h"
33 #include "t20/t20.h"
34 #include "t30/t30.h"
35 #include "t114/t114.h"
36 #include "t148/t148.h"
37 #include "t124/t124.h"
38 #include "vi.h"
39
40 #define MAX_DEVID_LENGTH        16
41
42 static struct of_device_id tegra_vi_of_match[] = {
43 #ifdef TEGRA_2X_OR_HIGHER_CONFIG
44         { .compatible = "nvidia,tegra20-vi",
45                 .data = (struct nvhost_device_data *)&t20_vi_info },
46 #endif
47 #ifdef TEGRA_3X_OR_HIGHER_CONFIG
48         { .compatible = "nvidia,tegra30-vi",
49                 .data = (struct nvhost_device_data *)&t30_vi_info },
50 #endif
51 #ifdef TEGRA_11X_OR_HIGHER_CONFIG
52         { .compatible = "nvidia,tegra114-vi",
53                 .data = (struct nvhost_device_data *)&t11_vi_info },
54 #endif
55 #ifdef TEGRA_14X_OR_HIGHER_CONFIG
56         { .compatible = "nvidia,tegra148-vi",
57                 .data = (struct nvhost_device_data *)&t14_vi_info },
58 #endif
59 #ifdef TEGRA_12X_OR_HIGHER_CONFIG
60         { .compatible = "nvidia,tegra124-vi",
61                 .data = (struct nvhost_device_data *)&t124_vi_info },
62 #endif
63         { },
64 };
65
66 #ifdef CONFIG_PM_GENERIC_DOMAINS
67 static int vi_unpowergate(struct generic_pm_domain *domain)
68 {
69         struct nvhost_device_data *pdata;
70
71         pdata = container_of(domain, struct nvhost_device_data, pd);
72         return nvhost_module_power_on(pdata->pdev);
73 }
74
75 static int vi_powergate(struct generic_pm_domain *domain)
76 {
77         struct nvhost_device_data *pdata;
78
79         pdata = container_of(domain, struct nvhost_device_data, pd);
80         return nvhost_module_power_off(pdata->pdev);
81 }
82 #endif
83
84 static int vi_probe(struct platform_device *dev)
85 {
86         int err = 0;
87         struct vi *tegra_vi;
88         struct nvhost_device_data *pdata = NULL;
89 #ifdef TEGRA_12X_OR_HIGHER_CONFIG
90         char devname[MAX_DEVID_LENGTH];
91 #endif
92
93         if (dev->dev.of_node) {
94                 const struct of_device_id *match;
95
96                 match = of_match_device(tegra_vi_of_match, &dev->dev);
97                 if (match)
98                         pdata = (struct nvhost_device_data *)match->data;
99         } else
100                 pdata = (struct nvhost_device_data *)dev->dev.platform_data;
101
102         WARN_ON(!pdata);
103         if (!pdata) {
104                 dev_info(&dev->dev, "no platform data\n");
105                 return -ENODATA;
106         }
107
108         dev_info(&dev->dev, "%s: ++\n", __func__);
109
110         tegra_vi = kzalloc(sizeof(struct vi), GFP_KERNEL);
111         if (!tegra_vi) {
112                 dev_err(&dev->dev, "can't allocate memory for vi\n");
113                 return -ENOMEM;
114         }
115
116         tegra_vi->ndev = dev;
117 #ifdef TEGRA_12X_OR_HIGHER_CONFIG
118         snprintf(devname, MAX_DEVID_LENGTH,
119                  (dev->id <= 0) ? "tegra_%s" : "tegra_%s.%d",
120                  dev->name, dev->id);
121         if (dev->id == 1)
122                 tegra_vi->clk_gate = clk_get_sys(devname, "vim2_clk");
123         else
124                 tegra_vi->clk_gate = clk_get_sys(devname, "csus");
125         if (IS_ERR(tegra_vi->clk_gate))
126                 dev_err(&dev->dev, "clk_get_sys failed for clk_gate of %s",
127                         devname);
128 #endif
129         pdata->private_data = tegra_vi;
130 #ifdef CONFIG_TEGRA_CAMERA
131         tegra_vi->camera = tegra_camera_register(dev);
132         if (!tegra_vi->camera) {
133                 dev_err(&dev->dev, "%s: can't register tegra_camera\n",
134                                 __func__);
135                 goto camera_register_fail;
136         }
137 #endif
138
139         pdata->pdev = dev;
140         mutex_init(&pdata->lock);
141         platform_set_drvdata(dev, pdata);
142         nvhost_module_init(dev);
143
144 #ifdef CONFIG_PM_GENERIC_DOMAINS
145         pdata->pd.name = "ve";
146         pdata->pd.power_off = vi_powergate;
147         pdata->pd.power_on = vi_unpowergate;
148         pdata->pd.dev_ops.start = nvhost_module_enable_clk;
149         pdata->pd.dev_ops.stop = nvhost_module_disable_clk;
150
151         /* add module power domain and also add its domain
152          * as sub-domain of MC domain */
153         err = nvhost_module_add_domain(&pdata->pd, dev);
154
155         /* overwrite save/restore fptrs set by pm_genpd_init */
156         pdata->pd.domain.ops.suspend = nvhost_client_device_suspend;
157         pdata->pd.domain.ops.resume = nvhost_client_device_resume;
158 #endif
159
160         err = nvhost_client_device_get_resources(dev);
161         if (err)
162                 goto camera_register_fail;
163
164         err = nvhost_client_device_init(dev);
165         if (err)
166                 goto camera_register_fail;
167
168 #ifdef CONFIG_PM_RUNTIME
169         if (pdata->clockgate_delay) {
170                 pm_runtime_set_autosuspend_delay(&dev->dev,
171                         pdata->clockgate_delay);
172                 pm_runtime_use_autosuspend(&dev->dev);
173         }
174         pm_runtime_enable(&dev->dev);
175 #else
176         nvhost_module_enable_clk(&dev->dev);
177 #endif
178
179         return 0;
180
181 camera_register_fail:
182         kfree(tegra_vi);
183         return err;
184 }
185
186 static int __exit vi_remove(struct platform_device *dev)
187 {
188 #ifdef CONFIG_TEGRA_CAMERA
189         int err = 0;
190         struct nvhost_device_data *pdata =
191                 (struct nvhost_device_data *)platform_get_drvdata(dev);
192         struct vi *tegra_vi = (struct vi *)pdata->private_data;
193 #endif
194
195         dev_info(&dev->dev, "%s: ++\n", __func__);
196
197 #ifdef CONFIG_TEGRA_CAMERA
198         err = tegra_camera_unregister(tegra_vi->camera);
199         if (err)
200                 return err;
201 #endif
202
203 #ifdef CONFIG_PM_RUNTIME
204         pm_runtime_put(&dev->dev);
205         pm_runtime_disable(&dev->dev);
206 #else
207         nvhost_module_disable_clk(&dev->dev);
208 #endif
209
210         return 0;
211 }
212
213 #ifdef CONFIG_PM
214 static int vi_suspend(struct device *dev)
215 {
216 #ifdef CONFIG_TEGRA_CAMERA
217         struct platform_device *pdev = to_platform_device(dev);
218         struct nvhost_device_data *pdata =
219                 (struct nvhost_device_data *)platform_get_drvdata(pdev);
220         struct vi *tegra_vi = (struct vi *)pdata->private_data;
221 #endif
222
223         dev_info(dev, "%s: ++\n", __func__);
224
225 #ifdef CONFIG_TEGRA_CAMERA
226         tegra_camera_suspend(tegra_vi->camera);
227 #endif
228
229         return nvhost_client_device_suspend(dev);
230 }
231
232 static int vi_resume(struct device *dev)
233 {
234 #ifdef CONFIG_TEGRA_CAMERA
235         struct platform_device *pdev = to_platform_device(dev);
236         struct nvhost_device_data *pdata =
237                 (struct nvhost_device_data *)platform_get_drvdata(pdev);
238         struct vi *tegra_vi = (struct vi *)pdata->private_data;
239 #endif
240
241         dev_info(dev, "%s: ++\n", __func__);
242
243 #ifdef CONFIG_TEGRA_CAMERA
244         tegra_camera_resume(tegra_vi->camera);
245 #endif
246
247         return 0;
248 }
249
250 static const struct dev_pm_ops vi_pm_ops = {
251         .suspend = vi_suspend,
252         .resume = vi_resume,
253         SET_RUNTIME_PM_OPS(nvhost_module_disable_clk,
254                 nvhost_module_enable_clk, NULL)
255 };
256 #endif
257
258 static struct platform_driver vi_driver = {
259         .probe = vi_probe,
260         .remove = __exit_p(vi_remove),
261         .driver = {
262                 .owner = THIS_MODULE,
263                 .name = "vi",
264 #ifdef CONFIG_PM
265                 .pm = &vi_pm_ops,
266 #endif
267 #ifdef CONFIG_OF
268                 .of_match_table = tegra_vi_of_match,
269 #endif
270         }
271 };
272
273 static int __init vi_init(void)
274 {
275         return platform_driver_register(&vi_driver);
276 }
277
278 static void __exit vi_exit(void)
279 {
280         platform_driver_unregister(&vi_driver);
281 }
282
283 #ifdef TEGRA_12X_OR_HIGHER_CONFIG
284 int nvhost_vi_init(struct platform_device *dev)
285 {
286         int ret = 0;
287         struct vi *tegra_vi;
288         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
289
290         tegra_vi->reg = regulator_get(&dev->dev, "avdd_dsi_csi");
291         if (IS_ERR_OR_NULL(tegra_vi->reg)) {
292                 if (tegra_vi->reg == ERR_PTR(-ENODEV)) {
293                         ret = -ENODEV;
294                         dev_info(&dev->dev,
295                                 "%s: no regulator device\n",
296                                 __func__);
297                 } else {
298                         dev_err(&dev->dev,
299                                 "%s: couldn't get regulator\n",
300                                 __func__);
301                 }
302                 tegra_vi->reg = NULL;
303         }
304         if (tegra_vi->clk_gate)
305                 clk_prepare_enable(tegra_vi->clk_gate);
306         return ret;
307 }
308
309 void nvhost_vi_deinit(struct platform_device *dev)
310 {
311         struct vi *tegra_vi;
312         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
313
314         if (tegra_vi->reg)
315                 regulator_put(tegra_vi->reg);
316         if (tegra_vi->clk_gate)
317                 clk_disable_unprepare(tegra_vi->clk_gate);
318 }
319
320 int nvhost_vi_finalize_poweron(struct platform_device *dev)
321 {
322         int ret = 0;
323         struct vi *tegra_vi;
324         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
325
326         if (tegra_vi->reg) {
327                 ret = regulator_enable(tegra_vi->reg);
328                 if (ret)
329                         dev_err(&dev->dev,
330                                 "%s: enable csi regulator failed.\n",
331                                 __func__);
332         }
333         return ret;
334 }
335
336 int nvhost_vi_prepare_poweroff(struct platform_device *dev)
337 {
338         int ret = 0;
339         struct vi *tegra_vi;
340         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
341
342         if (tegra_vi->reg) {
343                 ret = regulator_disable(tegra_vi->reg);
344                 if (ret)
345                         dev_err(&dev->dev,
346                                 "%s: disable csi regulator failed.\n",
347                                 __func__);
348         }
349         return ret;
350 }
351 #endif
352 late_initcall(vi_init);
353 module_exit(vi_exit);