1995 lines
91 KiB
C
1995 lines
91 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/********************************************************************************
|
|
*
|
|
* Copyright (C) 2017 NEXTCHIP Inc. All rights reserved.
|
|
* Module : video_auto_detect.c
|
|
* Description :
|
|
* Author :
|
|
* Date :
|
|
* Version : Version 1.0
|
|
*
|
|
********************************************************************************
|
|
* History :
|
|
*
|
|
*
|
|
********************************************************************************/
|
|
#include <linux/string.h>
|
|
#include <linux/delay.h>
|
|
#include "nvp6158_common.h"
|
|
#include "nvp6158_video_eq.h"
|
|
#include "nvp6158_video_eq_table.h"
|
|
#include "nvp6168_eq_table.h"
|
|
#include "nvp6158_audio.h"
|
|
#include "nvp6158_video_auto_detect.h"
|
|
|
|
extern unsigned int nvp6158_iic_addr[4];
|
|
extern int nvp6158_chip_id[4];
|
|
|
|
/*******************************************************************************
|
|
* Description : get eq stage(manual)
|
|
* Argurments : Ch(channel), pDistance(distance structure)
|
|
* Return value : distance( eq stage)
|
|
* Modify :
|
|
* warning :
|
|
*******************************************************************************/
|
|
CABLE_DISTANCE NVP6158_NC_VD_MANUAL_CABLE_DISTANCE_Get (unsigned char Ch, video_input_cable_dist *pDistance)
|
|
{
|
|
unsigned char sGetDistCnt = 0;
|
|
unsigned char sGetDist[10] = {0, };
|
|
unsigned char sMaxGetDistVal;
|
|
unsigned char sMaxDistVal;
|
|
unsigned char ii;
|
|
int sMaxDistCnt;
|
|
|
|
if((nvp6158_chip_id[Ch/4] == NVP6168C_R0_ID) || (nvp6158_chip_id[Ch/4] == NVP6168_R0_ID))
|
|
{
|
|
sMaxDistCnt = 3;
|
|
}
|
|
else
|
|
{
|
|
sMaxDistCnt = 10;
|
|
}
|
|
|
|
/* Get Distance 10 Times */
|
|
while(sGetDistCnt < sMaxDistCnt)
|
|
{
|
|
msleep(1);
|
|
|
|
//NC_VD_MANUAL_CABLE_DISTANCE_Read(pDistance);
|
|
if((nvp6158_chip_id[Ch/4] == NVP6168C_R0_ID) || (nvp6158_chip_id[Ch/4] == NVP6168_R0_ID))
|
|
nvp6168_video_input_cable_manualdist_read(pDistance);
|
|
else
|
|
nvp6158_video_input_cable_manualdist_read(pDistance);
|
|
|
|
sGetDist[ pDistance->dist ]++;
|
|
|
|
sGetDistCnt++;
|
|
}
|
|
|
|
sMaxDistVal = sGetDist[0];
|
|
sMaxGetDistVal = 0;
|
|
|
|
for(ii = 1; ii < 6; ii++)
|
|
{
|
|
if( sMaxDistVal < sGetDist[ii] )
|
|
{
|
|
sMaxDistVal = sGetDist[ii];
|
|
sMaxGetDistVal = ii;
|
|
}
|
|
}
|
|
|
|
|
|
printk("TESTING... Get Distance Value : ");
|
|
for(ii = 0; ii < 6; ii++)
|
|
printk("[ stage: %d _ get_value: %d ]\n", ii, sGetDist[ii]);
|
|
|
|
printk(" Distance distinguish result : [%d]\n", sMaxGetDistVal);
|
|
// return (CABLE_DISTANCE)pDistance->Dist;
|
|
return sMaxGetDistVal;
|
|
}
|
|
|
|
//0:video on; 1: video loss
|
|
static int nvp6158_IsChAlive(video_equalizer_info_s *ps_eq_info)
|
|
{
|
|
unsigned char vloss;
|
|
unsigned char vloss_ch;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[ps_eq_info->devnum], 0xFF, 0x00);
|
|
vloss = gpio_i2c_read(nvp6158_iic_addr[ps_eq_info->devnum], 0xA8);
|
|
vloss_ch = ((vloss>>ps_eq_info->Ch)&0x01);
|
|
return vloss_ch;
|
|
}
|
|
|
|
/**************************************************************************************
|
|
* @desc
|
|
* Function to read cable distance for EQ setting according to cable distance.(manual)
|
|
*
|
|
* @param_in (unsigned char)Ch Video Channel
|
|
*
|
|
* @return (CABLE_DISTANCE) 0 Short ( < 2M )
|
|
* @return 1 100M
|
|
* @return 2 200M
|
|
* @return 3 300M
|
|
* @return 4 400M
|
|
* @return 5 500M
|
|
***************************************************************************************/
|
|
//CABLE_DISTANCE NC_APP_VD_MANUAL_CABLE_DISTANCE_Get(unsigned char Ch, NC_VIVO_CH_FORMATDEF FmtDef )
|
|
CABLE_DISTANCE nvp6158_get_eq_dist(video_equalizer_info_s *ps_eq_info)
|
|
{
|
|
unsigned int Waiting_AGC_Stable_cnt = 0;
|
|
unsigned char oChannel = 0;
|
|
CABLE_DISTANCE Distance=0;
|
|
unsigned char oMaxTimeCnt = 20;
|
|
|
|
video_input_hsync_accum Hsync_Accumulation;
|
|
video_input_sam_val SAM;
|
|
video_input_agc_val AGC;
|
|
NC_VD_AUTO_CABLE_DIST_STR Cable_Distance;
|
|
video_input_cable_dist sManualDistance;
|
|
|
|
unsigned char oDevAddr = 0x00;
|
|
unsigned int AGC_Stable_Check = 0;
|
|
|
|
oChannel = ps_eq_info->Ch;
|
|
oDevAddr = ps_eq_info->devnum;
|
|
|
|
SAM.ch = oChannel;
|
|
SAM.devnum = oDevAddr;
|
|
Hsync_Accumulation.ch = oChannel;
|
|
Hsync_Accumulation.devnum = oDevAddr;
|
|
AGC.ch = oChannel;
|
|
AGC.devnum = oDevAddr;
|
|
Cable_Distance.Ch = oChannel;
|
|
Cable_Distance.devnum = oDevAddr;
|
|
if(nvp6158_chip_id[oChannel/4]==NVP6158_R0_ID || nvp6158_chip_id[oChannel/4]==NVP6158C_R0_ID)
|
|
{
|
|
while(1)
|
|
{
|
|
if(0==nvp6158_IsChAlive(ps_eq_info)) //when camera disconnect during eq caculation.
|
|
{
|
|
Distance = 0;
|
|
ps_eq_info->distance = Distance;
|
|
return Distance;
|
|
}
|
|
msleep(300);
|
|
|
|
//NC_VD_AUTO_SAM_Get(oChannel, &SAM);
|
|
nvp6158_video_input_sam_val_read(&SAM);
|
|
//NC_VD_AUTO_HSYNC_Get(oChannel, &Hsync_Accumulation);
|
|
nvp6158_video_input_hsync_accum_read(&Hsync_Accumulation);
|
|
//NC_VD_AUTO_AGC_Get(oChannel, &AGC);
|
|
nvp6158_video_input_agc_val_read(&AGC);
|
|
//NC_VD_AUTO_ACC_GAIN_Get(Ch, ACC_GAIN_NORMAL);
|
|
//nvp6158_video_input_acc_gain_val_read();
|
|
|
|
//AGC_Stable_Check = NC_APP_VD_AGC_STABLE_Check(&Hsync_Accumulation, &AGC, &SAM);
|
|
AGC_Stable_Check = ((Hsync_Accumulation.hsync_accum_result!=0)&&(SAM.sam_val!=0));
|
|
|
|
if(AGC_Stable_Check || Waiting_AGC_Stable_cnt >= oMaxTimeCnt)
|
|
{
|
|
/* temp by edward */
|
|
msleep(500);
|
|
//NC_VD_AUTO_HSYNC_Get(oChannel, &Hsync_Accumulation);
|
|
nvp6158_video_input_hsync_accum_read(&Hsync_Accumulation);
|
|
//NC_VD_AUTO_AGC_Get(oChannel, &AGC);
|
|
nvp6158_video_input_agc_val_read(&AGC);
|
|
//NC_VD_AUTO_SAM_Get(oChannel, &SAM);
|
|
nvp6158_video_input_sam_val_read(&SAM);
|
|
|
|
printk("CH:[%d] Hsync 1 : %08x\n", oChannel, Hsync_Accumulation.hsync_accum_val1);
|
|
printk("CH:[%d] Hsync 2 : %08x\n", oChannel, Hsync_Accumulation.hsync_accum_val2);
|
|
printk("CH:[%d] Hsync Result : %08x\n", oChannel, Hsync_Accumulation.hsync_accum_result);
|
|
|
|
printk("CH:[%d] Waiting for AGC Stable >>> %d\n", oChannel, Waiting_AGC_Stable_cnt + 1);
|
|
|
|
if(Waiting_AGC_Stable_cnt >= oMaxTimeCnt)
|
|
{
|
|
printk("CH:[%d] AGC Stable Fail\n", oChannel);
|
|
}
|
|
else
|
|
{
|
|
printk("CH:[%d] AGC Stable Success.\n", oChannel);
|
|
}
|
|
Waiting_AGC_Stable_cnt = 0;
|
|
break;
|
|
}
|
|
|
|
Waiting_AGC_Stable_cnt++;
|
|
}
|
|
}
|
|
/* convert vfc to formatDefine for APP and save videoloss information */
|
|
sManualDistance.ch = oChannel;
|
|
sManualDistance.FmtDef = ps_eq_info->FmtDef;
|
|
sManualDistance.devnum = oDevAddr;
|
|
sManualDistance.cabletype = 0; // Now, we use coaxial cable(0:coax, 1:utp, 2:reserved1, 3:reserved2
|
|
|
|
Distance = NVP6158_NC_VD_MANUAL_CABLE_DISTANCE_Get(oChannel, &sManualDistance);
|
|
ps_eq_info->distance = Distance;
|
|
return Distance;
|
|
}
|
|
|
|
unsigned char __nvp6158_video_cable_manualdistance( unsigned char cabletype, video_input_hsync_accum *pvin_hsync_accum, video_input_acc_gain_val *pvin_acc_val, nvp6158_video_equalizer_distance_table_s *pdistance_value )
|
|
{
|
|
int i = 0;
|
|
unsigned char distance = 0; /* default : short(0) */
|
|
|
|
/* for coaxial */
|
|
if( cabletype == 0 )
|
|
{
|
|
for( i = 0; i < 6; i++ )
|
|
{
|
|
if( (pvin_hsync_accum->hsync_accum_result > pdistance_value->hsync_stage.hsync_stage[i]) )
|
|
{
|
|
distance = i;
|
|
break;
|
|
}
|
|
|
|
}
|
|
if( i == 6 )
|
|
{
|
|
distance = 5;
|
|
}
|
|
}
|
|
|
|
if( pvin_hsync_accum->hsync_accum_result == 0 )
|
|
{
|
|
distance = 0; /* set default value(short:0) */
|
|
}
|
|
|
|
printk(">>>>> DRV[%s:%d] CH:%d, distance:%d\n", __func__, __LINE__, pvin_hsync_accum->ch, distance );
|
|
|
|
return distance;
|
|
}
|
|
|
|
void __nvp6158_eq_base_set_value( video_equalizer_info_s *pvin_eq_set, video_equalizer_base_s *pbase )
|
|
{
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char dist = pvin_eq_set->distance;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x01, pbase->eq_bypass[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x58, pbase->eq_band_sel[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5C, pbase->eq_gain_sel[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, (ch < 2 ? 0x0a : 0x0b) );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x3d + (ch%2 * 0x80), pbase->deq_a_on[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x3c + (ch%2 * 0x80), pbase->deq_a_sel[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x09 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x80 + (ch * 0x20), pbase->deq_b_sel[dist] );
|
|
|
|
#if 0 //test
|
|
printk("ch[%d]: BASE, dist:%d, eq_bypass[%02x]\n", ch, dist, pbase->eq_bypass[dist] );
|
|
printk("ch[%d]: BASE, dist:%d, eq_band_sel[%02x]\n", ch, dist, pbase->eq_band_sel[dist] );
|
|
printk("ch[%d]: BASE, dist:%d, eq_gain_sel[%02x]\n", ch, dist, pbase->eq_gain_sel[dist] );
|
|
printk("ch[%d]: BASE, dist:%d, deq_a_on[%02x]\n", ch, dist, pbase->deq_a_on[dist] );
|
|
printk("ch[%d]: BASE, dist:%d, deq_a_sel[%02x]\n", ch, dist, pbase->deq_a_sel[dist] );
|
|
printk("ch[%d]: BASE, dist:%d, deq_b_sel[%02x]\n", ch, dist, pbase->deq_b_sel[dist] );
|
|
#endif
|
|
}
|
|
|
|
void __nvp6158_eq_coeff_set_value( video_equalizer_info_s *pvin_eq_set, video_equalizer_coeff_s *pcoeff )
|
|
{
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char dist = pvin_eq_set->distance;
|
|
|
|
// unsigned char val_0x30;
|
|
// unsigned char val_0x31;
|
|
// unsigned char val_0x32;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, (ch < 2 ? 0x0a : 0x0b) );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + (ch%2 * 0x80), pcoeff->deqA_01[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x31 + (ch%2 * 0x80), pcoeff->deqA_02[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x32 + (ch%2 * 0x80), pcoeff->deqA_03[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x33 + (ch%2 * 0x80), pcoeff->deqA_04[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + (ch%2 * 0x80), pcoeff->deqA_05[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x35 + (ch%2 * 0x80), pcoeff->deqA_06[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x36 + (ch%2 * 0x80), pcoeff->deqA_07[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x37 + (ch%2 * 0x80), pcoeff->deqA_08[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x38 + (ch%2 * 0x80), pcoeff->deqA_09[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x39 + (ch%2 * 0x80), pcoeff->deqA_10[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x3a + (ch%2 * 0x80), pcoeff->deqA_11[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x3b + (ch%2 * 0x80), pcoeff->deqA_12[dist] );
|
|
|
|
#if 0
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_01[%02x]\n", ch, dist, pcoeff->deqA_01[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_02[%02x]\n", ch, dist, pcoeff->deqA_02[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_03[%02x]\n", ch, dist, pcoeff->deqA_03[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_04[%02x]\n", ch, dist, pcoeff->deqA_04[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_05[%02x]\n", ch, dist, pcoeff->deqA_05[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_06[%02x]\n", ch, dist, pcoeff->deqA_06[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_07[%02x]\n", ch, dist, pcoeff->deqA_07[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_08[%02x]\n", ch, dist, pcoeff->deqA_08[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_09[%02x]\n", ch, dist, pcoeff->deqA_09[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_10[%02x]\n", ch, dist, pcoeff->deqA_10[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_11[%02x]\n", ch, dist, pcoeff->deqA_11[dist] );
|
|
printk("ch[%d]: COEFF, dist:%d, deqA_12[%02x]\n", ch, dist, pcoeff->deqA_12[dist] );
|
|
#endif
|
|
}
|
|
|
|
void __nvp6158_eq_color_set_value( video_equalizer_info_s *pvin_eq_set, video_equalizer_color_s *pcolor )
|
|
{
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char dist = pvin_eq_set->distance;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x00 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10 + ch, pcolor->contrast[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x18 + ch, pcolor->h_peaking[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x21 + ch*4, pcolor->c_filter[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x40 + ch, pcolor->hue[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x44 + ch, pcolor->u_gain[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x48 + ch, pcolor->v_gain[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x4C + ch, pcolor->u_offset[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x50 + ch, pcolor->v_offset[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x05 + ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20, pcolor->black_level[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x27, pcolor->acc_ref[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x28, pcolor->cti_delay[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2b, pcolor->sub_saturation[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x24, pcolor->burst_dec_a[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5f, pcolor->burst_dec_b[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xd1, pcolor->burst_dec_c[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xd5, pcolor->c_option[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, (ch < 2 ? 0x0a : 0x0b) );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x25 + (ch%2 * 0x80), pcolor->y_filter_b[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x27 + (ch%2 * 0x80), pcolor->y_filter_b_sel[dist] );
|
|
|
|
if( pvin_eq_set->FmtDef == TVI_8M_15P || pvin_eq_set->FmtDef == TVI_8M_12_5P )
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x00 );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ch, 0xf0 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x3c + ch, 0xB8 );
|
|
}
|
|
else
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x00 );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ch, 0x00 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x3c + ch, 0x80 );
|
|
}
|
|
|
|
#if 0
|
|
printk("ch[%d]: COLOR, dist:%d, contrast[%02x]\n", ch, dist, pcolor->contrast[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, h_peaking[%02x]\n", ch, dist, pcolor->h_peaking[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, c_filter[%02x]\n", ch, dist, pcolor->c_filter[dist] );
|
|
|
|
printk("ch[%d]: COLOR, dist:%d, hue[%02x]\n", ch, dist, pcolor->hue[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, u_gain[%02x]\n", ch, dist, pcolor->u_gain[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, v_gain[%02x]\n", ch, dist, pcolor->v_gain[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, u_offset[%02x]\n", ch, dist, pcolor->u_offset[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, v_offset[%02x]\n", ch, dist, pcolor->v_offset[dist] );
|
|
|
|
printk("ch[%d]: COLOR, dist:%d, black_level[%02x]\n", ch, dist, pcolor->black_level[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, cti_delay[%02x]\n", ch, dist, pcolor->cti_delay[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, sub_saturation[%02x]\n", ch, dist, pcolor->sub_saturation[dist] );
|
|
|
|
printk("ch[%d]: COLOR, dist:%d, burst_dec_a[%02x]\n", ch, dist, pcolor->burst_dec_a[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, burst_dec_b[%02x]\n", ch, dist, pcolor->burst_dec_b[dist] );
|
|
printk("ch[%d]: COLOR, dist:%d, burst_dec_c[%02x]\n", ch, dist, pcolor->burst_dec_c[dist] );
|
|
|
|
printk("ch[%d]: COLOR, dist:%d, c_option[%02x]\n", ch, dist, pcolor->c_option[dist] );
|
|
#endif
|
|
}
|
|
|
|
void __nvp6158_eq_timing_a_set_value(video_equalizer_info_s * pvin_eq_set, video_equalizer_timing_a_s * ptiming_a)
|
|
{
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char dist = pvin_eq_set->distance;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x58 + ch, ptiming_a->h_delay_a[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x89 + ch, ptiming_a->h_delay_b[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x8e + ch, ptiming_a->h_delay_c[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xa0 + ch, ptiming_a->y_delay[dist] );
|
|
|
|
#if 0
|
|
printk("ch[%d]: TIMING_A, dist:%d, h_delay_a[%02x]\n", ch, dist, ptiming_a->h_delay_a[dist] );
|
|
printk("ch[%d]: TIMING_A, dist:%d, h_delay_b[%02x]\n", ch, dist, ptiming_a->h_delay_b[dist] );
|
|
printk("ch[%d]: TIMING_A, dist:%d, h_delay_c[%02x]\n", ch, dist, ptiming_a->h_delay_c[dist] );
|
|
printk("ch[%d]: TIMING_A, dist:%d, y_delay[%02x]\n", ch, dist, ptiming_a->y_delay[dist] );
|
|
#endif
|
|
}
|
|
|
|
void __nvp6158_eq_clk_set_value( video_equalizer_info_s *pvin_eq_set, video_equalizer_clk_s *pclk )
|
|
{
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char dist = pvin_eq_set->distance;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x01 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x84 + ch, pclk->clk_adc[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x8C + ch, pclk->clk_dec[dist] );
|
|
}
|
|
void __nvp6158_eq_timing_b_set_value( video_equalizer_info_s *pvin_eq_set, video_equalizer_timing_b_s *ptiming_b )
|
|
{
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char dist = pvin_eq_set->distance;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x09 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x96 + (ch * 0x20), ptiming_b->h_scaler1[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x97 + (ch * 0x20), ptiming_b->h_scaler2[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x98 + (ch * 0x20), ptiming_b->h_scaler3[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x99 + (ch * 0x20), ptiming_b->h_scaler4[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x9A + (ch * 0x20), ptiming_b->h_scaler5[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x9B + (ch * 0x20), ptiming_b->h_scaler6[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x9C + (ch * 0x20), ptiming_b->h_scaler7[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x9D + (ch * 0x20), ptiming_b->h_scaler8[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x9E + (ch * 0x20), ptiming_b->h_scaler9[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x40 + ch , ptiming_b->pn_auto[dist] );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x05 + ch );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x90, ptiming_b->comb_mode[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xb9, ptiming_b->h_pll_op_a[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x57, ptiming_b->mem_path[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x25, ptiming_b->fsc_lock_speed[dist] );
|
|
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x00 );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x81 + ch, ptiming_b->format_set1[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x85 + ch, ptiming_b->format_set2[dist] );
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x64 + ch, ptiming_b->v_delay[dist] );
|
|
|
|
#if 0
|
|
printk("ch[%d]: TIMING_B, dist:%d, h_scaler1[%02x]\n", ch, dist, ptiming_b->h_scaler1[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, h_scaler2[%02x]\n", ch, dist, ptiming_b->h_scaler2[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, h_scaler3[%02x]\n", ch, dist, ptiming_b->h_scaler3[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, h_scaler4[%02x]\n", ch, dist, ptiming_b->h_scaler4[dist] );
|
|
|
|
printk("ch[%d]: TIMING_B, dist:%d, pn_auto[%02x]\n", ch, dist, ptiming_b->pn_auto[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, comb_mode[%02x]\n", ch, dist, ptiming_b->comb_mode[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, h_pll_op_a[%02x]\n", ch, dist, ptiming_b->h_pll_op_a[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, mem_path[%02x]\n", ch, dist, ptiming_b->mem_path[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, format_set1[%02x]\n", ch, dist, ptiming_b->format_set1[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, format_set2[%02x]\n", ch, dist, ptiming_b->format_set2[dist] );
|
|
printk("ch[%d]: TIMING_B, dist:%d, v_delay[%02x]\n", ch, dist, ptiming_b->v_delay[dist] );
|
|
#endif
|
|
|
|
}
|
|
|
|
unsigned int __nvp6158_get_acc_gain(unsigned char ch, unsigned char devnum)
|
|
{
|
|
unsigned int acc_gain_status;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x05+ch%4);
|
|
acc_gain_status = gpio_i2c_read(nvp6158_iic_addr[devnum],0xE2);
|
|
acc_gain_status <<= 8;
|
|
acc_gain_status |= gpio_i2c_read(nvp6158_iic_addr[devnum],0xE3);
|
|
|
|
return acc_gain_status;
|
|
}
|
|
|
|
unsigned int __nvp6158_get_yplus_slope(unsigned char ch, unsigned char devnum)
|
|
{
|
|
unsigned int y_plus_slp_status;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x05+ch%4);
|
|
y_plus_slp_status = gpio_i2c_read(nvp6158_iic_addr[devnum],0xE8)&0x07;
|
|
y_plus_slp_status <<= 8;
|
|
y_plus_slp_status |= gpio_i2c_read(nvp6158_iic_addr[devnum],0xE9);
|
|
|
|
return y_plus_slp_status;
|
|
}
|
|
|
|
unsigned int __nvp6158_get_yminus_slope(unsigned char ch, unsigned char devnum)
|
|
{
|
|
unsigned int y_minus_slp_status;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x05+ch%4);
|
|
y_minus_slp_status = gpio_i2c_read(nvp6158_iic_addr[devnum],0xEA)&0x07;
|
|
y_minus_slp_status <<= 8;
|
|
y_minus_slp_status |= gpio_i2c_read(nvp6158_iic_addr[devnum],0xEB);
|
|
|
|
return y_minus_slp_status;
|
|
}
|
|
|
|
unsigned int __nvp6158_get_sync_width( unsigned char ch, unsigned char devnum )
|
|
{
|
|
unsigned char reg_B0_E0 = 0;
|
|
unsigned char agc_stable = 0;
|
|
unsigned int sync_width = 0;
|
|
unsigned int check_timeout = 0;
|
|
|
|
while(agc_stable == 0)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
reg_B0_E0 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0xE0 )&0xF;
|
|
agc_stable = reg_B0_E0 & (0x01 << (ch%4));
|
|
|
|
if( check_timeout++ > 100 )
|
|
{
|
|
printk(">>>>> DRV[%s:%d] CH:%d, TimeOut, AGC_stable[%x] check[%x] in get sync width\n", __func__, __LINE__, ch, reg_B0_E0, agc_stable );
|
|
break;
|
|
}
|
|
msleep(1);
|
|
}
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+(ch%4));
|
|
sync_width = gpio_i2c_read(nvp6158_iic_addr[devnum], 0xC4)&0x0F;
|
|
sync_width <<=8;
|
|
sync_width |= gpio_i2c_read(nvp6158_iic_addr[devnum], 0xC5);
|
|
sync_width = sync_width & 0x0FFF;
|
|
printk(">>>>> DRV[%s:%d] CH:%d, sync_width:0x%x\n", __func__, __LINE__, ch, sync_width );
|
|
|
|
return sync_width;
|
|
}
|
|
|
|
int nvp6158_video_input_cable_measure_way( unsigned char ch, unsigned char devnum )
|
|
{
|
|
unsigned int acc_gain;
|
|
unsigned int y_slope;
|
|
unsigned char y_plus_slope;
|
|
unsigned char y_minus_slope;
|
|
unsigned int sync_width;
|
|
|
|
acc_gain = __nvp6158_get_acc_gain(ch, devnum);
|
|
y_plus_slope = __nvp6158_get_yplus_slope(ch, devnum);
|
|
y_minus_slope = __nvp6158_get_yminus_slope(ch, devnum);
|
|
y_slope = y_plus_slope + y_minus_slope;
|
|
sync_width = __nvp6158_get_sync_width(ch, devnum);
|
|
|
|
printk(">>>>> DRV[%s:%d] CH:%d, accgain=0x%x(%d), yslope=0x%x(%d), syncwidth=0x%x(%d)\n", \
|
|
__func__, __LINE__, ch, acc_gain, acc_gain, y_slope, y_slope, sync_width, sync_width );
|
|
|
|
return 0;
|
|
}
|
|
|
|
void nvp6158_video_input_cable_manualdist_read(video_input_cable_dist *vin_cable_dist )
|
|
{
|
|
video_input_acc_gain_val vin_acc;
|
|
video_input_hsync_accum vin_hsync_accum;
|
|
|
|
/* cable type => 0:coaxial, 1:utp, 2:reserved1, 3:reserved2 */
|
|
nvp6158_video_equalizer_distance_table_s distance_value = (nvp6158_video_equalizer_distance_table_s)equalizer_distance_fmtdef[vin_cable_dist->FmtDef];
|
|
|
|
if( vin_cable_dist->FmtDef >= AHD20_SD_H960_NT && vin_cable_dist->FmtDef <= AHD20_SD_H960_2EX_Btype_PAL )
|
|
{
|
|
/* CVBS Resolution not need distance distinguish, because cvbs format has low color frequency */
|
|
vin_cable_dist->dist = 0;
|
|
}
|
|
else if(distance_value.hsync_stage.hsync_stage[0] != 0)
|
|
{
|
|
/* get hsync*/
|
|
vin_hsync_accum.ch = vin_cable_dist->ch;
|
|
vin_hsync_accum.devnum = vin_cable_dist->devnum;
|
|
nvp6158_video_input_hsync_accum_read(&vin_hsync_accum);
|
|
|
|
/* get acc */
|
|
vin_acc.ch = vin_cable_dist->ch;
|
|
vin_acc.devnum = vin_cable_dist->devnum;
|
|
vin_acc.func_sel = 0;
|
|
/* 1 is ACC_GAIN_DEBUG
|
|
0 is ACC_GAIN_NORMAL */
|
|
nvp6158_video_input_acc_gain_val_read(&vin_acc);
|
|
|
|
/* measure eq */
|
|
nvp6158_video_input_cable_measure_way(vin_cable_dist->ch, vin_cable_dist->devnum);
|
|
|
|
/* decision distance using hsync and distance table */
|
|
vin_cable_dist->dist = __nvp6158_video_cable_manualdistance( vin_cable_dist->cabletype, &vin_hsync_accum, &vin_acc, &distance_value );
|
|
|
|
|
|
printk(">>>>> DRV, CH:%d, hsync : %08x\n", vin_cable_dist->ch, vin_hsync_accum.hsync_accum_result);
|
|
printk(">>>>> DRV, CH:%d, eq stage:%d\n", vin_cable_dist->ch, vin_cable_dist->dist);
|
|
}
|
|
else
|
|
{
|
|
vin_cable_dist->dist = 0;
|
|
|
|
printk(">>>>> DRV, CH:%d, This Format Not support Yet [%d] eq stage:%d\n", vin_cable_dist->ch, vin_cable_dist->FmtDef ,vin_cable_dist->dist);
|
|
|
|
}
|
|
}
|
|
|
|
void nvp6168_video_input_cable_manualdist_read(video_input_cable_dist *vin_cable_dist )
|
|
{
|
|
video_input_hsync_accum vin_hsync_accum;
|
|
nvp6158_video_equalizer_distance_table_s distance_value = (nvp6158_video_equalizer_distance_table_s)nvp6168_equalizer_distance_fmtdef[vin_cable_dist->FmtDef];
|
|
|
|
if( vin_cable_dist->FmtDef >= AHD20_SD_H960_NT && vin_cable_dist->FmtDef <= AHD20_SD_H960_2EX_Btype_PAL )
|
|
{
|
|
/* CVBS Resolution not need distance distinguish, because cvbs format has low color frequency */
|
|
vin_cable_dist->dist = 0;
|
|
return;
|
|
}
|
|
|
|
/* get hsync*/
|
|
vin_hsync_accum.ch = vin_cable_dist->ch;
|
|
vin_hsync_accum.devnum = vin_cable_dist->devnum;
|
|
nvp6168_video_input_hsync_accum_read(&vin_hsync_accum );
|
|
|
|
if(((vin_hsync_accum.hsync_accum_val1|vin_hsync_accum.hsync_accum_val2) == 0) &&
|
|
(vin_hsync_accum.hsync_accum_result == 0xffffffff))
|
|
{
|
|
vin_cable_dist->dist = 0xFF;
|
|
return;
|
|
}
|
|
|
|
/* decision distance using hsync and distance table */
|
|
vin_cable_dist->dist = __nvp6158_video_cable_manualdistance( vin_cable_dist->cabletype, &vin_hsync_accum, 0, &distance_value );
|
|
|
|
if(vin_cable_dist->dist > 5)
|
|
vin_cable_dist->dist = 5;
|
|
|
|
printk(">>>>> DRV, CH:%d, hsync : %08x\n", vin_cable_dist->ch, vin_hsync_accum.hsync_accum_result);
|
|
printk(">>>>> DRV, CH:%d, eq stage:%d\n", vin_cable_dist->ch, vin_cable_dist->dist);
|
|
}
|
|
int nvp6158_set_equalizer(video_equalizer_info_s *pvin_eq_set)
|
|
{
|
|
int ii;
|
|
unsigned char val_13x30;
|
|
unsigned char val_13x31;
|
|
unsigned char val_13x32;
|
|
unsigned char val_0x54;
|
|
//unsigned char val_5678x69;
|
|
unsigned char val_9x44;
|
|
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
video_equalizer_value_table_s eq_value;
|
|
|
|
/* cable type => 0:coaxial, 1:utp, 2:reserved1, 3:reserved2 */
|
|
//video_equalizer_value_table_s eq_value = (video_equalizer_value_table_s)nvp6158_equalizer_value_fmtdef[pvin_eq_set->FmtDef];
|
|
memset(&eq_value, 0xFF,sizeof(video_equalizer_value_table_s));
|
|
memcpy(&eq_value,&nvp6158_equalizer_value_fmtdef[pvin_eq_set->FmtDef],sizeof(video_equalizer_value_table_s));
|
|
if(0xFF == eq_value.eq_base.eq_band_sel[pvin_eq_set->distance] || 0x00 == eq_value.eq_base.eq_bypass[pvin_eq_set->distance]) //if 5x58==0xFF it's not a valid value.
|
|
{
|
|
printk(">>>>>>DRV %s not supported video format[%2x]\n\n\n", __func__, pvin_eq_set->FmtDef);
|
|
/* Auto Mode ON */
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0xff, 0x13 );
|
|
val_13x30 = gpio_i2c_read(nvp6158_iic_addr[pvin_eq_set->devnum], 0x30);
|
|
val_13x30 |= (0x11 << pvin_eq_set->Ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x30, val_13x30 );
|
|
|
|
val_13x31 = gpio_i2c_read(nvp6158_iic_addr[pvin_eq_set->devnum], 0x31);
|
|
val_13x31 |= (0x11 << pvin_eq_set->Ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x31, val_13x31 );
|
|
|
|
val_13x32 = gpio_i2c_read(nvp6158_iic_addr[pvin_eq_set->devnum], 0x32);
|
|
val_13x32 |= (0x01 << pvin_eq_set->Ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x32, val_13x32 );
|
|
return -1;
|
|
}
|
|
/* for verification by edward */
|
|
|
|
if(pvin_eq_set->FmtDef == AHD20_720P_30P_EX_Btype || pvin_eq_set->FmtDef == AHD20_720P_25P_EX_Btype ||
|
|
pvin_eq_set->FmtDef == AHD20_720P_30P || pvin_eq_set->FmtDef == AHD20_720P_25P ||
|
|
pvin_eq_set->FmtDef == CVI_HD_30P_EX || pvin_eq_set->FmtDef == CVI_HD_25P_EX ||
|
|
pvin_eq_set->FmtDef == CVI_HD_30P || pvin_eq_set->FmtDef == CVI_HD_25P ||
|
|
pvin_eq_set->FmtDef == TVI_HD_30P || pvin_eq_set->FmtDef == TVI_HD_25P ||
|
|
pvin_eq_set->FmtDef == TVI_HD_30P_EX || pvin_eq_set->FmtDef == TVI_HD_25P_EX ||
|
|
pvin_eq_set->FmtDef == TVI_HD_B_30P || pvin_eq_set->FmtDef == TVI_HD_B_25P ||
|
|
pvin_eq_set->FmtDef == TVI_HD_B_30P_EX || pvin_eq_set->FmtDef == TVI_HD_B_25P_EX
|
|
)
|
|
{
|
|
printk("DRV >> This Format Support Maximum EQ Stage 10\n");
|
|
printk("DRV >> Now Select EQ Stage %d\n", pvin_eq_set->distance);
|
|
}
|
|
else
|
|
{
|
|
if(pvin_eq_set->distance > 5)
|
|
{
|
|
printk("DRV >> This Format Only Support Maximum EQ Stage 5\n");
|
|
printk("DRV >> Now Select EQ Stage %d\n", pvin_eq_set->distance);
|
|
pvin_eq_set->distance = 5;
|
|
}
|
|
}
|
|
|
|
/* set eq value */
|
|
__nvp6158_eq_base_set_value( pvin_eq_set, &eq_value.eq_base );
|
|
__nvp6158_eq_coeff_set_value( pvin_eq_set, &eq_value.eq_coeff );
|
|
__nvp6158_eq_color_set_value( pvin_eq_set, &eq_value.eq_color);
|
|
__nvp6158_eq_timing_a_set_value( pvin_eq_set, &eq_value.eq_timing_a );
|
|
__nvp6158_eq_clk_set_value( pvin_eq_set, &eq_value.eq_clk );
|
|
__nvp6158_eq_timing_b_set_value( pvin_eq_set, &eq_value.eq_timing_b );
|
|
|
|
if( pvin_eq_set->FmtDef >= AHD20_SD_H960_NT && pvin_eq_set->FmtDef <= AHD20_SD_H960_2EX_Btype_PAL )
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x00);
|
|
if((pvin_eq_set->FmtDef >= AHD20_SD_H960_NT)&&(pvin_eq_set->FmtDef <= AHD20_SD_H960_EX_PAL))
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00); /* line_mem_mode disable */
|
|
else
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x01); /* line_mem_mode Enable */
|
|
|
|
if( (pvin_eq_set->FmtDef%2) == 0 ) //NTSC
|
|
{
|
|
val_0x54 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x54);
|
|
val_0x54 &= ~((0x1 << (ch+4)));
|
|
val_0x54 |= ((0x1 << (ch+4)));
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x54, val_0x54); /* Enable FLD_INV for CVBS NT format */
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ch, 0xa0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0xd0); /* Set V_Delay */
|
|
}
|
|
else //if( pvin_eq_set->FmtDef == AHD20_SD_H960_2EX_Btype_PAL )
|
|
{
|
|
val_0x54 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x54);
|
|
val_0x54 &= ~((0x1 << (ch+4)));
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x54, val_0x54); /* Disable FLD_INV for CVBS PAL format */
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ch, 0xdd);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0xbf); /* Set V_Delay */
|
|
|
|
}
|
|
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0xff, 0x05 + ch );
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x2C, 0x08);
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x47, 0x04);
|
|
if((pvin_eq_set->FmtDef >= AHD20_SD_H960_NT)&&(pvin_eq_set->FmtDef <= AHD20_SD_H960_EX_PAL))
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x64, 0x00 ); /* disable Mem_Path */
|
|
else
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x64, 0x01 ); /* Enable Mem_Path */
|
|
}
|
|
else
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xff, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00); /* line_mem_mode Disable */
|
|
val_0x54 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x54);
|
|
val_0x54 &= ~((0x1 << (ch+4)));
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x54, val_0x54); /* Disable FLD_INV */
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x80); /* Recovery V_Delay */
|
|
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0xff, 0x05 + ch );
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x2C, 0x00);
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x47, 0xEE);
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x64, 0x00 ); /* Disable Mem_Path */
|
|
|
|
if(pvin_eq_set->FmtDef == TVI_4M_15P )
|
|
{
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6E, 0x10 ); //VBLK setting
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6F, 0x7e );
|
|
}
|
|
else
|
|
{
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6E, 0x00 ); //VBLK default setting
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6F, 0x00 );
|
|
}
|
|
}
|
|
|
|
/* Auto Mode Off */
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0xff, 0x13 );
|
|
val_13x30 = gpio_i2c_read(nvp6158_iic_addr[pvin_eq_set->devnum], 0x30);
|
|
val_13x30 &= ~(0x11 << pvin_eq_set->Ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x30, val_13x30 );
|
|
|
|
val_13x31 = gpio_i2c_read(nvp6158_iic_addr[pvin_eq_set->devnum], 0x31);
|
|
val_13x31 &= ~(0x11 << pvin_eq_set->Ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x31, val_13x31 );
|
|
|
|
val_13x32 = gpio_i2c_read(nvp6158_iic_addr[pvin_eq_set->devnum], 0x32);
|
|
val_13x32 &= ~(0x01 << pvin_eq_set->Ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x32, val_13x32 );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0xff, 0x05 + ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x59, 0x00 );
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0xff, 0x00 );
|
|
gpio_i2c_write(nvp6158_iic_addr[pvin_eq_set->devnum], 0x23 + (pvin_eq_set->Ch * 4), 0x41);
|
|
|
|
for(ii=0;ii<0x16;ii++)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ) + ii, 0x00); //first set bank11 to default values.
|
|
}
|
|
|
|
if( pvin_eq_set->FmtDef == TVI_5M_20P || pvin_eq_set->FmtDef == TVI_5M_12_5P ||
|
|
pvin_eq_set->FmtDef == TVI_4M_30P || pvin_eq_set->FmtDef == TVI_4M_25P ||
|
|
pvin_eq_set->FmtDef == TVI_8M_15P || pvin_eq_set->FmtDef == TVI_8M_12_5P ||
|
|
pvin_eq_set->FmtDef == TVI_4M_15P )
|
|
|
|
{
|
|
if(pvin_eq_set->FmtDef != TVI_4M_15P)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x09);
|
|
val_9x44 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x44);
|
|
val_9x44 &= ~(1 << ch);
|
|
val_9x44 |= (1 << ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x44 , val_9x44);
|
|
}
|
|
|
|
if( pvin_eq_set->FmtDef == TVI_5M_20P)
|
|
{
|
|
/* TVI 5M 20P PN Value Set */
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x50 + ( ch * 4 ) , 0x36);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x51 + ( ch * 4 ) , 0x40);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x52 + ( ch * 4 ) , 0xa7);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x53 + ( ch * 4 ) , 0x74);
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ( ch * 0x20 ), 0xdb);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ( ch * 0x20 ), 0x0a);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ( ch * 0x20 ), 0x0e);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x06 + ( ch * 0x20 ), 0xa6);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ( ch * 0x20 ), 0x96);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0a + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0b + ( ch * 0x20 ), 0x98);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0d + ( ch * 0x20 ), 0xbc);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11 + ( ch * 0x20 ), 0xa0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x13 + ( ch * 0x20 ), 0xfa);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x15 + ( ch * 0x20 ), 0x65);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x0f);
|
|
}
|
|
else if( pvin_eq_set->FmtDef == TVI_4M_15P)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ( ch * 0x20 ), 0xd0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ( ch * 0x20 ), 0x0a);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ( ch * 0x20 ), 0x97);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x06 + ( ch * 0x20 ), 0x70);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ( ch * 0x20 ), 0x78);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0a + ( ch * 0x20 ), 0x05);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0b + ( ch * 0x20 ), 0xa0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ( ch * 0x20 ), 0x06);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0d + ( ch * 0x20 ), 0x71);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11 + ( ch * 0x20 ), 0x50);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x13 + ( ch * 0x20 ), 0x96);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x15 + ( ch * 0x20 ), 0x30);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x0f);
|
|
}
|
|
else if( pvin_eq_set->FmtDef == TVI_5M_12_5P)
|
|
{
|
|
/* TVI 5M 12_5P PN Value Set */
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x50 + ( ch * 4 ) , 0x8b);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x51 + ( ch * 4 ) , 0xae);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x52 + ( ch * 4 ) , 0xbb);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x53 + ( ch * 4 ) , 0x48);
|
|
}
|
|
else if( pvin_eq_set->FmtDef == TVI_4M_30P || pvin_eq_set->FmtDef == TVI_4M_25P )
|
|
{
|
|
/* TVI 4M 30P PN Value Set */
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x50 + ( ch * 4 ) , 0x9e);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x51 + ( ch * 4 ) , 0x48);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x52 + ( ch * 4 ) , 0x59);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x53 + ( ch * 4 ) , 0x74);
|
|
}
|
|
else if( pvin_eq_set->FmtDef == TVI_8M_15P || pvin_eq_set->FmtDef == TVI_8M_12_5P )
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x50 + ( ch * 4 ) , 0x73);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x51 + ( ch * 4 ) , 0x76);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x52 + ( ch * 4 ) , 0x58);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x53 + ( ch * 4 ) , 0x74);
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
|
|
if( pvin_eq_set->FmtDef == TVI_8M_12_5P )
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ( ch * 0x20 ), 0x9b);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ( ch * 0x20 ), 0x0f);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ( ch * 0x20 ), 0x14);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x06 + ( ch * 0x20 ), 0xa0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ( ch * 0x20 ), 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0a + ( ch * 0x20 ), 0x08);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0b + ( ch * 0x20 ), 0x70);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ( ch * 0x20 ), 0x08);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0d + ( ch * 0x20 ), 0xca);
|
|
// gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11 + ( ch * 0x20 ), 0xa0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x12 + ( ch * 0x20 ), 0x01);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x13 + ( ch * 0x20 ), 0xcc);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x15 + ( ch * 0x20 ), 0x3c);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x0d);
|
|
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch%4);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x25, 0xda);
|
|
msleep(100);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2a, 0xd4);
|
|
msleep(40);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2a, 0xd2);
|
|
printk("TVI_8M_12_5P adopted test\n");
|
|
}
|
|
else
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ( ch * 0x20 ), 0x9b);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ( ch * 0x20 ), 0x0f);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ( ch * 0x20 ), 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x06 + ( ch * 0x20 ), 0x30);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ( ch * 0x20 ), 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0a + ( ch * 0x20 ), 0x08);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0b + ( ch * 0x20 ), 0x70);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ( ch * 0x20 ), 0x08);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0d + ( ch * 0x20 ), 0xca);
|
|
// gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11 + ( ch * 0x20 ), 0xa0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x12 + ( ch * 0x20 ), 0x01);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x13 + ( ch * 0x20 ), 0xcc);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x15 + ( ch * 0x20 ), 0x3c);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x0d);
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
else
|
|
{
|
|
if( pvin_eq_set->FmtDef == CVI_5M_20P)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x01 + ( ch * 0x20 ), 0x01);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ( ch * 0x20 ), 0x30);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ( ch * 0x20 ), 0x0a);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04 + ( ch * 0x20 ), 0x20);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ( ch * 0x20 ), 0x0e);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x06 + ( ch * 0x20 ), 0xa6);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07 + ( ch * 0x20 ), 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ( ch * 0x20 ), 0x96);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0a + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0b + ( ch * 0x20 ), 0x98);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0d + ( ch * 0x20 ), 0xbc);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0e + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0f + ( ch * 0x20 ), 0xad);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10 + ( ch * 0x20 ), 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11 + ( ch * 0x20 ), 0xfa);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x12 + ( ch * 0x20 ), 0x01);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x13 + ( ch * 0x20 ), 0x22);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x14 + ( ch * 0x20 ), 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x15 + ( ch * 0x20 ), 0x6e);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x0f);
|
|
}
|
|
else
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04 + ( ch * 0x20 ), 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x00);
|
|
}
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x09);
|
|
val_9x44 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x44);
|
|
val_9x44 &= ~(1 << ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x44 , val_9x44);
|
|
}
|
|
|
|
if( pvin_eq_set->FmtDef == AHD20_1080P_15P_EX || pvin_eq_set->FmtDef == AHD20_1080P_12_5P_EX )
|
|
{
|
|
unsigned char val_1x7a = 0x00;
|
|
unsigned char val_11x00 = 0x00;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x01);
|
|
val_1x7a = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x7a);
|
|
val_1x7a &= ~(0x1 << ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7A, val_1x7a);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x11);
|
|
val_11x00 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x00 + (ch*0x20));
|
|
val_11x00 |= 0x10;
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + (ch * 0x20) , val_11x00);
|
|
}
|
|
else
|
|
{
|
|
unsigned char val_11x00 = 0x00;
|
|
unsigned char val_1x7a = 0x00;
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x01);
|
|
val_1x7a = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x7a);
|
|
val_1x7a |= (0x1 << ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7A, val_1x7a);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x11);
|
|
val_11x00 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x00 + (ch*0x20));
|
|
val_11x00 &= ~0x10;
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + (ch * 0x20) , val_11x00);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void __nvp6168_set_eq_ext_val(video_equalizer_info_s *pvin_eq_set)
|
|
{
|
|
int devnum = pvin_eq_set->devnum;
|
|
int ch = pvin_eq_set->Ch;
|
|
unsigned char tmp_val;
|
|
|
|
// 0x54 : FIELD_INV
|
|
// 0x69 : SD_FREQ - always 0
|
|
// 0x22 : COLOR_OFF/C_KILL
|
|
// 0x30 : Y_DELAY_1
|
|
// 0x5C : V_DELAY_1
|
|
// 5x05 : About AGC
|
|
// 5x7B : SD:0x00, Others:0x11
|
|
// 13x74/75 : HSYNC_FALLING MIN/MAX
|
|
// 13x76/77 : HSYNC_RISING MIN/MAX
|
|
// 13x78/79 : SHORT-HSYNC_FALLING MIN/MAX
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
tmp_val = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x54);
|
|
tmp_val &= ~(0x01<<(ch+4));
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x54, tmp_val);
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x69, 0x00);
|
|
|
|
switch(pvin_eq_set->FmtDef)
|
|
{
|
|
// CVBS
|
|
case AHD20_SD_H960_2EX_Btype_NT :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x10);
|
|
tmp_val = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x54);
|
|
tmp_val |= 0x01<<(ch+4);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x54, tmp_val);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0xD0);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD20_SD_H960_2EX_Btype_PAL :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x10);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0xBF);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
|
|
// AHD
|
|
case AHD20_720P_30P_EX_Btype :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x12);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD20_720P_25P_EX_Btype :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x12);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD20_1080P_30P :
|
|
case AHD20_1080P_15P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD20_1080P_25P :
|
|
case AHD20_1080P_12_5P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD20_1080P_60P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case AHD20_1080P_50P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case AHD30_4M_30P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_4M_25P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_4M_15P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_3M_30P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_3M_25P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_3M_18P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_5M_12_5P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_5M_20P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_5_3M_20P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_8M_12_5P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD30_8M_15P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case AHD20_960P_30P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD20_960P_25P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case AHD20_960P_60P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case AHD20_960P_50P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
|
|
// TVI
|
|
case TVI_FHD_30P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_FHD_25P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_HD_30P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_HD_25P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_HD_B_30P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_HD_B_25P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_HD_60P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_HD_50P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_3M_18P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_5M_12_5P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_5M_20P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_4M_30P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_4M_25P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_4M_15P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_8M_15P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
case TVI_8M_12_5P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
break;
|
|
|
|
// CVI
|
|
case CVI_FHD_30P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
break;
|
|
case CVI_FHD_25P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_HD_60P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_HD_50P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_HD_30P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_HD_25P_EX :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x16);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_4M_30P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_4M_25P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_8M_15P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
case CVI_8M_12_5P :
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x22+(ch*4), 0x02);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30 + ch, 0x17);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x34 + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x5c + ch, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05, 0x24);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7B, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB5, 0x80);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x74, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x76, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x75, 0xff);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x77, 0xff);
|
|
break;
|
|
|
|
case AHD20_SD_H960_NT :
|
|
case AHD20_SD_H960_PAL :
|
|
case AHD20_SD_SH720_NT :
|
|
case AHD20_SD_SH720_PAL :
|
|
case AHD20_SD_H1280_NT :
|
|
case AHD20_SD_H1280_PAL :
|
|
case AHD20_SD_H1440_NT :
|
|
case AHD20_SD_H1440_PAL :
|
|
case AHD20_SD_H960_EX_NT :
|
|
case AHD20_SD_H960_EX_PAL :
|
|
case AHD20_SD_H960_2EX_NT :
|
|
case AHD20_SD_H960_2EX_PAL :
|
|
case AHD20_720P_60P :
|
|
case AHD20_720P_50P :
|
|
case AHD20_720P_30P :
|
|
case AHD20_720P_25P :
|
|
case AHD20_720P_30P_EX :
|
|
case AHD20_720P_25P_EX :
|
|
case AHD30_6M_18P :
|
|
case AHD30_6M_20P :
|
|
case AHD30_8M_X_30P :
|
|
case AHD30_8M_X_25P :
|
|
case AHD30_8M_7_5P :
|
|
case TVI_HD_30P :
|
|
case TVI_HD_25P :
|
|
case TVI_HD_B_30P :
|
|
case TVI_HD_B_25P :
|
|
case CVI_HD_30P :
|
|
case CVI_HD_25P :
|
|
case TVI_FHD_60P :
|
|
#if 0
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
#endif
|
|
case TVI_FHD_50P :
|
|
#if 0
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x78, 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x79, 0xff);
|
|
#endif
|
|
|
|
default :
|
|
break;
|
|
}
|
|
}
|
|
|
|
int nvp6168_set_equalizer(video_equalizer_info_s *pvin_eq_set)
|
|
{
|
|
unsigned char val_9x44, ii;
|
|
unsigned char ch = pvin_eq_set->Ch;
|
|
unsigned char devnum = pvin_eq_set->devnum;
|
|
|
|
decoder_dev_ch_info_s pDecoder_info;
|
|
|
|
video_equalizer_value_table_s eq_value;// = (video_equalizer_value_table_s)nvp6168_equalizer_value_fmtdef[pvin_eq_set->FmtDef];
|
|
|
|
/* cable type => 0:coaxial, 1:utp, 2:reserved1, 3:reserved2 */
|
|
//video_equalizer_value_table_s eq_value = (video_equalizer_value_table_s)nvp6158_equalizer_value_fmtdef[pvin_eq_set->FmtDef];
|
|
memset(&eq_value, 0xFF,sizeof(video_equalizer_value_table_s));
|
|
memcpy(&eq_value,&nvp6168_equalizer_value_fmtdef[pvin_eq_set->FmtDef],sizeof(video_equalizer_value_table_s));
|
|
if(0xFF == eq_value.eq_base.eq_band_sel[pvin_eq_set->distance] || 0x00 == eq_value.eq_base.eq_bypass[pvin_eq_set->distance]) //if 5x58==0xFF it's not a valid value.
|
|
{
|
|
printk("func[%s] eq_value[fmt:%d] not found\n", __func__, pvin_eq_set->FmtDef);
|
|
return -1;
|
|
}
|
|
|
|
/* set eq value */
|
|
__nvp6158_eq_base_set_value( pvin_eq_set, &eq_value.eq_base );
|
|
__nvp6158_eq_coeff_set_value( pvin_eq_set, &eq_value.eq_coeff );
|
|
__nvp6158_eq_color_set_value( pvin_eq_set, &eq_value.eq_color);
|
|
__nvp6158_eq_timing_a_set_value( pvin_eq_set, &eq_value.eq_timing_a );
|
|
__nvp6158_eq_clk_set_value( pvin_eq_set, &eq_value.eq_clk );
|
|
__nvp6158_eq_timing_b_set_value( pvin_eq_set, &eq_value.eq_timing_b );
|
|
|
|
__nvp6168_set_eq_ext_val(pvin_eq_set);
|
|
|
|
if(nvp6158_audio_in_type_get() == NC_AD_AOC)
|
|
{
|
|
pDecoder_info.ch = ch;
|
|
pDecoder_info.devnum = devnum;
|
|
pDecoder_info.fmt_def = pvin_eq_set->FmtDef;
|
|
|
|
nvp6158_audio_set_aoc_format(&pDecoder_info);
|
|
}
|
|
|
|
for(ii=0;ii<0x16;ii++)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ) + ii, 0x00); //first set bank11 to default values.
|
|
}
|
|
|
|
|
|
if( pvin_eq_set->FmtDef == CVI_5M_20P)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x01 + ( ch * 0x20 ), 0x01);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ( ch * 0x20 ), 0x30);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ( ch * 0x20 ), 0x0a);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04 + ( ch * 0x20 ), 0x20);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ( ch * 0x20 ), 0x0e);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x06 + ( ch * 0x20 ), 0xa6);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07 + ( ch * 0x20 ), 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ( ch * 0x20 ), 0x96);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0a + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0b + ( ch * 0x20 ), 0x98);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0d + ( ch * 0x20 ), 0xbc);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0e + ( ch * 0x20 ), 0x07);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0f + ( ch * 0x20 ), 0xad);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10 + ( ch * 0x20 ), 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11 + ( ch * 0x20 ), 0xfa);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x12 + ( ch * 0x20 ), 0x01);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x13 + ( ch * 0x20 ), 0x22);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x14 + ( ch * 0x20 ), 0x00);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x15 + ( ch * 0x20 ), 0x6e);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x0f);
|
|
}
|
|
else if(pvin_eq_set->FmtDef == AHD20_1080P_15P_EX || pvin_eq_set->FmtDef == AHD20_1080P_12_5P_EX)
|
|
{
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x11);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ( ch * 0x20 ), 0x10);
|
|
}
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF,0x09);
|
|
val_9x44 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x44);
|
|
val_9x44 &= ~(1 << ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0x44 , val_9x44);
|
|
|
|
if(pvin_eq_set->FmtDef == TVI_4M_15P )
|
|
{
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch );
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6E, 0x10 ); //VBLK setting
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6F, 0x7e );
|
|
}
|
|
else
|
|
{
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch );
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6E, 0x00 ); //VBLK default setting
|
|
gpio_i2c_write( nvp6158_iic_addr[devnum], 0x6F, 0x00 );
|
|
}
|
|
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch);
|
|
gpio_i2c_write(nvp6158_iic_addr[devnum], 0xB8, 0x39);
|
|
|
|
return 0;
|
|
}
|
|
|