.. | .. |
---|
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 | } |
---|