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