video: tegra: host: Add ISP & VI power gating
[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         tegra_pd_add_device(&dev->dev);
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
158         return 0;
159
160 camera_register_fail:
161         kfree(tegra_vi);
162         return err;
163
164 }
165
166 static int __exit vi_remove(struct platform_device *dev)
167 {
168 #ifdef CONFIG_TEGRA_CAMERA
169         int err = 0;
170         struct nvhost_device_data *pdata =
171                 (struct nvhost_device_data *)platform_get_drvdata(dev);
172         struct vi *tegra_vi = (struct vi *)pdata->private_data;
173 #endif
174
175         dev_info(&dev->dev, "%s: ++\n", __func__);
176
177 #ifdef CONFIG_TEGRA_CAMERA
178         err = tegra_camera_unregister(tegra_vi->camera);
179         if (err)
180                 return err;
181 #endif
182
183         return 0;
184 }
185
186 #ifdef CONFIG_PM
187 static int vi_suspend(struct device *dev)
188 {
189 #ifdef CONFIG_TEGRA_CAMERA
190         struct platform_device *pdev = to_platform_device(dev);
191         struct nvhost_device_data *pdata =
192                 (struct nvhost_device_data *)platform_get_drvdata(pdev);
193         struct vi *tegra_vi = (struct vi *)pdata->private_data;
194 #endif
195
196         dev_info(dev, "%s: ++\n", __func__);
197
198 #ifdef CONFIG_TEGRA_CAMERA
199         tegra_camera_suspend(tegra_vi->camera);
200 #endif
201
202         return nvhost_client_device_suspend(dev);
203 }
204
205 static int vi_resume(struct device *dev)
206 {
207 #ifdef CONFIG_TEGRA_CAMERA
208         struct platform_device *pdev = to_platform_device(dev);
209         struct nvhost_device_data *pdata =
210                 (struct nvhost_device_data *)platform_get_drvdata(pdev);
211         struct vi *tegra_vi = (struct vi *)pdata->private_data;
212 #endif
213
214         dev_info(dev, "%s: ++\n", __func__);
215
216 #ifdef CONFIG_TEGRA_CAMERA
217         tegra_camera_resume(tegra_vi->camera);
218 #endif
219
220         return 0;
221 }
222
223 static const struct dev_pm_ops vi_pm_ops = {
224         .suspend = vi_suspend,
225         .resume = vi_resume,
226 #ifdef CONFIG_PM_RUNTIME
227         .runtime_suspend = nvhost_module_disable_clk,
228         .runtime_resume = nvhost_module_enable_clk,
229 #endif
230 };
231 #endif
232
233 static struct platform_driver vi_driver = {
234         .probe = vi_probe,
235         .remove = __exit_p(vi_remove),
236         .driver = {
237                 .owner = THIS_MODULE,
238                 .name = "vi",
239 #ifdef CONFIG_PM
240                 .pm = &vi_pm_ops,
241 #endif
242 #ifdef CONFIG_OF
243                 .of_match_table = tegra_vi_of_match,
244 #endif
245         }
246 };
247
248 static int __init vi_init(void)
249 {
250         return platform_driver_register(&vi_driver);
251 }
252
253 static void __exit vi_exit(void)
254 {
255         platform_driver_unregister(&vi_driver);
256 }
257
258 late_initcall(vi_init);
259 module_exit(vi_exit);