2019-05-29 07:18:00 -07:00
// SPDX-License-Identifier: GPL-2.0-only
2011-06-17 04:01:34 -03:00
/*
* Copyright ( C ) 2010 Texas Instruments Inc
*/
# include <linux/module.h>
2018-07-09 11:19:02 -04:00
# include <linux/mod_devicetable.h>
2011-06-17 04:01:34 -03:00
# include <linux/kernel.h>
# include <linux/init.h>
# include <linux/ctype.h>
# include <linux/delay.h>
# include <linux/device.h>
# include <linux/interrupt.h>
# include <linux/platform_device.h>
# include <linux/videodev2.h>
# include <linux/slab.h>
2012-08-24 15:11:34 +02:00
# include <linux/platform_data/i2c-davinci.h>
2011-06-17 04:01:34 -03:00
# include <linux/io.h>
# include <media/davinci/vpbe_types.h>
# include <media/davinci/vpbe_venc.h>
# include <media/davinci/vpss.h>
# include <media/v4l2-device.h>
# include "vpbe_venc_regs.h"
2012-11-20 07:30:36 -03:00
# define MODULE_NAME "davinci-vpbe-venc"
2017-08-15 07:23:41 -04:00
static const struct platform_device_id vpbe_venc_devtype [ ] = {
2012-11-20 07:30:36 -03:00
{
. name = DM644X_VPBE_VENC_SUBDEV_NAME ,
. driver_data = VPBE_VERSION_1 ,
} , {
. name = DM365_VPBE_VENC_SUBDEV_NAME ,
. driver_data = VPBE_VERSION_2 ,
} , {
. name = DM355_VPBE_VENC_SUBDEV_NAME ,
. driver_data = VPBE_VERSION_3 ,
} ,
2013-03-08 06:22:10 -03:00
{
/* sentinel */
}
2012-11-20 07:30:36 -03:00
} ;
MODULE_DEVICE_TABLE ( platform , vpbe_venc_devtype ) ;
2011-06-17 04:01:34 -03:00
static int debug = 2 ;
module_param ( debug , int , 0644 ) ;
MODULE_PARM_DESC ( debug , " Debug level 0-2 " ) ;
struct venc_state {
struct v4l2_subdev sd ;
struct venc_callback * callback ;
struct venc_platform_data * pdata ;
struct device * pdev ;
u32 output ;
v4l2_std_id std ;
spinlock_t lock ;
void __iomem * venc_base ;
void __iomem * vdaccfg_reg ;
2012-11-20 07:30:36 -03:00
enum vpbe_version venc_type ;
2011-06-17 04:01:34 -03:00
} ;
static inline struct venc_state * to_state ( struct v4l2_subdev * sd )
{
return container_of ( sd , struct venc_state , sd ) ;
}
static inline u32 venc_read ( struct v4l2_subdev * sd , u32 offset )
{
struct venc_state * venc = to_state ( sd ) ;
return readl ( venc - > venc_base + offset ) ;
}
static inline u32 venc_write ( struct v4l2_subdev * sd , u32 offset , u32 val )
{
struct venc_state * venc = to_state ( sd ) ;
writel ( val , ( venc - > venc_base + offset ) ) ;
return val ;
}
static inline u32 venc_modify ( struct v4l2_subdev * sd , u32 offset ,
u32 val , u32 mask )
{
u32 new_val = ( venc_read ( sd , offset ) & ~ mask ) | ( val & mask ) ;
venc_write ( sd , offset , new_val ) ;
return new_val ;
}
static inline u32 vdaccfg_write ( struct v4l2_subdev * sd , u32 val )
{
struct venc_state * venc = to_state ( sd ) ;
writel ( val , venc - > vdaccfg_reg ) ;
val = readl ( venc - > vdaccfg_reg ) ;
return val ;
}
2011-09-10 02:19:55 -03:00
# define VDAC_COMPONENT 0x543
# define VDAC_S_VIDEO 0x210
2011-06-17 04:01:34 -03:00
/* This function sets the dac of the VPBE for various outputs
*/
static int venc_set_dac ( struct v4l2_subdev * sd , u32 out_index )
{
switch ( out_index ) {
case 0 :
v4l2_dbg ( debug , 1 , sd , " Setting output to Composite \n " ) ;
venc_write ( sd , VENC_DACSEL , 0 ) ;
break ;
case 1 :
2011-09-10 02:19:55 -03:00
v4l2_dbg ( debug , 1 , sd , " Setting output to Component \n " ) ;
venc_write ( sd , VENC_DACSEL , VDAC_COMPONENT ) ;
2011-06-17 04:01:34 -03:00
break ;
2011-09-10 02:19:55 -03:00
case 2 :
v4l2_dbg ( debug , 1 , sd , " Setting output to S-video \n " ) ;
venc_write ( sd , VENC_DACSEL , VDAC_S_VIDEO ) ;
2011-06-17 04:01:34 -03:00
break ;
default :
return - EINVAL ;
}
return 0 ;
}
static void venc_enabledigitaloutput ( struct v4l2_subdev * sd , int benable )
{
2011-09-10 02:19:55 -03:00
struct venc_state * venc = to_state ( sd ) ;
2012-11-20 07:30:36 -03:00
2011-06-17 04:01:34 -03:00
v4l2_dbg ( debug , 2 , sd , " venc_enabledigitaloutput \n " ) ;
if ( benable ) {
venc_write ( sd , VENC_VMOD , 0 ) ;
venc_write ( sd , VENC_CVBS , 0 ) ;
venc_write ( sd , VENC_LCDOUT , 0 ) ;
venc_write ( sd , VENC_HSPLS , 0 ) ;
venc_write ( sd , VENC_HSTART , 0 ) ;
venc_write ( sd , VENC_HVALID , 0 ) ;
venc_write ( sd , VENC_HINT , 0 ) ;
venc_write ( sd , VENC_VSPLS , 0 ) ;
venc_write ( sd , VENC_VSTART , 0 ) ;
venc_write ( sd , VENC_VVALID , 0 ) ;
venc_write ( sd , VENC_VINT , 0 ) ;
venc_write ( sd , VENC_YCCCTL , 0 ) ;
venc_write ( sd , VENC_DACSEL , 0 ) ;
} else {
venc_write ( sd , VENC_VMOD , 0 ) ;
/* disable VCLK output pin enable */
venc_write ( sd , VENC_VIDCTL , 0x141 ) ;
/* Disable output sync pins */
venc_write ( sd , VENC_SYNCCTL , 0 ) ;
/* Disable DCLOCK */
venc_write ( sd , VENC_DCLKCTL , 0 ) ;
venc_write ( sd , VENC_DRGBX1 , 0x0000057C ) ;
/* Disable LCD output control (accepting default polarity) */
venc_write ( sd , VENC_LCDOUT , 0 ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type ! = VPBE_VERSION_3 )
2011-09-10 02:19:55 -03:00
venc_write ( sd , VENC_CMPNT , 0x100 ) ;
2011-06-17 04:01:34 -03:00
venc_write ( sd , VENC_HSPLS , 0 ) ;
venc_write ( sd , VENC_HINT , 0 ) ;
venc_write ( sd , VENC_HSTART , 0 ) ;
venc_write ( sd , VENC_HVALID , 0 ) ;
venc_write ( sd , VENC_VSPLS , 0 ) ;
venc_write ( sd , VENC_VINT , 0 ) ;
venc_write ( sd , VENC_VSTART , 0 ) ;
venc_write ( sd , VENC_VVALID , 0 ) ;
venc_write ( sd , VENC_HSDLY , 0 ) ;
venc_write ( sd , VENC_VSDLY , 0 ) ;
venc_write ( sd , VENC_YCCCTL , 0 ) ;
venc_write ( sd , VENC_VSTARTA , 0 ) ;
/* Set OSD clock and OSD Sync Adavance registers */
venc_write ( sd , VENC_OSDCLK0 , 1 ) ;
venc_write ( sd , VENC_OSDCLK1 , 2 ) ;
}
}
2013-03-22 04:53:13 -03:00
static void
venc_enable_vpss_clock ( int venc_type ,
enum vpbe_enc_timings_type type ,
unsigned int pclock )
{
if ( venc_type = = VPBE_VERSION_1 )
return ;
if ( venc_type = = VPBE_VERSION_2 & & ( type = = VPBE_ENC_STD | | ( type = =
VPBE_ENC_DV_TIMINGS & & pclock < = 27000000 ) ) ) {
vpss_enable_clock ( VPSS_VENC_CLOCK_SEL , 1 ) ;
vpss_enable_clock ( VPSS_VPBE_CLOCK , 1 ) ;
return ;
}
if ( venc_type = = VPBE_VERSION_3 & & type = = VPBE_ENC_STD )
vpss_enable_clock ( VPSS_VENC_CLOCK_SEL , 0 ) ;
}
2011-09-10 02:19:55 -03:00
# define VDAC_CONFIG_SD_V3 0x0E21A6B6
# define VDAC_CONFIG_SD_V2 0x081141CF
2011-06-17 04:01:34 -03:00
/*
* setting NTSC mode
*/
static int venc_set_ntsc ( struct v4l2_subdev * sd )
{
struct venc_state * venc = to_state ( sd ) ;
struct venc_platform_data * pdata = venc - > pdata ;
v4l2_dbg ( debug , 2 , sd , " venc_set_ntsc \n " ) ;
/* Setup clock at VPSS & VENC for SD */
vpss_enable_clock ( VPSS_VENC_CLOCK_SEL , 1 ) ;
if ( pdata - > setup_clock ( VPBE_ENC_STD , V4L2_STD_525_60 ) < 0 )
return - EINVAL ;
2013-03-22 04:53:13 -03:00
venc_enable_vpss_clock ( venc - > venc_type , VPBE_ENC_STD , V4L2_STD_525_60 ) ;
2011-06-17 04:01:34 -03:00
venc_enabledigitaloutput ( sd , 0 ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type = = VPBE_VERSION_3 ) {
2011-09-10 02:19:55 -03:00
venc_write ( sd , VENC_CLKCTL , 0x01 ) ;
venc_write ( sd , VENC_VIDCTL , 0 ) ;
2018-04-05 12:53:34 -04:00
vdaccfg_write ( sd , VDAC_CONFIG_SD_V3 ) ;
2012-11-20 07:30:36 -03:00
} else if ( venc - > venc_type = = VPBE_VERSION_2 ) {
2011-09-10 02:19:55 -03:00
venc_write ( sd , VENC_CLKCTL , 0x01 ) ;
venc_write ( sd , VENC_VIDCTL , 0 ) ;
vdaccfg_write ( sd , VDAC_CONFIG_SD_V2 ) ;
} else {
/* to set VENC CLK DIV to 1 - final clock is 54 MHz */
venc_modify ( sd , VENC_VIDCTL , 0 , 1 < < 1 ) ;
/* Set REC656 Mode */
venc_write ( sd , VENC_YCCCTL , 0x1 ) ;
venc_modify ( sd , VENC_VDPRO , 0 , VENC_VDPRO_DAFRQ ) ;
venc_modify ( sd , VENC_VDPRO , 0 , VENC_VDPRO_DAUPS ) ;
}
2011-06-17 04:01:34 -03:00
venc_write ( sd , VENC_VMOD , 0 ) ;
venc_modify ( sd , VENC_VMOD , ( 1 < < VENC_VMOD_VIE_SHIFT ) ,
VENC_VMOD_VIE ) ;
venc_modify ( sd , VENC_VMOD , ( 0 < < VENC_VMOD_VMD ) , VENC_VMOD_VMD ) ;
venc_modify ( sd , VENC_VMOD , ( 0 < < VENC_VMOD_TVTYP_SHIFT ) ,
VENC_VMOD_TVTYP ) ;
venc_write ( sd , VENC_DACTST , 0x0 ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VENC , VENC_VMOD_VENC ) ;
return 0 ;
}
/*
* setting PAL mode
*/
static int venc_set_pal ( struct v4l2_subdev * sd )
{
struct venc_state * venc = to_state ( sd ) ;
v4l2_dbg ( debug , 2 , sd , " venc_set_pal \n " ) ;
/* Setup clock at VPSS & VENC for SD */
vpss_enable_clock ( VPSS_VENC_CLOCK_SEL , 1 ) ;
if ( venc - > pdata - > setup_clock ( VPBE_ENC_STD , V4L2_STD_625_50 ) < 0 )
return - EINVAL ;
2013-03-22 04:53:13 -03:00
venc_enable_vpss_clock ( venc - > venc_type , VPBE_ENC_STD , V4L2_STD_625_50 ) ;
2011-06-17 04:01:34 -03:00
venc_enabledigitaloutput ( sd , 0 ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type = = VPBE_VERSION_3 ) {
2011-09-10 02:19:55 -03:00
venc_write ( sd , VENC_CLKCTL , 0x1 ) ;
venc_write ( sd , VENC_VIDCTL , 0 ) ;
vdaccfg_write ( sd , VDAC_CONFIG_SD_V3 ) ;
2012-11-20 07:30:36 -03:00
} else if ( venc - > venc_type = = VPBE_VERSION_2 ) {
2011-09-10 02:19:55 -03:00
venc_write ( sd , VENC_CLKCTL , 0x1 ) ;
venc_write ( sd , VENC_VIDCTL , 0 ) ;
vdaccfg_write ( sd , VDAC_CONFIG_SD_V2 ) ;
} else {
/* to set VENC CLK DIV to 1 - final clock is 54 MHz */
venc_modify ( sd , VENC_VIDCTL , 0 , 1 < < 1 ) ;
/* Set REC656 Mode */
venc_write ( sd , VENC_YCCCTL , 0x1 ) ;
}
2011-06-17 04:01:34 -03:00
venc_modify ( sd , VENC_SYNCCTL , 1 < < VENC_SYNCCTL_OVD_SHIFT ,
VENC_SYNCCTL_OVD ) ;
venc_write ( sd , VENC_VMOD , 0 ) ;
venc_modify ( sd , VENC_VMOD ,
( 1 < < VENC_VMOD_VIE_SHIFT ) ,
VENC_VMOD_VIE ) ;
venc_modify ( sd , VENC_VMOD ,
( 0 < < VENC_VMOD_VMD ) , VENC_VMOD_VMD ) ;
venc_modify ( sd , VENC_VMOD ,
( 1 < < VENC_VMOD_TVTYP_SHIFT ) ,
VENC_VMOD_TVTYP ) ;
venc_write ( sd , VENC_DACTST , 0x0 ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VENC , VENC_VMOD_VENC ) ;
return 0 ;
}
2011-09-10 02:19:55 -03:00
# define VDAC_CONFIG_HD_V2 0x081141EF
2011-06-17 04:01:34 -03:00
/*
* venc_set_480p59_94
*
* This function configures the video encoder to EDTV ( 525 p ) component setting .
*/
static int venc_set_480p59_94 ( struct v4l2_subdev * sd )
{
struct venc_state * venc = to_state ( sd ) ;
struct venc_platform_data * pdata = venc - > pdata ;
v4l2_dbg ( debug , 2 , sd , " venc_set_480p59_94 \n " ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type ! = VPBE_VERSION_1 & &
venc - > venc_type ! = VPBE_VERSION_2 )
2011-09-10 02:19:55 -03:00
return - EINVAL ;
2011-06-17 04:01:34 -03:00
/* Setup clock at VPSS & VENC for SD */
2013-02-15 15:06:28 -03:00
if ( pdata - > setup_clock ( VPBE_ENC_DV_TIMINGS , 27000000 ) < 0 )
2011-06-17 04:01:34 -03:00
return - EINVAL ;
2013-03-22 04:53:13 -03:00
venc_enable_vpss_clock ( venc - > venc_type , VPBE_ENC_DV_TIMINGS , 27000000 ) ;
2011-06-17 04:01:34 -03:00
venc_enabledigitaloutput ( sd , 0 ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type = = VPBE_VERSION_2 )
2011-09-10 02:19:55 -03:00
vdaccfg_write ( sd , VDAC_CONFIG_HD_V2 ) ;
2011-06-17 04:01:34 -03:00
venc_write ( sd , VENC_OSDCLK0 , 0 ) ;
venc_write ( sd , VENC_OSDCLK1 , 1 ) ;
2011-09-10 02:19:55 -03:00
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type = = VPBE_VERSION_1 ) {
2011-09-10 02:19:55 -03:00
venc_modify ( sd , VENC_VDPRO , VENC_VDPRO_DAFRQ ,
VENC_VDPRO_DAFRQ ) ;
venc_modify ( sd , VENC_VDPRO , VENC_VDPRO_DAUPS ,
VENC_VDPRO_DAUPS ) ;
}
2011-06-17 04:01:34 -03:00
venc_write ( sd , VENC_VMOD , 0 ) ;
venc_modify ( sd , VENC_VMOD , ( 1 < < VENC_VMOD_VIE_SHIFT ) ,
VENC_VMOD_VIE ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_HDMD , VENC_VMOD_HDMD ) ;
venc_modify ( sd , VENC_VMOD , ( HDTV_525P < < VENC_VMOD_TVTYP_SHIFT ) ,
VENC_VMOD_TVTYP ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VDMD_YCBCR8 < <
VENC_VMOD_VDMD_SHIFT , VENC_VMOD_VDMD ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VENC , VENC_VMOD_VENC ) ;
return 0 ;
}
/*
* venc_set_625p
*
* This function configures the video encoder to HDTV ( 625 p ) component setting
*/
static int venc_set_576p50 ( struct v4l2_subdev * sd )
{
struct venc_state * venc = to_state ( sd ) ;
struct venc_platform_data * pdata = venc - > pdata ;
v4l2_dbg ( debug , 2 , sd , " venc_set_576p50 \n " ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type ! = VPBE_VERSION_1 & &
venc - > venc_type ! = VPBE_VERSION_2 )
2011-09-10 02:19:55 -03:00
return - EINVAL ;
2011-06-17 04:01:34 -03:00
/* Setup clock at VPSS & VENC for SD */
2013-02-15 15:06:28 -03:00
if ( pdata - > setup_clock ( VPBE_ENC_DV_TIMINGS , 27000000 ) < 0 )
2011-06-17 04:01:34 -03:00
return - EINVAL ;
2013-03-22 04:53:13 -03:00
venc_enable_vpss_clock ( venc - > venc_type , VPBE_ENC_DV_TIMINGS , 27000000 ) ;
2011-06-17 04:01:34 -03:00
venc_enabledigitaloutput ( sd , 0 ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type = = VPBE_VERSION_2 )
2011-09-10 02:19:55 -03:00
vdaccfg_write ( sd , VDAC_CONFIG_HD_V2 ) ;
2011-06-17 04:01:34 -03:00
venc_write ( sd , VENC_OSDCLK0 , 0 ) ;
venc_write ( sd , VENC_OSDCLK1 , 1 ) ;
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type = = VPBE_VERSION_1 ) {
2011-09-10 02:19:55 -03:00
venc_modify ( sd , VENC_VDPRO , VENC_VDPRO_DAFRQ ,
VENC_VDPRO_DAFRQ ) ;
venc_modify ( sd , VENC_VDPRO , VENC_VDPRO_DAUPS ,
VENC_VDPRO_DAUPS ) ;
}
2011-06-17 04:01:34 -03:00
venc_write ( sd , VENC_VMOD , 0 ) ;
venc_modify ( sd , VENC_VMOD , ( 1 < < VENC_VMOD_VIE_SHIFT ) ,
VENC_VMOD_VIE ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_HDMD , VENC_VMOD_HDMD ) ;
venc_modify ( sd , VENC_VMOD , ( HDTV_625P < < VENC_VMOD_TVTYP_SHIFT ) ,
VENC_VMOD_TVTYP ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VDMD_YCBCR8 < <
VENC_VMOD_VDMD_SHIFT , VENC_VMOD_VDMD ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VENC , VENC_VMOD_VENC ) ;
return 0 ;
}
2011-09-10 02:19:55 -03:00
/*
* venc_set_720p60_internal - Setup 720 p60 in venc for dm365 only
*/
static int venc_set_720p60_internal ( struct v4l2_subdev * sd )
{
struct venc_state * venc = to_state ( sd ) ;
struct venc_platform_data * pdata = venc - > pdata ;
2013-02-15 15:06:28 -03:00
if ( pdata - > setup_clock ( VPBE_ENC_DV_TIMINGS , 74250000 ) < 0 )
2011-09-10 02:19:55 -03:00
return - EINVAL ;
2013-03-22 04:53:13 -03:00
venc_enable_vpss_clock ( venc - > venc_type , VPBE_ENC_DV_TIMINGS , 74250000 ) ;
2011-09-10 02:19:55 -03:00
venc_enabledigitaloutput ( sd , 0 ) ;
venc_write ( sd , VENC_OSDCLK0 , 0 ) ;
venc_write ( sd , VENC_OSDCLK1 , 1 ) ;
venc_write ( sd , VENC_VMOD , 0 ) ;
/* DM365 component HD mode */
venc_modify ( sd , VENC_VMOD , ( 1 < < VENC_VMOD_VIE_SHIFT ) ,
VENC_VMOD_VIE ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_HDMD , VENC_VMOD_HDMD ) ;
venc_modify ( sd , VENC_VMOD , ( HDTV_720P < < VENC_VMOD_TVTYP_SHIFT ) ,
VENC_VMOD_TVTYP ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VENC , VENC_VMOD_VENC ) ;
venc_write ( sd , VENC_XHINTVL , 0 ) ;
return 0 ;
}
/*
* venc_set_1080i30_internal - Setup 1080 i30 in venc for dm365 only
*/
static int venc_set_1080i30_internal ( struct v4l2_subdev * sd )
{
struct venc_state * venc = to_state ( sd ) ;
struct venc_platform_data * pdata = venc - > pdata ;
2013-02-15 15:06:28 -03:00
if ( pdata - > setup_clock ( VPBE_ENC_DV_TIMINGS , 74250000 ) < 0 )
2011-09-10 02:19:55 -03:00
return - EINVAL ;
2013-03-22 04:53:13 -03:00
venc_enable_vpss_clock ( venc - > venc_type , VPBE_ENC_DV_TIMINGS , 74250000 ) ;
2011-09-10 02:19:55 -03:00
venc_enabledigitaloutput ( sd , 0 ) ;
venc_write ( sd , VENC_OSDCLK0 , 0 ) ;
venc_write ( sd , VENC_OSDCLK1 , 1 ) ;
venc_write ( sd , VENC_VMOD , 0 ) ;
/* DM365 component HD mode */
venc_modify ( sd , VENC_VMOD , ( 1 < < VENC_VMOD_VIE_SHIFT ) ,
VENC_VMOD_VIE ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_HDMD , VENC_VMOD_HDMD ) ;
venc_modify ( sd , VENC_VMOD , ( HDTV_1080I < < VENC_VMOD_TVTYP_SHIFT ) ,
VENC_VMOD_TVTYP ) ;
venc_modify ( sd , VENC_VMOD , VENC_VMOD_VENC , VENC_VMOD_VENC ) ;
venc_write ( sd , VENC_XHINTVL , 0 ) ;
return 0 ;
}
2011-06-17 04:01:34 -03:00
static int venc_s_std_output ( struct v4l2_subdev * sd , v4l2_std_id norm )
{
v4l2_dbg ( debug , 1 , sd , " venc_s_std_output \n " ) ;
if ( norm & V4L2_STD_525_60 )
return venc_set_ntsc ( sd ) ;
else if ( norm & V4L2_STD_625_50 )
return venc_set_pal ( sd ) ;
return - EINVAL ;
}
2012-10-01 11:39:46 -03:00
static int venc_s_dv_timings ( struct v4l2_subdev * sd ,
struct v4l2_dv_timings * dv_timings )
2011-06-17 04:01:34 -03:00
{
2011-09-10 02:19:55 -03:00
struct venc_state * venc = to_state ( sd ) ;
2012-10-01 11:39:46 -03:00
u32 height = dv_timings - > bt . height ;
2011-09-10 02:19:55 -03:00
int ret ;
2012-10-01 11:39:46 -03:00
v4l2_dbg ( debug , 1 , sd , " venc_s_dv_timings \n " ) ;
2011-06-17 04:01:34 -03:00
2012-10-01 11:39:46 -03:00
if ( height = = 576 )
2011-06-17 04:01:34 -03:00
return venc_set_576p50 ( sd ) ;
2012-10-01 11:39:46 -03:00
else if ( height = = 480 )
2011-06-17 04:01:34 -03:00
return venc_set_480p59_94 ( sd ) ;
2012-10-01 11:39:46 -03:00
else if ( ( height = = 720 ) & &
2012-11-20 07:30:36 -03:00
( venc - > venc_type = = VPBE_VERSION_2 ) ) {
2011-09-10 02:19:55 -03:00
/* TBD setup internal 720p mode here */
ret = venc_set_720p60_internal ( sd ) ;
/* for DM365 VPBE, there is DAC inside */
vdaccfg_write ( sd , VDAC_CONFIG_HD_V2 ) ;
return ret ;
2012-10-01 11:39:46 -03:00
} else if ( ( height = = 1080 ) & &
2012-11-20 07:30:36 -03:00
( venc - > venc_type = = VPBE_VERSION_2 ) ) {
2011-09-10 02:19:55 -03:00
/* TBD setup internal 1080i mode here */
ret = venc_set_1080i30_internal ( sd ) ;
/* for DM365 VPBE, there is DAC inside */
vdaccfg_write ( sd , VDAC_CONFIG_HD_V2 ) ;
return ret ;
}
2011-06-17 04:01:34 -03:00
return - EINVAL ;
}
static int venc_s_routing ( struct v4l2_subdev * sd , u32 input , u32 output ,
u32 config )
{
struct venc_state * venc = to_state ( sd ) ;
int ret ;
v4l2_dbg ( debug , 1 , sd , " venc_s_routing \n " ) ;
ret = venc_set_dac ( sd , output ) ;
if ( ! ret )
venc - > output = output ;
return ret ;
}
static long venc_ioctl ( struct v4l2_subdev * sd ,
unsigned int cmd ,
void * arg )
{
u32 val ;
switch ( cmd ) {
case VENC_GET_FLD :
val = venc_read ( sd , VENC_VSTAT ) ;
* ( ( int * ) arg ) = ( ( val & VENC_VSTAT_FIDST ) = =
VENC_VSTAT_FIDST ) ;
break ;
default :
v4l2_err ( sd , " Wrong IOCTL cmd \n " ) ;
break ;
}
return 0 ;
}
static const struct v4l2_subdev_core_ops venc_core_ops = {
. ioctl = venc_ioctl ,
} ;
static const struct v4l2_subdev_video_ops venc_video_ops = {
. s_routing = venc_s_routing ,
. s_std_output = venc_s_std_output ,
2012-10-01 11:39:46 -03:00
. s_dv_timings = venc_s_dv_timings ,
2011-06-17 04:01:34 -03:00
} ;
static const struct v4l2_subdev_ops venc_ops = {
. core = & venc_core_ops ,
. video = & venc_video_ops ,
} ;
static int venc_initialize ( struct v4l2_subdev * sd )
{
struct venc_state * venc = to_state ( sd ) ;
int ret ;
/* Set default to output to composite and std to NTSC */
venc - > output = 0 ;
venc - > std = V4L2_STD_525_60 ;
ret = venc_s_routing ( sd , 0 , venc - > output , 0 ) ;
if ( ret < 0 ) {
v4l2_err ( sd , " Error setting output during init \n " ) ;
return - EINVAL ;
}
ret = venc_s_std_output ( sd , venc - > std ) ;
if ( ret < 0 ) {
v4l2_err ( sd , " Error setting std during init \n " ) ;
return - EINVAL ;
}
return ret ;
}
static int venc_device_get ( struct device * dev , void * data )
{
struct platform_device * pdev = to_platform_device ( dev ) ;
struct venc_state * * venc = data ;
2012-11-20 07:30:36 -03:00
if ( strstr ( pdev - > name , " vpbe-venc " ) ! = NULL )
2011-06-17 04:01:34 -03:00
* venc = platform_get_drvdata ( pdev ) ;
return 0 ;
}
struct v4l2_subdev * venc_sub_dev_init ( struct v4l2_device * v4l2_dev ,
const char * venc_name )
{
2018-04-20 06:13:52 -04:00
struct venc_state * venc = NULL ;
2011-06-17 04:01:34 -03:00
2018-04-05 12:53:34 -04:00
bus_for_each_dev ( & platform_bus_type , NULL , & venc ,
2011-06-17 04:01:34 -03:00
venc_device_get ) ;
if ( venc = = NULL )
return NULL ;
v4l2_subdev_init ( & venc - > sd , & venc_ops ) ;
2018-09-10 16:20:42 -04:00
strscpy ( venc - > sd . name , venc_name , sizeof ( venc - > sd . name ) ) ;
2011-06-17 04:01:34 -03:00
if ( v4l2_device_register_subdev ( v4l2_dev , & venc - > sd ) < 0 ) {
v4l2_err ( v4l2_dev ,
" vpbe unable to register venc sub device \n " ) ;
return NULL ;
}
if ( venc_initialize ( & venc - > sd ) ) {
v4l2_err ( v4l2_dev ,
" vpbe venc initialization failed \n " ) ;
return NULL ;
}
return & venc - > sd ;
}
EXPORT_SYMBOL ( venc_sub_dev_init ) ;
static int venc_probe ( struct platform_device * pdev )
{
2012-11-20 07:30:36 -03:00
const struct platform_device_id * pdev_id ;
2011-06-17 04:01:34 -03:00
struct venc_state * venc ;
struct resource * res ;
2013-07-13 04:50:27 -03:00
if ( ! pdev - > dev . platform_data ) {
dev_err ( & pdev - > dev , " No platform data for VENC sub device " ) ;
return - EINVAL ;
}
pdev_id = platform_get_device_id ( pdev ) ;
if ( ! pdev_id )
return - EINVAL ;
venc = devm_kzalloc ( & pdev - > dev , sizeof ( struct venc_state ) , GFP_KERNEL ) ;
2011-06-17 04:01:34 -03:00
if ( venc = = NULL )
return - ENOMEM ;
2012-11-20 07:30:36 -03:00
venc - > venc_type = pdev_id - > driver_data ;
2011-06-17 04:01:34 -03:00
venc - > pdev = & pdev - > dev ;
venc - > pdata = pdev - > dev . platform_data ;
2013-07-13 04:50:27 -03:00
2011-06-17 04:01:34 -03:00
res = platform_get_resource ( pdev , IORESOURCE_MEM , 0 ) ;
2013-07-13 04:50:27 -03:00
venc - > venc_base = devm_ioremap_resource ( & pdev - > dev , res ) ;
if ( IS_ERR ( venc - > venc_base ) )
return PTR_ERR ( venc - > venc_base ) ;
2011-06-17 04:01:34 -03:00
2012-11-20 07:30:36 -03:00
if ( venc - > venc_type ! = VPBE_VERSION_1 ) {
2011-09-10 02:19:55 -03:00
res = platform_get_resource ( pdev , IORESOURCE_MEM , 1 ) ;
2013-07-13 04:50:27 -03:00
venc - > vdaccfg_reg = devm_ioremap_resource ( & pdev - > dev , res ) ;
if ( IS_ERR ( venc - > vdaccfg_reg ) )
return PTR_ERR ( venc - > vdaccfg_reg ) ;
2011-09-10 02:19:55 -03:00
}
2011-06-17 04:01:34 -03:00
spin_lock_init ( & venc - > lock ) ;
platform_set_drvdata ( pdev , venc ) ;
dev_notice ( venc - > pdev , " VENC sub device probe success \n " ) ;
2013-07-13 04:50:27 -03:00
return 0 ;
2011-06-17 04:01:34 -03:00
}
static int venc_remove ( struct platform_device * pdev )
{
return 0 ;
}
static struct platform_driver venc_driver = {
. probe = venc_probe ,
. remove = venc_remove ,
. driver = {
. name = MODULE_NAME ,
} ,
2012-11-20 07:30:36 -03:00
. id_table = vpbe_venc_devtype
2011-06-17 04:01:34 -03:00
} ;
2012-01-10 03:21:49 -03:00
module_platform_driver ( venc_driver ) ;
2011-06-17 04:01:34 -03:00
MODULE_LICENSE ( " GPL " ) ;
MODULE_DESCRIPTION ( " VPBE VENC Driver " ) ;
MODULE_AUTHOR ( " Texas Instruments " ) ;