Version:  2.0.40 2.2.26 2.4.37 3.0 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16

Linux/drivers/media/platform/davinci/vpbe_venc.c

  1 /*
  2  * Copyright (C) 2010 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 version 2.
  7  *
  8  * This program is distributed in the hope that it will be useful,
  9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 11  * GNU General Public License for more details.
 12  *
 13  * You should have received a copy of the GNU General Public License
 14  * along with this program; if not, write to the Free Software
 15  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 16  */
 17 #include <linux/module.h>
 18 #include <linux/kernel.h>
 19 #include <linux/init.h>
 20 #include <linux/ctype.h>
 21 #include <linux/delay.h>
 22 #include <linux/device.h>
 23 #include <linux/interrupt.h>
 24 #include <linux/platform_device.h>
 25 #include <linux/videodev2.h>
 26 #include <linux/slab.h>
 27 
 28 #include <mach/hardware.h>
 29 #include <mach/mux.h>
 30 #include <linux/platform_data/i2c-davinci.h>
 31 
 32 #include <linux/io.h>
 33 
 34 #include <media/davinci/vpbe_types.h>
 35 #include <media/davinci/vpbe_venc.h>
 36 #include <media/davinci/vpss.h>
 37 #include <media/v4l2-device.h>
 38 
 39 #include "vpbe_venc_regs.h"
 40 
 41 #define MODULE_NAME     "davinci-vpbe-venc"
 42 
 43 static struct platform_device_id vpbe_venc_devtype[] = {
 44         {
 45                 .name = DM644X_VPBE_VENC_SUBDEV_NAME,
 46                 .driver_data = VPBE_VERSION_1,
 47         }, {
 48                 .name = DM365_VPBE_VENC_SUBDEV_NAME,
 49                 .driver_data = VPBE_VERSION_2,
 50         }, {
 51                 .name = DM355_VPBE_VENC_SUBDEV_NAME,
 52                 .driver_data = VPBE_VERSION_3,
 53         },
 54         {
 55                 /* sentinel */
 56         }
 57 };
 58 
 59 MODULE_DEVICE_TABLE(platform, vpbe_venc_devtype);
 60 
 61 static int debug = 2;
 62 module_param(debug, int, 0644);
 63 MODULE_PARM_DESC(debug, "Debug level 0-2");
 64 
 65 struct venc_state {
 66         struct v4l2_subdev sd;
 67         struct venc_callback *callback;
 68         struct venc_platform_data *pdata;
 69         struct device *pdev;
 70         u32 output;
 71         v4l2_std_id std;
 72         spinlock_t lock;
 73         void __iomem *venc_base;
 74         void __iomem *vdaccfg_reg;
 75         enum vpbe_version venc_type;
 76 };
 77 
 78 static inline struct venc_state *to_state(struct v4l2_subdev *sd)
 79 {
 80         return container_of(sd, struct venc_state, sd);
 81 }
 82 
 83 static inline u32 venc_read(struct v4l2_subdev *sd, u32 offset)
 84 {
 85         struct venc_state *venc = to_state(sd);
 86 
 87         return readl(venc->venc_base + offset);
 88 }
 89 
 90 static inline u32 venc_write(struct v4l2_subdev *sd, u32 offset, u32 val)
 91 {
 92         struct venc_state *venc = to_state(sd);
 93 
 94         writel(val, (venc->venc_base + offset));
 95 
 96         return val;
 97 }
 98 
 99 static inline u32 venc_modify(struct v4l2_subdev *sd, u32 offset,
100                                  u32 val, u32 mask)
101 {
102         u32 new_val = (venc_read(sd, offset) & ~mask) | (val & mask);
103 
104         venc_write(sd, offset, new_val);
105 
106         return new_val;
107 }
108 
109 static inline u32 vdaccfg_write(struct v4l2_subdev *sd, u32 val)
110 {
111         struct venc_state *venc = to_state(sd);
112 
113         writel(val, venc->vdaccfg_reg);
114 
115         val = readl(venc->vdaccfg_reg);
116 
117         return val;
118 }
119 
120 #define VDAC_COMPONENT  0x543
121 #define VDAC_S_VIDEO    0x210
122 /* This function sets the dac of the VPBE for various outputs
123  */
124 static int venc_set_dac(struct v4l2_subdev *sd, u32 out_index)
125 {
126         switch (out_index) {
127         case 0:
128                 v4l2_dbg(debug, 1, sd, "Setting output to Composite\n");
129                 venc_write(sd, VENC_DACSEL, 0);
130                 break;
131         case 1:
132                 v4l2_dbg(debug, 1, sd, "Setting output to Component\n");
133                 venc_write(sd, VENC_DACSEL, VDAC_COMPONENT);
134                 break;
135         case 2:
136                 v4l2_dbg(debug, 1, sd, "Setting output to S-video\n");
137                 venc_write(sd, VENC_DACSEL, VDAC_S_VIDEO);
138                 break;
139         default:
140                 return -EINVAL;
141         }
142 
143         return 0;
144 }
145 
146 static void venc_enabledigitaloutput(struct v4l2_subdev *sd, int benable)
147 {
148         struct venc_state *venc = to_state(sd);
149 
150         v4l2_dbg(debug, 2, sd, "venc_enabledigitaloutput\n");
151 
152         if (benable) {
153                 venc_write(sd, VENC_VMOD, 0);
154                 venc_write(sd, VENC_CVBS, 0);
155                 venc_write(sd, VENC_LCDOUT, 0);
156                 venc_write(sd, VENC_HSPLS, 0);
157                 venc_write(sd, VENC_HSTART, 0);
158                 venc_write(sd, VENC_HVALID, 0);
159                 venc_write(sd, VENC_HINT, 0);
160                 venc_write(sd, VENC_VSPLS, 0);
161                 venc_write(sd, VENC_VSTART, 0);
162                 venc_write(sd, VENC_VVALID, 0);
163                 venc_write(sd, VENC_VINT, 0);
164                 venc_write(sd, VENC_YCCCTL, 0);
165                 venc_write(sd, VENC_DACSEL, 0);
166 
167         } else {
168                 venc_write(sd, VENC_VMOD, 0);
169                 /* disable VCLK output pin enable */
170                 venc_write(sd, VENC_VIDCTL, 0x141);
171 
172                 /* Disable output sync pins */
173                 venc_write(sd, VENC_SYNCCTL, 0);
174 
175                 /* Disable DCLOCK */
176                 venc_write(sd, VENC_DCLKCTL, 0);
177                 venc_write(sd, VENC_DRGBX1, 0x0000057C);
178 
179                 /* Disable LCD output control (accepting default polarity) */
180                 venc_write(sd, VENC_LCDOUT, 0);
181                 if (venc->venc_type != VPBE_VERSION_3)
182                         venc_write(sd, VENC_CMPNT, 0x100);
183                 venc_write(sd, VENC_HSPLS, 0);
184                 venc_write(sd, VENC_HINT, 0);
185                 venc_write(sd, VENC_HSTART, 0);
186                 venc_write(sd, VENC_HVALID, 0);
187 
188                 venc_write(sd, VENC_VSPLS, 0);
189                 venc_write(sd, VENC_VINT, 0);
190                 venc_write(sd, VENC_VSTART, 0);
191                 venc_write(sd, VENC_VVALID, 0);
192 
193                 venc_write(sd, VENC_HSDLY, 0);
194                 venc_write(sd, VENC_VSDLY, 0);
195 
196                 venc_write(sd, VENC_YCCCTL, 0);
197                 venc_write(sd, VENC_VSTARTA, 0);
198 
199                 /* Set OSD clock and OSD Sync Adavance registers */
200                 venc_write(sd, VENC_OSDCLK0, 1);
201                 venc_write(sd, VENC_OSDCLK1, 2);
202         }
203 }
204 
205 static void
206 venc_enable_vpss_clock(int venc_type,
207                        enum vpbe_enc_timings_type type,
208                        unsigned int pclock)
209 {
210         if (venc_type == VPBE_VERSION_1)
211                 return;
212 
213         if (venc_type == VPBE_VERSION_2 && (type == VPBE_ENC_STD || (type ==
214             VPBE_ENC_DV_TIMINGS && pclock <= 27000000))) {
215                 vpss_enable_clock(VPSS_VENC_CLOCK_SEL, 1);
216                 vpss_enable_clock(VPSS_VPBE_CLOCK, 1);
217                 return;
218         }
219 
220         if (venc_type == VPBE_VERSION_3 && type == VPBE_ENC_STD)
221                 vpss_enable_clock(VPSS_VENC_CLOCK_SEL, 0);
222 }
223 
224 #define VDAC_CONFIG_SD_V3       0x0E21A6B6
225 #define VDAC_CONFIG_SD_V2       0x081141CF
226 /*
227  * setting NTSC mode
228  */
229 static int venc_set_ntsc(struct v4l2_subdev *sd)
230 {
231         u32 val;
232         struct venc_state *venc = to_state(sd);
233         struct venc_platform_data *pdata = venc->pdata;
234 
235         v4l2_dbg(debug, 2, sd, "venc_set_ntsc\n");
236 
237         /* Setup clock at VPSS & VENC for SD */
238         vpss_enable_clock(VPSS_VENC_CLOCK_SEL, 1);
239         if (pdata->setup_clock(VPBE_ENC_STD, V4L2_STD_525_60) < 0)
240                 return -EINVAL;
241 
242         venc_enable_vpss_clock(venc->venc_type, VPBE_ENC_STD, V4L2_STD_525_60);
243         venc_enabledigitaloutput(sd, 0);
244 
245         if (venc->venc_type == VPBE_VERSION_3) {
246                 venc_write(sd, VENC_CLKCTL, 0x01);
247                 venc_write(sd, VENC_VIDCTL, 0);
248                 val = vdaccfg_write(sd, VDAC_CONFIG_SD_V3);
249         } else if (venc->venc_type == VPBE_VERSION_2) {
250                 venc_write(sd, VENC_CLKCTL, 0x01);
251                 venc_write(sd, VENC_VIDCTL, 0);
252                 vdaccfg_write(sd, VDAC_CONFIG_SD_V2);
253         } else {
254                 /* to set VENC CLK DIV to 1 - final clock is 54 MHz */
255                 venc_modify(sd, VENC_VIDCTL, 0, 1 << 1);
256                 /* Set REC656 Mode */
257                 venc_write(sd, VENC_YCCCTL, 0x1);
258                 venc_modify(sd, VENC_VDPRO, 0, VENC_VDPRO_DAFRQ);
259                 venc_modify(sd, VENC_VDPRO, 0, VENC_VDPRO_DAUPS);
260         }
261 
262         venc_write(sd, VENC_VMOD, 0);
263         venc_modify(sd, VENC_VMOD, (1 << VENC_VMOD_VIE_SHIFT),
264                         VENC_VMOD_VIE);
265         venc_modify(sd, VENC_VMOD, (0 << VENC_VMOD_VMD), VENC_VMOD_VMD);
266         venc_modify(sd, VENC_VMOD, (0 << VENC_VMOD_TVTYP_SHIFT),
267                         VENC_VMOD_TVTYP);
268         venc_write(sd, VENC_DACTST, 0x0);
269         venc_modify(sd, VENC_VMOD, VENC_VMOD_VENC, VENC_VMOD_VENC);
270 
271         return 0;
272 }
273 
274 /*
275  * setting PAL mode
276  */
277 static int venc_set_pal(struct v4l2_subdev *sd)
278 {
279         struct venc_state *venc = to_state(sd);
280 
281         v4l2_dbg(debug, 2, sd, "venc_set_pal\n");
282 
283         /* Setup clock at VPSS & VENC for SD */
284         vpss_enable_clock(VPSS_VENC_CLOCK_SEL, 1);
285         if (venc->pdata->setup_clock(VPBE_ENC_STD, V4L2_STD_625_50) < 0)
286                 return -EINVAL;
287 
288         venc_enable_vpss_clock(venc->venc_type, VPBE_ENC_STD, V4L2_STD_625_50);
289         venc_enabledigitaloutput(sd, 0);
290 
291         if (venc->venc_type == VPBE_VERSION_3) {
292                 venc_write(sd, VENC_CLKCTL, 0x1);
293                 venc_write(sd, VENC_VIDCTL, 0);
294                 vdaccfg_write(sd, VDAC_CONFIG_SD_V3);
295         } else if (venc->venc_type == VPBE_VERSION_2) {
296                 venc_write(sd, VENC_CLKCTL, 0x1);
297                 venc_write(sd, VENC_VIDCTL, 0);
298                 vdaccfg_write(sd, VDAC_CONFIG_SD_V2);
299         } else {
300                 /* to set VENC CLK DIV to 1 - final clock is 54 MHz */
301                 venc_modify(sd, VENC_VIDCTL, 0, 1 << 1);
302                 /* Set REC656 Mode */
303                 venc_write(sd, VENC_YCCCTL, 0x1);
304         }
305 
306         venc_modify(sd, VENC_SYNCCTL, 1 << VENC_SYNCCTL_OVD_SHIFT,
307                         VENC_SYNCCTL_OVD);
308         venc_write(sd, VENC_VMOD, 0);
309         venc_modify(sd, VENC_VMOD,
310                         (1 << VENC_VMOD_VIE_SHIFT),
311                         VENC_VMOD_VIE);
312         venc_modify(sd, VENC_VMOD,
313                         (0 << VENC_VMOD_VMD), VENC_VMOD_VMD);
314         venc_modify(sd, VENC_VMOD,
315                         (1 << VENC_VMOD_TVTYP_SHIFT),
316                         VENC_VMOD_TVTYP);
317         venc_write(sd, VENC_DACTST, 0x0);
318         venc_modify(sd, VENC_VMOD, VENC_VMOD_VENC, VENC_VMOD_VENC);
319 
320         return 0;
321 }
322 
323 #define VDAC_CONFIG_HD_V2       0x081141EF
324 /*
325  * venc_set_480p59_94
326  *
327  * This function configures the video encoder to EDTV(525p) component setting.
328  */
329 static int venc_set_480p59_94(struct v4l2_subdev *sd)
330 {
331         struct venc_state *venc = to_state(sd);
332         struct venc_platform_data *pdata = venc->pdata;
333 
334         v4l2_dbg(debug, 2, sd, "venc_set_480p59_94\n");
335         if (venc->venc_type != VPBE_VERSION_1 &&
336             venc->venc_type != VPBE_VERSION_2)
337                 return -EINVAL;
338 
339         /* Setup clock at VPSS & VENC for SD */
340         if (pdata->setup_clock(VPBE_ENC_DV_TIMINGS, 27000000) < 0)
341                 return -EINVAL;
342 
343         venc_enable_vpss_clock(venc->venc_type, VPBE_ENC_DV_TIMINGS, 27000000);
344         venc_enabledigitaloutput(sd, 0);
345 
346         if (venc->venc_type == VPBE_VERSION_2)
347                 vdaccfg_write(sd, VDAC_CONFIG_HD_V2);
348         venc_write(sd, VENC_OSDCLK0, 0);
349         venc_write(sd, VENC_OSDCLK1, 1);
350 
351         if (venc->venc_type == VPBE_VERSION_1) {
352                 venc_modify(sd, VENC_VDPRO, VENC_VDPRO_DAFRQ,
353                             VENC_VDPRO_DAFRQ);
354                 venc_modify(sd, VENC_VDPRO, VENC_VDPRO_DAUPS,
355                             VENC_VDPRO_DAUPS);
356         }
357 
358         venc_write(sd, VENC_VMOD, 0);
359         venc_modify(sd, VENC_VMOD, (1 << VENC_VMOD_VIE_SHIFT),
360                     VENC_VMOD_VIE);
361         venc_modify(sd, VENC_VMOD, VENC_VMOD_HDMD, VENC_VMOD_HDMD);
362         venc_modify(sd, VENC_VMOD, (HDTV_525P << VENC_VMOD_TVTYP_SHIFT),
363                     VENC_VMOD_TVTYP);
364         venc_modify(sd, VENC_VMOD, VENC_VMOD_VDMD_YCBCR8 <<
365                     VENC_VMOD_VDMD_SHIFT, VENC_VMOD_VDMD);
366 
367         venc_modify(sd, VENC_VMOD, VENC_VMOD_VENC, VENC_VMOD_VENC);
368 
369         return 0;
370 }
371 
372 /*
373  * venc_set_625p
374  *
375  * This function configures the video encoder to HDTV(625p) component setting
376  */
377 static int venc_set_576p50(struct v4l2_subdev *sd)
378 {
379         struct venc_state *venc = to_state(sd);
380         struct venc_platform_data *pdata = venc->pdata;
381 
382         v4l2_dbg(debug, 2, sd, "venc_set_576p50\n");
383 
384         if (venc->venc_type != VPBE_VERSION_1 &&
385             venc->venc_type != VPBE_VERSION_2)
386                 return -EINVAL;
387         /* Setup clock at VPSS & VENC for SD */
388         if (pdata->setup_clock(VPBE_ENC_DV_TIMINGS, 27000000) < 0)
389                 return -EINVAL;
390 
391         venc_enable_vpss_clock(venc->venc_type, VPBE_ENC_DV_TIMINGS, 27000000);
392         venc_enabledigitaloutput(sd, 0);
393 
394         if (venc->venc_type == VPBE_VERSION_2)
395                 vdaccfg_write(sd, VDAC_CONFIG_HD_V2);
396 
397         venc_write(sd, VENC_OSDCLK0, 0);
398         venc_write(sd, VENC_OSDCLK1, 1);
399 
400         if (venc->venc_type == VPBE_VERSION_1) {
401                 venc_modify(sd, VENC_VDPRO, VENC_VDPRO_DAFRQ,
402                             VENC_VDPRO_DAFRQ);
403                 venc_modify(sd, VENC_VDPRO, VENC_VDPRO_DAUPS,
404                             VENC_VDPRO_DAUPS);
405         }
406 
407         venc_write(sd, VENC_VMOD, 0);
408         venc_modify(sd, VENC_VMOD, (1 << VENC_VMOD_VIE_SHIFT),
409                     VENC_VMOD_VIE);
410         venc_modify(sd, VENC_VMOD, VENC_VMOD_HDMD, VENC_VMOD_HDMD);
411         venc_modify(sd, VENC_VMOD, (HDTV_625P << VENC_VMOD_TVTYP_SHIFT),
412                     VENC_VMOD_TVTYP);
413 
414         venc_modify(sd, VENC_VMOD, VENC_VMOD_VDMD_YCBCR8 <<
415                     VENC_VMOD_VDMD_SHIFT, VENC_VMOD_VDMD);
416         venc_modify(sd, VENC_VMOD, VENC_VMOD_VENC, VENC_VMOD_VENC);
417 
418         return 0;
419 }
420 
421 /*
422  * venc_set_720p60_internal - Setup 720p60 in venc for dm365 only
423  */
424 static int venc_set_720p60_internal(struct v4l2_subdev *sd)
425 {
426         struct venc_state *venc = to_state(sd);
427         struct venc_platform_data *pdata = venc->pdata;
428 
429         if (pdata->setup_clock(VPBE_ENC_DV_TIMINGS, 74250000) < 0)
430                 return -EINVAL;
431 
432         venc_enable_vpss_clock(venc->venc_type, VPBE_ENC_DV_TIMINGS, 74250000);
433         venc_enabledigitaloutput(sd, 0);
434 
435         venc_write(sd, VENC_OSDCLK0, 0);
436         venc_write(sd, VENC_OSDCLK1, 1);
437 
438         venc_write(sd, VENC_VMOD, 0);
439         /* DM365 component HD mode */
440         venc_modify(sd, VENC_VMOD, (1 << VENC_VMOD_VIE_SHIFT),
441             VENC_VMOD_VIE);
442         venc_modify(sd, VENC_VMOD, VENC_VMOD_HDMD, VENC_VMOD_HDMD);
443         venc_modify(sd, VENC_VMOD, (HDTV_720P << VENC_VMOD_TVTYP_SHIFT),
444                     VENC_VMOD_TVTYP);
445         venc_modify(sd, VENC_VMOD, VENC_VMOD_VENC, VENC_VMOD_VENC);
446         venc_write(sd, VENC_XHINTVL, 0);
447         return 0;
448 }
449 
450 /*
451  * venc_set_1080i30_internal - Setup 1080i30 in venc for dm365 only
452  */
453 static int venc_set_1080i30_internal(struct v4l2_subdev *sd)
454 {
455         struct venc_state *venc = to_state(sd);
456         struct venc_platform_data *pdata = venc->pdata;
457 
458         if (pdata->setup_clock(VPBE_ENC_DV_TIMINGS, 74250000) < 0)
459                 return -EINVAL;
460 
461         venc_enable_vpss_clock(venc->venc_type, VPBE_ENC_DV_TIMINGS, 74250000);
462         venc_enabledigitaloutput(sd, 0);
463 
464         venc_write(sd, VENC_OSDCLK0, 0);
465         venc_write(sd, VENC_OSDCLK1, 1);
466 
467 
468         venc_write(sd, VENC_VMOD, 0);
469         /* DM365 component HD mode */
470         venc_modify(sd, VENC_VMOD, (1 << VENC_VMOD_VIE_SHIFT),
471                     VENC_VMOD_VIE);
472         venc_modify(sd, VENC_VMOD, VENC_VMOD_HDMD, VENC_VMOD_HDMD);
473         venc_modify(sd, VENC_VMOD, (HDTV_1080I << VENC_VMOD_TVTYP_SHIFT),
474                     VENC_VMOD_TVTYP);
475         venc_modify(sd, VENC_VMOD, VENC_VMOD_VENC, VENC_VMOD_VENC);
476         venc_write(sd, VENC_XHINTVL, 0);
477         return 0;
478 }
479 
480 static int venc_s_std_output(struct v4l2_subdev *sd, v4l2_std_id norm)
481 {
482         v4l2_dbg(debug, 1, sd, "venc_s_std_output\n");
483 
484         if (norm & V4L2_STD_525_60)
485                 return venc_set_ntsc(sd);
486         else if (norm & V4L2_STD_625_50)
487                 return venc_set_pal(sd);
488 
489         return -EINVAL;
490 }
491 
492 static int venc_s_dv_timings(struct v4l2_subdev *sd,
493                             struct v4l2_dv_timings *dv_timings)
494 {
495         struct venc_state *venc = to_state(sd);
496         u32 height = dv_timings->bt.height;
497         int ret;
498 
499         v4l2_dbg(debug, 1, sd, "venc_s_dv_timings\n");
500 
501         if (height == 576)
502                 return venc_set_576p50(sd);
503         else if (height == 480)
504                 return venc_set_480p59_94(sd);
505         else if ((height == 720) &&
506                         (venc->venc_type == VPBE_VERSION_2)) {
507                 /* TBD setup internal 720p mode here */
508                 ret = venc_set_720p60_internal(sd);
509                 /* for DM365 VPBE, there is DAC inside */
510                 vdaccfg_write(sd, VDAC_CONFIG_HD_V2);
511                 return ret;
512         } else if ((height == 1080) &&
513                 (venc->venc_type == VPBE_VERSION_2)) {
514                 /* TBD setup internal 1080i mode here */
515                 ret = venc_set_1080i30_internal(sd);
516                 /* for DM365 VPBE, there is DAC inside */
517                 vdaccfg_write(sd, VDAC_CONFIG_HD_V2);
518                 return ret;
519         }
520         return -EINVAL;
521 }
522 
523 static int venc_s_routing(struct v4l2_subdev *sd, u32 input, u32 output,
524                           u32 config)
525 {
526         struct venc_state *venc = to_state(sd);
527         int ret;
528 
529         v4l2_dbg(debug, 1, sd, "venc_s_routing\n");
530 
531         ret = venc_set_dac(sd, output);
532         if (!ret)
533                 venc->output = output;
534 
535         return ret;
536 }
537 
538 static long venc_ioctl(struct v4l2_subdev *sd,
539                         unsigned int cmd,
540                         void *arg)
541 {
542         u32 val;
543 
544         switch (cmd) {
545         case VENC_GET_FLD:
546                 val = venc_read(sd, VENC_VSTAT);
547                 *((int *)arg) = ((val & VENC_VSTAT_FIDST) ==
548                 VENC_VSTAT_FIDST);
549                 break;
550         default:
551                 v4l2_err(sd, "Wrong IOCTL cmd\n");
552                 break;
553         }
554 
555         return 0;
556 }
557 
558 static const struct v4l2_subdev_core_ops venc_core_ops = {
559         .ioctl      = venc_ioctl,
560 };
561 
562 static const struct v4l2_subdev_video_ops venc_video_ops = {
563         .s_routing = venc_s_routing,
564         .s_std_output = venc_s_std_output,
565         .s_dv_timings = venc_s_dv_timings,
566 };
567 
568 static const struct v4l2_subdev_ops venc_ops = {
569         .core = &venc_core_ops,
570         .video = &venc_video_ops,
571 };
572 
573 static int venc_initialize(struct v4l2_subdev *sd)
574 {
575         struct venc_state *venc = to_state(sd);
576         int ret;
577 
578         /* Set default to output to composite and std to NTSC */
579         venc->output = 0;
580         venc->std = V4L2_STD_525_60;
581 
582         ret = venc_s_routing(sd, 0, venc->output, 0);
583         if (ret < 0) {
584                 v4l2_err(sd, "Error setting output during init\n");
585                 return -EINVAL;
586         }
587 
588         ret = venc_s_std_output(sd, venc->std);
589         if (ret < 0) {
590                 v4l2_err(sd, "Error setting std during init\n");
591                 return -EINVAL;
592         }
593 
594         return ret;
595 }
596 
597 static int venc_device_get(struct device *dev, void *data)
598 {
599         struct platform_device *pdev = to_platform_device(dev);
600         struct venc_state **venc = data;
601 
602         if (strstr(pdev->name, "vpbe-venc") != NULL)
603                 *venc = platform_get_drvdata(pdev);
604 
605         return 0;
606 }
607 
608 struct v4l2_subdev *venc_sub_dev_init(struct v4l2_device *v4l2_dev,
609                 const char *venc_name)
610 {
611         struct venc_state *venc;
612         int err;
613 
614         err = bus_for_each_dev(&platform_bus_type, NULL, &venc,
615                         venc_device_get);
616         if (venc == NULL)
617                 return NULL;
618 
619         v4l2_subdev_init(&venc->sd, &venc_ops);
620 
621         strcpy(venc->sd.name, venc_name);
622         if (v4l2_device_register_subdev(v4l2_dev, &venc->sd) < 0) {
623                 v4l2_err(v4l2_dev,
624                         "vpbe unable to register venc sub device\n");
625                 return NULL;
626         }
627         if (venc_initialize(&venc->sd)) {
628                 v4l2_err(v4l2_dev,
629                         "vpbe venc initialization failed\n");
630                 return NULL;
631         }
632 
633         return &venc->sd;
634 }
635 EXPORT_SYMBOL(venc_sub_dev_init);
636 
637 static int venc_probe(struct platform_device *pdev)
638 {
639         const struct platform_device_id *pdev_id;
640         struct venc_state *venc;
641         struct resource *res;
642 
643         if (!pdev->dev.platform_data) {
644                 dev_err(&pdev->dev, "No platform data for VENC sub device");
645                 return -EINVAL;
646         }
647 
648         pdev_id = platform_get_device_id(pdev);
649         if (!pdev_id)
650                 return -EINVAL;
651 
652         venc = devm_kzalloc(&pdev->dev, sizeof(struct venc_state), GFP_KERNEL);
653         if (venc == NULL)
654                 return -ENOMEM;
655 
656         venc->venc_type = pdev_id->driver_data;
657         venc->pdev = &pdev->dev;
658         venc->pdata = pdev->dev.platform_data;
659 
660         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
661 
662         venc->venc_base = devm_ioremap_resource(&pdev->dev, res);
663         if (IS_ERR(venc->venc_base))
664                 return PTR_ERR(venc->venc_base);
665 
666         if (venc->venc_type != VPBE_VERSION_1) {
667                 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
668 
669                 venc->vdaccfg_reg = devm_ioremap_resource(&pdev->dev, res);
670                 if (IS_ERR(venc->vdaccfg_reg))
671                         return PTR_ERR(venc->vdaccfg_reg);
672         }
673         spin_lock_init(&venc->lock);
674         platform_set_drvdata(pdev, venc);
675         dev_notice(venc->pdev, "VENC sub device probe success\n");
676 
677         return 0;
678 }
679 
680 static int venc_remove(struct platform_device *pdev)
681 {
682         return 0;
683 }
684 
685 static struct platform_driver venc_driver = {
686         .probe          = venc_probe,
687         .remove         = venc_remove,
688         .driver         = {
689                 .name   = MODULE_NAME,
690                 .owner  = THIS_MODULE,
691         },
692         .id_table       = vpbe_venc_devtype
693 };
694 
695 module_platform_driver(venc_driver);
696 
697 MODULE_LICENSE("GPL");
698 MODULE_DESCRIPTION("VPBE VENC Driver");
699 MODULE_AUTHOR("Texas Instruments");
700 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us