From cde9070d9970eef1f7ec2360586c802a16230ad8 Mon Sep 17 00:00:00 2001 From: hc <hc@nodka.com> Date: Fri, 10 May 2024 07:43:50 +0000 Subject: [PATCH] rtl88x2CE_WiFi_linux driver --- kernel/drivers/media/i2c/nvp6158_drv/nvp6158_coax_protocol.c | 581 ++++++++++++++++++++++++--------------------------------- 1 files changed, 247 insertions(+), 334 deletions(-) diff --git a/kernel/drivers/media/i2c/nvp6158_drv/nvp6158_coax_protocol.c b/kernel/drivers/media/i2c/nvp6158_drv/nvp6158_coax_protocol.c index 3327d9c..71710ab 100644 --- a/kernel/drivers/media/i2c/nvp6158_drv/nvp6158_coax_protocol.c +++ b/kernel/drivers/media/i2c/nvp6158_drv/nvp6158_coax_protocol.c @@ -56,42 +56,38 @@ * * ioctl : IOC_VDEC_COAX_TX_INIT ***************************************************************************************/ -static NC_VD_ACP_CMDDEF_STR *__NC_VD_ACP_Get_CommandFormat_Get( NC_COAX_CMD_DEF def ) +static NC_VD_ACP_CMDDEF_STR *__NC_VD_ACP_Get_CommandFormat_Get(NC_COAX_CMD_DEF def) { NC_VD_ACP_CMDDEF_STR *pRet = &nvp6158_coax_cmd_lists[def]; - if( pRet == NULL ) - { + if( pRet == NULL ) { printk("Not Supported format Yet!!!(%d)\n",def); } return pRet; } -static NC_VD_COAX_Init_STR *__NC_VD_COAX_InitFormat_Get( NC_VIVO_CH_FORMATDEF def ) +static NC_VD_COAX_Init_STR *__NC_VD_COAX_InitFormat_Get(NC_VIVO_CH_FORMATDEF def) { NC_VD_COAX_Init_STR *pRet = &nvp6158_coax_init_lists[def]; - if( pRet == NULL ) - { + if( pRet == NULL ) { printk("Not Supported format Yet!!!(%d)\n",def); } return pRet; } -static NC_VD_COAX_Init_STR *__NC_VD_COAX_16bit_InitFormat_Get( NC_VIVO_CH_FORMATDEF def ) +static NC_VD_COAX_Init_STR *__NC_VD_COAX_16bit_InitFormat_Get(NC_VIVO_CH_FORMATDEF def) { NC_VD_COAX_Init_STR *pRet = &nvp6158_coax_acp_16bit_init_lists[def]; - if( pRet == NULL ) - { + if( pRet == NULL ) { printk("Not Supported format Yet!!!(%d)\n",def); } return pRet; } -static int __NC_VD_COAX_Command_Each_Copy( unsigned char *Dst, int *Src ) +static int __NC_VD_COAX_Command_Each_Copy(unsigned char *Dst, int *Src) { int items = 0; - while( Src[items] != EOD ) - { + while( Src[items] != EOD ) { Dst[items] = Src[items]; items++; } @@ -99,62 +95,52 @@ return items; } -static int __NC_VD_COAX_Command_Copy( NC_FORMAT_STANDARD format, NC_VIVO_CH_FORMATDEF vivofmt, unsigned char *Dst, NC_VD_ACP_CMDDEF_STR *pCMD ) +static int __NC_VD_COAX_Command_Copy(NC_FORMAT_STANDARD format, NC_VIVO_CH_FORMATDEF vivofmt, + unsigned char *Dst, NC_VD_ACP_CMDDEF_STR *pCMD) { int cmd_cnt = 0; - if( format == FMT_SD ) - { - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->sd ); - } - else if( (format == FMT_AHD20) || (format == FMT_AHD30) ) - { - if( vivofmt == AHD30_4M_30P || vivofmt == AHD30_4M_25P || vivofmt == AHD30_4M_15P || - vivofmt == AHD30_5M_20P || vivofmt == AHD30_5M_12_5P || vivofmt == AHD30_5_3M_20P || - vivofmt == AHD30_8M_12_5P || vivofmt == AHD30_8M_15P ) - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_4_5m ); + if( format == FMT_SD ) { + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->sd); + } else if((format == FMT_AHD20) || (format == FMT_AHD30)) { + if(vivofmt == AHD30_4M_30P || vivofmt == AHD30_4M_25P || vivofmt == AHD30_4M_15P || + vivofmt == AHD30_5M_20P || vivofmt == AHD30_5M_12_5P || vivofmt == AHD30_5_3M_20P || + vivofmt == AHD30_8M_12_5P || vivofmt == AHD30_8M_15P) + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->ahd_4_5m); + //cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_4_5m ); //else if( vivofmt == AHD30_4M_30P || vivofmt == AHD30_4M_25P || vivofmt == AHD30_4M_15P ) //cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_4_5m ); else - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_8bit ); - } - else if( format == FMT_CVI ) - { - cmd_cnt= __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->cvi_cmd ); - } - else if( format == FMT_TVI ) - { - if( (vivofmt == TVI_4M_30P) || (vivofmt == TVI_4M_25P) || (vivofmt == TVI_4M_15P) || - (vivofmt == TVI_5M_20P) || (vivofmt == TVI_5M_12_5P) || (vivofmt == TVI_8M_12_5P) || (vivofmt == TVI_8M_15P) ) - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->tvi_v2_0 ); + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->ahd_8bit); + } else if(format == FMT_CVI) { + cmd_cnt= __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->cvi_cmd); + } else if(format == FMT_TVI) { + if((vivofmt == TVI_4M_30P) || (vivofmt == TVI_4M_25P) || (vivofmt == TVI_4M_15P) || + (vivofmt == TVI_5M_20P) || (vivofmt == TVI_5M_12_5P) || (vivofmt == TVI_8M_12_5P) || (vivofmt == TVI_8M_15P)) + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->tvi_v2_0); else - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->tvi_v1_0 ); - } - else + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->tvi_v1_0); + } else { printk("NC_VD_COAX_Tx_Command_Send::Command Copy Error!!\n"); - + } return cmd_cnt; } -static int __NC_VD_COAX_16bit_Command_Copy( NC_FORMAT_STANDARD format, NC_VIVO_CH_FORMATDEF vivofmt, unsigned char *Dst, NC_VD_ACP_CMDDEF_STR *pCMD ) +static int __NC_VD_COAX_16bit_Command_Copy(NC_FORMAT_STANDARD format, NC_VIVO_CH_FORMATDEF vivofmt, + unsigned char *Dst, NC_VD_ACP_CMDDEF_STR *pCMD) { int cmd_cnt = 0; - if( (vivofmt == AHD20_720P_25P) || (vivofmt == AHD20_720P_30P) ||\ + if((vivofmt == AHD20_720P_25P) || (vivofmt == AHD20_720P_30P) ||\ (vivofmt == AHD20_720P_25P_EX) || (vivofmt == AHD20_720P_30P_EX) ||\ - (vivofmt == AHD20_720P_25P_EX_Btype) || (vivofmt == AHD20_720P_30P_EX_Btype) ) - { + (vivofmt == AHD20_720P_25P_EX_Btype) || (vivofmt == AHD20_720P_30P_EX_Btype)) { cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_16bit ); - } - else if( (vivofmt == CVI_4M_25P) || (vivofmt == CVI_4M_30P) ||\ - (vivofmt == CVI_5M_20P) || (vivofmt == CVI_8M_15P) || (vivofmt == CVI_8M_12_5P) ) - { - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->cvi_new_cmd ); - } - else - { - printk("[drv_coax] Can not send commands!! Unsupported format!!\n" ); + } else if((vivofmt == CVI_4M_25P) || (vivofmt == CVI_4M_30P) ||\ + (vivofmt == CVI_5M_20P) || (vivofmt == CVI_8M_15P) || (vivofmt == CVI_8M_12_5P)) { + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->cvi_new_cmd); + } else { + printk("[drv_coax] Can not send commands!! Unsupported format!!\n"); return 0; } @@ -171,10 +157,10 @@ * * ioctl : IOC_VDEC_COAX_TX_INIT ***************************************************************************************/ -void nvp6158_coax_tx_init( nvp6158_coax_str *ps_coax_str ) +void nvp6158_coax_tx_init(nvp6158_coax_str *ps_coax_str) { - unsigned char ch = ps_coax_str->ch%4; - unsigned char devnum = ps_coax_str->ch/4; + unsigned char ch = ps_coax_str->ch % 4; + unsigned char devnum = ps_coax_str->ch / 4; unsigned char distance = 0; NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get( ps_coax_str->fmt_def); printk("[drv_coax]Ch: %d Format >>>>> %s\n", ch, CoaxVal->name ); @@ -184,7 +170,7 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0xA8+ch, 0x08+ch); // MPP_TST_SEL1 // Coaxial each mode set - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch%4); // BANK 5 + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch % 4); // BANK 5 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F, 0x00); // MPP_H_INV, MPP_V_INV, MPP_F_INV gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30, 0xE0); // MPP_H_S[7~4], MPP_H_E[3:0] gpio_i2c_write(nvp6158_iic_addr[devnum], 0x31, 0x43); // MPP_H_S[7:0] @@ -192,21 +178,21 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7C, CoaxVal->rx_src); gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7D, CoaxVal->rx_slice_lev); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00+((ch%2)*0x80), CoaxVal->tx_baud[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02+((ch%2)*0x80), CoaxVal->tx_pel_baud[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03+((ch%2)*0x80), CoaxVal->tx_line_pos0[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04+((ch%2)*0x80), CoaxVal->tx_line_pos1[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05+((ch%2)*0x80), CoaxVal->tx_line_count); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07+((ch%2)*0x80), CoaxVal->tx_pel_line_pos0[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08+((ch%2)*0x80), CoaxVal->tx_pel_line_pos1[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A+((ch%2)*0x80), CoaxVal->tx_line_count_max); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B+((ch%2)*0x80), CoaxVal->tx_mode); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D+((ch%2)*0x80), CoaxVal->tx_sync_pos0[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0E + ((ch%2)*0x80), CoaxVal->tx_sync_pos1[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F+((ch%2)*0x80), CoaxVal->tx_even); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C+((ch%2)*0x80), CoaxVal->tx_zero_length); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ((ch % 2) * 0x80), CoaxVal->tx_baud[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ((ch % 2) * 0x80), CoaxVal->tx_pel_baud[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ((ch % 2) * 0x80), CoaxVal->tx_line_pos0[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04 + ((ch % 2) * 0x80), CoaxVal->tx_line_pos1[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ((ch % 2) * 0x80), CoaxVal->tx_line_count); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07 + ((ch % 2) * 0x80), CoaxVal->tx_pel_line_pos0[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ((ch % 2) * 0x80), CoaxVal->tx_pel_line_pos1[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A + ((ch % 2) * 0x80), CoaxVal->tx_line_count_max); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B + ((ch % 2) * 0x80), CoaxVal->tx_mode); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D + ((ch % 2) * 0x80), CoaxVal->tx_sync_pos0[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0E + ((ch % 2) * 0x80), CoaxVal->tx_sync_pos1[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F + ((ch % 2) * 0x80), CoaxVal->tx_even); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C + ((ch % 2) * 0x80), CoaxVal->tx_zero_length); #if DBG_TX_INIT_PRINT printk("[drv]tx_src: 5x7C>> 0x%02X\n", CoaxVal->rx_src ); @@ -243,27 +229,21 @@ //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; NC_VD_COAX_Init_STR *CoaxVal; - unsigned char ch = ps_coax_str->ch%4; - unsigned char devnum = ps_coax_str->ch/4; + unsigned char ch = ps_coax_str->ch % 4; + unsigned char devnum = ps_coax_str->ch / 4; NC_VIVO_CH_FORMATDEF fmt_def = ps_coax_str->fmt_def; //int fmt = coax_tx->vivo_fmt; unsigned char distance = 0; - if( (fmt_def == AHD20_720P_25P) || (fmt_def == AHD20_720P_30P) ||\ + if((fmt_def == AHD20_720P_25P) || (fmt_def == AHD20_720P_30P) ||\ (fmt_def == AHD20_720P_25P_EX) || (fmt_def == AHD20_720P_30P_EX) ||\ - (fmt_def == AHD20_720P_25P_EX_Btype) || (fmt_def == AHD20_720P_30P_EX_Btype)\ - ) - { - printk("[drv_coax]Ch: %d ACP 16bit initialize!!!\n", ch ); - } - else if( (fmt_def == CVI_4M_25P) || (fmt_def == CVI_4M_30P) ) //some fh cams may need this + (fmt_def == AHD20_720P_25P_EX_Btype) || (fmt_def == AHD20_720P_30P_EX_Btype)) { + printk("[drv_coax]Ch: %d ACP 16bit initialize!!!\n", ch); + } else if((fmt_def == CVI_4M_25P) || (fmt_def == CVI_4M_30P)) { //some fh cams may need this // (fmt_def == CVI_8M_15P) || (fmt_def == CVI_8M_12_5P) ) - { - printk("[drv_coax]Ch: %d CVI New Protocol initialize!!!\n", ch ); - } - else - { - printk("[drv_coax]Ch: %d Can not initialize!! Unsupported format!!\n", ch ); + printk("[drv_coax]Ch: %d CVI New Protocol initialize!!!\n", ch); + } else { + printk("[drv_coax]Ch: %d Can not initialize!! Unsupported format!!\n", ch); return -1; } @@ -272,10 +252,10 @@ // MPP Coaxial mode select Ch1~4 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x01); // BANK 1 - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xA8+ch, 0x08+ch%4); // MPP_TST_SEL1 + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xA8 + ch, 0x08 + ch % 4); // MPP_TST_SEL1 // Coaxial each mode set - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch%4); // BANK 5 + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch % 4); // BANK 5 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F, 0x00); // MPP_H_INV, MPP_V_INV, MPP_F_INV gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30, 0xE0); // MPP_H_S[7~4], MPP_H_E[3:0] gpio_i2c_write(nvp6158_iic_addr[devnum], 0x31, 0x43); // MPP_H_S[7:0] @@ -283,21 +263,21 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7C, CoaxVal->rx_src); gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7D, CoaxVal->rx_slice_lev); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00+((ch%2)*0x80), CoaxVal->tx_baud[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02+((ch%2)*0x80), CoaxVal->tx_pel_baud[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03+((ch%2)*0x80), CoaxVal->tx_line_pos0[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04+((ch%2)*0x80), CoaxVal->tx_line_pos1[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05+((ch%2)*0x80), CoaxVal->tx_line_count); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07+((ch%2)*0x80), CoaxVal->tx_pel_line_pos0[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08+((ch%2)*0x80), CoaxVal->tx_pel_line_pos1[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A+((ch%2)*0x80), CoaxVal->tx_line_count_max); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B+((ch%2)*0x80), CoaxVal->tx_mode); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D+((ch%2)*0x80), CoaxVal->tx_sync_pos0[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ((ch%2)*0x80), CoaxVal->tx_baud[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ((ch%2)*0x80), CoaxVal->tx_pel_baud[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ((ch%2)*0x80), CoaxVal->tx_line_pos0[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04 + ((ch%2)*0x80), CoaxVal->tx_line_pos1[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ((ch%2)*0x80), CoaxVal->tx_line_count); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07 + ((ch%2)*0x80), CoaxVal->tx_pel_line_pos0[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ((ch%2)*0x80), CoaxVal->tx_pel_line_pos1[distance]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A + ((ch%2)*0x80), CoaxVal->tx_line_count_max); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B + ((ch%2)*0x80), CoaxVal->tx_mode); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D + ((ch%2)*0x80), CoaxVal->tx_sync_pos0[distance]); gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0E + ((ch%2)*0x80), CoaxVal->tx_sync_pos1[distance]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F+((ch%2)*0x80), CoaxVal->tx_even); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C+((ch%2)*0x80), CoaxVal->tx_zero_length); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F + ((ch%2)*0x80), CoaxVal->tx_even); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C + ((ch%2)*0x80), CoaxVal->tx_zero_length); #if DBG_TX_INIT_PRINT printk("[drv]tx_src: 5x7C>> 0x%02X\n", CoaxVal->rx_src ); @@ -335,26 +315,26 @@ //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; int i; int cmd_cnt = 0; - unsigned char ch = ps_coax_str->ch%4; - unsigned char devnum = ps_coax_str->ch/4; - NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; - NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; + unsigned char ch = ps_coax_str->ch % 4; + unsigned char devnum = ps_coax_str->ch/4; + NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; + NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt); - unsigned char tx_bank = 0x00; - unsigned char tx_cmd_addr = 0x00; - unsigned char tx_shot_addr = 0x00; - unsigned char command[32] = {0,}; + unsigned char tx_bank = 0x00; + unsigned char tx_cmd_addr = 0x00; + unsigned char tx_shot_addr = 0x00; + unsigned char command[32] = {0,}; unsigned char TCP_CMD_Stop_v10[10] = { 0xb5, 0x00, 0x14, 0x00, 0x80, 0x00, 0x00, 0x00, 0xc9, 0x80 }; //unsigned char TCP_CMD_Stop_v20[10] = { 0xb5, 0x01, 0x14, 0x00, 0x80, 0x00, 0x00, 0x00, 0xc5, 0x80 }; // UP Stream get from coax table NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get(vivofmt); // Get from Coax_Tx_Init Table - NC_VD_ACP_CMDDEF_STR *pCMD = __NC_VD_ACP_Get_CommandFormat_Get(cmd); // Get From Coax_Tx_Command Table + NC_VD_ACP_CMDDEF_STR *pCMD = __NC_VD_ACP_Get_CommandFormat_Get(cmd); // Get From Coax_Tx_Command Table printk("[drv_coax]Ch: %d Command >>>>> %s >>> autostop = %d\n", ch, pCMD->name, pCMD->autostop); - tx_bank = CoaxVal->tx_bank; - tx_cmd_addr = CoaxVal->tx_cmd_addr; + tx_bank = CoaxVal->tx_bank; + tx_cmd_addr = CoaxVal->tx_cmd_addr; tx_shot_addr = CoaxVal->tx_shot_addr; // UP Stream command copy in coax command table @@ -365,63 +345,53 @@ // printk("[%2x] ", command[i]); //printk("\n "); // fill command + shot - if( format == FMT_SD ) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2) ); - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, 0); + if( format == FMT_SD ) { + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + ((ch % 4) / 2) ); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, 0); } // Shot - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); msleep(CoaxVal->shot_delay); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); msleep(CoaxVal->reset_delay); - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, command[i]); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, command[i]); } // Shot - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); msleep(CoaxVal->shot_delay); //if(cmd == COAX_CMD_STOP) - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); - } - else if(format == FMT_CVI) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+(ch%4)); - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr+i, command[i]); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+i, 0xff); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); + } else if(format == FMT_CVI) { + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + (ch % 4)); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr + i, command[i]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10 + i, 0xff); } // Shot - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); - if((cmd == COAX_CMD_STOP) ||(pCMD->autostop==1)) - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); - } - else if(format == FMT_TVI) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2) ); - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, command[i]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); + if((cmd == COAX_CMD_STOP) || (pCMD->autostop == 1)) + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr +((ch % 2) * 0x80), 0x00); + } else if(format == FMT_TVI) { + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + ((ch % 4) / 2) ); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, command[i]); } - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x08); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x08); msleep(30); - if((cmd == COAX_CMD_STOP) ||(pCMD->autostop==1)) - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); + if((cmd == COAX_CMD_STOP) || (pCMD->autostop == 1)) + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); - if(pCMD->autostop == 1) - { + if(pCMD->autostop == 1) { if(vivofmt == TVI_4M_15P) msleep(70); else @@ -441,39 +411,35 @@ else #endif { - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2)); - for(i=0;i<10;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr+((ch%2)*0x80)+i, TCP_CMD_Stop_v10[i]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + ((ch % 4) / 2)); + for(i=0; i<10; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr + + ((ch % 2) * 0x80) + i, TCP_CMD_Stop_v10[i]); } } // shot - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x08); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x08); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); } - } - else - { - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2) ); - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, command[i]); + } else { + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch % 4) / 2) ); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, command[i]); } // Shot - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); - if((cmd == COAX_CMD_STOP) ||(pCMD->autostop==1)) - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch%2) * 0x80), 0x01); + if((cmd == COAX_CMD_STOP) || (pCMD->autostop == 1)) + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); } - if(cmd == COAX_CMD_STOP) //stop command sends twice in case of AF camera losses response... - { + if(cmd == COAX_CMD_STOP) {//stop command sends twice in case of AF camera losses response... msleep(35); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); } } @@ -492,16 +458,16 @@ //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; int i; int cmd_cnt = 0; - unsigned char ch = ps_coax_str->ch%4; - unsigned char devnum = ps_coax_str->ch/4; - NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; - NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; + unsigned char ch = ps_coax_str->ch % 4; + unsigned char devnum = ps_coax_str->ch / 4; + NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; + NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt); - unsigned char tx_bank = 0x00; - unsigned char tx_cmd_addr = 0x00; - unsigned char tx_shot_addr = 0x00; - unsigned char command[32] ={0,}; + unsigned char tx_bank = 0x00; + unsigned char tx_cmd_addr = 0x00; + unsigned char tx_shot_addr = 0x00; + unsigned char command[32] ={0,}; // UP Stream get from coax table NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get(vivofmt); // Get from Coax_Tx_Init Table @@ -516,32 +482,29 @@ cmd_cnt = __NC_VD_COAX_16bit_Command_Copy( format, vivofmt, command, pCMD ); // Adjust Bank - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); // fill Reset - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20+((ch%2)*0x80)+i, 0); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20 + ((ch % 2) * 0x80) + i, 0); } // Command Shot - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x01); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x01); msleep(30); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x00); - + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x00); // fill command - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20+((ch%2)*0x80)+i, command[i]); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20 + ((ch % 2) * 0x80) + i, command[i]); } - // Command Shot - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x01); + // Command Shot + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x01); msleep(30); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x00); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x00); } @@ -550,10 +513,10 @@ //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; int i; int cmd_cnt = 0; - unsigned char ch = ps_coax_str->ch%4; - unsigned char devnum = ps_coax_str->ch/4; - NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; - NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; + unsigned char ch = ps_coax_str->ch % 4; + unsigned char devnum = ps_coax_str->ch / 4; + NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; + NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt); unsigned char tx_bank = 0x00; @@ -573,16 +536,15 @@ // UP Stream command copy in coax command table cmd_cnt = __NC_VD_COAX_16bit_Command_Copy( format, vivofmt, command, pCMD ); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+(ch%4)); - for(i=0;i<cmd_cnt;i++) - { - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr+i, command[i]); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + (ch % 4)); + for(i=0; i<cmd_cnt; i++) { + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr + i, command[i]); } // Shot - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); } /*======================================================================================================= @@ -617,21 +579,21 @@ void nvp6158_coax_rx_init( nvp6158_coax_str *ps_coax_str ) { //NC_VD_COAX_STR *coax_rx = (NC_VD_COAX_STR*)p_param; - unsigned char ch = ps_coax_str->ch%4; - unsigned char devnum = ps_coax_str->ch/4; + unsigned char ch = ps_coax_str->ch % 4; + unsigned char devnum = ps_coax_str->ch / 4; //NC_VIVO_CH_FORMATDEF vivofmt = coax_rx->vivo_fmt; NC_VD_COAX_Init_STR *coax_rx_val = __NC_VD_COAX_InitFormat_Get(ps_coax_str->fmt_def); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x63+((ch%2)*0x80), coax_rx_val->rx_comm_on); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x62+((ch%2)*0x80), coax_rx_val->rx_area); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x66+((ch%2)*0x80), coax_rx_val->rx_signal_enhance); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x69+((ch%2)*0x80), coax_rx_val->rx_manual_duty); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x60+((ch%2)*0x80), coax_rx_val->rx_head_matching); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), coax_rx_val->rx_data_rz); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), coax_rx_val->rx_sz); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x63 + ((ch%2)*0x80), coax_rx_val->rx_comm_on); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x62 + ((ch%2)*0x80), coax_rx_val->rx_area); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x66 + ((ch%2)*0x80), coax_rx_val->rx_signal_enhance); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x69 + ((ch%2)*0x80), coax_rx_val->rx_manual_duty); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x60 + ((ch%2)*0x80), coax_rx_val->rx_head_matching); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61 + ((ch%2)*0x80), coax_rx_val->rx_data_rz); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68 + ((ch%2)*0x80), coax_rx_val->rx_sz); #if DBG_RX_INIT_PRINT printk("[drv]Channel %d Format >>>>> %s\n", ch, coax_rx_val->name ); printk("[drv]rx_head_matching: 0x60 >> 0x%02X\n", coax_rx_val->rx_head_matching); @@ -660,16 +622,14 @@ //NC_VD_COAX_STR *coax_rx = (NC_VD_COAX_STR*)p_param; int ii = 0; - unsigned char ch = coax_rx->ch%4; - unsigned char devnum = coax_rx->ch/4; + unsigned char ch = coax_rx->ch % 4; + unsigned char devnum = coax_rx->ch / 4; NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(coax_rx->fmt_def); - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); - if( (format == FMT_CVI) || (format == FMT_TVI) ) - { - for(ii=0;ii<5;ii++) - { + if( (format == FMT_CVI) || (format == FMT_TVI) ) { + for(ii=0; ii<5; ii++) { coax_rx->rx_data1[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x40+((ch%2)*0x80))+ii); // ChX_Rx_Line_1 : 0x40 ~ 0x44 5byte coax_rx->rx_data2[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x45+((ch%2)*0x80))+ii); // ChX_Rx_Line_2 : 0x45 ~ 0x49 5byte coax_rx->rx_data3[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x4A+((ch%2)*0x80))+ii); // ChX_Rx_Line_3 : 0x4A ~ 0x4E 5byte @@ -677,11 +637,8 @@ coax_rx->rx_data5[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x71+((ch%2)*0x80))+ii); // ChX_Rx_Line_5 : 0x71 ~ 0x75 5byte coax_rx->rx_data6[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x76+((ch%2)*0x80))+ii); // ChX_Rx_Line_6 : 0x76 ~ 0x7A 5byte } - } - else // AHD - { - for(ii=0;ii<8;ii++) - { + } else {// AHD + for(ii=0; ii<8; ii++) { coax_rx->rx_pelco_data[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x50+((ch%2)*0x80))+ii); // ChX_PELCO_Rx_Line_1 ~ 8 : 0x50 ~ 0x57 8byte } } @@ -775,13 +732,11 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0x60+((ch%2)*0x80), 0x55 ); // Header Matching /* If the header is (0x50=>0x55) and chip information is (0x51=>0x3X, 0x4X, 0x5X ), it can update firmware */ - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x50+((ch%2)*0x80) ) == 0x55 ) - { - printk(">>>>> DRV[%s:%d] CH:%d, this camera can update, please, wait! = 0x%x\n", __func__, __LINE__, ch, gpio_i2c_read( nvp6158_iic_addr[ch/4], 0x51+((ch%2)*0x80) ) ); + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x50+((ch%2)*0x80) ) == 0x55 ) { + printk(">>>>> DRV[%s:%d] CH:%d, this camera can update, please, wait! = 0x%x\n", + __func__, __LINE__, ch, gpio_i2c_read( nvp6158_iic_addr[ch/4], 0x51+((ch%2)*0x80))); ret = FW_SUCCESS; - } - else - { + } else { readval= gpio_i2c_read( nvp6158_iic_addr[devnum], 0x50+((ch%2)*0x80) ); printk(">>>>> DRV[%s:%d] check ACP_STATUS_MODE::0x%x\n", __func__, __LINE__, readval ); ret = FW_FAILURE; @@ -819,8 +774,7 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A+((ch%2)*0x80), 0x04); // Tx Line count max /* change video mode FHD@25P Command Send */ - if( (cp_mode == FMT_AHD20) || (cp_mode == FMT_AHD30) ) - { + if( (cp_mode == FMT_AHD20) || (cp_mode == FMT_AHD30)) { gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x60); // Register Write Control - 17th line gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11+((ch%2)*0x80), 0xB0); // table(Mode Change Command) - 18th line gpio_i2c_write(nvp6158_iic_addr[devnum], 0x12+((ch%2)*0x80), 0x02); // Flash Update Mode(big data) - 19th line @@ -830,11 +784,10 @@ msleep(400); gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // reset gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x00); // trigger Off - printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", __func__, __LINE__, ch ); + printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", + __func__, __LINE__, ch ); ret = FW_SUCCESS; - } - else if( (cp_mode == FMT_CVI) || (cp_mode == FMT_TVI) ) - { + } else if((cp_mode == FMT_CVI) || (cp_mode == FMT_TVI)) { /* change video mode FHD@25P Command Send */ gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x55); // 0x55(header) - 16th line @@ -847,11 +800,10 @@ msleep(1000); gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // reset gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x00); // trigger Off - printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", __func__, __LINE__, ch ); + printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", + __func__, __LINE__, ch ); ret = FW_SUCCESS; - } - else - { + } else { printk(">>>> DRV[%s:%d] CH:%d, FMT:%d > Unknown Format!!! \n", __func__, __LINE__, ch, cp_mode ); ret = FW_FAILURE; } @@ -892,20 +844,17 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) - { + if(gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02) { /* get status, If the status is 0x00(Camera information), 0x01(Firmware version */ - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00 ) - { + if(gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00) { printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [READY]\n", __func__, __LINE__, ch ); ret = FW_SUCCESS; } - } - else - { + } else { retval = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ); retval2 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ); - printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[READY], [0x56-true[0x00]:0x%x], [0x57-true[0x02]:0x%x]\n", __func__, __LINE__, ch, retval, retval2 ); + printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[READY], [0x56-true[0x00]:0x%x], [0x57-true[0x02]:0x%x]\n", + __func__, __LINE__, ch, retval, retval2 ); ret = FW_FAILURE; } @@ -994,22 +943,19 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) - { - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00 ) - { + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02) { + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00) { printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [START]\n", __func__, __LINE__, ch ); ret = FW_SUCCESS; - } - else - { + } else { unsigned char retval1; unsigned char retval2; gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); retval1 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ); retval2 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ); ret = FW_FAILURE; - printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[START], [0x56-true[0x02]:0x%x], [0x57-true[0x02]:0x%x]\n", __func__, __LINE__, ch, retval1, retval2 ); + printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[START], [0x56-true[0x02]:0x%x], [0x57-true[0x02]:0x%x]\n", + __func__, __LINE__, ch, retval1, retval2 ); } } @@ -1053,15 +999,11 @@ /* fill packet(139bytes), end packet is filled with 0xff */ gpio_i2c_write( nvp6158_iic_addr[devnum], 0xff, 0x0c+(ch%4) ); - for( ii = 0; ii < 139; ii++ ) - { - if( byteNumOfPacket < readsize) - { + for( ii = 0; ii < 139; ii++ ) { + if( byteNumOfPacket < readsize) { gpio_i2c_write( nvp6158_iic_addr[devnum], 0x00+ii, pstFileInfo->onepacketbuf[ii] ); byteNumOfPacket++; - } - else if( byteNumOfPacket >= readsize ) // end packet : fill 0xff - { + } else if( byteNumOfPacket >= readsize ) {// end packet : fill 0xff gpio_i2c_write( nvp6158_iic_addr[devnum], 0x00+ii, 0xff ); byteNumOfPacket++; } @@ -1075,7 +1017,8 @@ } /* offset */ - pstFileInfo->currentFileOffset = (unsigned int)((high << 16 )&(0xFF0000))| (unsigned int)((mid << 8 )&(0xFF00)) | (unsigned char)(low); + pstFileInfo->currentFileOffset = (unsigned int)((high << 16 )&(0xFF0000)) | + (unsigned int)((mid << 8 )&(0xFF00)) | (unsigned char)(low); /* Tx Change mode to use Big data */ gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); @@ -1123,15 +1066,13 @@ gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) - { + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) { /* check ISP status - only check first packet */ - if( pstFileInfo->currentpacketnum == 0 ) - { - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x03 ) - { + if( pstFileInfo->currentpacketnum == 0 ) { + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x03 ) { pstFileInfo->result = FW_FAILURE; - printk(">>>>> DRV[%s:%d] CH:%d, Failed, error status, code=3..................\n", __func__, __LINE__, ch ); + printk(">>>>> DRV[%s:%d] CH:%d, Failed, error status, code=3..................\n", + __func__, __LINE__, ch ); return; } } @@ -1140,8 +1081,7 @@ receive_addr = (( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x53+((ch%2)*0x80))<<16) + \ (gpio_i2c_read( nvp6158_iic_addr[devnum], 0x54+((ch%2)*0x80))<<8) + gpio_i2c_read( nvp6158_iic_addr[devnum], 0x55+((ch%2)*0x80))); - if( onepacketaddr == receive_addr ) - { + if( onepacketaddr == receive_addr ) { gpio_i2c_write( nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // Reset gpio_i2c_write( nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x00); // trigger off ret = FW_SUCCESS; @@ -1188,15 +1128,14 @@ gpio_i2c_write( nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x60); gpio_i2c_write( nvp6158_iic_addr[devnum], 0x11+((ch%2)*0x80), 0xb0); gpio_i2c_write( nvp6158_iic_addr[devnum], 0x12+((ch%2)*0x80), 0x02); - if( send_success == FW_FAILURE ) - { + if( send_success == FW_FAILURE ) { gpio_i2c_write( nvp6158_iic_addr[devnum], 0x13+((ch%2)*0x80), 0xE0/*0xC0*/); - printk(">>>>> DRV[%s:%d] CH:%d, Camera UPDATE error signal. send Abnormal ending!\n", __func__, __LINE__, ch ); - } - else - { + printk(">>>>> DRV[%s:%d] CH:%d, Camera UPDATE error signal. send Abnormal ending!\n", + __func__, __LINE__, ch ); + } else { gpio_i2c_write( nvp6158_iic_addr[devnum], 0x13+((ch%2)*0x80), 0x80/*0x60*/); - printk(">>>>> DVR[%s:%d] CH:%d, Camera UPDATE ending signal. wait please!\n", __func__, __LINE__, ch ); + printk(">>>>> DVR[%s:%d] CH:%d, Camera UPDATE ending signal. wait please!\n", + __func__, __LINE__, ch ); } /* Shot */ @@ -1235,8 +1174,7 @@ gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x05+(ch%4)); videofm = gpio_i2c_read( nvp6158_iic_addr[devnum], 0xF0); - if( videofm == 0xFF ) - { + if( videofm == 0xFF ) { printk(">>>>> DRV[%s:%d] Final[CH:%d], No video[END]!\n", __func__, __LINE__, ch ); pstFileInfo->result = FW_FAILURE; return; @@ -1256,15 +1194,13 @@ gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); ack_return = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ); isp_status = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ); - if( isp_status == 0x02 && ack_return == 0x05 ) - { + if( isp_status == 0x02 && ack_return == 0x05 ) { printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [END]\n", __func__, __LINE__, ch ); pstFileInfo->result = FW_SUCCESS; return; - } - else - { - printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[END], [0x56-true[0x05]:0x%x], [0x57-true[0x02]:0x%x]\n", __func__, __LINE__, ch, ack_return, isp_status ); + } else { + printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[END], [0x56-true[0x05]:0x%x], [0x57-true[0x02]:0x%x]\n", + __func__, __LINE__, ch, ack_return, isp_status ); pstFileInfo->result = FW_FAILURE; return; } @@ -1303,20 +1239,15 @@ // Adjust Tx if( fmtdef == AHD30_3M_30P || fmtdef == AHD30_3M_25P || fmtdef == AHD30_3M_18P || fmtdef == AHD30_4M_30P || fmtdef == AHD30_4M_25P || fmtdef == AHD30_4M_15P || - fmtdef == AHD30_5M_12_5P || fmtdef == AHD30_5M_20P - ) - { // 3M Upper Format + fmtdef == AHD30_5M_12_5P || fmtdef == AHD30_5M_20P) { // 3M Upper Format gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x05+((ch%2)*0x80), 0x07); // Tx line set gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x0A+((ch%2)*0x80), 0x08); // Tx max line set - } - else // 3M Under Format - { + } else {// 3M Under Format gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x05+((ch%2)*0x80), 0x03); // Tx line set gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x0A+((ch%2)*0x80), 0x04); // Tx max line set } - if( param == 0 ) // RT Mode - { + if( param == 0 ) {// RT Mode gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x00); // RT Mode @@ -1325,9 +1256,7 @@ gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); - } - else if( param == 1 )// NRT Mode - { + } else if( param == 1 ) {// NRT Mode gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x01); // NRT Mode @@ -1336,9 +1265,7 @@ gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); - } - else if( param == 2 )// AHD 5M 20P - { + } else if( param == 2 ) {// AHD 5M 20P gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format @@ -1347,9 +1274,7 @@ gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); - } - else if( param == 3 )// AHD 5M 12.5P - { + } else if( param == 3 ) {// AHD 5M 12.5P gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format @@ -1358,9 +1283,7 @@ gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); - } - else if( param == 4 )// AHD 4M 30P - { + } else if( param == 4 ) {// AHD 4M 30P gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format @@ -1369,9 +1292,7 @@ gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); - } - else if( param == 5 )// AHD 4M 25P - { + } else if( param == 5 ) {// AHD 4M 25P gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format @@ -1380,9 +1301,7 @@ gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); - } - else if( param == 6 )// AHD 4M 15P - { + } else if( param == 6 ) {// AHD 4M 15P gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format @@ -1459,22 +1378,18 @@ void nvp6158_coax_test_data_set(NC_VD_COAX_TEST_STR *coax_data) { unsigned char temp_reg; - printk("[DRV_Set]bank(0x%02X)/addr(0x%02X)/param(0x%02X)\n", coax_data->bank, coax_data->data_addr, coax_data->param ); + printk("[DRV_Set]bank(0x%02X)/addr(0x%02X)/param(0x%02X)\n", + coax_data->bank, coax_data->data_addr, coax_data->param ); gpio_i2c_write(nvp6158_iic_addr[coax_data->chip_num], 0xFF, coax_data->bank); - if(coax_data->bank == 0x01 && coax_data->data_addr == 0xED) - { + if(coax_data->bank == 0x01 && coax_data->data_addr == 0xED) { temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); temp_reg = ((temp_reg & ~(0x01 << coax_data->param)) | (0x01 << coax_data->param)); - } - else if(coax_data->bank == 0x01 && coax_data->data_addr == 0x7A) - { + } else if(coax_data->bank == 0x01 && coax_data->data_addr == 0x7A) { temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); temp_reg = (temp_reg & ~(0x01 << coax_data->param)); - } - else if(coax_data->bank == 0x09 && coax_data->data_addr == 0x44) - { + } else if(coax_data->bank == 0x09 && coax_data->data_addr == 0x44) { temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); temp_reg = ((temp_reg & ~(0x01 << coax_data->param)) | (0x01 << coax_data->param)); } @@ -1498,7 +1413,8 @@ { gpio_i2c_write(nvp6158_iic_addr[coax_data->chip_num], 0xFF, coax_data->bank); coax_data->param = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); - printk("[DRV_Get]bank(0x%02X), addr(0x%02X), param(0x%02X)\n", coax_data->bank, coax_data->data_addr, coax_data->param ); + printk("[DRV_Get]bank(0x%02X), addr(0x%02X), param(0x%02X)\n", + coax_data->bank, coax_data->data_addr, coax_data->param ); } /************************************************************************************** @@ -1517,8 +1433,7 @@ gpio_i2c_write(nvp6158_iic_addr[coax_data->vd_dev], 0xFF, coax_data->bank); - for(ii=0; ii<256; ii++) - { + for(ii=0; ii<256; ii++) { coax_data->rx_pelco_data[ii] = gpio_i2c_read(nvp6158_iic_addr[coax_data->vd_dev], 0x00+ii); } } @@ -1557,8 +1472,7 @@ gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x10+3+(ch%2)*0x80, 0x00); gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x09+(ch%2)*0x80, 0x08); msleep(100); - for(i=0;i<8;i++) - { + for(i=0; i<8; i++) { data_3x50[i] = gpio_i2c_read(nvp6158_iic_addr[ch/4],0x50+i+((ch%2)*0x80)); printk("acp_isp_read ch = %d, reg_addr = %x, reg_data = %x\n", ch,reg_addr, data_3x50[i]); } @@ -1600,8 +1514,7 @@ gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x10+3+(ch%2)*0x80, reg_data); gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x09+(ch%2)*0x80, 0x08); msleep(100); - for(i=0;i<8;i++) - { + for(i=0; i<8; i++) { data_3x50[i] = gpio_i2c_read(nvp6158_iic_addr[ch/4],0x50+i+((ch%2)*0x80)); printk("acp_isp_write ch = %d, reg_addr = %x, reg_data = %x\n", ch,reg_addr, data_3x50[i]); } -- Gitblit v1.6.2