diff options
-rw-r--r-- | drivers/media/video/davinci/vpss.c | 301 | ||||
-rw-r--r-- | include/media/davinci/vpss.h | 69 |
2 files changed, 370 insertions, 0 deletions
diff --git a/drivers/media/video/davinci/vpss.c b/drivers/media/video/davinci/vpss.c new file mode 100644 index 000000000000..6d709ca8cfb0 --- /dev/null +++ b/drivers/media/video/davinci/vpss.c | |||
@@ -0,0 +1,301 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2009 Texas Instruments. | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or modify | ||
5 | * it under the terms of the GNU General Public License as published by | ||
6 | * the Free Software Foundation; either version 2 of the License, or | ||
7 | * (at your option) any later version. | ||
8 | * | ||
9 | * This program is distributed in the hope that it will be useful, | ||
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
12 | * GNU General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program; if not, write to the Free Software | ||
16 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
17 | * | ||
18 | * common vpss driver for all video drivers. | ||
19 | */ | ||
20 | #include <linux/kernel.h> | ||
21 | #include <linux/sched.h> | ||
22 | #include <linux/init.h> | ||
23 | #include <linux/module.h> | ||
24 | #include <linux/platform_device.h> | ||
25 | #include <linux/spinlock.h> | ||
26 | #include <linux/compiler.h> | ||
27 | #include <linux/io.h> | ||
28 | #include <mach/hardware.h> | ||
29 | #include <media/davinci/vpss.h> | ||
30 | |||
31 | MODULE_LICENSE("GPL"); | ||
32 | MODULE_DESCRIPTION("VPSS Driver"); | ||
33 | MODULE_AUTHOR("Texas Instruments"); | ||
34 | |||
35 | /* DM644x defines */ | ||
36 | #define DM644X_SBL_PCR_VPSS (4) | ||
37 | |||
38 | /* vpss BL register offsets */ | ||
39 | #define DM355_VPSSBL_CCDCMUX 0x1c | ||
40 | /* vpss CLK register offsets */ | ||
41 | #define DM355_VPSSCLK_CLKCTRL 0x04 | ||
42 | /* masks and shifts */ | ||
43 | #define VPSS_HSSISEL_SHIFT 4 | ||
44 | |||
45 | /* | ||
46 | * vpss operations. Depends on platform. Not all functions are available | ||
47 | * on all platforms. The api, first check if a functio is available before | ||
48 | * invoking it. In the probe, the function ptrs are intialized based on | ||
49 | * vpss name. vpss name can be "dm355_vpss", "dm644x_vpss" etc. | ||
50 | */ | ||
51 | struct vpss_hw_ops { | ||
52 | /* enable clock */ | ||
53 | int (*enable_clock)(enum vpss_clock_sel clock_sel, int en); | ||
54 | /* select input to ccdc */ | ||
55 | void (*select_ccdc_source)(enum vpss_ccdc_source_sel src_sel); | ||
56 | /* clear wbl overlflow bit */ | ||
57 | int (*clear_wbl_overflow)(enum vpss_wbl_sel wbl_sel); | ||
58 | }; | ||
59 | |||
60 | /* vpss configuration */ | ||
61 | struct vpss_oper_config { | ||
62 | __iomem void *vpss_bl_regs_base; | ||
63 | __iomem void *vpss_regs_base; | ||
64 | struct resource *r1; | ||
65 | resource_size_t len1; | ||
66 | struct resource *r2; | ||
67 | resource_size_t len2; | ||
68 | char vpss_name[32]; | ||
69 | spinlock_t vpss_lock; | ||
70 | struct vpss_hw_ops hw_ops; | ||
71 | }; | ||
72 | |||
73 | static struct vpss_oper_config oper_cfg; | ||
74 | |||
75 | /* register access routines */ | ||
76 | static inline u32 bl_regr(u32 offset) | ||
77 | { | ||
78 | return __raw_readl(oper_cfg.vpss_bl_regs_base + offset); | ||
79 | } | ||
80 | |||
81 | static inline void bl_regw(u32 val, u32 offset) | ||
82 | { | ||
83 | __raw_writel(val, oper_cfg.vpss_bl_regs_base + offset); | ||
84 | } | ||
85 | |||
86 | static inline u32 vpss_regr(u32 offset) | ||
87 | { | ||
88 | return __raw_readl(oper_cfg.vpss_regs_base + offset); | ||
89 | } | ||
90 | |||
91 | static inline void vpss_regw(u32 val, u32 offset) | ||
92 | { | ||
93 | __raw_writel(val, oper_cfg.vpss_regs_base + offset); | ||
94 | } | ||
95 | |||
96 | static void dm355_select_ccdc_source(enum vpss_ccdc_source_sel src_sel) | ||
97 | { | ||
98 | bl_regw(src_sel << VPSS_HSSISEL_SHIFT, DM355_VPSSBL_CCDCMUX); | ||
99 | } | ||
100 | |||
101 | int vpss_select_ccdc_source(enum vpss_ccdc_source_sel src_sel) | ||
102 | { | ||
103 | if (!oper_cfg.hw_ops.select_ccdc_source) | ||
104 | return -1; | ||
105 | |||
106 | dm355_select_ccdc_source(src_sel); | ||
107 | return 0; | ||
108 | } | ||
109 | EXPORT_SYMBOL(vpss_select_ccdc_source); | ||
110 | |||
111 | static int dm644x_clear_wbl_overflow(enum vpss_wbl_sel wbl_sel) | ||
112 | { | ||
113 | u32 mask = 1, val; | ||
114 | |||
115 | if (wbl_sel < VPSS_PCR_AEW_WBL_0 || | ||
116 | wbl_sel > VPSS_PCR_CCDC_WBL_O) | ||
117 | return -1; | ||
118 | |||
119 | /* writing a 0 clear the overflow */ | ||
120 | mask = ~(mask << wbl_sel); | ||
121 | val = bl_regr(DM644X_SBL_PCR_VPSS) & mask; | ||
122 | bl_regw(val, DM644X_SBL_PCR_VPSS); | ||
123 | return 0; | ||
124 | } | ||
125 | |||
126 | int vpss_clear_wbl_overflow(enum vpss_wbl_sel wbl_sel) | ||
127 | { | ||
128 | if (!oper_cfg.hw_ops.clear_wbl_overflow) | ||
129 | return -1; | ||
130 | |||
131 | return oper_cfg.hw_ops.clear_wbl_overflow(wbl_sel); | ||
132 | } | ||
133 | EXPORT_SYMBOL(vpss_clear_wbl_overflow); | ||
134 | |||
135 | /* | ||
136 | * dm355_enable_clock - Enable VPSS Clock | ||
137 | * @clock_sel: CLock to be enabled/disabled | ||
138 | * @en: enable/disable flag | ||
139 | * | ||
140 | * This is called to enable or disable a vpss clock | ||
141 | */ | ||
142 | static int dm355_enable_clock(enum vpss_clock_sel clock_sel, int en) | ||
143 | { | ||
144 | unsigned long flags; | ||
145 | u32 utemp, mask = 0x1, shift = 0; | ||
146 | |||
147 | switch (clock_sel) { | ||
148 | case VPSS_VPBE_CLOCK: | ||
149 | /* nothing since lsb */ | ||
150 | break; | ||
151 | case VPSS_VENC_CLOCK_SEL: | ||
152 | shift = 2; | ||
153 | break; | ||
154 | case VPSS_CFALD_CLOCK: | ||
155 | shift = 3; | ||
156 | break; | ||
157 | case VPSS_H3A_CLOCK: | ||
158 | shift = 4; | ||
159 | break; | ||
160 | case VPSS_IPIPE_CLOCK: | ||
161 | shift = 5; | ||
162 | break; | ||
163 | case VPSS_CCDC_CLOCK: | ||
164 | shift = 6; | ||
165 | break; | ||
166 | default: | ||
167 | printk(KERN_ERR "dm355_enable_clock:" | ||
168 | " Invalid selector: %d\n", clock_sel); | ||
169 | return -1; | ||
170 | } | ||
171 | |||
172 | spin_lock_irqsave(&oper_cfg.vpss_lock, flags); | ||
173 | utemp = vpss_regr(DM355_VPSSCLK_CLKCTRL); | ||
174 | if (!en) | ||
175 | utemp &= ~(mask << shift); | ||
176 | else | ||
177 | utemp |= (mask << shift); | ||
178 | |||
179 | vpss_regw(utemp, DM355_VPSSCLK_CLKCTRL); | ||
180 | spin_unlock_irqrestore(&oper_cfg.vpss_lock, flags); | ||
181 | return 0; | ||
182 | } | ||
183 | |||
184 | int vpss_enable_clock(enum vpss_clock_sel clock_sel, int en) | ||
185 | { | ||
186 | if (!oper_cfg.hw_ops.enable_clock) | ||
187 | return -1; | ||
188 | |||
189 | return oper_cfg.hw_ops.enable_clock(clock_sel, en); | ||
190 | } | ||
191 | EXPORT_SYMBOL(vpss_enable_clock); | ||
192 | |||
193 | static int __init vpss_probe(struct platform_device *pdev) | ||
194 | { | ||
195 | int status, dm355 = 0; | ||
196 | |||
197 | if (!pdev->dev.platform_data) { | ||
198 | dev_err(&pdev->dev, "no platform data\n"); | ||
199 | return -ENOENT; | ||
200 | } | ||
201 | strcpy(oper_cfg.vpss_name, pdev->dev.platform_data); | ||
202 | |||
203 | if (!strcmp(oper_cfg.vpss_name, "dm355_vpss")) | ||
204 | dm355 = 1; | ||
205 | else if (strcmp(oper_cfg.vpss_name, "dm644x_vpss")) { | ||
206 | dev_err(&pdev->dev, "vpss driver not supported on" | ||
207 | " this platform\n"); | ||
208 | return -ENODEV; | ||
209 | } | ||
210 | |||
211 | dev_info(&pdev->dev, "%s vpss probed\n", oper_cfg.vpss_name); | ||
212 | oper_cfg.r1 = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
213 | if (!oper_cfg.r1) | ||
214 | return -ENOENT; | ||
215 | |||
216 | oper_cfg.len1 = oper_cfg.r1->end - oper_cfg.r1->start + 1; | ||
217 | |||
218 | oper_cfg.r1 = request_mem_region(oper_cfg.r1->start, oper_cfg.len1, | ||
219 | oper_cfg.r1->name); | ||
220 | if (!oper_cfg.r1) | ||
221 | return -EBUSY; | ||
222 | |||
223 | oper_cfg.vpss_bl_regs_base = ioremap(oper_cfg.r1->start, oper_cfg.len1); | ||
224 | if (!oper_cfg.vpss_bl_regs_base) { | ||
225 | status = -EBUSY; | ||
226 | goto fail1; | ||
227 | } | ||
228 | |||
229 | if (dm355) { | ||
230 | oper_cfg.r2 = platform_get_resource(pdev, IORESOURCE_MEM, 1); | ||
231 | if (!oper_cfg.r2) { | ||
232 | status = -ENOENT; | ||
233 | goto fail2; | ||
234 | } | ||
235 | oper_cfg.len2 = oper_cfg.r2->end - oper_cfg.r2->start + 1; | ||
236 | oper_cfg.r2 = request_mem_region(oper_cfg.r2->start, | ||
237 | oper_cfg.len2, | ||
238 | oper_cfg.r2->name); | ||
239 | if (!oper_cfg.r2) { | ||
240 | status = -EBUSY; | ||
241 | goto fail2; | ||
242 | } | ||
243 | |||
244 | oper_cfg.vpss_regs_base = ioremap(oper_cfg.r2->start, | ||
245 | oper_cfg.len2); | ||
246 | if (!oper_cfg.vpss_regs_base) { | ||
247 | status = -EBUSY; | ||
248 | goto fail3; | ||
249 | } | ||
250 | } | ||
251 | |||
252 | if (dm355) { | ||
253 | oper_cfg.hw_ops.enable_clock = dm355_enable_clock; | ||
254 | oper_cfg.hw_ops.select_ccdc_source = dm355_select_ccdc_source; | ||
255 | } else | ||
256 | oper_cfg.hw_ops.clear_wbl_overflow = dm644x_clear_wbl_overflow; | ||
257 | |||
258 | spin_lock_init(&oper_cfg.vpss_lock); | ||
259 | dev_info(&pdev->dev, "%s vpss probe success\n", oper_cfg.vpss_name); | ||
260 | return 0; | ||
261 | |||
262 | fail3: | ||
263 | release_mem_region(oper_cfg.r2->start, oper_cfg.len2); | ||
264 | fail2: | ||
265 | iounmap(oper_cfg.vpss_bl_regs_base); | ||
266 | fail1: | ||
267 | release_mem_region(oper_cfg.r1->start, oper_cfg.len1); | ||
268 | return status; | ||
269 | } | ||
270 | |||
271 | static int vpss_remove(struct platform_device *pdev) | ||
272 | { | ||
273 | iounmap(oper_cfg.vpss_bl_regs_base); | ||
274 | release_mem_region(oper_cfg.r1->start, oper_cfg.len1); | ||
275 | if (!strcmp(oper_cfg.vpss_name, "dm355_vpss")) { | ||
276 | iounmap(oper_cfg.vpss_regs_base); | ||
277 | release_mem_region(oper_cfg.r2->start, oper_cfg.len2); | ||
278 | } | ||
279 | return 0; | ||
280 | } | ||
281 | |||
282 | static struct platform_driver vpss_driver = { | ||
283 | .driver = { | ||
284 | .name = "vpss", | ||
285 | .owner = THIS_MODULE, | ||
286 | }, | ||
287 | .remove = __devexit_p(vpss_remove), | ||
288 | .probe = vpss_probe, | ||
289 | }; | ||
290 | |||
291 | static void vpss_exit(void) | ||
292 | { | ||
293 | platform_driver_unregister(&vpss_driver); | ||
294 | } | ||
295 | |||
296 | static int __init vpss_init(void) | ||
297 | { | ||
298 | return platform_driver_register(&vpss_driver); | ||
299 | } | ||
300 | subsys_initcall(vpss_init); | ||
301 | module_exit(vpss_exit); | ||
diff --git a/include/media/davinci/vpss.h b/include/media/davinci/vpss.h new file mode 100644 index 000000000000..fcdff745fae2 --- /dev/null +++ b/include/media/davinci/vpss.h | |||
@@ -0,0 +1,69 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2009 Texas Instruments Inc | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or modify | ||
5 | * it under the terms of the GNU General Public License as published by | ||
6 | * the Free Software Foundation; either version 2 of the License, or | ||
7 | * (at your option) any later version. | ||
8 | * | ||
9 | * This program is distributed in the hope that it will be useful, | ||
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
12 | * GNU General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program; if not, write to the Free Software | ||
16 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
17 | * | ||
18 | * vpss - video processing subsystem module header file. | ||
19 | * | ||
20 | * Include this header file if a driver needs to configure vpss system | ||
21 | * module. It exports a set of library functions for video drivers to | ||
22 | * configure vpss system module functions such as clock enable/disable, | ||
23 | * vpss interrupt mux to arm, and other common vpss system module | ||
24 | * functions. | ||
25 | */ | ||
26 | #ifndef _VPSS_H | ||
27 | #define _VPSS_H | ||
28 | |||
29 | /* selector for ccdc input selection on DM355 */ | ||
30 | enum vpss_ccdc_source_sel { | ||
31 | VPSS_CCDCIN, | ||
32 | VPSS_HSSIIN | ||
33 | }; | ||
34 | |||
35 | /* Used for enable/diable VPSS Clock */ | ||
36 | enum vpss_clock_sel { | ||
37 | /* DM355/DM365 */ | ||
38 | VPSS_CCDC_CLOCK, | ||
39 | VPSS_IPIPE_CLOCK, | ||
40 | VPSS_H3A_CLOCK, | ||
41 | VPSS_CFALD_CLOCK, | ||
42 | /* | ||
43 | * When using VPSS_VENC_CLOCK_SEL in vpss_enable_clock() api | ||
44 | * following applies:- | ||
45 | * en = 0 selects ENC_CLK | ||
46 | * en = 1 selects ENC_CLK/2 | ||
47 | */ | ||
48 | VPSS_VENC_CLOCK_SEL, | ||
49 | VPSS_VPBE_CLOCK, | ||
50 | }; | ||
51 | |||
52 | /* select input to ccdc on dm355 */ | ||
53 | int vpss_select_ccdc_source(enum vpss_ccdc_source_sel src_sel); | ||
54 | /* enable/disable a vpss clock, 0 - success, -1 - failure */ | ||
55 | int vpss_enable_clock(enum vpss_clock_sel clock_sel, int en); | ||
56 | |||
57 | /* wbl reset for dm644x */ | ||
58 | enum vpss_wbl_sel { | ||
59 | VPSS_PCR_AEW_WBL_0 = 16, | ||
60 | VPSS_PCR_AF_WBL_0, | ||
61 | VPSS_PCR_RSZ4_WBL_0, | ||
62 | VPSS_PCR_RSZ3_WBL_0, | ||
63 | VPSS_PCR_RSZ2_WBL_0, | ||
64 | VPSS_PCR_RSZ1_WBL_0, | ||
65 | VPSS_PCR_PREV_WBL_0, | ||
66 | VPSS_PCR_CCDC_WBL_O, | ||
67 | }; | ||
68 | int vpss_clear_wbl_overflow(enum vpss_wbl_sel wbl_sel); | ||
69 | #endif | ||