video: tegra: host: handle !PM_RUNTIME
[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 static struct of_device_id tegra_vi_of_match[] = {
41 #ifdef TEGRA_2X_OR_HIGHER_CONFIG
42         { .compatible = "nvidia,tegra20-vi",
43                 .data = (struct nvhost_device_data *)&t20_vi_info },
44 #endif
45 #ifdef TEGRA_3X_OR_HIGHER_CONFIG
46         { .compatible = "nvidia,tegra30-vi",
47                 .data = (struct nvhost_device_data *)&t30_vi_info },
48 #endif
49 #ifdef TEGRA_11X_OR_HIGHER_CONFIG
50         { .compatible = "nvidia,tegra114-vi",
51                 .data = (struct nvhost_device_data *)&t11_vi_info },
52 #endif
53 #ifdef TEGRA_14X_OR_HIGHER_CONFIG
54         { .compatible = "nvidia,tegra148-vi",
55                 .data = (struct nvhost_device_data *)&t14_vi_info },
56 #endif
57 #ifdef TEGRA_12X_OR_HIGHER_CONFIG
58         { .compatible = "nvidia,tegra124-vi",
59                 .data = (struct nvhost_device_data *)&t124_vi_info },
60 #endif
61         { },
62 };
63
64 #ifdef CONFIG_PM_GENERIC_DOMAINS
65 static int vi_unpowergate(struct generic_pm_domain *domain)
66 {
67         struct nvhost_device_data *pdata;
68
69         pdata = container_of(domain, struct nvhost_device_data, pd);
70         return nvhost_module_power_on(pdata->pdev);
71 }
72
73 static int vi_powergate(struct generic_pm_domain *domain)
74 {
75         struct nvhost_device_data *pdata;
76
77         pdata = container_of(domain, struct nvhost_device_data, pd);
78         return nvhost_module_power_off(pdata->pdev);
79 }
80 #endif
81
82 static int vi_probe(struct platform_device *dev)
83 {
84         int err = 0;
85         struct vi *tegra_vi;
86         struct nvhost_device_data *pdata = NULL;
87
88         if (dev->dev.of_node) {
89                 const struct of_device_id *match;
90
91                 match = of_match_device(tegra_vi_of_match, &dev->dev);
92                 if (match)
93                         pdata = (struct nvhost_device_data *)match->data;
94         } else
95                 pdata = (struct nvhost_device_data *)dev->dev.platform_data;
96
97         WARN_ON(!pdata);
98         if (!pdata) {
99                 dev_info(&dev->dev, "no platform data\n");
100                 return -ENODATA;
101         }
102
103         dev_info(&dev->dev, "%s: ++\n", __func__);
104         tegra_vi = kzalloc(sizeof(struct vi), GFP_KERNEL);
105         if (!tegra_vi) {
106                 dev_err(&dev->dev, "can't allocate memory for vi\n");
107                 return -ENOMEM;
108         }
109
110         tegra_vi->ndev = dev;
111         pdata->private_data = tegra_vi;
112
113 #ifdef CONFIG_TEGRA_CAMERA
114         tegra_vi->camera = tegra_camera_register(dev);
115         if (!tegra_vi->camera) {
116                 dev_err(&dev->dev, "%s: can't register tegra_camera\n",
117                                 __func__);
118                 goto camera_register_fail;
119         }
120 #endif
121         pdata->pdev = dev;
122         mutex_init(&pdata->lock);
123         platform_set_drvdata(dev, pdata);
124         nvhost_module_init(dev);
125
126 #ifdef CONFIG_PM_GENERIC_DOMAINS
127         pdata->pd.name = "ve";
128         pdata->pd.power_off = vi_powergate;
129         pdata->pd.power_on = vi_unpowergate;
130         pdata->pd.dev_ops.start = nvhost_module_enable_clk;
131         pdata->pd.dev_ops.stop = nvhost_module_disable_clk;
132
133         /* add module power domain and also add its domain
134          * as sub-domain of MC domain */
135         err = nvhost_module_add_domain(&pdata->pd, dev);
136
137         /* overwrite save/restore fptrs set by pm_genpd_init */
138         pdata->pd.domain.ops.suspend = nvhost_client_device_suspend;
139         pdata->pd.domain.ops.resume = nvhost_client_device_resume;
140 #endif
141
142         err = nvhost_client_device_get_resources(dev);
143         if (err)
144                 goto camera_register_fail;
145
146         err = nvhost_client_device_init(dev);
147         if (err)
148                 goto camera_register_fail;
149
150 #ifdef CONFIG_PM_RUNTIME
151         if (pdata->clockgate_delay) {
152                 pm_runtime_set_autosuspend_delay(&dev->dev,
153                         pdata->clockgate_delay);
154                 pm_runtime_use_autosuspend(&dev->dev);
155         }
156         pm_runtime_enable(&dev->dev);
157 #else
158         nvhost_module_enable_clk(&dev->dev);
159 #endif
160
161         return 0;
162
163 camera_register_fail:
164         kfree(tegra_vi);
165         return err;
166
167 }
168
169 static int __exit vi_remove(struct platform_device *dev)
170 {
171 #ifdef CONFIG_TEGRA_CAMERA
172         int err = 0;
173         struct nvhost_device_data *pdata =
174                 (struct nvhost_device_data *)platform_get_drvdata(dev);
175         struct vi *tegra_vi = (struct vi *)pdata->private_data;
176 #endif
177
178         dev_info(&dev->dev, "%s: ++\n", __func__);
179
180 #ifdef CONFIG_TEGRA_CAMERA
181         err = tegra_camera_unregister(tegra_vi->camera);
182         if (err)
183                 return err;
184 #endif
185
186 #ifdef CONFIG_PM_RUNTIME
187         pm_runtime_put(&dev->dev);
188         pm_runtime_disable(&dev->dev);
189 #else
190         nvhost_module_disable_clk(&dev->dev);
191 #endif
192
193         return 0;
194 }
195
196 #ifdef CONFIG_PM
197 static int vi_suspend(struct device *dev)
198 {
199 #ifdef CONFIG_TEGRA_CAMERA
200         struct platform_device *pdev = to_platform_device(dev);
201         struct nvhost_device_data *pdata =
202                 (struct nvhost_device_data *)platform_get_drvdata(pdev);
203         struct vi *tegra_vi = (struct vi *)pdata->private_data;
204 #endif
205
206         dev_info(dev, "%s: ++\n", __func__);
207
208 #ifdef CONFIG_TEGRA_CAMERA
209         tegra_camera_suspend(tegra_vi->camera);
210 #endif
211
212         return nvhost_client_device_suspend(dev);
213 }
214
215 static int vi_resume(struct device *dev)
216 {
217 #ifdef CONFIG_TEGRA_CAMERA
218         struct platform_device *pdev = to_platform_device(dev);
219         struct nvhost_device_data *pdata =
220                 (struct nvhost_device_data *)platform_get_drvdata(pdev);
221         struct vi *tegra_vi = (struct vi *)pdata->private_data;
222 #endif
223
224         dev_info(dev, "%s: ++\n", __func__);
225
226 #ifdef CONFIG_TEGRA_CAMERA
227         tegra_camera_resume(tegra_vi->camera);
228 #endif
229
230         return 0;
231 }
232
233 static const struct dev_pm_ops vi_pm_ops = {
234         .suspend = vi_suspend,
235         .resume = vi_resume,
236         SET_RUNTIME_PM_OPS(nvhost_module_disable_clk,
237                 nvhost_module_enable_clk, NULL)
238 };
239 #endif
240
241 static struct platform_driver vi_driver = {
242         .probe = vi_probe,
243         .remove = __exit_p(vi_remove),
244         .driver = {
245                 .owner = THIS_MODULE,
246                 .name = "vi",
247 #ifdef CONFIG_PM
248                 .pm = &vi_pm_ops,
249 #endif
250 #ifdef CONFIG_OF
251                 .of_match_table = tegra_vi_of_match,
252 #endif
253         }
254 };
255
256 static int __init vi_init(void)
257 {
258         return platform_driver_register(&vi_driver);
259 }
260
261 static void __exit vi_exit(void)
262 {
263         platform_driver_unregister(&vi_driver);
264 }
265
266 late_initcall(vi_init);
267 module_exit(vi_exit);