hc
2024-05-13 9d77db3c730780c8ef5ccd4b66403ff5675cfe4e
kernel/drivers/media/i2c/nvp6158_drv/nvp6158_coax_protocol.c
....@@ -56,42 +56,38 @@
5656 *
5757 * ioctl : IOC_VDEC_COAX_TX_INIT
5858 ***************************************************************************************/
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)
6060 {
6161 NC_VD_ACP_CMDDEF_STR *pRet = &nvp6158_coax_cmd_lists[def];
62
- if( pRet == NULL )
63
- {
62
+ if( pRet == NULL ) {
6463 printk("Not Supported format Yet!!!(%d)\n",def);
6564 }
6665 return pRet;
6766 }
6867
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)
7069 {
7170 NC_VD_COAX_Init_STR *pRet = &nvp6158_coax_init_lists[def];
72
- if( pRet == NULL )
73
- {
71
+ if( pRet == NULL ) {
7472 printk("Not Supported format Yet!!!(%d)\n",def);
7573 }
7674 return pRet;
7775 }
7876
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)
8078 {
8179 NC_VD_COAX_Init_STR *pRet = &nvp6158_coax_acp_16bit_init_lists[def];
82
- if( pRet == NULL )
83
- {
80
+ if( pRet == NULL ) {
8481 printk("Not Supported format Yet!!!(%d)\n",def);
8582 }
8683 return pRet;
8784 }
8885
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)
9087 {
9188 int items = 0;
9289
93
- while( Src[items] != EOD )
94
- {
90
+ while( Src[items] != EOD ) {
9591 Dst[items] = Src[items];
9692 items++;
9793 }
....@@ -99,62 +95,52 @@
9995 return items;
10096 }
10197
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)
103100 {
104101 int cmd_cnt = 0;
105102
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 );
116111 //else if( vivofmt == AHD30_4M_30P || vivofmt == AHD30_4M_25P || vivofmt == AHD30_4M_15P )
117112 //cmd_cnt = __NC_VD_COAX_Command_Each_Copy( Dst, pCMD->ahd_4_5m );
118113 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);
130121 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 {
134124 printk("NC_VD_COAX_Tx_Command_Send::Command Copy Error!!\n");
135
-
125
+ }
136126
137127 return cmd_cnt;
138128 }
139129
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)
141132 {
142133 int cmd_cnt = 0;
143134
144
- if( (vivofmt == AHD20_720P_25P) || (vivofmt == AHD20_720P_30P) ||\
135
+ if((vivofmt == AHD20_720P_25P) || (vivofmt == AHD20_720P_30P) ||\
145136 (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)) {
148138 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");
158144 return 0;
159145 }
160146
....@@ -171,10 +157,10 @@
171157 *
172158 * ioctl : IOC_VDEC_COAX_TX_INIT
173159 ***************************************************************************************/
174
-void nvp6158_coax_tx_init( nvp6158_coax_str *ps_coax_str )
160
+void nvp6158_coax_tx_init(nvp6158_coax_str *ps_coax_str)
175161 {
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;
178164 unsigned char distance = 0;
179165 NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get( ps_coax_str->fmt_def);
180166 printk("[drv_coax]Ch: %d Format >>>>> %s\n", ch, CoaxVal->name );
....@@ -184,7 +170,7 @@
184170 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xA8+ch, 0x08+ch); // MPP_TST_SEL1
185171
186172 // 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
188174 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F, 0x00); // MPP_H_INV, MPP_V_INV, MPP_F_INV
189175 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30, 0xE0); // MPP_H_S[7~4], MPP_H_E[3:0]
190176 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x31, 0x43); // MPP_H_S[7:0]
....@@ -192,21 +178,21 @@
192178 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7C, CoaxVal->rx_src);
193179 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7D, CoaxVal->rx_slice_lev);
194180
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));
196182
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);
210196
211197 #if DBG_TX_INIT_PRINT
212198 printk("[drv]tx_src: 5x7C>> 0x%02X\n", CoaxVal->rx_src );
....@@ -243,27 +229,21 @@
243229 //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param;
244230 NC_VD_COAX_Init_STR *CoaxVal;
245231
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;
248234 NC_VIVO_CH_FORMATDEF fmt_def = ps_coax_str->fmt_def;
249235 //int fmt = coax_tx->vivo_fmt;
250236 unsigned char distance = 0;
251237
252
- if( (fmt_def == AHD20_720P_25P) || (fmt_def == AHD20_720P_30P) ||\
238
+ if((fmt_def == AHD20_720P_25P) || (fmt_def == AHD20_720P_30P) ||\
253239 (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
260243 // (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);
267247 return -1;
268248 }
269249
....@@ -272,10 +252,10 @@
272252
273253 // MPP Coaxial mode select Ch1~4
274254 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
276256
277257 // 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
279259 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2F, 0x00); // MPP_H_INV, MPP_V_INV, MPP_F_INV
280260 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x30, 0xE0); // MPP_H_S[7~4], MPP_H_E[3:0]
281261 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x31, 0x43); // MPP_H_S[7:0]
....@@ -283,21 +263,21 @@
283263 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7C, CoaxVal->rx_src);
284264 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x7D, CoaxVal->rx_slice_lev);
285265
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));
287267
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]);
298278 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);
301281
302282 #if DBG_TX_INIT_PRINT
303283 printk("[drv]tx_src: 5x7C>> 0x%02X\n", CoaxVal->rx_src );
....@@ -335,26 +315,26 @@
335315 //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param;
336316 int i;
337317 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;
342322 NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt);
343323
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,};
348328 unsigned char TCP_CMD_Stop_v10[10] = { 0xb5, 0x00, 0x14, 0x00, 0x80, 0x00, 0x00, 0x00, 0xc9, 0x80 };
349329 //unsigned char TCP_CMD_Stop_v20[10] = { 0xb5, 0x01, 0x14, 0x00, 0x80, 0x00, 0x00, 0x00, 0xc5, 0x80 };
350330
351331 // UP Stream get from coax table
352332 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
354334 printk("[drv_coax]Ch: %d Command >>>>> %s >>> autostop = %d\n", ch, pCMD->name, pCMD->autostop);
355335
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;
358338 tx_shot_addr = CoaxVal->tx_shot_addr;
359339
360340 // UP Stream command copy in coax command table
....@@ -365,63 +345,53 @@
365345 // printk("[%2x] ", command[i]);
366346 //printk("\n ");
367347 // 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);
374352 }
375353 // 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);
378356 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);
380358
381359 msleep(CoaxVal->reset_delay);
382360
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]);
386363 }
387364 // 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);
390367 msleep(CoaxVal->shot_delay);
391368 //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);
401375 }
402376
403377 // 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]);
415386 }
416387
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);
419390 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);
422393
423
- if(pCMD->autostop == 1)
424
- {
394
+ if(pCMD->autostop == 1) {
425395 if(vivofmt == TVI_4M_15P)
426396 msleep(70);
427397 else
....@@ -441,39 +411,35 @@
441411 else
442412 #endif
443413 {
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]);
448418 }
449419 }
450420
451421 // 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);
454424 }
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]);
462429 }
463430
464431 // 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);
469436 }
470437
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...
473439 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);
477443 }
478444 }
479445
....@@ -492,16 +458,16 @@
492458 //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param;
493459 int i;
494460 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;
499465 NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt);
500466
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,};
505471
506472 // UP Stream get from coax table
507473 NC_VD_COAX_Init_STR *CoaxVal = __NC_VD_COAX_InitFormat_Get(vivofmt); // Get from Coax_Tx_Init Table
....@@ -516,32 +482,29 @@
516482 cmd_cnt = __NC_VD_COAX_16bit_Command_Copy( format, vivofmt, command, pCMD );
517483
518484 // 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) );
520486
521487 // 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);
525490 }
526491
527492 // 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);
530495 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);
533497
534498 // 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]);
538501 }
539502
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);
543506 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);
545508
546509 }
547510
....@@ -550,10 +513,10 @@
550513 //NC_VD_COAX_STR *coax_tx = (NC_VD_COAX_STR*)p_param;
551514 int i;
552515 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;
557520 NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(vivofmt);
558521
559522 unsigned char tx_bank = 0x00;
....@@ -573,16 +536,15 @@
573536 // UP Stream command copy in coax command table
574537 cmd_cnt = __NC_VD_COAX_16bit_Command_Copy( format, vivofmt, command, pCMD );
575538
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]);
580542 }
581543
582544 // 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);
586548 }
587549
588550 /*=======================================================================================================
....@@ -617,21 +579,21 @@
617579 void nvp6158_coax_rx_init( nvp6158_coax_str *ps_coax_str )
618580 {
619581 //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;
622584 //NC_VIVO_CH_FORMATDEF vivofmt = coax_rx->vivo_fmt;
623585
624586 NC_VD_COAX_Init_STR *coax_rx_val = __NC_VD_COAX_InitFormat_Get(ps_coax_str->fmt_def);
625587
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));
627589
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);
635597 #if DBG_RX_INIT_PRINT
636598 printk("[drv]Channel %d Format >>>>> %s\n", ch, coax_rx_val->name );
637599 printk("[drv]rx_head_matching: 0x60 >> 0x%02X\n", coax_rx_val->rx_head_matching);
....@@ -660,16 +622,14 @@
660622 //NC_VD_COAX_STR *coax_rx = (NC_VD_COAX_STR*)p_param;
661623
662624 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;
665627 NC_FORMAT_STANDARD format = NVP6158_GetFmtStd_from_Fmtdef(coax_rx->fmt_def);
666628
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));
668630
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++) {
673633 coax_rx->rx_data1[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x40+((ch%2)*0x80))+ii); // ChX_Rx_Line_1 : 0x40 ~ 0x44 5byte
674634 coax_rx->rx_data2[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x45+((ch%2)*0x80))+ii); // ChX_Rx_Line_2 : 0x45 ~ 0x49 5byte
675635 coax_rx->rx_data3[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x4A+((ch%2)*0x80))+ii); // ChX_Rx_Line_3 : 0x4A ~ 0x4E 5byte
....@@ -677,11 +637,8 @@
677637 coax_rx->rx_data5[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x71+((ch%2)*0x80))+ii); // ChX_Rx_Line_5 : 0x71 ~ 0x75 5byte
678638 coax_rx->rx_data6[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], (0x76+((ch%2)*0x80))+ii); // ChX_Rx_Line_6 : 0x76 ~ 0x7A 5byte
679639 }
680
- }
681
- else // AHD
682
- {
683
- for(ii=0;ii<8;ii++)
684
- {
640
+ } else {// AHD
641
+ for(ii=0; ii<8; ii++) {
685642 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
686643 }
687644 }
....@@ -775,13 +732,11 @@
775732 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x60+((ch%2)*0x80), 0x55 ); // Header Matching
776733
777734 /* 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)));
781738 ret = FW_SUCCESS;
782
- }
783
- else
784
- {
739
+ } else {
785740 readval= gpio_i2c_read( nvp6158_iic_addr[devnum], 0x50+((ch%2)*0x80) );
786741 printk(">>>>> DRV[%s:%d] check ACP_STATUS_MODE::0x%x\n", __func__, __LINE__, readval );
787742 ret = FW_FAILURE;
....@@ -819,8 +774,7 @@
819774 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x0A+((ch%2)*0x80), 0x04); // Tx Line count max
820775
821776 /* 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)) {
824778 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x60); // Register Write Control - 17th line
825779 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x11+((ch%2)*0x80), 0xB0); // table(Mode Change Command) - 18th line
826780 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x12+((ch%2)*0x80), 0x02); // Flash Update Mode(big data) - 19th line
....@@ -830,11 +784,10 @@
830784 msleep(400);
831785 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // reset
832786 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 );
834789 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)) {
838791 /* change video mode FHD@25P Command Send */
839792 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) );
840793 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x55); // 0x55(header) - 16th line
....@@ -847,11 +800,10 @@
847800 msleep(1000);
848801 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // reset
849802 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 );
851805 ret = FW_SUCCESS;
852
- }
853
- else
854
- {
806
+ } else {
855807 printk(">>>> DRV[%s:%d] CH:%d, FMT:%d > Unknown Format!!! \n", __func__, __LINE__, ch, cp_mode );
856808 ret = FW_FAILURE;
857809 }
....@@ -892,20 +844,17 @@
892844 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz
893845 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ
894846
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) {
897848 /* 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) {
900850 printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [READY]\n", __func__, __LINE__, ch );
901851 ret = FW_SUCCESS;
902852 }
903
- }
904
- else
905
- {
853
+ } else {
906854 retval = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) );
907855 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 );
909858 ret = FW_FAILURE;
910859 }
911860
....@@ -994,22 +943,19 @@
994943 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz
995944 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ
996945
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) {
1001948 printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [START]\n", __func__, __LINE__, ch );
1002949 ret = FW_SUCCESS;
1003
- }
1004
- else
1005
- {
950
+ } else {
1006951 unsigned char retval1;
1007952 unsigned char retval2;
1008953 gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2));
1009954 retval1 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) );
1010955 retval2 = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x57+((ch%2)*0x80) );
1011956 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 );
1013959 }
1014960 }
1015961
....@@ -1053,15 +999,11 @@
1053999
10541000 /* fill packet(139bytes), end packet is filled with 0xff */
10551001 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) {
10601004 gpio_i2c_write( nvp6158_iic_addr[devnum], 0x00+ii, pstFileInfo->onepacketbuf[ii] );
10611005 byteNumOfPacket++;
1062
- }
1063
- else if( byteNumOfPacket >= readsize ) // end packet : fill 0xff
1064
- {
1006
+ } else if( byteNumOfPacket >= readsize ) {// end packet : fill 0xff
10651007 gpio_i2c_write( nvp6158_iic_addr[devnum], 0x00+ii, 0xff );
10661008 byteNumOfPacket++;
10671009 }
....@@ -1075,7 +1017,8 @@
10751017 }
10761018
10771019 /* 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);
10791022
10801023 /* Tx Change mode to use Big data */
10811024 gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2) );
....@@ -1123,15 +1066,13 @@
11231066 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x61+((ch%2)*0x80), 0x00 ); // Ch_X Rx data_rz
11241067 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x68+((ch%2)*0x80), 0x80 ); // Ch_X Rx SZ
11251068
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 ) {
11281070 /* 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 ) {
11331073 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 );
11351076 return;
11361077 }
11371078 }
....@@ -1140,8 +1081,7 @@
11401081 receive_addr = (( gpio_i2c_read( nvp6158_iic_addr[devnum], 0x53+((ch%2)*0x80))<<16) + \
11411082 (gpio_i2c_read( nvp6158_iic_addr[devnum], 0x54+((ch%2)*0x80))<<8) +
11421083 gpio_i2c_read( nvp6158_iic_addr[devnum], 0x55+((ch%2)*0x80)));
1143
- if( onepacketaddr == receive_addr )
1144
- {
1084
+ if( onepacketaddr == receive_addr ) {
11451085 gpio_i2c_write( nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x10); // Reset
11461086 gpio_i2c_write( nvp6158_iic_addr[devnum], 0x09+((ch%2)*0x80), 0x00); // trigger off
11471087 ret = FW_SUCCESS;
....@@ -1188,15 +1128,14 @@
11881128 gpio_i2c_write( nvp6158_iic_addr[devnum], 0x10+((ch%2)*0x80), 0x60);
11891129 gpio_i2c_write( nvp6158_iic_addr[devnum], 0x11+((ch%2)*0x80), 0xb0);
11901130 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 ) {
11931132 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 {
11981136 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 );
12001139 }
12011140
12021141 /* Shot */
....@@ -1235,8 +1174,7 @@
12351174 gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x05+(ch%4));
12361175 videofm = gpio_i2c_read( nvp6158_iic_addr[devnum], 0xF0);
12371176
1238
- if( videofm == 0xFF )
1239
- {
1177
+ if( videofm == 0xFF ) {
12401178 printk(">>>>> DRV[%s:%d] Final[CH:%d], No video[END]!\n", __func__, __LINE__, ch );
12411179 pstFileInfo->result = FW_FAILURE;
12421180 return;
....@@ -1256,15 +1194,13 @@
12561194 gpio_i2c_write( nvp6158_iic_addr[devnum], 0xFF, 0x03+((ch%4)/2));
12571195 ack_return = gpio_i2c_read( nvp6158_iic_addr[devnum], 0x56+((ch%2)*0x80) );
12581196 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 ) {
12611198 printk(">>>>> DRV[%s:%d]CH:%d Receive ISP status : [END]\n", __func__, __LINE__, ch );
12621199 pstFileInfo->result = FW_SUCCESS;
12631200 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 );
12681204 pstFileInfo->result = FW_FAILURE;
12691205 return;
12701206 }
....@@ -1303,20 +1239,15 @@
13031239 // Adjust Tx
13041240 if( fmtdef == AHD30_3M_30P || fmtdef == AHD30_3M_25P || fmtdef == AHD30_3M_18P ||
13051241 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
13091243 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x05+((ch%2)*0x80), 0x07); // Tx line set
13101244 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
13141246 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x05+((ch%2)*0x80), 0x03); // Tx line set
13151247 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x0A+((ch%2)*0x80), 0x04); // Tx max line set
13161248 }
13171249
1318
- if( param == 0 ) // RT Mode
1319
- {
1250
+ if( param == 0 ) {// RT Mode
13201251 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write
13211252 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command
13221253 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x00); // RT Mode
....@@ -1325,9 +1256,7 @@
13251256 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00);
13261257 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00);
13271258 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
13311260 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write
13321261 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command
13331262 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x01); // NRT Mode
....@@ -1336,9 +1265,7 @@
13361265 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00);
13371266 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00);
13381267 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
13421269 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write
13431270 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command
13441271 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format
....@@ -1347,9 +1274,7 @@
13471274 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00);
13481275 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00);
13491276 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
13531278 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write
13541279 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command
13551280 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format
....@@ -1358,9 +1283,7 @@
13581283 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00);
13591284 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00);
13601285 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
13641287 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write
13651288 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command
13661289 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format
....@@ -1369,9 +1292,7 @@
13691292 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00);
13701293 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00);
13711294 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
13751296 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write
13761297 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command
13771298 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format
....@@ -1380,9 +1301,7 @@
13801301 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x15+((ch%2)*0x80), 0x00);
13811302 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x16+((ch%2)*0x80), 0x00);
13821303 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
13861305 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x10+((ch%2)*0x80), 0x60); // Register write
13871306 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x11+((ch%2)*0x80), 0xb1); // Output command
13881307 gpio_i2c_write( nvp6158_iic_addr[coax_val->vd_dev], 0x12+((ch%2)*0x80), 0x02); // Change Format
....@@ -1459,22 +1378,18 @@
14591378 void nvp6158_coax_test_data_set(NC_VD_COAX_TEST_STR *coax_data)
14601379 {
14611380 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 );
14631383
14641384 gpio_i2c_write(nvp6158_iic_addr[coax_data->chip_num], 0xFF, coax_data->bank);
14651385
1466
- if(coax_data->bank == 0x01 && coax_data->data_addr == 0xED)
1467
- {
1386
+ if(coax_data->bank == 0x01 && coax_data->data_addr == 0xED) {
14681387 temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr);
14691388 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) {
14731390 temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr);
14741391 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) {
14781393 temp_reg = gpio_i2c_read(nvp6158_iic_addr[coax_data->chip_num], coax_data->data_addr);
14791394 temp_reg = ((temp_reg & ~(0x01 << coax_data->param)) | (0x01 << coax_data->param));
14801395 }
....@@ -1498,7 +1413,8 @@
14981413 {
14991414 gpio_i2c_write(nvp6158_iic_addr[coax_data->chip_num], 0xFF, coax_data->bank);
15001415 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 );
15021418 }
15031419
15041420 /**************************************************************************************
....@@ -1517,8 +1433,7 @@
15171433
15181434 gpio_i2c_write(nvp6158_iic_addr[coax_data->vd_dev], 0xFF, coax_data->bank);
15191435
1520
- for(ii=0; ii<256; ii++)
1521
- {
1436
+ for(ii=0; ii<256; ii++) {
15221437 coax_data->rx_pelco_data[ii] = gpio_i2c_read(nvp6158_iic_addr[coax_data->vd_dev], 0x00+ii);
15231438 }
15241439 }
....@@ -1557,8 +1472,7 @@
15571472 gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x10+3+(ch%2)*0x80, 0x00);
15581473 gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x09+(ch%2)*0x80, 0x08);
15591474 msleep(100);
1560
- for(i=0;i<8;i++)
1561
- {
1475
+ for(i=0; i<8; i++) {
15621476 data_3x50[i] = gpio_i2c_read(nvp6158_iic_addr[ch/4],0x50+i+((ch%2)*0x80));
15631477 printk("acp_isp_read ch = %d, reg_addr = %x, reg_data = %x\n", ch,reg_addr, data_3x50[i]);
15641478 }
....@@ -1600,8 +1514,7 @@
16001514 gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x10+3+(ch%2)*0x80, reg_data);
16011515 gpio_i2c_write(nvp6158_iic_addr[ch/4], 0x09+(ch%2)*0x80, 0x08);
16021516 msleep(100);
1603
- for(i=0;i<8;i++)
1604
- {
1517
+ for(i=0; i<8; i++) {
16051518 data_3x50[i] = gpio_i2c_read(nvp6158_iic_addr[ch/4],0x50+i+((ch%2)*0x80));
16061519 printk("acp_isp_write ch = %d, reg_addr = %x, reg_data = %x\n", ch,reg_addr, data_3x50[i]);
16071520 }