| .. | .. |
|---|
| 56 | 56 | * |
|---|
| 57 | 57 | * ioctl : IOC_VDEC_COAX_TX_INIT |
|---|
| 58 | 58 | ***************************************************************************************/ |
|---|
| 59 | | -static NC_VD_ACP_CMDDEF_STR *__NC_VD_ACP_Get_CommandFormat_Get( NC_COAX_CMD_DEF def ) |
|---|
| 59 | +static NC_VD_ACP_CMDDEF_STR *__NC_VD_ACP_Get_CommandFormat_Get(NC_COAX_CMD_DEF def) |
|---|
| 60 | 60 | { |
|---|
| 61 | 61 | NC_VD_ACP_CMDDEF_STR *pRet = &nvp6158_coax_cmd_lists[def]; |
|---|
| 62 | | - if( pRet == NULL ) |
|---|
| 63 | | - { |
|---|
| 62 | + if( pRet == NULL ) { |
|---|
| 64 | 63 | printk("Not Supported format Yet!!!(%d)\n",def); |
|---|
| 65 | 64 | } |
|---|
| 66 | 65 | return pRet; |
|---|
| 67 | 66 | } |
|---|
| 68 | 67 | |
|---|
| 69 | | -static NC_VD_COAX_Init_STR *__NC_VD_COAX_InitFormat_Get( NC_VIVO_CH_FORMATDEF def ) |
|---|
| 68 | +static NC_VD_COAX_Init_STR *__NC_VD_COAX_InitFormat_Get(NC_VIVO_CH_FORMATDEF def) |
|---|
| 70 | 69 | { |
|---|
| 71 | 70 | NC_VD_COAX_Init_STR *pRet = &nvp6158_coax_init_lists[def]; |
|---|
| 72 | | - if( pRet == NULL ) |
|---|
| 73 | | - { |
|---|
| 71 | + if( pRet == NULL ) { |
|---|
| 74 | 72 | printk("Not Supported format Yet!!!(%d)\n",def); |
|---|
| 75 | 73 | } |
|---|
| 76 | 74 | return pRet; |
|---|
| 77 | 75 | } |
|---|
| 78 | 76 | |
|---|
| 79 | | -static NC_VD_COAX_Init_STR *__NC_VD_COAX_16bit_InitFormat_Get( NC_VIVO_CH_FORMATDEF def ) |
|---|
| 77 | +static NC_VD_COAX_Init_STR *__NC_VD_COAX_16bit_InitFormat_Get(NC_VIVO_CH_FORMATDEF def) |
|---|
| 80 | 78 | { |
|---|
| 81 | 79 | NC_VD_COAX_Init_STR *pRet = &nvp6158_coax_acp_16bit_init_lists[def]; |
|---|
| 82 | | - if( pRet == NULL ) |
|---|
| 83 | | - { |
|---|
| 80 | + if( pRet == NULL ) { |
|---|
| 84 | 81 | printk("Not Supported format Yet!!!(%d)\n",def); |
|---|
| 85 | 82 | } |
|---|
| 86 | 83 | return pRet; |
|---|
| 87 | 84 | } |
|---|
| 88 | 85 | |
|---|
| 89 | | -static int __NC_VD_COAX_Command_Each_Copy( unsigned char *Dst, int *Src ) |
|---|
| 86 | +static int __NC_VD_COAX_Command_Each_Copy(unsigned char *Dst, int *Src) |
|---|
| 90 | 87 | { |
|---|
| 91 | 88 | int items = 0; |
|---|
| 92 | 89 | |
|---|
| 93 | | - while( Src[items] != EOD ) |
|---|
| 94 | | - { |
|---|
| 90 | + while( Src[items] != EOD ) { |
|---|
| 95 | 91 | Dst[items] = Src[items]; |
|---|
| 96 | 92 | items++; |
|---|
| 97 | 93 | } |
|---|
| .. | .. |
|---|
| 99 | 95 | return items; |
|---|
| 100 | 96 | } |
|---|
| 101 | 97 | |
|---|
| 102 | | -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 ) |
|---|
| 98 | +static int __NC_VD_COAX_Command_Copy(NC_FORMAT_STANDARD format, NC_VIVO_CH_FORMATDEF vivofmt, |
|---|
| 99 | + unsigned char *Dst, NC_VD_ACP_CMDDEF_STR *pCMD) |
|---|
| 103 | 100 | { |
|---|
| 104 | 101 | int cmd_cnt = 0; |
|---|
| 105 | 102 | |
|---|
| 106 | | - if( format == FMT_SD ) |
|---|
| 107 | | - { |
|---|
| 108 | | - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->sd ); |
|---|
| 109 | | - } |
|---|
| 110 | | - else if( (format == FMT_AHD20) || (format == FMT_AHD30) ) |
|---|
| 111 | | - { |
|---|
| 112 | | - if( vivofmt == AHD30_4M_30P || vivofmt == AHD30_4M_25P || vivofmt == AHD30_4M_15P || |
|---|
| 113 | | - vivofmt == AHD30_5M_20P || vivofmt == AHD30_5M_12_5P || vivofmt == AHD30_5_3M_20P || |
|---|
| 114 | | - vivofmt == AHD30_8M_12_5P || vivofmt == AHD30_8M_15P ) |
|---|
| 115 | | - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_4_5m ); |
|---|
| 103 | + if( format == FMT_SD ) { |
|---|
| 104 | + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->sd); |
|---|
| 105 | + } else if((format == FMT_AHD20) || (format == FMT_AHD30)) { |
|---|
| 106 | + if(vivofmt == AHD30_4M_30P || vivofmt == AHD30_4M_25P || vivofmt == AHD30_4M_15P || |
|---|
| 107 | + vivofmt == AHD30_5M_20P || vivofmt == AHD30_5M_12_5P || vivofmt == AHD30_5_3M_20P || |
|---|
| 108 | + vivofmt == AHD30_8M_12_5P || vivofmt == AHD30_8M_15P) |
|---|
| 109 | + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->ahd_4_5m); |
|---|
| 110 | + //cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_4_5m ); |
|---|
| 116 | 111 | //else if( vivofmt == AHD30_4M_30P || vivofmt == AHD30_4M_25P || vivofmt == AHD30_4M_15P ) |
|---|
| 117 | 112 | //cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_4_5m ); |
|---|
| 118 | 113 | else |
|---|
| 119 | | - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_8bit ); |
|---|
| 120 | | - } |
|---|
| 121 | | - else if( format == FMT_CVI ) |
|---|
| 122 | | - { |
|---|
| 123 | | - cmd_cnt= __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->cvi_cmd ); |
|---|
| 124 | | - } |
|---|
| 125 | | - else if( format == FMT_TVI ) |
|---|
| 126 | | - { |
|---|
| 127 | | - if( (vivofmt == TVI_4M_30P) || (vivofmt == TVI_4M_25P) || (vivofmt == TVI_4M_15P) || |
|---|
| 128 | | - (vivofmt == TVI_5M_20P) || (vivofmt == TVI_5M_12_5P) || (vivofmt == TVI_8M_12_5P) || (vivofmt == TVI_8M_15P) ) |
|---|
| 129 | | - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->tvi_v2_0 ); |
|---|
| 114 | + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->ahd_8bit); |
|---|
| 115 | + } else if(format == FMT_CVI) { |
|---|
| 116 | + cmd_cnt= __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->cvi_cmd); |
|---|
| 117 | + } else if(format == FMT_TVI) { |
|---|
| 118 | + if((vivofmt == TVI_4M_30P) || (vivofmt == TVI_4M_25P) || (vivofmt == TVI_4M_15P) || |
|---|
| 119 | + (vivofmt == TVI_5M_20P) || (vivofmt == TVI_5M_12_5P) || (vivofmt == TVI_8M_12_5P) || (vivofmt == TVI_8M_15P)) |
|---|
| 120 | + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->tvi_v2_0); |
|---|
| 130 | 121 | else |
|---|
| 131 | | - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->tvi_v1_0 ); |
|---|
| 132 | | - } |
|---|
| 133 | | - else |
|---|
| 122 | + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->tvi_v1_0); |
|---|
| 123 | + } else { |
|---|
| 134 | 124 | printk("NC_VD_COAX_Tx_Command_Send::Command Copy Error!!\n"); |
|---|
| 135 | | - |
|---|
| 125 | + } |
|---|
| 136 | 126 | |
|---|
| 137 | 127 | return cmd_cnt; |
|---|
| 138 | 128 | } |
|---|
| 139 | 129 | |
|---|
| 140 | | -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 ) |
|---|
| 130 | +static int __NC_VD_COAX_16bit_Command_Copy(NC_FORMAT_STANDARD format, NC_VIVO_CH_FORMATDEF vivofmt, |
|---|
| 131 | + unsigned char *Dst, NC_VD_ACP_CMDDEF_STR *pCMD) |
|---|
| 141 | 132 | { |
|---|
| 142 | 133 | int cmd_cnt = 0; |
|---|
| 143 | 134 | |
|---|
| 144 | | - if( (vivofmt == AHD20_720P_25P) || (vivofmt == AHD20_720P_30P) ||\ |
|---|
| 135 | + if((vivofmt == AHD20_720P_25P) || (vivofmt == AHD20_720P_30P) ||\ |
|---|
| 145 | 136 | (vivofmt == AHD20_720P_25P_EX) || (vivofmt == AHD20_720P_30P_EX) ||\ |
|---|
| 146 | | - (vivofmt == AHD20_720P_25P_EX_Btype) || (vivofmt == AHD20_720P_30P_EX_Btype) ) |
|---|
| 147 | | - { |
|---|
| 137 | + (vivofmt == AHD20_720P_25P_EX_Btype) || (vivofmt == AHD20_720P_30P_EX_Btype)) { |
|---|
| 148 | 138 | cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_16bit ); |
|---|
| 149 | | - } |
|---|
| 150 | | - else if( (vivofmt == CVI_4M_25P) || (vivofmt == CVI_4M_30P) ||\ |
|---|
| 151 | | - (vivofmt == CVI_5M_20P) || (vivofmt == CVI_8M_15P) || (vivofmt == CVI_8M_12_5P) ) |
|---|
| 152 | | - { |
|---|
| 153 | | - cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->cvi_new_cmd ); |
|---|
| 154 | | - } |
|---|
| 155 | | - else |
|---|
| 156 | | - { |
|---|
| 157 | | - printk("[drv_coax] Can not send commands!! Unsupported format!!\n" ); |
|---|
| 139 | + } else if((vivofmt == CVI_4M_25P) || (vivofmt == CVI_4M_30P) ||\ |
|---|
| 140 | + (vivofmt == CVI_5M_20P) || (vivofmt == CVI_8M_15P) || (vivofmt == CVI_8M_12_5P)) { |
|---|
| 141 | + cmd_cnt = __NC_VD_COAX_Command_Each_Copy(Dst, pCMD->cvi_new_cmd); |
|---|
| 142 | + } else { |
|---|
| 143 | + printk("[drv_coax] Can not send commands!! Unsupported format!!\n"); |
|---|
| 158 | 144 | return 0; |
|---|
| 159 | 145 | } |
|---|
| 160 | 146 | |
|---|
| .. | .. |
|---|
| 171 | 157 | * |
|---|
| 172 | 158 | * ioctl : IOC_VDEC_COAX_TX_INIT |
|---|
| 173 | 159 | ***************************************************************************************/ |
|---|
| 174 | | -void nvp6158_coax_tx_init( nvp6158_coax_str *ps_coax_str ) |
|---|
| 160 | +void nvp6158_coax_tx_init(nvp6158_coax_str *ps_coax_str) |
|---|
| 175 | 161 | { |
|---|
| 176 | | - unsigned char ch = ps_coax_str->ch%4; |
|---|
| 177 | | - unsigned char devnum = ps_coax_str->ch/4; |
|---|
| 162 | + unsigned char ch = ps_coax_str->ch % 4; |
|---|
| 163 | + unsigned char devnum = ps_coax_str->ch / 4; |
|---|
| 178 | 164 | unsigned char distance = 0; |
|---|
| 179 | 165 | NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get( ps_coax_str->fmt_def); |
|---|
| 180 | 166 | printk("[drv_coax]Ch: %d Format >>>>> %s\n", ch, CoaxVal->name ); |
|---|
| .. | .. |
|---|
| 184 | 170 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0xA8+ch, 0x08+ch); // MPP_TST_SEL1 |
|---|
| 185 | 171 | |
|---|
| 186 | 172 | // Coaxial each mode set |
|---|
| 187 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch%4); // BANK 5 |
|---|
| 173 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch % 4); // BANK 5 |
|---|
| 188 | 174 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F, 0x00); // MPP_H_INV, MPP_V_INV, MPP_F_INV |
|---|
| 189 | 175 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30, 0xE0); // MPP_H_S[7~4], MPP_H_E[3:0] |
|---|
| 190 | 176 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x31, 0x43); // MPP_H_S[7:0] |
|---|
| .. | .. |
|---|
| 192 | 178 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7C, CoaxVal->rx_src); |
|---|
| 193 | 179 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7D, CoaxVal->rx_slice_lev); |
|---|
| 194 | 180 | |
|---|
| 195 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); |
|---|
| 181 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); |
|---|
| 196 | 182 | |
|---|
| 197 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00+((ch%2)*0x80), CoaxVal->tx_baud[distance]); |
|---|
| 198 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02+((ch%2)*0x80), CoaxVal->tx_pel_baud[distance]); |
|---|
| 199 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03+((ch%2)*0x80), CoaxVal->tx_line_pos0[distance]); |
|---|
| 200 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04+((ch%2)*0x80), CoaxVal->tx_line_pos1[distance]); |
|---|
| 201 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05+((ch%2)*0x80), CoaxVal->tx_line_count); |
|---|
| 202 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07+((ch%2)*0x80), CoaxVal->tx_pel_line_pos0[distance]); |
|---|
| 203 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08+((ch%2)*0x80), CoaxVal->tx_pel_line_pos1[distance]); |
|---|
| 204 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A+((ch%2)*0x80), CoaxVal->tx_line_count_max); |
|---|
| 205 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B+((ch%2)*0x80), CoaxVal->tx_mode); |
|---|
| 206 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D+((ch%2)*0x80), CoaxVal->tx_sync_pos0[distance]); |
|---|
| 207 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0E + ((ch%2)*0x80), CoaxVal->tx_sync_pos1[distance]); |
|---|
| 208 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F+((ch%2)*0x80), CoaxVal->tx_even); |
|---|
| 209 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C+((ch%2)*0x80), CoaxVal->tx_zero_length); |
|---|
| 183 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ((ch % 2) * 0x80), CoaxVal->tx_baud[distance]); |
|---|
| 184 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ((ch % 2) * 0x80), CoaxVal->tx_pel_baud[distance]); |
|---|
| 185 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ((ch % 2) * 0x80), CoaxVal->tx_line_pos0[distance]); |
|---|
| 186 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04 + ((ch % 2) * 0x80), CoaxVal->tx_line_pos1[distance]); |
|---|
| 187 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ((ch % 2) * 0x80), CoaxVal->tx_line_count); |
|---|
| 188 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07 + ((ch % 2) * 0x80), CoaxVal->tx_pel_line_pos0[distance]); |
|---|
| 189 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ((ch % 2) * 0x80), CoaxVal->tx_pel_line_pos1[distance]); |
|---|
| 190 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A + ((ch % 2) * 0x80), CoaxVal->tx_line_count_max); |
|---|
| 191 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B + ((ch % 2) * 0x80), CoaxVal->tx_mode); |
|---|
| 192 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D + ((ch % 2) * 0x80), CoaxVal->tx_sync_pos0[distance]); |
|---|
| 193 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0E + ((ch % 2) * 0x80), CoaxVal->tx_sync_pos1[distance]); |
|---|
| 194 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F + ((ch % 2) * 0x80), CoaxVal->tx_even); |
|---|
| 195 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C + ((ch % 2) * 0x80), CoaxVal->tx_zero_length); |
|---|
| 210 | 196 | |
|---|
| 211 | 197 | #if DBG_TX_INIT_PRINT |
|---|
| 212 | 198 | printk("[drv]tx_src: 5x7C>> 0x%02X\n", CoaxVal->rx_src ); |
|---|
| .. | .. |
|---|
| 243 | 229 | //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; |
|---|
| 244 | 230 | NC_VD_COAX_Init_STR *CoaxVal; |
|---|
| 245 | 231 | |
|---|
| 246 | | - unsigned char ch = ps_coax_str->ch%4; |
|---|
| 247 | | - unsigned char devnum = ps_coax_str->ch/4; |
|---|
| 232 | + unsigned char ch = ps_coax_str->ch % 4; |
|---|
| 233 | + unsigned char devnum = ps_coax_str->ch / 4; |
|---|
| 248 | 234 | NC_VIVO_CH_FORMATDEF fmt_def = ps_coax_str->fmt_def; |
|---|
| 249 | 235 | //int fmt = coax_tx->vivo_fmt; |
|---|
| 250 | 236 | unsigned char distance = 0; |
|---|
| 251 | 237 | |
|---|
| 252 | | - if( (fmt_def == AHD20_720P_25P) || (fmt_def == AHD20_720P_30P) ||\ |
|---|
| 238 | + if((fmt_def == AHD20_720P_25P) || (fmt_def == AHD20_720P_30P) ||\ |
|---|
| 253 | 239 | (fmt_def == AHD20_720P_25P_EX) || (fmt_def == AHD20_720P_30P_EX) ||\ |
|---|
| 254 | | - (fmt_def == AHD20_720P_25P_EX_Btype) || (fmt_def == AHD20_720P_30P_EX_Btype)\ |
|---|
| 255 | | - ) |
|---|
| 256 | | - { |
|---|
| 257 | | - printk("[drv_coax]Ch: %d ACP 16bit initialize!!!\n", ch ); |
|---|
| 258 | | - } |
|---|
| 259 | | - else if( (fmt_def == CVI_4M_25P) || (fmt_def == CVI_4M_30P) ) //some fh cams may need this |
|---|
| 240 | + (fmt_def == AHD20_720P_25P_EX_Btype) || (fmt_def == AHD20_720P_30P_EX_Btype)) { |
|---|
| 241 | + printk("[drv_coax]Ch: %d ACP 16bit initialize!!!\n", ch); |
|---|
| 242 | + } else if((fmt_def == CVI_4M_25P) || (fmt_def == CVI_4M_30P)) { //some fh cams may need this |
|---|
| 260 | 243 | // (fmt_def == CVI_8M_15P) || (fmt_def == CVI_8M_12_5P) ) |
|---|
| 261 | | - { |
|---|
| 262 | | - printk("[drv_coax]Ch: %d CVI New Protocol initialize!!!\n", ch ); |
|---|
| 263 | | - } |
|---|
| 264 | | - else |
|---|
| 265 | | - { |
|---|
| 266 | | - printk("[drv_coax]Ch: %d Can not initialize!! Unsupported format!!\n", ch ); |
|---|
| 244 | + printk("[drv_coax]Ch: %d CVI New Protocol initialize!!!\n", ch); |
|---|
| 245 | + } else { |
|---|
| 246 | + printk("[drv_coax]Ch: %d Can not initialize!! Unsupported format!!\n", ch); |
|---|
| 267 | 247 | return -1; |
|---|
| 268 | 248 | } |
|---|
| 269 | 249 | |
|---|
| .. | .. |
|---|
| 272 | 252 | |
|---|
| 273 | 253 | // MPP Coaxial mode select Ch1~4 |
|---|
| 274 | 254 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x01); // BANK 1 |
|---|
| 275 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xA8+ch, 0x08+ch%4); // MPP_TST_SEL1 |
|---|
| 255 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xA8 + ch, 0x08 + ch % 4); // MPP_TST_SEL1 |
|---|
| 276 | 256 | |
|---|
| 277 | 257 | // Coaxial each mode set |
|---|
| 278 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05+ch%4); // BANK 5 |
|---|
| 258 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch % 4); // BANK 5 |
|---|
| 279 | 259 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F, 0x00); // MPP_H_INV, MPP_V_INV, MPP_F_INV |
|---|
| 280 | 260 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30, 0xE0); // MPP_H_S[7~4], MPP_H_E[3:0] |
|---|
| 281 | 261 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x31, 0x43); // MPP_H_S[7:0] |
|---|
| .. | .. |
|---|
| 283 | 263 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7C, CoaxVal->rx_src); |
|---|
| 284 | 264 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7D, CoaxVal->rx_slice_lev); |
|---|
| 285 | 265 | |
|---|
| 286 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); |
|---|
| 266 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); |
|---|
| 287 | 267 | |
|---|
| 288 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00+((ch%2)*0x80), CoaxVal->tx_baud[distance]); |
|---|
| 289 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02+((ch%2)*0x80), CoaxVal->tx_pel_baud[distance]); |
|---|
| 290 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03+((ch%2)*0x80), CoaxVal->tx_line_pos0[distance]); |
|---|
| 291 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04+((ch%2)*0x80), CoaxVal->tx_line_pos1[distance]); |
|---|
| 292 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05+((ch%2)*0x80), CoaxVal->tx_line_count); |
|---|
| 293 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07+((ch%2)*0x80), CoaxVal->tx_pel_line_pos0[distance]); |
|---|
| 294 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08+((ch%2)*0x80), CoaxVal->tx_pel_line_pos1[distance]); |
|---|
| 295 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A+((ch%2)*0x80), CoaxVal->tx_line_count_max); |
|---|
| 296 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B+((ch%2)*0x80), CoaxVal->tx_mode); |
|---|
| 297 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D+((ch%2)*0x80), CoaxVal->tx_sync_pos0[distance]); |
|---|
| 268 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x00 + ((ch%2)*0x80), CoaxVal->tx_baud[distance]); |
|---|
| 269 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x02 + ((ch%2)*0x80), CoaxVal->tx_pel_baud[distance]); |
|---|
| 270 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x03 + ((ch%2)*0x80), CoaxVal->tx_line_pos0[distance]); |
|---|
| 271 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x04 + ((ch%2)*0x80), CoaxVal->tx_line_pos1[distance]); |
|---|
| 272 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x05 + ((ch%2)*0x80), CoaxVal->tx_line_count); |
|---|
| 273 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x07 + ((ch%2)*0x80), CoaxVal->tx_pel_line_pos0[distance]); |
|---|
| 274 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x08 + ((ch%2)*0x80), CoaxVal->tx_pel_line_pos1[distance]); |
|---|
| 275 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A + ((ch%2)*0x80), CoaxVal->tx_line_count_max); |
|---|
| 276 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0B + ((ch%2)*0x80), CoaxVal->tx_mode); |
|---|
| 277 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0D + ((ch%2)*0x80), CoaxVal->tx_sync_pos0[distance]); |
|---|
| 298 | 278 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0E + ((ch%2)*0x80), CoaxVal->tx_sync_pos1[distance]); |
|---|
| 299 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F+((ch%2)*0x80), CoaxVal->tx_even); |
|---|
| 300 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C+((ch%2)*0x80), CoaxVal->tx_zero_length); |
|---|
| 279 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F + ((ch%2)*0x80), CoaxVal->tx_even); |
|---|
| 280 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0C + ((ch%2)*0x80), CoaxVal->tx_zero_length); |
|---|
| 301 | 281 | |
|---|
| 302 | 282 | #if DBG_TX_INIT_PRINT |
|---|
| 303 | 283 | printk("[drv]tx_src: 5x7C>> 0x%02X\n", CoaxVal->rx_src ); |
|---|
| .. | .. |
|---|
| 335 | 315 | //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; |
|---|
| 336 | 316 | int i; |
|---|
| 337 | 317 | int cmd_cnt = 0; |
|---|
| 338 | | - unsigned char ch = ps_coax_str->ch%4; |
|---|
| 339 | | - unsigned char devnum = ps_coax_str->ch/4; |
|---|
| 340 | | - NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; |
|---|
| 341 | | - NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; |
|---|
| 318 | + unsigned char ch = ps_coax_str->ch % 4; |
|---|
| 319 | + unsigned char devnum = ps_coax_str->ch/4; |
|---|
| 320 | + NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; |
|---|
| 321 | + NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; |
|---|
| 342 | 322 | NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt); |
|---|
| 343 | 323 | |
|---|
| 344 | | - unsigned char tx_bank = 0x00; |
|---|
| 345 | | - unsigned char tx_cmd_addr = 0x00; |
|---|
| 346 | | - unsigned char tx_shot_addr = 0x00; |
|---|
| 347 | | - unsigned char command[32] = {0,}; |
|---|
| 324 | + unsigned char tx_bank = 0x00; |
|---|
| 325 | + unsigned char tx_cmd_addr = 0x00; |
|---|
| 326 | + unsigned char tx_shot_addr = 0x00; |
|---|
| 327 | + unsigned char command[32] = {0,}; |
|---|
| 348 | 328 | unsigned char TCP_CMD_Stop_v10[10] = { 0xb5, 0x00, 0x14, 0x00, 0x80, 0x00, 0x00, 0x00, 0xc9, 0x80 }; |
|---|
| 349 | 329 | //unsigned char TCP_CMD_Stop_v20[10] = { 0xb5, 0x01, 0x14, 0x00, 0x80, 0x00, 0x00, 0x00, 0xc5, 0x80 }; |
|---|
| 350 | 330 | |
|---|
| 351 | 331 | // UP Stream get from coax table |
|---|
| 352 | 332 | NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get(vivofmt); // Get from Coax_Tx_Init Table |
|---|
| 353 | | - NC_VD_ACP_CMDDEF_STR *pCMD = __NC_VD_ACP_Get_CommandFormat_Get(cmd); // Get From Coax_Tx_Command Table |
|---|
| 333 | + NC_VD_ACP_CMDDEF_STR *pCMD = __NC_VD_ACP_Get_CommandFormat_Get(cmd); // Get From Coax_Tx_Command Table |
|---|
| 354 | 334 | printk("[drv_coax]Ch: %d Command >>>>> %s >>> autostop = %d\n", ch, pCMD->name, pCMD->autostop); |
|---|
| 355 | 335 | |
|---|
| 356 | | - tx_bank = CoaxVal->tx_bank; |
|---|
| 357 | | - tx_cmd_addr = CoaxVal->tx_cmd_addr; |
|---|
| 336 | + tx_bank = CoaxVal->tx_bank; |
|---|
| 337 | + tx_cmd_addr = CoaxVal->tx_cmd_addr; |
|---|
| 358 | 338 | tx_shot_addr = CoaxVal->tx_shot_addr; |
|---|
| 359 | 339 | |
|---|
| 360 | 340 | // UP Stream command copy in coax command table |
|---|
| .. | .. |
|---|
| 365 | 345 | // printk("[%2x] ", command[i]); |
|---|
| 366 | 346 | //printk("\n "); |
|---|
| 367 | 347 | // fill command + shot |
|---|
| 368 | | - if( format == FMT_SD ) |
|---|
| 369 | | - { |
|---|
| 370 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2) ); |
|---|
| 371 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 372 | | - { |
|---|
| 373 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, 0); |
|---|
| 348 | + if( format == FMT_SD ) { |
|---|
| 349 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + ((ch % 4) / 2) ); |
|---|
| 350 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 351 | + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, 0); |
|---|
| 374 | 352 | } |
|---|
| 375 | 353 | // Shot |
|---|
| 376 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 377 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); |
|---|
| 354 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 355 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); |
|---|
| 378 | 356 | msleep(CoaxVal->shot_delay); |
|---|
| 379 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 357 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); |
|---|
| 380 | 358 | |
|---|
| 381 | 359 | msleep(CoaxVal->reset_delay); |
|---|
| 382 | 360 | |
|---|
| 383 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 384 | | - { |
|---|
| 385 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, command[i]); |
|---|
| 361 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 362 | + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, command[i]); |
|---|
| 386 | 363 | } |
|---|
| 387 | 364 | // Shot |
|---|
| 388 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 389 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); |
|---|
| 365 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 366 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); |
|---|
| 390 | 367 | msleep(CoaxVal->shot_delay); |
|---|
| 391 | 368 | //if(cmd == COAX_CMD_STOP) |
|---|
| 392 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 393 | | - } |
|---|
| 394 | | - else if(format == FMT_CVI) |
|---|
| 395 | | - { |
|---|
| 396 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+(ch%4)); |
|---|
| 397 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 398 | | - { |
|---|
| 399 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr+i, command[i]); |
|---|
| 400 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+i, 0xff); |
|---|
| 369 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); |
|---|
| 370 | + } else if(format == FMT_CVI) { |
|---|
| 371 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + (ch % 4)); |
|---|
| 372 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 373 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr + i, command[i]); |
|---|
| 374 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10 + i, 0xff); |
|---|
| 401 | 375 | } |
|---|
| 402 | 376 | |
|---|
| 403 | 377 | // Shot |
|---|
| 404 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 405 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); |
|---|
| 406 | | - if((cmd == COAX_CMD_STOP) ||(pCMD->autostop==1)) |
|---|
| 407 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 408 | | - } |
|---|
| 409 | | - else if(format == FMT_TVI) |
|---|
| 410 | | - { |
|---|
| 411 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2) ); |
|---|
| 412 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 413 | | - { |
|---|
| 414 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, command[i]); |
|---|
| 378 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 379 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); |
|---|
| 380 | + if((cmd == COAX_CMD_STOP) || (pCMD->autostop == 1)) |
|---|
| 381 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr +((ch % 2) * 0x80), 0x00); |
|---|
| 382 | + } else if(format == FMT_TVI) { |
|---|
| 383 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + ((ch % 4) / 2) ); |
|---|
| 384 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 385 | + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, command[i]); |
|---|
| 415 | 386 | } |
|---|
| 416 | 387 | |
|---|
| 417 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 418 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x08); |
|---|
| 388 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 389 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x08); |
|---|
| 419 | 390 | msleep(30); |
|---|
| 420 | | - if((cmd == COAX_CMD_STOP) ||(pCMD->autostop==1)) |
|---|
| 421 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 391 | + if((cmd == COAX_CMD_STOP) || (pCMD->autostop == 1)) |
|---|
| 392 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); |
|---|
| 422 | 393 | |
|---|
| 423 | | - if(pCMD->autostop == 1) |
|---|
| 424 | | - { |
|---|
| 394 | + if(pCMD->autostop == 1) { |
|---|
| 425 | 395 | if(vivofmt == TVI_4M_15P) |
|---|
| 426 | 396 | msleep(70); |
|---|
| 427 | 397 | else |
|---|
| .. | .. |
|---|
| 441 | 411 | else |
|---|
| 442 | 412 | #endif |
|---|
| 443 | 413 | { |
|---|
| 444 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2)); |
|---|
| 445 | | - for(i=0;i<10;i++) |
|---|
| 446 | | - { |
|---|
| 447 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr+((ch%2)*0x80)+i, TCP_CMD_Stop_v10[i]); |
|---|
| 414 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + ((ch % 4) / 2)); |
|---|
| 415 | + for(i=0; i<10; i++) { |
|---|
| 416 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr + |
|---|
| 417 | + ((ch % 2) * 0x80) + i, TCP_CMD_Stop_v10[i]); |
|---|
| 448 | 418 | } |
|---|
| 449 | 419 | } |
|---|
| 450 | 420 | |
|---|
| 451 | 421 | // shot |
|---|
| 452 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x08); |
|---|
| 453 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 422 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x08); |
|---|
| 423 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); |
|---|
| 454 | 424 | } |
|---|
| 455 | | - } |
|---|
| 456 | | - else |
|---|
| 457 | | - { |
|---|
| 458 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch%4)/2) ); |
|---|
| 459 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 460 | | - { |
|---|
| 461 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr+((ch%2)*0x80))+i, command[i]); |
|---|
| 425 | + } else { |
|---|
| 426 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+((ch % 4) / 2) ); |
|---|
| 427 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 428 | + gpio_i2c_write(nvp6158_iic_addr[devnum], (tx_cmd_addr + ((ch % 2) * 0x80)) + i, command[i]); |
|---|
| 462 | 429 | } |
|---|
| 463 | 430 | |
|---|
| 464 | 431 | // Shot |
|---|
| 465 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 466 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); |
|---|
| 467 | | - if((cmd == COAX_CMD_STOP) ||(pCMD->autostop==1)) |
|---|
| 468 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 432 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 433 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch%2) * 0x80), 0x01); |
|---|
| 434 | + if((cmd == COAX_CMD_STOP) || (pCMD->autostop == 1)) |
|---|
| 435 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); |
|---|
| 469 | 436 | } |
|---|
| 470 | 437 | |
|---|
| 471 | | - if(cmd == COAX_CMD_STOP) //stop command sends twice in case of AF camera losses response... |
|---|
| 472 | | - { |
|---|
| 438 | + if(cmd == COAX_CMD_STOP) {//stop command sends twice in case of AF camera losses response... |
|---|
| 473 | 439 | msleep(35); |
|---|
| 474 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 475 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); |
|---|
| 476 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 440 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 441 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); |
|---|
| 442 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); |
|---|
| 477 | 443 | } |
|---|
| 478 | 444 | } |
|---|
| 479 | 445 | |
|---|
| .. | .. |
|---|
| 492 | 458 | //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; |
|---|
| 493 | 459 | int i; |
|---|
| 494 | 460 | int cmd_cnt = 0; |
|---|
| 495 | | - unsigned char ch = ps_coax_str->ch%4; |
|---|
| 496 | | - unsigned char devnum = ps_coax_str->ch/4; |
|---|
| 497 | | - NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; |
|---|
| 498 | | - NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; |
|---|
| 461 | + unsigned char ch = ps_coax_str->ch % 4; |
|---|
| 462 | + unsigned char devnum = ps_coax_str->ch / 4; |
|---|
| 463 | + NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; |
|---|
| 464 | + NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; |
|---|
| 499 | 465 | NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt); |
|---|
| 500 | 466 | |
|---|
| 501 | | - unsigned char tx_bank = 0x00; |
|---|
| 502 | | - unsigned char tx_cmd_addr = 0x00; |
|---|
| 503 | | - unsigned char tx_shot_addr = 0x00; |
|---|
| 504 | | - unsigned char command[32] ={0,}; |
|---|
| 467 | + unsigned char tx_bank = 0x00; |
|---|
| 468 | + unsigned char tx_cmd_addr = 0x00; |
|---|
| 469 | + unsigned char tx_shot_addr = 0x00; |
|---|
| 470 | + unsigned char command[32] ={0,}; |
|---|
| 505 | 471 | |
|---|
| 506 | 472 | // UP Stream get from coax table |
|---|
| 507 | 473 | NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get(vivofmt); // Get from Coax_Tx_Init Table |
|---|
| .. | .. |
|---|
| 516 | 482 | cmd_cnt = __NC_VD_COAX_16bit_Command_Copy( format, vivofmt, command, pCMD ); |
|---|
| 517 | 483 | |
|---|
| 518 | 484 | // Adjust Bank |
|---|
| 519 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 485 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 520 | 486 | |
|---|
| 521 | 487 | // fill Reset |
|---|
| 522 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 523 | | - { |
|---|
| 524 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20+((ch%2)*0x80)+i, 0); |
|---|
| 488 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 489 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20 + ((ch % 2) * 0x80) + i, 0); |
|---|
| 525 | 490 | } |
|---|
| 526 | 491 | |
|---|
| 527 | 492 | // Command Shot |
|---|
| 528 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 529 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x01); |
|---|
| 493 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 494 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x01); |
|---|
| 530 | 495 | msleep(30); |
|---|
| 531 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x00); |
|---|
| 532 | | - |
|---|
| 496 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x00); |
|---|
| 533 | 497 | |
|---|
| 534 | 498 | // fill command |
|---|
| 535 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 536 | | - { |
|---|
| 537 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20+((ch%2)*0x80)+i, command[i]); |
|---|
| 499 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 500 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x20 + ((ch % 2) * 0x80) + i, command[i]); |
|---|
| 538 | 501 | } |
|---|
| 539 | 502 | |
|---|
| 540 | | - // Command Shot |
|---|
| 541 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 542 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x01); |
|---|
| 503 | + // Command Shot |
|---|
| 504 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 505 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x01); |
|---|
| 543 | 506 | msleep(30); |
|---|
| 544 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c+((ch%2)*0x80), 0x00); |
|---|
| 507 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0c + ((ch % 2) * 0x80), 0x00); |
|---|
| 545 | 508 | |
|---|
| 546 | 509 | } |
|---|
| 547 | 510 | |
|---|
| .. | .. |
|---|
| 550 | 513 | //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param; |
|---|
| 551 | 514 | int i; |
|---|
| 552 | 515 | int cmd_cnt = 0; |
|---|
| 553 | | - unsigned char ch = ps_coax_str->ch%4; |
|---|
| 554 | | - unsigned char devnum = ps_coax_str->ch/4; |
|---|
| 555 | | - NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; |
|---|
| 556 | | - NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; |
|---|
| 516 | + unsigned char ch = ps_coax_str->ch % 4; |
|---|
| 517 | + unsigned char devnum = ps_coax_str->ch / 4; |
|---|
| 518 | + NC_COAX_CMD_DEF cmd = ps_coax_str->cmd; |
|---|
| 519 | + NC_VIVO_CH_FORMATDEF vivofmt = ps_coax_str->fmt_def; |
|---|
| 557 | 520 | NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt); |
|---|
| 558 | 521 | |
|---|
| 559 | 522 | unsigned char tx_bank = 0x00; |
|---|
| .. | .. |
|---|
| 573 | 536 | // UP Stream command copy in coax command table |
|---|
| 574 | 537 | cmd_cnt = __NC_VD_COAX_16bit_Command_Copy( format, vivofmt, command, pCMD ); |
|---|
| 575 | 538 | |
|---|
| 576 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank+(ch%4)); |
|---|
| 577 | | - for(i=0;i<cmd_cnt;i++) |
|---|
| 578 | | - { |
|---|
| 579 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr+i, command[i]); |
|---|
| 539 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, tx_bank + (ch % 4)); |
|---|
| 540 | + for(i=0; i<cmd_cnt; i++) { |
|---|
| 541 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_cmd_addr + i, command[i]); |
|---|
| 580 | 542 | } |
|---|
| 581 | 543 | |
|---|
| 582 | 544 | // Shot |
|---|
| 583 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 584 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x01); |
|---|
| 585 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr+((ch%2)*0x80), 0x00); |
|---|
| 545 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2) ); |
|---|
| 546 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x01); |
|---|
| 547 | + gpio_i2c_write(nvp6158_iic_addr[devnum], tx_shot_addr + ((ch % 2) * 0x80), 0x00); |
|---|
| 586 | 548 | } |
|---|
| 587 | 549 | |
|---|
| 588 | 550 | /*======================================================================================================= |
|---|
| .. | .. |
|---|
| 617 | 579 | void nvp6158_coax_rx_init( nvp6158_coax_str *ps_coax_str ) |
|---|
| 618 | 580 | { |
|---|
| 619 | 581 | //NC_VD_COAX_STR *coax_rx = (NC_VD_COAX_STR*)p_param; |
|---|
| 620 | | - unsigned char ch = ps_coax_str->ch%4; |
|---|
| 621 | | - unsigned char devnum = ps_coax_str->ch/4; |
|---|
| 582 | + unsigned char ch = ps_coax_str->ch % 4; |
|---|
| 583 | + unsigned char devnum = ps_coax_str->ch / 4; |
|---|
| 622 | 584 | //NC_VIVO_CH_FORMATDEF vivofmt = coax_rx->vivo_fmt; |
|---|
| 623 | 585 | |
|---|
| 624 | 586 | NC_VD_COAX_Init_STR *coax_rx_val = __NC_VD_COAX_InitFormat_Get(ps_coax_str->fmt_def); |
|---|
| 625 | 587 | |
|---|
| 626 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); |
|---|
| 588 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); |
|---|
| 627 | 589 | |
|---|
| 628 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x63+((ch%2)*0x80), coax_rx_val->rx_comm_on); |
|---|
| 629 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x62+((ch%2)*0x80), coax_rx_val->rx_area); |
|---|
| 630 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x66+((ch%2)*0x80), coax_rx_val->rx_signal_enhance); |
|---|
| 631 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x69+((ch%2)*0x80), coax_rx_val->rx_manual_duty); |
|---|
| 632 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x60+((ch%2)*0x80), coax_rx_val->rx_head_matching); |
|---|
| 633 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), coax_rx_val->rx_data_rz); |
|---|
| 634 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), coax_rx_val->rx_sz); |
|---|
| 590 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x63 + ((ch%2)*0x80), coax_rx_val->rx_comm_on); |
|---|
| 591 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x62 + ((ch%2)*0x80), coax_rx_val->rx_area); |
|---|
| 592 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x66 + ((ch%2)*0x80), coax_rx_val->rx_signal_enhance); |
|---|
| 593 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x69 + ((ch%2)*0x80), coax_rx_val->rx_manual_duty); |
|---|
| 594 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x60 + ((ch%2)*0x80), coax_rx_val->rx_head_matching); |
|---|
| 595 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61 + ((ch%2)*0x80), coax_rx_val->rx_data_rz); |
|---|
| 596 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68 + ((ch%2)*0x80), coax_rx_val->rx_sz); |
|---|
| 635 | 597 | #if DBG_RX_INIT_PRINT |
|---|
| 636 | 598 | printk("[drv]Channel %d Format >>>>> %s\n", ch, coax_rx_val->name ); |
|---|
| 637 | 599 | printk("[drv]rx_head_matching: 0x60 >> 0x%02X\n", coax_rx_val->rx_head_matching); |
|---|
| .. | .. |
|---|
| 660 | 622 | //NC_VD_COAX_STR *coax_rx = (NC_VD_COAX_STR*)p_param; |
|---|
| 661 | 623 | |
|---|
| 662 | 624 | int ii = 0; |
|---|
| 663 | | - unsigned char ch = coax_rx->ch%4; |
|---|
| 664 | | - unsigned char devnum = coax_rx->ch/4; |
|---|
| 625 | + unsigned char ch = coax_rx->ch % 4; |
|---|
| 626 | + unsigned char devnum = coax_rx->ch / 4; |
|---|
| 665 | 627 | NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(coax_rx->fmt_def); |
|---|
| 666 | 628 | |
|---|
| 667 | | - gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); |
|---|
| 629 | + gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03 + ((ch % 4) / 2)); |
|---|
| 668 | 630 | |
|---|
| 669 | | - if( (format == FMT_CVI) || (format == FMT_TVI) ) |
|---|
| 670 | | - { |
|---|
| 671 | | - for(ii=0;ii<5;ii++) |
|---|
| 672 | | - { |
|---|
| 631 | + if( (format == FMT_CVI) || (format == FMT_TVI) ) { |
|---|
| 632 | + for(ii=0; ii<5; ii++) { |
|---|
| 673 | 633 | coax_rx->rx_data1[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x40+((ch%2)*0x80))+ii); // ChX_Rx_Line_1 : 0x40 ~ 0x44 5byte |
|---|
| 674 | 634 | coax_rx->rx_data2[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x45+((ch%2)*0x80))+ii); // ChX_Rx_Line_2 : 0x45 ~ 0x49 5byte |
|---|
| 675 | 635 | 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 | 637 | coax_rx->rx_data5[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x71+((ch%2)*0x80))+ii); // ChX_Rx_Line_5 : 0x71 ~ 0x75 5byte |
|---|
| 678 | 638 | coax_rx->rx_data6[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x76+((ch%2)*0x80))+ii); // ChX_Rx_Line_6 : 0x76 ~ 0x7A 5byte |
|---|
| 679 | 639 | } |
|---|
| 680 | | - } |
|---|
| 681 | | - else // AHD |
|---|
| 682 | | - { |
|---|
| 683 | | - for(ii=0;ii<8;ii++) |
|---|
| 684 | | - { |
|---|
| 640 | + } else {// AHD |
|---|
| 641 | + for(ii=0; ii<8; ii++) { |
|---|
| 685 | 642 | 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 |
|---|
| 686 | 643 | } |
|---|
| 687 | 644 | } |
|---|
| .. | .. |
|---|
| 775 | 732 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x60+((ch%2)*0x80), 0x55 ); // Header Matching |
|---|
| 776 | 733 | |
|---|
| 777 | 734 | /* If the header is (0x50=>0x55) and chip information is (0x51=>0x3X, 0x4X, 0x5X ), it can update firmware */ |
|---|
| 778 | | - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x50+((ch%2)*0x80) ) == 0x55 ) |
|---|
| 779 | | - { |
|---|
| 780 | | - 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) ) ); |
|---|
| 735 | + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x50+((ch%2)*0x80) ) == 0x55 ) { |
|---|
| 736 | + printk(">>>>> DRV[%s:%d] CH:%d, this camera can update, please, wait! = 0x%x\n", |
|---|
| 737 | + __func__, __LINE__, ch, gpio_i2c_read( nvp6158_iic_addr[ch/4], 0x51+((ch%2)*0x80))); |
|---|
| 781 | 738 | ret = FW_SUCCESS; |
|---|
| 782 | | - } |
|---|
| 783 | | - else |
|---|
| 784 | | - { |
|---|
| 739 | + } else { |
|---|
| 785 | 740 | readval= gpio_i2c_read( nvp6158_iic_addr[devnum], 0x50+((ch%2)*0x80) ); |
|---|
| 786 | 741 | printk(">>>>> DRV[%s:%d] check ACP_STATUS_MODE::0x%x\n", __func__, __LINE__, readval ); |
|---|
| 787 | 742 | ret = FW_FAILURE; |
|---|
| .. | .. |
|---|
| 819 | 774 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A+((ch%2)*0x80), 0x04); // Tx Line count max |
|---|
| 820 | 775 | |
|---|
| 821 | 776 | /* change video mode FHD@25P Command Send */ |
|---|
| 822 | | - if( (cp_mode == FMT_AHD20) || (cp_mode == FMT_AHD30) ) |
|---|
| 823 | | - { |
|---|
| 777 | + if( (cp_mode == FMT_AHD20) || (cp_mode == FMT_AHD30)) { |
|---|
| 824 | 778 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x60); // Register Write Control - 17th line |
|---|
| 825 | 779 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11+((ch%2)*0x80), 0xB0); // table(Mode Change Command) - 18th line |
|---|
| 826 | 780 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x12+((ch%2)*0x80), 0x02); // Flash Update Mode(big data) - 19th line |
|---|
| .. | .. |
|---|
| 830 | 784 | msleep(400); |
|---|
| 831 | 785 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // reset |
|---|
| 832 | 786 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x00); // trigger Off |
|---|
| 833 | | - printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", __func__, __LINE__, ch ); |
|---|
| 787 | + printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", |
|---|
| 788 | + __func__, __LINE__, ch ); |
|---|
| 834 | 789 | ret = FW_SUCCESS; |
|---|
| 835 | | - } |
|---|
| 836 | | - else if( (cp_mode == FMT_CVI) || (cp_mode == FMT_TVI) ) |
|---|
| 837 | | - { |
|---|
| 790 | + } else if((cp_mode == FMT_CVI) || (cp_mode == FMT_TVI)) { |
|---|
| 838 | 791 | /* change video mode FHD@25P Command Send */ |
|---|
| 839 | 792 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| 840 | 793 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x55); // 0x55(header) - 16th line |
|---|
| .. | .. |
|---|
| 847 | 800 | msleep(1000); |
|---|
| 848 | 801 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // reset |
|---|
| 849 | 802 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x00); // trigger Off |
|---|
| 850 | | - printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", __func__, __LINE__, ch ); |
|---|
| 803 | + printk(">>>>> DRV[%s:%d] CH:%d, nvp6158_coax_fw_ready_cmd_to_isp_send!!- AHD\n", |
|---|
| 804 | + __func__, __LINE__, ch ); |
|---|
| 851 | 805 | ret = FW_SUCCESS; |
|---|
| 852 | | - } |
|---|
| 853 | | - else |
|---|
| 854 | | - { |
|---|
| 806 | + } else { |
|---|
| 855 | 807 | printk(">>>> DRV[%s:%d] CH:%d, FMT:%d > Unknown Format!!! \n", __func__, __LINE__, ch, cp_mode ); |
|---|
| 856 | 808 | ret = FW_FAILURE; |
|---|
| 857 | 809 | } |
|---|
| .. | .. |
|---|
| 892 | 844 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz |
|---|
| 893 | 845 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ |
|---|
| 894 | 846 | |
|---|
| 895 | | - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) |
|---|
| 896 | | - { |
|---|
| 847 | + if(gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02) { |
|---|
| 897 | 848 | /* get status, If the status is 0x00(Camera information), 0x01(Firmware version */ |
|---|
| 898 | | - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00 ) |
|---|
| 899 | | - { |
|---|
| 849 | + if(gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00) { |
|---|
| 900 | 850 | printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [READY]\n", __func__, __LINE__, ch ); |
|---|
| 901 | 851 | ret = FW_SUCCESS; |
|---|
| 902 | 852 | } |
|---|
| 903 | | - } |
|---|
| 904 | | - else |
|---|
| 905 | | - { |
|---|
| 853 | + } else { |
|---|
| 906 | 854 | retval = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ); |
|---|
| 907 | 855 | retval2 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ); |
|---|
| 908 | | - 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 ); |
|---|
| 856 | + printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[READY], [0x56-true[0x00]:0x%x], [0x57-true[0x02]:0x%x]\n", |
|---|
| 857 | + __func__, __LINE__, ch, retval, retval2 ); |
|---|
| 909 | 858 | ret = FW_FAILURE; |
|---|
| 910 | 859 | } |
|---|
| 911 | 860 | |
|---|
| .. | .. |
|---|
| 994 | 943 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz |
|---|
| 995 | 944 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ |
|---|
| 996 | 945 | |
|---|
| 997 | | - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) |
|---|
| 998 | | - { |
|---|
| 999 | | - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00 ) |
|---|
| 1000 | | - { |
|---|
| 946 | + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02) { |
|---|
| 947 | + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x00) { |
|---|
| 1001 | 948 | printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [START]\n", __func__, __LINE__, ch ); |
|---|
| 1002 | 949 | ret = FW_SUCCESS; |
|---|
| 1003 | | - } |
|---|
| 1004 | | - else |
|---|
| 1005 | | - { |
|---|
| 950 | + } else { |
|---|
| 1006 | 951 | unsigned char retval1; |
|---|
| 1007 | 952 | unsigned char retval2; |
|---|
| 1008 | 953 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); |
|---|
| 1009 | 954 | retval1 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ); |
|---|
| 1010 | 955 | retval2 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ); |
|---|
| 1011 | 956 | ret = FW_FAILURE; |
|---|
| 1012 | | - 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 ); |
|---|
| 957 | + printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[START], [0x56-true[0x02]:0x%x], [0x57-true[0x02]:0x%x]\n", |
|---|
| 958 | + __func__, __LINE__, ch, retval1, retval2 ); |
|---|
| 1013 | 959 | } |
|---|
| 1014 | 960 | } |
|---|
| 1015 | 961 | |
|---|
| .. | .. |
|---|
| 1053 | 999 | |
|---|
| 1054 | 1000 | /* fill packet(139bytes), end packet is filled with 0xff */ |
|---|
| 1055 | 1001 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0xff, 0x0c+(ch%4) ); |
|---|
| 1056 | | - for( ii = 0; ii < 139; ii++ ) |
|---|
| 1057 | | - { |
|---|
| 1058 | | - if( byteNumOfPacket < readsize) |
|---|
| 1059 | | - { |
|---|
| 1002 | + for( ii = 0; ii < 139; ii++ ) { |
|---|
| 1003 | + if( byteNumOfPacket < readsize) { |
|---|
| 1060 | 1004 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x00+ii, pstFileInfo->onepacketbuf[ii] ); |
|---|
| 1061 | 1005 | byteNumOfPacket++; |
|---|
| 1062 | | - } |
|---|
| 1063 | | - else if( byteNumOfPacket >= readsize ) // end packet : fill 0xff |
|---|
| 1064 | | - { |
|---|
| 1006 | + } else if( byteNumOfPacket >= readsize ) {// end packet : fill 0xff |
|---|
| 1065 | 1007 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x00+ii, 0xff ); |
|---|
| 1066 | 1008 | byteNumOfPacket++; |
|---|
| 1067 | 1009 | } |
|---|
| .. | .. |
|---|
| 1075 | 1017 | } |
|---|
| 1076 | 1018 | |
|---|
| 1077 | 1019 | /* offset */ |
|---|
| 1078 | | - pstFileInfo->currentFileOffset = (unsigned int)((high << 16 )&(0xFF0000))| (unsigned int)((mid << 8 )&(0xFF00)) | (unsigned char)(low); |
|---|
| 1020 | + pstFileInfo->currentFileOffset = (unsigned int)((high << 16 )&(0xFF0000)) | |
|---|
| 1021 | + (unsigned int)((mid << 8 )&(0xFF00)) | (unsigned char)(low); |
|---|
| 1079 | 1022 | |
|---|
| 1080 | 1023 | /* Tx Change mode to use Big data */ |
|---|
| 1081 | 1024 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) ); |
|---|
| .. | .. |
|---|
| 1123 | 1066 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz |
|---|
| 1124 | 1067 | gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ |
|---|
| 1125 | 1068 | |
|---|
| 1126 | | - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) |
|---|
| 1127 | | - { |
|---|
| 1069 | + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ) == 0x02 ) { |
|---|
| 1128 | 1070 | /* check ISP status - only check first packet */ |
|---|
| 1129 | | - if( pstFileInfo->currentpacketnum == 0 ) |
|---|
| 1130 | | - { |
|---|
| 1131 | | - if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x03 ) |
|---|
| 1132 | | - { |
|---|
| 1071 | + if( pstFileInfo->currentpacketnum == 0 ) { |
|---|
| 1072 | + if( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ) == 0x03 ) { |
|---|
| 1133 | 1073 | pstFileInfo->result = FW_FAILURE; |
|---|
| 1134 | | - printk(">>>>> DRV[%s:%d] CH:%d, Failed, error status, code=3..................\n", __func__, __LINE__, ch ); |
|---|
| 1074 | + printk(">>>>> DRV[%s:%d] CH:%d, Failed, error status, code=3..................\n", |
|---|
| 1075 | + __func__, __LINE__, ch ); |
|---|
| 1135 | 1076 | return; |
|---|
| 1136 | 1077 | } |
|---|
| 1137 | 1078 | } |
|---|
| .. | .. |
|---|
| 1140 | 1081 | receive_addr = (( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x53+((ch%2)*0x80))<<16) + \ |
|---|
| 1141 | 1082 | (gpio_i2c_read( nvp6158_iic_addr[devnum], 0x54+((ch%2)*0x80))<<8) + |
|---|
| 1142 | 1083 | gpio_i2c_read( nvp6158_iic_addr[devnum], 0x55+((ch%2)*0x80))); |
|---|
| 1143 | | - if( onepacketaddr == receive_addr ) |
|---|
| 1144 | | - { |
|---|
| 1084 | + if( onepacketaddr == receive_addr ) { |
|---|
| 1145 | 1085 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // Reset |
|---|
| 1146 | 1086 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x00); // trigger off |
|---|
| 1147 | 1087 | ret = FW_SUCCESS; |
|---|
| .. | .. |
|---|
| 1188 | 1128 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x60); |
|---|
| 1189 | 1129 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x11+((ch%2)*0x80), 0xb0); |
|---|
| 1190 | 1130 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x12+((ch%2)*0x80), 0x02); |
|---|
| 1191 | | - if( send_success == FW_FAILURE ) |
|---|
| 1192 | | - { |
|---|
| 1131 | + if( send_success == FW_FAILURE ) { |
|---|
| 1193 | 1132 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x13+((ch%2)*0x80), 0xE0/*0xC0*/); |
|---|
| 1194 | | - printk(">>>>> DRV[%s:%d] CH:%d, Camera UPDATE error signal. send Abnormal ending!\n", __func__, __LINE__, ch ); |
|---|
| 1195 | | - } |
|---|
| 1196 | | - else |
|---|
| 1197 | | - { |
|---|
| 1133 | + printk(">>>>> DRV[%s:%d] CH:%d, Camera UPDATE error signal. send Abnormal ending!\n", |
|---|
| 1134 | + __func__, __LINE__, ch ); |
|---|
| 1135 | + } else { |
|---|
| 1198 | 1136 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0x13+((ch%2)*0x80), 0x80/*0x60*/); |
|---|
| 1199 | | - printk(">>>>> DVR[%s:%d] CH:%d, Camera UPDATE ending signal. wait please!\n", __func__, __LINE__, ch ); |
|---|
| 1137 | + printk(">>>>> DVR[%s:%d] CH:%d, Camera UPDATE ending signal. wait please!\n", |
|---|
| 1138 | + __func__, __LINE__, ch ); |
|---|
| 1200 | 1139 | } |
|---|
| 1201 | 1140 | |
|---|
| 1202 | 1141 | /* Shot */ |
|---|
| .. | .. |
|---|
| 1235 | 1174 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x05+(ch%4)); |
|---|
| 1236 | 1175 | videofm = gpio_i2c_read( nvp6158_iic_addr[devnum], 0xF0); |
|---|
| 1237 | 1176 | |
|---|
| 1238 | | - if( videofm == 0xFF ) |
|---|
| 1239 | | - { |
|---|
| 1177 | + if( videofm == 0xFF ) { |
|---|
| 1240 | 1178 | printk(">>>>> DRV[%s:%d] Final[CH:%d], No video[END]!\n", __func__, __LINE__, ch ); |
|---|
| 1241 | 1179 | pstFileInfo->result = FW_FAILURE; |
|---|
| 1242 | 1180 | return; |
|---|
| .. | .. |
|---|
| 1256 | 1194 | gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2)); |
|---|
| 1257 | 1195 | ack_return = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) ); |
|---|
| 1258 | 1196 | isp_status = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) ); |
|---|
| 1259 | | - if( isp_status == 0x02 && ack_return == 0x05 ) |
|---|
| 1260 | | - { |
|---|
| 1197 | + if( isp_status == 0x02 && ack_return == 0x05 ) { |
|---|
| 1261 | 1198 | printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [END]\n", __func__, __LINE__, ch ); |
|---|
| 1262 | 1199 | pstFileInfo->result = FW_SUCCESS; |
|---|
| 1263 | 1200 | return; |
|---|
| 1264 | | - } |
|---|
| 1265 | | - else |
|---|
| 1266 | | - { |
|---|
| 1267 | | - 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 ); |
|---|
| 1201 | + } else { |
|---|
| 1202 | + printk(">>>>> DRV[%s:%d]CH:%d retry : Receive ISP status[END], [0x56-true[0x05]:0x%x], [0x57-true[0x02]:0x%x]\n", |
|---|
| 1203 | + __func__, __LINE__, ch, ack_return, isp_status ); |
|---|
| 1268 | 1204 | pstFileInfo->result = FW_FAILURE; |
|---|
| 1269 | 1205 | return; |
|---|
| 1270 | 1206 | } |
|---|
| .. | .. |
|---|
| 1303 | 1239 | // Adjust Tx |
|---|
| 1304 | 1240 | if( fmtdef == AHD30_3M_30P || fmtdef == AHD30_3M_25P || fmtdef == AHD30_3M_18P || |
|---|
| 1305 | 1241 | fmtdef == AHD30_4M_30P || fmtdef == AHD30_4M_25P || fmtdef == AHD30_4M_15P || |
|---|
| 1306 | | - fmtdef == AHD30_5M_12_5P || fmtdef == AHD30_5M_20P |
|---|
| 1307 | | - ) |
|---|
| 1308 | | - { // 3M Upper Format |
|---|
| 1242 | + fmtdef == AHD30_5M_12_5P || fmtdef == AHD30_5M_20P) { // 3M Upper Format |
|---|
| 1309 | 1243 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x05+((ch%2)*0x80), 0x07); // Tx line set |
|---|
| 1310 | 1244 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x0A+((ch%2)*0x80), 0x08); // Tx max line set |
|---|
| 1311 | | - } |
|---|
| 1312 | | - else // 3M Under Format |
|---|
| 1313 | | - { |
|---|
| 1245 | + } else {// 3M Under Format |
|---|
| 1314 | 1246 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x05+((ch%2)*0x80), 0x03); // Tx line set |
|---|
| 1315 | 1247 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x0A+((ch%2)*0x80), 0x04); // Tx max line set |
|---|
| 1316 | 1248 | } |
|---|
| 1317 | 1249 | |
|---|
| 1318 | | - if( param == 0 ) // RT Mode |
|---|
| 1319 | | - { |
|---|
| 1250 | + if( param == 0 ) {// RT Mode |
|---|
| 1320 | 1251 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write |
|---|
| 1321 | 1252 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command |
|---|
| 1322 | 1253 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x00); // RT Mode |
|---|
| .. | .. |
|---|
| 1325 | 1256 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); |
|---|
| 1326 | 1257 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); |
|---|
| 1327 | 1258 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); |
|---|
| 1328 | | - } |
|---|
| 1329 | | - else if( param == 1 )// NRT Mode |
|---|
| 1330 | | - { |
|---|
| 1259 | + } else if( param == 1 ) {// NRT Mode |
|---|
| 1331 | 1260 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write |
|---|
| 1332 | 1261 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command |
|---|
| 1333 | 1262 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x01); // NRT Mode |
|---|
| .. | .. |
|---|
| 1336 | 1265 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); |
|---|
| 1337 | 1266 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); |
|---|
| 1338 | 1267 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); |
|---|
| 1339 | | - } |
|---|
| 1340 | | - else if( param == 2 )// AHD 5M 20P |
|---|
| 1341 | | - { |
|---|
| 1268 | + } else if( param == 2 ) {// AHD 5M 20P |
|---|
| 1342 | 1269 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write |
|---|
| 1343 | 1270 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command |
|---|
| 1344 | 1271 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format |
|---|
| .. | .. |
|---|
| 1347 | 1274 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); |
|---|
| 1348 | 1275 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); |
|---|
| 1349 | 1276 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); |
|---|
| 1350 | | - } |
|---|
| 1351 | | - else if( param == 3 )// AHD 5M 12.5P |
|---|
| 1352 | | - { |
|---|
| 1277 | + } else if( param == 3 ) {// AHD 5M 12.5P |
|---|
| 1353 | 1278 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write |
|---|
| 1354 | 1279 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command |
|---|
| 1355 | 1280 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format |
|---|
| .. | .. |
|---|
| 1358 | 1283 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); |
|---|
| 1359 | 1284 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); |
|---|
| 1360 | 1285 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); |
|---|
| 1361 | | - } |
|---|
| 1362 | | - else if( param == 4 )// AHD 4M 30P |
|---|
| 1363 | | - { |
|---|
| 1286 | + } else if( param == 4 ) {// AHD 4M 30P |
|---|
| 1364 | 1287 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write |
|---|
| 1365 | 1288 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command |
|---|
| 1366 | 1289 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format |
|---|
| .. | .. |
|---|
| 1369 | 1292 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); |
|---|
| 1370 | 1293 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); |
|---|
| 1371 | 1294 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); |
|---|
| 1372 | | - } |
|---|
| 1373 | | - else if( param == 5 )// AHD 4M 25P |
|---|
| 1374 | | - { |
|---|
| 1295 | + } else if( param == 5 ) {// AHD 4M 25P |
|---|
| 1375 | 1296 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write |
|---|
| 1376 | 1297 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command |
|---|
| 1377 | 1298 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format |
|---|
| .. | .. |
|---|
| 1380 | 1301 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00); |
|---|
| 1381 | 1302 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00); |
|---|
| 1382 | 1303 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x17+((ch%2)*0x80), 0x00); |
|---|
| 1383 | | - } |
|---|
| 1384 | | - else if( param == 6 )// AHD 4M 15P |
|---|
| 1385 | | - { |
|---|
| 1304 | + } else if( param == 6 ) {// AHD 4M 15P |
|---|
| 1386 | 1305 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write |
|---|
| 1387 | 1306 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command |
|---|
| 1388 | 1307 | gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format |
|---|
| .. | .. |
|---|
| 1459 | 1378 | void nvp6158_coax_test_data_set(NC_VD_COAX_TEST_STR *coax_data) |
|---|
| 1460 | 1379 | { |
|---|
| 1461 | 1380 | unsigned char temp_reg; |
|---|
| 1462 | | - printk("[DRV_Set]bank(0x%02X)/addr(0x%02X)/param(0x%02X)\n", coax_data->bank, coax_data->data_addr, coax_data->param ); |
|---|
| 1381 | + printk("[DRV_Set]bank(0x%02X)/addr(0x%02X)/param(0x%02X)\n", |
|---|
| 1382 | + coax_data->bank, coax_data->data_addr, coax_data->param ); |
|---|
| 1463 | 1383 | |
|---|
| 1464 | 1384 | gpio_i2c_write(nvp6158_iic_addr[coax_data->chip_num], 0xFF, coax_data->bank); |
|---|
| 1465 | 1385 | |
|---|
| 1466 | | - if(coax_data->bank == 0x01 && coax_data->data_addr == 0xED) |
|---|
| 1467 | | - { |
|---|
| 1386 | + if(coax_data->bank == 0x01 && coax_data->data_addr == 0xED) { |
|---|
| 1468 | 1387 | temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); |
|---|
| 1469 | 1388 | temp_reg = ((temp_reg & ~(0x01 << coax_data->param)) | (0x01 << coax_data->param)); |
|---|
| 1470 | | - } |
|---|
| 1471 | | - else if(coax_data->bank == 0x01 && coax_data->data_addr == 0x7A) |
|---|
| 1472 | | - { |
|---|
| 1389 | + } else if(coax_data->bank == 0x01 && coax_data->data_addr == 0x7A) { |
|---|
| 1473 | 1390 | temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); |
|---|
| 1474 | 1391 | temp_reg = (temp_reg & ~(0x01 << coax_data->param)); |
|---|
| 1475 | | - } |
|---|
| 1476 | | - else if(coax_data->bank == 0x09 && coax_data->data_addr == 0x44) |
|---|
| 1477 | | - { |
|---|
| 1392 | + } else if(coax_data->bank == 0x09 && coax_data->data_addr == 0x44) { |
|---|
| 1478 | 1393 | temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); |
|---|
| 1479 | 1394 | temp_reg = ((temp_reg & ~(0x01 << coax_data->param)) | (0x01 << coax_data->param)); |
|---|
| 1480 | 1395 | } |
|---|
| .. | .. |
|---|
| 1498 | 1413 | { |
|---|
| 1499 | 1414 | gpio_i2c_write(nvp6158_iic_addr[coax_data->chip_num], 0xFF, coax_data->bank); |
|---|
| 1500 | 1415 | coax_data->param = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr); |
|---|
| 1501 | | - printk("[DRV_Get]bank(0x%02X), addr(0x%02X), param(0x%02X)\n", coax_data->bank, coax_data->data_addr, coax_data->param ); |
|---|
| 1416 | + printk("[DRV_Get]bank(0x%02X), addr(0x%02X), param(0x%02X)\n", |
|---|
| 1417 | + coax_data->bank, coax_data->data_addr, coax_data->param ); |
|---|
| 1502 | 1418 | } |
|---|
| 1503 | 1419 | |
|---|
| 1504 | 1420 | /************************************************************************************** |
|---|
| .. | .. |
|---|
| 1517 | 1433 | |
|---|
| 1518 | 1434 | gpio_i2c_write(nvp6158_iic_addr[coax_data->vd_dev], 0xFF, coax_data->bank); |
|---|
| 1519 | 1435 | |
|---|
| 1520 | | - for(ii=0; ii<256; ii++) |
|---|
| 1521 | | - { |
|---|
| 1436 | + for(ii=0; ii<256; ii++) { |
|---|
| 1522 | 1437 | coax_data->rx_pelco_data[ii] = gpio_i2c_read(nvp6158_iic_addr[coax_data->vd_dev], 0x00+ii); |
|---|
| 1523 | 1438 | } |
|---|
| 1524 | 1439 | } |
|---|
| .. | .. |
|---|
| 1557 | 1472 | gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x10+3+(ch%2)*0x80, 0x00); |
|---|
| 1558 | 1473 | gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x09+(ch%2)*0x80, 0x08); |
|---|
| 1559 | 1474 | msleep(100); |
|---|
| 1560 | | - for(i=0;i<8;i++) |
|---|
| 1561 | | - { |
|---|
| 1475 | + for(i=0; i<8; i++) { |
|---|
| 1562 | 1476 | data_3x50[i] = gpio_i2c_read(nvp6158_iic_addr[ch/4],0x50+i+((ch%2)*0x80)); |
|---|
| 1563 | 1477 | printk("acp_isp_read ch = %d, reg_addr = %x, reg_data = %x\n", ch,reg_addr, data_3x50[i]); |
|---|
| 1564 | 1478 | } |
|---|
| .. | .. |
|---|
| 1600 | 1514 | gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x10+3+(ch%2)*0x80, reg_data); |
|---|
| 1601 | 1515 | gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x09+(ch%2)*0x80, 0x08); |
|---|
| 1602 | 1516 | msleep(100); |
|---|
| 1603 | | - for(i=0;i<8;i++) |
|---|
| 1604 | | - { |
|---|
| 1517 | + for(i=0; i<8; i++) { |
|---|
| 1605 | 1518 | data_3x50[i] = gpio_i2c_read(nvp6158_iic_addr[ch/4],0x50+i+((ch%2)*0x80)); |
|---|
| 1606 | 1519 | printk("acp_isp_write ch = %d, reg_addr = %x, reg_data = %x\n", ch,reg_addr, data_3x50[i]); |
|---|
| 1607 | 1520 | } |
|---|