video: tegra: host: correct runtime pm callback registeration
[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 #if defined(CONFIG_PM_RUNTIME) && !defined(CONFIG_PM_GENERIC_DOMAINS)
254         .runtime_suspend = nvhost_module_disable_clk,
255         .runtime_resume = nvhost_module_enable_clk,
256 #endif
257 };
258 #endif
259
260 static struct platform_driver vi_driver = {
261         .probe = vi_probe,
262         .remove = __exit_p(vi_remove),
263         .driver = {
264                 .owner = THIS_MODULE,
265                 .name = "vi",
266 #ifdef CONFIG_PM
267                 .pm = &vi_pm_ops,
268 #endif
269 #ifdef CONFIG_OF
270                 .of_match_table = tegra_vi_of_match,
271 #endif
272         }
273 };
274
275 static int __init vi_init(void)
276 {
277         return platform_driver_register(&vi_driver);
278 }
279
280 static void __exit vi_exit(void)
281 {
282         platform_driver_unregister(&vi_driver);
283 }
284
285 #ifdef TEGRA_12X_OR_HIGHER_CONFIG
286 int nvhost_vi_init(struct platform_device *dev)
287 {
288         int ret = 0;
289         struct vi *tegra_vi;
290         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
291
292         tegra_vi->reg = regulator_get(&dev->dev, "avdd_dsi_csi");
293         if (IS_ERR_OR_NULL(tegra_vi->reg)) {
294                 if (tegra_vi->reg == ERR_PTR(-ENODEV)) {
295                         ret = -ENODEV;
296                         dev_info(&dev->dev,
297                                 "%s: no regulator device\n",
298                                 __func__);
299                 } else {
300                         dev_err(&dev->dev,
301                                 "%s: couldn't get regulator\n",
302                                 __func__);
303                 }
304                 tegra_vi->reg = NULL;
305         }
306         if (tegra_vi->clk_gate)
307                 clk_prepare_enable(tegra_vi->clk_gate);
308         return ret;
309 }
310
311 void nvhost_vi_deinit(struct platform_device *dev)
312 {
313         struct vi *tegra_vi;
314         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
315
316         if (tegra_vi->reg)
317                 regulator_put(tegra_vi->reg);
318         if (tegra_vi->clk_gate)
319                 clk_disable_unprepare(tegra_vi->clk_gate);
320 }
321
322 int nvhost_vi_finalize_poweron(struct platform_device *dev)
323 {
324         int ret = 0;
325         struct vi *tegra_vi;
326         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
327
328         if (tegra_vi->reg) {
329                 ret = regulator_enable(tegra_vi->reg);
330                 if (ret)
331                         dev_err(&dev->dev,
332                                 "%s: enable csi regulator failed.\n",
333                                 __func__);
334         }
335         return ret;
336 }
337
338 int nvhost_vi_prepare_poweroff(struct platform_device *dev)
339 {
340         int ret = 0;
341         struct vi *tegra_vi;
342         tegra_vi = (struct vi *)nvhost_get_private_data(dev);
343
344         if (tegra_vi->reg) {
345                 ret = regulator_disable(tegra_vi->reg);
346                 if (ret)
347                         dev_err(&dev->dev,
348                                 "%s: disable csi regulator failed.\n",
349                                 __func__);
350         }
351         return ret;
352 }
353 #endif
354 late_initcall(vi_init);
355 module_exit(vi_exit);