hc
2023-12-11 d2ccde1c8e90d38cee87a1b0309ad2827f3fd30d
kernel/drivers/media/i2c/nvp6158_drv/nvp6158_video_auto_detect.c
....@@ -134,19 +134,17 @@
134134 extern unsigned char nvp6158_det_mode[16];
135135 NC_VIVO_CH_FORMATDEF NVP6158_NC_VD_AUTO_VFCtoFMTDEF(unsigned char ch, unsigned char VFC)
136136 {
137
- if((nvp6158_chip_id[ch/4] == NVP6168C_R0_ID) || (nvp6158_chip_id[ch/4] == NVP6168_R0_ID))
138
- {
137
+ if((nvp6158_chip_id[ch/4] == NVP6168C_R0_ID) ||
138
+ (nvp6158_chip_id[ch/4] == NVP6168_R0_ID)) {
139139 return nvp6158_arrVfcType_raptor4[VFC];
140
- }
141
- else
142
- {
140
+ } else {
143141 if(nvp6158_det_mode[ch] == NVP6158_DET_MODE_AUTO)
144142 return nvp6158_arrVfcType[VFC];
145143 else if(nvp6158_det_mode[ch] == NVP6158_DET_MODE_CVI)
146144 return nvp6158_arrVfcType_cvi[VFC];
147145 else if(nvp6158_det_mode[ch] == NVP6158_DET_MODE_TVI)
148146 return nvp6158_arrVfcType_tvi[VFC];
149
- else
147
+ else
150148 return nvp6158_arrVfcType_ahd[VFC];
151149 }
152150 }
....@@ -168,8 +166,8 @@
168166
169167 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0xFF, 0x00);
170168 //B0 0x00/1/2/3 gain[4], powerdown[0]
171
- gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x00 + vin_auto_det->ch, ((vin_auto_det->vafe.gain & 0x01) << 4) |
172
- (vin_auto_det->vafe.powerdown & 0x01));
169
+ gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x00 + vin_auto_det->ch,
170
+ ((vin_auto_det->vafe.gain & 0x01) << 4) | (vin_auto_det->vafe.powerdown & 0x01));
173171
174172 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0xFF, 0x01);
175173 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x84 + vin_auto_det->ch, 0x00);
....@@ -186,7 +184,8 @@
186184
187185 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x00, val_5678x00);
188186
189
- val_5678x01 = ((vin_auto_det->vafe.ctrlreg << 6) | (vin_auto_det->vafe.ctrlibs << 4) | (vin_auto_det->vafe.adcspd << 2) | (vin_auto_det->vafe.clplevel));
187
+ val_5678x01 = ((vin_auto_det->vafe.ctrlreg << 6) | (vin_auto_det->vafe.ctrlibs << 4) |
188
+ (vin_auto_det->vafe.adcspd << 2) | (vin_auto_det->vafe.clplevel));
190189 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x01, val_5678x01 );
191190
192191 //B5/6/7/8 0x58 eq_band[7:4], lpf_front_band[1:0]
....@@ -194,13 +193,15 @@
194193 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x58, val_5678x58);
195194
196195 //B5/6/7/8 0x5B ref_vol[1:0]
197
- val_5678x59 = ((vin_auto_det->vafe.clpmode << 7) | (vin_auto_det->vafe.f_lpf_bypass << 4) | (vin_auto_det->vafe.clproff << 3) | (vin_auto_det->vafe.b_lpf_bypass));
196
+ val_5678x59 = ((vin_auto_det->vafe.clpmode << 7) | (vin_auto_det->vafe.f_lpf_bypass << 4) |
197
+ (vin_auto_det->vafe.clproff << 3) | (vin_auto_det->vafe.b_lpf_bypass));
198198 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x59, val_5678x59);
199199
200200 val_5678x5B = ((vin_auto_det->vafe.duty << 4) | (vin_auto_det->vafe.ref_vol));
201201 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x5B, val_5678x5B);
202202
203
- val_5678x5C = ((vin_auto_det->vafe.lpf_back_band << 4) | (vin_auto_det->vafe.clk_sel << 3) | (vin_auto_det->vafe.eq_gainsel));
203
+ val_5678x5C = ((vin_auto_det->vafe.lpf_back_band << 4) |
204
+ (vin_auto_det->vafe.clk_sel << 3) | (vin_auto_det->vafe.eq_gainsel));
204205 gpio_i2c_write(nvp6158_iic_addr[vin_auto_det->devnum], 0x5C, val_5678x5C);
205206 }
206207
....@@ -462,7 +463,7 @@
462463 unsigned char val_13x32;
463464 unsigned char val_9x44;
464465 unsigned char val_1x7A;
465
-
466
+
466467 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0xFF, 0x00);
467468 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x21 + (auto_novid->ch * 4), 0x82);
468469 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x23 + (auto_novid->ch * 4), 0x41);
....@@ -483,12 +484,12 @@
483484 //gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x58, 0x07);
484485 //gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x5C, 0x78);
485486 /* After 08/28 */
486
- gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x47, 0xEE);
487
+ gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x47, 0xEE);
487488 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x50, 0xc6); //recovery to std value.
488489 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x58, 0x47);
489490 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x5C, 0x7f);
490491 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x6E, 0x00); //VBLK default setting
491
- gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x6F, 0x00);
492
+ gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x6F, 0x00);
492493 /* Low-Poass Filter (LPF) Bypass Enable Bank5/6/7/8 0x59 */
493494 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x59, 0x10);
494495
....@@ -511,7 +512,7 @@
511512 /* disable Bank11 0x00, if before setting format TVI 5M 20P when onvideo */
512513 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0xFF, 0x11);
513514 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x00 + ( auto_novid->ch * 0x20 ), 0x00);
514
-
515
+
515516 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0xFF, 0x09);
516517 val_9x44 = gpio_i2c_read(nvp6158_iic_addr[auto_novid->devnum], 0x44);
517518 val_9x44 |= (1 << auto_novid->ch);
....@@ -530,7 +531,7 @@
530531 gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x8c + auto_novid->ch, 0x55);
531532 val_1x7A = gpio_i2c_read(nvp6158_iic_addr[auto_novid->devnum], 0x7A);
532533 val_1x7A |= (1 << auto_novid->ch);
533
- gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x7A, val_1x7A);
534
+ gpio_i2c_write(nvp6158_iic_addr[auto_novid->devnum], 0x7A, val_1x7A);
534535 }
535536
536537 void nvp6168_video_input_no_video_set(video_input_novid *auto_novid)
....@@ -573,7 +574,7 @@
573574
574575
575576
576
-void nvp6158_video_input_sam_val_read(video_input_sam_val *vin_sam_val )
577
+void nvp6158_video_input_sam_val_read(video_input_sam_val *vin_sam_val )
577578 {
578579 unsigned char val1, val2;
579580
....@@ -763,7 +764,7 @@
763764 unsigned int val_1 = 0;
764765 unsigned int val_2 = 0;
765766 unsigned int val_result;
766
-
767
+
767768 static unsigned int pre_val_1;
768769 static unsigned int pre_val_2;
769770
....@@ -777,8 +778,7 @@
777778 gpio_i2c_write(nvp6158_iic_addr[vin_hsync_accum->devnum], 0xFF, 0x13);
778779 gpio_i2c_write(nvp6158_iic_addr[vin_hsync_accum->devnum], 0x2B, vin_hsync_accum->ch);
779780
780
- while(read_cnt < total_cnt)
781
- {
781
+ while(read_cnt < total_cnt) {
782782 gpio_i2c_write(nvp6158_iic_addr[vin_hsync_accum->devnum], 0xFF, 0x00);
783783 video_loss = gpio_i2c_read(nvp6158_iic_addr[vin_hsync_accum->devnum], 0xA8);
784784 video_loss = (((video_loss >> vin_hsync_accum->ch) & 0x1)) ;
....@@ -786,9 +786,9 @@
786786 gpio_i2c_write(nvp6158_iic_addr[vin_hsync_accum->devnum], 0xFF, 0x05 + vin_hsync_accum->ch);
787787 vfc = gpio_i2c_read(nvp6158_iic_addr[vin_hsync_accum->devnum], 0xF0);
788788
789
- if((video_loss == 1) && (vfc == 0xFF))
790
- {
791
- printk("[%s] CH:%d, video_loss:%02X, vfc:0x%X \r\n", __func__, vin_hsync_accum->ch, video_loss, vfc);
789
+ if((video_loss == 1) && (vfc == 0xFF)) {
790
+ printk("[%s] CH:%d, video_loss:%02X, vfc:0x%X \r\n", __func__,
791
+ vin_hsync_accum->ch, video_loss, vfc);
792792 vin_hsync_accum->hsync_accum_val1 = 0;
793793 vin_hsync_accum->hsync_accum_val2 = 0;
794794 vin_hsync_accum->hsync_accum_result = 0xffffffff;
....@@ -822,10 +822,8 @@
822822
823823 //printk("[%s] CH:%d, video_loss:%02X, vfc:0x%X val1:%08X / val2:%08X \r\n", __func__, vin_hsync_accum->ch, video_loss, vfc, val_1, val_2);
824824
825
- if((val_1 != 0) && (val_2 != 0))
826
- {
827
- if((pre_val_1 != val_1) || (pre_val_2 != val_2))
828
- {
825
+ if((val_1 != 0) && (val_2 != 0)) {
826
+ if((pre_val_1 != val_1) || (pre_val_2 != val_2)) {
829827 gpio_i2c_write(nvp6158_iic_addr[vin_hsync_accum->devnum], 0x7A, rst_reg);
830828 gpio_i2c_write(nvp6158_iic_addr[vin_hsync_accum->devnum], 0x7A, 0x10);
831829 pre_val_1 = val_1;
....@@ -987,14 +985,11 @@
987985
988986 val1 = gpio_i2c_read(nvp6158_iic_addr[vin_acc_gain->devnum],0xE2) & 0x7; // B5 0xE2 acc gain [10:8]
989987 val2 = gpio_i2c_read(nvp6158_iic_addr[vin_acc_gain->devnum],0xE3); // B5 0xE3 acc gain [7:0]
990
- }
991
- else if(vin_acc_gain->func_sel == ACC_GAIN_DEBUG) { // DEBUG
988
+ } else if(vin_acc_gain->func_sel == ACC_GAIN_DEBUG) { // DEBUG
992989 gpio_i2c_write(nvp6158_iic_addr[vin_acc_gain->devnum], 0xFF, 0x00);
993990 val1 = 0;
994991 val2 = gpio_i2c_read(nvp6158_iic_addr[vin_acc_gain->devnum],0xD8 + vin_acc_gain->ch); // B13 0xC6 acc gain [9:8]
995
- }
996
- else
997
- {
992
+ } else {
998993 gpio_i2c_write(nvp6158_iic_addr[vin_acc_gain->devnum], 0xFF, 0x05);
999994
1000995 val1 = gpio_i2c_read(nvp6158_iic_addr[vin_acc_gain->devnum],0xE2) & 0x7; // B5 0xE2 acc gain [10:8]
....@@ -1013,8 +1008,7 @@
10131008 // 0x7A [7 : 4][3 : 0] 0x7B [7 : 4][3 : 0]
10141009 gpio_i2c_write(nvp6158_iic_addr[vo_data_out_mode->devnum], 0xFF, 0x00);
10151010
1016
- switch(vo_data_out_mode -> ch)
1017
- {
1011
+ switch(vo_data_out_mode -> ch) {
10181012 case CH1 :
10191013 case CH2 : temp_val = gpio_i2c_read(nvp6158_iic_addr[vo_data_out_mode->devnum], 0x7A);
10201014 break;
....@@ -1023,8 +1017,7 @@
10231017 break;
10241018 }
10251019
1026
- switch(vo_data_out_mode -> ch)
1027
- {
1020
+ switch(vo_data_out_mode -> ch) {
10281021 case CH1 :
10291022 case CH3 : temp_val = ((temp_val & 0xF0) | (vo_data_out_mode -> set_val & 0xF));
10301023 break;
....@@ -1034,8 +1027,7 @@
10341027 }
10351028
10361029 // printk("[%s:%s] : %s >>>> temp_val [ %x ]\n", __FILE__, __LINE__, __FUNCTION__,temp_val);
1037
- switch(vo_data_out_mode -> ch)
1038
- {
1030
+ switch(vo_data_out_mode -> ch) {
10391031 case CH1 :
10401032 case CH2 : gpio_i2c_write(nvp6158_iic_addr[vo_data_out_mode->devnum], 0x7A, temp_val);
10411033 break;
....@@ -1050,8 +1042,7 @@
10501042 {
10511043 unsigned char ret = 0; //
10521044
1053
- if(
1054
- (decoder_info->fmt_def == AHD30_3M_30P) ||
1045
+ if((decoder_info->fmt_def == AHD30_3M_30P) ||
10551046 (decoder_info->fmt_def == AHD30_3M_25P) ||
10561047 (decoder_info->fmt_def == AHD30_4M_30P) ||
10571048 (decoder_info->fmt_def == AHD30_4M_25P) ||
....@@ -1070,9 +1061,7 @@
10701061 (decoder_info->fmt_def == CVI_4M_30P) ||
10711062 (decoder_info->fmt_def == CVI_5M_20P) ||
10721063 (decoder_info->fmt_def == CVI_8M_15P) ||
1073
- (decoder_info->fmt_def == CVI_8M_12_5P)
1074
- )
1075
- {
1064
+ (decoder_info->fmt_def == CVI_8M_12_5P)) {
10761065 ret = 1;
10771066 }
10781067 return ret; // 0:Over 3M RT, 1:other formation
....@@ -1083,48 +1072,36 @@
10831072 {
10841073 unsigned char format_3M_RT;
10851074
1086
- printk("onvideo_set dev_num[%x] ch_num[%x] fmt_def[%d]", decoder_info->devnum, decoder_info->ch, decoder_info->fmt_def);
1087
-
1088
-
1075
+ printk("onvideo_set dev_num[%x] ch_num[%x] fmt_def[%d]",
1076
+ decoder_info->devnum, decoder_info->ch, decoder_info->fmt_def);
10891077
10901078 /* after 09/12 */
10911079 format_3M_RT = __nvp6158_IsOver3MRTVideoFormat(decoder_info);
10921080
1093
- if(format_3M_RT)
1094
- {
1081
+ if(format_3M_RT) {
10951082 /* DECI_FILTER_ON */
10961083 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0xFF, 0x05 + decoder_info->ch);
10971084 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0x50, 0x76);
1098
- }
1099
- else
1100
- {
1085
+ } else {
11011086 /* DECI_FILTER_OFF */
11021087 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0xFF, 0x05 + decoder_info->ch);
11031088 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0x50, 0xc6);
11041089 }
11051090
11061091
1107
- if( decoder_info->fmt_def == CVI_HD_30P ||
1108
- decoder_info->fmt_def == CVI_HD_30P_EX ||
1109
- decoder_info->fmt_def == AHD20_720P_30P ||
1110
- decoder_info->fmt_def == AHD20_720P_30P_EX ||
1111
- decoder_info->fmt_def == AHD20_720P_30P_EX_Btype)
1112
- {
1092
+ if(decoder_info->fmt_def == CVI_HD_30P || decoder_info->fmt_def == CVI_HD_30P_EX ||
1093
+ decoder_info->fmt_def == AHD20_720P_30P || decoder_info->fmt_def == AHD20_720P_30P_EX ||
1094
+ decoder_info->fmt_def == AHD20_720P_30P_EX_Btype) {
11131095 //meant to remove pre-connection issue. 07.31
1114
- if( nvp6158_s_only_onetime_run[decoder_info->ch + 4 * decoder_info->devnum] == 0)
1115
- {
1096
+ if( nvp6158_s_only_onetime_run[decoder_info->ch + 4 * decoder_info->devnum] == 0) {
11161097 nvp6158_video_input_vafe_reset(decoder_info);
11171098 nvp6158_s_only_onetime_run[decoder_info->ch + 4 * decoder_info->devnum] = 1;
11181099 }
1119
- }
1120
- else
1121
- {
1122
- if( nvp6158_s_only_onetime_run[decoder_info->ch + 4 * decoder_info->devnum] == 0)
1123
- {
1100
+ } else {
1101
+ if( nvp6158_s_only_onetime_run[decoder_info->ch + 4 * decoder_info->devnum] == 0) {
11241102 nvp6158_s_only_onetime_run[decoder_info->ch + 4 * decoder_info->devnum] = 1;
11251103 }
11261104 }
1127
-
11281105 }
11291106
11301107 void nvp6168_video_input_onvideo_set(decoder_dev_ch_info_s *decoder_info)
....@@ -1133,10 +1110,11 @@
11331110 unsigned char ch = decoder_info->ch % 4;
11341111 unsigned char devnum = decoder_info->devnum;
11351112 unsigned char val_9x44;
1136
-#ifndef _NVP6168_USE_MANUAL_MODE_
1113
+#ifndef _NVP6168_USE_MANUAL_MODE_
11371114 unsigned char set_done=0xF0;
11381115 #endif
1139
- printk("onvideo_set dev_num[%x] ch_num[%x] fmt_def[%d]", decoder_info->devnum, decoder_info->ch, decoder_info->fmt_def);
1116
+ printk("onvideo_set dev_num[%x] ch_num[%x] fmt_def[%d]",
1117
+ decoder_info->devnum, decoder_info->ch, decoder_info->fmt_def);
11401118
11411119 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x09);
11421120 val_9x44 = gpio_i2c_read(nvp6158_iic_addr[devnum], 0x44);
....@@ -1202,14 +1180,10 @@
12021180 void nvp6158_video_input_manual_agc_stable_endi(decoder_dev_ch_info_s *decoder_info, int endi)
12031181 {
12041182 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0xFF, 0x05+decoder_info->ch);
1205
- if( endi == 1 )
1206
- {
1183
+ if( endi == 1 ) {
12071184 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0x82, 0xff);
12081185 printk("[DRV] MANUAL AGC STABLE ENABLE CH:[%d]\n", decoder_info->ch);
1209
- }
1210
- else
1211
- {
1212
-
1186
+ } else {
12131187 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0x82, 0x00);
12141188 printk("[DRV] MANUAL AGC STABLE ENABLE CH:[%d]\n", decoder_info->ch);
12151189 }
....@@ -1221,8 +1195,7 @@
12211195
12221196 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0xFF, 0x00);
12231197
1224
- if(cmd == 0)
1225
- {
1198
+ if(cmd == 0) {
12261199 val_0x00 = gpio_i2c_read(nvp6158_iic_addr[decoder_info->devnum], 0x00 + decoder_info->ch);
12271200 _SET_BIT(val_0x00, 0);
12281201 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0x00 + decoder_info->ch, val_0x00);
....@@ -1230,9 +1203,7 @@
12301203 printk("[DRV] [Ch:%d] AFE Power Down ... \n", decoder_info->ch);
12311204
12321205 msleep(10);
1233
- }
1234
- else if(cmd == 1)
1235
- {
1206
+ } else if(cmd == 1) {
12361207 val_0x00 = gpio_i2c_read(nvp6158_iic_addr[decoder_info->devnum], 0x00 + decoder_info->ch);
12371208 _CLE_BIT(val_0x00, 0);
12381209 gpio_i2c_write(nvp6158_iic_addr[decoder_info->devnum], 0x00 + decoder_info->ch, val_0x00);
....@@ -1251,8 +1222,7 @@
12511222 max = input_arry[0];
12521223 min = input_arry[0];
12531224
1254
- for(ii = 0; ii < cnt; ii++)
1255
- {
1225
+ for(ii = 0; ii < cnt; ii++) {
12561226 max = max > input_arry[ii] ? max : input_arry[ii];
12571227 min = min > input_arry[ii] ? input_arry[ii] : min;
12581228
....@@ -1261,12 +1231,9 @@
12611231
12621232 result = sum - (max + min);
12631233
1264
- if(result == 0)
1265
- {
1234
+ if(result == 0) {
12661235 return 0;
1267
- }
1268
- else
1269
- {
1236
+ } else {
12701237 result /= ( cnt - 2 );
12711238 }
12721239
....@@ -1285,21 +1252,15 @@
12851252
12861253 chk1 = input_arry[0];
12871254
1288
- for(ii = 0; ii < cnt; ii++)
1289
- {
1255
+ for(ii = 0; ii < cnt; ii++) {
12901256 chk2 = input_arry[ii];
12911257
1292
- if( chk1 == chk2)
1293
- {
1258
+ if( chk1 == chk2) {
12941259 calc_array[0][inner_idx] += 1;
12951260 calc_array[1][inner_idx] = chk1;
1296
- }
1297
- else if( chk1 != chk2 )
1298
- {
1299
- for(ij = 0; ij < ii; ij++)
1300
- {
1301
- if( calc_array[1][ij] == chk2 )
1302
- {
1261
+ } else if( chk1 != chk2 ) {
1262
+ for(ij = 0; ij < ii; ij++) {
1263
+ if( calc_array[1][ij] == chk2 ) {
13031264 find_idx = ij;
13041265 calc_array[0][find_idx] += 1;
13051266 calc_array[1][find_idx] = chk2;
....@@ -1309,31 +1270,26 @@
13091270 need_update = 1;
13101271 }
13111272
1312
- if(need_update)
1313
- {
1273
+ if(need_update) {
13141274 inner_idx += 1;
13151275 calc_array[0][inner_idx] += 1;
13161276 calc_array[1][inner_idx] = chk2;
13171277 }
13181278 }
1319
-
13201279 chk1 = chk2;
13211280 }
13221281
13231282 max = calc_array[0][0];
13241283
1325
- for(ii = 0; ii < cnt; ii++)
1326
- {
1327
- if( max < calc_array[0][ii] )
1328
- {
1284
+ for(ii = 0; ii < cnt; ii++) {
1285
+ if( max < calc_array[0][ii] ) {
13291286 max_idx = ii;
13301287 max = calc_array[0][ii];
13311288 }
13321289 }
13331290
13341291
1335
- for(ii = 0; ii < cnt; ii++)
1336
- {
1292
+ for(ii = 0; ii < cnt; ii++) {
13371293 printk("[DRV] [ idx %d ] [ num %d ] [ val %x ]\n", ii, calc_array[0][ii], calc_array[1][ii]);
13381294 }
13391295
....@@ -1360,43 +1316,32 @@
13601316
13611317 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch);
13621318
1363
- for(ii = 0; ii < check_time; ii++)
1364
- {
1319
+ for(ii = 0; ii < check_time; ii++) {
13651320 msleep(100);
1366
- B5xF5_F4[ii] = ( gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF5) << 8 ) | gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF4);
1321
+ B5xF5_F4[ii] = ( gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF5) << 8 ) |
1322
+ gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF4);
13671323 printk("[DRV] [Ch:%d] %d time B5xF3_F4 : %x \n", ch, ii, B5xF5_F4[ii]);
13681324 }
13691325
13701326 check_point = __nvp6158_s_distinguish_5M_ahd_tvi_func( B5xF5_F4, check_time );
13711327
1372
- if( fmtdef == AHD30_5M_20P )
1373
- {
1374
- if( ( check_point & 0xfff ) == 0x7c2)
1375
- {
1328
+ if( fmtdef == AHD30_5M_20P ) {
1329
+ if( ( check_point & 0xfff ) == 0x7c2) {
13761330 decoder_info->fmt_def = TVI_5M_20P;
13771331 printk("[DRV] [Ch:%d] Get Format : AHD 5M 20P, Change Format : TVI 5M 20P\n", decoder_info->ch);
1378
- }
1379
- else if( ( check_point & 0xfff ) == 0x7c4)
1380
- {
1332
+ } else if( ( check_point & 0xfff ) == 0x7c4) {
13811333 decoder_info->fmt_def = CVI_5M_20P;
13821334 printk("[DRV] [Ch:%d] Get Format : AHD 5M 20P, Change Format : CVI 5M 20P\n", decoder_info->ch);
1383
- }
1384
- else
1385
- {
1335
+ } else {
13861336
13871337 printk("[DRV] [Ch:%d] Get Format : AHD 5M 20P, Not Change Format\n", decoder_info->ch);
13881338 }
1389
- }
1390
- else if( fmtdef == 0x2B)
1391
- {
1392
- if( ( check_point & 0xfff ) >= 0x673)
1393
- {
1339
+ } else if( fmtdef == 0x2B) {
1340
+ if( ( check_point & 0xfff ) >= 0x673) {
13941341 decoder_info->fmt_def = TVI_4M_15P;
13951342 printk("[DRV] [Ch:%d] Get Format : AHD 4M15P #0P, Change Format : TVI 4M 15P\n", decoder_info->ch);
13961343 }
1397
- }
1398
- else
1399
- {
1344
+ } else {
14001345 decoder_info->fmt_def = fmtdef;
14011346 }
14021347
....@@ -1464,22 +1409,19 @@
14641409
14651410 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch);
14661411
1467
- for(ii = 0; ii < check_time; ii++)
1468
- {
1412
+ for(ii = 0; ii < check_time; ii++) {
14691413 msleep(100);
1470
- B5xF5_F4[ii] = ( gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF5) << 8 ) | gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF4);
1414
+ B5xF5_F4[ii] = ( gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF5) << 8 ) |
1415
+ gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF4);
14711416 printk("[DRV] [Ch:%d] %d time B5xF3_F4 : %x \n", ch, ii, B5xF5_F4[ii]);
14721417 }
14731418
14741419 check_point = __nvp6158_s_distinguish_5M_ahd_tvi_func( B5xF5_F4, check_time );
14751420
1476
- if( ( check_point & 0xfff ) == 0x7c4)
1477
- {
1421
+ if( ( check_point & 0xfff ) == 0x7c4) {
14781422 decoder_info->fmt_def = CVI_5M_20P;
14791423 printk("[DRV] [Ch:%d] Get Format : AHD 5M 20P, Change Format : CVI 5M 20P\n", decoder_info->ch);
1480
- }
1481
- else
1482
- {
1424
+ } else {
14831425
14841426 decoder_info->fmt_def = TVI_5M_20P;
14851427 printk("[DRV] [Ch:%d] Get Format : AHD 5M 20P, Change Format : TVI 5M 20P\n", decoder_info->ch);
....@@ -1500,21 +1442,15 @@
15001442
15011443 chk1 = input_arry[0];
15021444
1503
- for(ii = 0; ii < cnt; ii++)
1504
- {
1445
+ for(ii = 0; ii < cnt; ii++) {
15051446 chk2 = input_arry[ii];
15061447
1507
- if( chk1 == chk2)
1508
- {
1448
+ if( chk1 == chk2) {
15091449 calc_array[0][inner_idx] += 1;
15101450 calc_array[1][inner_idx] = chk1;
1511
- }
1512
- else if( chk1 != chk2 )
1513
- {
1514
- for(ij = 0; ij < ii; ij++)
1515
- {
1516
- if( calc_array[1][ij] == chk2 )
1517
- {
1451
+ } else if( chk1 != chk2 ) {
1452
+ for(ij = 0; ij < ii; ij++) {
1453
+ if( calc_array[1][ij] == chk2 ) {
15181454 find_idx = ij;
15191455 calc_array[0][find_idx] += 1;
15201456 calc_array[1][find_idx] = chk2;
....@@ -1524,31 +1460,26 @@
15241460 need_update = 1;
15251461 }
15261462
1527
- if(need_update)
1528
- {
1463
+ if(need_update) {
15291464 inner_idx += 1;
15301465 calc_array[0][inner_idx] += 1;
15311466 calc_array[1][inner_idx] = chk2;
15321467 }
15331468 }
1534
-
15351469 chk1 = chk2;
15361470 }
15371471
15381472 max = calc_array[0][0];
15391473
1540
- for(ii = 0; ii < cnt; ii++)
1541
- {
1542
- if( max < calc_array[0][ii] )
1543
- {
1474
+ for(ii = 0; ii < cnt; ii++) {
1475
+ if( max < calc_array[0][ii] ) {
15441476 max_idx = ii;
15451477 max = calc_array[0][ii];
15461478 }
15471479 }
15481480
15491481
1550
- for(ii = 0; ii < cnt; ii++)
1551
- {
1482
+ for(ii = 0; ii < cnt; ii++) {
15521483 printk("[DRV] [ idx %d ] [ num %d ] [ val %x ]\n", ii, calc_array[0][ii], calc_array[1][ii]);
15531484 }
15541485
....@@ -1573,13 +1504,11 @@
15731504
15741505 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
15751506 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2B, ch % 4 );
1576
-
1577
- for(ii = 0; ii < check_time; ii++)
1578
- {
1507
+
1508
+ for(ii = 0; ii < check_time; ii++) {
15791509 msleep(100);
15801510 B13xAB[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], 0xAB);
1581
- if(B13xAB[ii] == 0)
1582
- {
1511
+ if(B13xAB[ii] == 0) {
15831512 B13xAB_zerocnt ++;
15841513 }
15851514 printk("[DRV] [Ch:%d] %d time B13xAB : %x \n", ch, ii, B13xAB[ii]);
....@@ -1590,28 +1519,19 @@
15901519
15911520 check_point = __nvp6158_s_distinguish_8M_cvi_tvi_func( B13xAB, check_time );
15921521
1593
- if( fmtdef == CVI_8M_15P || fmtdef == CVI_8M_12_5P )
1594
- {
1595
- if( ( check_point & 0xff ) > 0x1A )
1596
- {
1597
- if( fmtdef == CVI_8M_12_5P )
1598
- {
1522
+ if( fmtdef == CVI_8M_15P || fmtdef == CVI_8M_12_5P ) {
1523
+ if( ( check_point & 0xff ) > 0x1A ) {
1524
+ if( fmtdef == CVI_8M_12_5P ) {
15991525 decoder_info->fmt_def = TVI_8M_12_5P;
16001526 printk("[DRV] [Ch:%d] Get Format : CVI 8M 12_5P, Change Format : TVI 8M 12_5P\n", decoder_info->ch);
1601
- }
1602
- else
1603
- {
1527
+ } else {
16041528 decoder_info->fmt_def = TVI_8M_15P;
16051529 printk("[DRV] [Ch:%d] Get Format : CVI 8M 15P, Change Format : TVI 8M 15P\n", decoder_info->ch);
16061530 }
1607
- }
1608
- else
1609
- {
1531
+ } else {
16101532 printk("[DRV] [Ch:%d] Get Format : CVI 8M, Not Change Format\n", decoder_info->ch);
16111533 }
1612
- }
1613
- else
1614
- {
1534
+ } else {
16151535 decoder_info->fmt_def = fmtdef;
16161536 }
16171537 return 0;
....@@ -1629,21 +1549,15 @@
16291549
16301550 chk1 = input_arry[0];
16311551
1632
- for(ii = 0; ii < cnt; ii++)
1633
- {
1552
+ for(ii = 0; ii < cnt; ii++) {
16341553 chk2 = input_arry[ii];
16351554
1636
- if( chk1 == chk2)
1637
- {
1555
+ if( chk1 == chk2) {
16381556 calc_array[0][inner_idx] += 1;
16391557 calc_array[1][inner_idx] = chk1;
1640
- }
1641
- else if( chk1 != chk2 )
1642
- {
1643
- for(ij = 0; ij < ii; ij++)
1644
- {
1645
- if( calc_array[1][ij] == chk2 )
1646
- {
1558
+ } else if( chk1 != chk2 ) {
1559
+ for(ij = 0; ij < ii; ij++) {
1560
+ if( calc_array[1][ij] == chk2 ) {
16471561 find_idx = ij;
16481562 calc_array[0][find_idx] += 1;
16491563 calc_array[1][find_idx] = chk2;
....@@ -1653,31 +1567,26 @@
16531567 need_update = 1;
16541568 }
16551569
1656
- if(need_update)
1657
- {
1570
+ if(need_update) {
16581571 inner_idx += 1;
16591572 calc_array[0][inner_idx] += 1;
16601573 calc_array[1][inner_idx] = chk2;
16611574 }
16621575 }
1663
-
16641576 chk1 = chk2;
16651577 }
16661578
16671579 max = calc_array[0][0];
16681580
1669
- for(ii = 0; ii < cnt; ii++)
1670
- {
1671
- if( max < calc_array[0][ii] )
1672
- {
1581
+ for(ii = 0; ii < cnt; ii++) {
1582
+ if( max < calc_array[0][ii] ) {
16731583 max_idx = ii;
16741584 max = calc_array[0][ii];
16751585 }
16761586 }
16771587
16781588
1679
- for(ii = 0; ii < cnt; ii++)
1680
- {
1589
+ for(ii = 0; ii < cnt; ii++) {
16811590 printk("[DRV] [ idx %d ] [ num %d ] [ val %x ]\n", ii, calc_array[0][ii], calc_array[1][ii]);
16821591 }
16831592
....@@ -1701,8 +1610,7 @@
17011610
17021611 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x05 + ch);
17031612
1704
- for(ii = 0; ii < check_time; ii++)
1705
- {
1613
+ for(ii = 0; ii < check_time; ii++) {
17061614 msleep(30);
17071615 B5xF3[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], 0xF3);
17081616 printk("[DRV] [Ch:%d] %d time B5xF3 : %x \n", ch, ii, B5xF3[ii]);
....@@ -1710,18 +1618,13 @@
17101618
17111619 check_point = __nvp6158_s_distinguish_ahd_nrt_func( B5xF3, check_time );
17121620
1713
- if( ( check_point & 0xff ) == 0x14 )
1714
- {
1621
+ if( ( check_point & 0xff ) == 0x14 ) {
17151622 decoder_info->fmt_def = AHD20_1080P_12_5P_EX;
17161623 printk("[DRV] [Ch:%d] Get Format : AHD 1080P 12.5P\n", decoder_info->ch);
1717
- }
1718
- else if( ( check_point & 0xff ) == 0x11 )
1719
- {
1624
+ } else if( ( check_point & 0xff ) == 0x11 ) {
17201625 decoder_info->fmt_def = AHD20_1080P_15P_EX;
17211626 printk("[DRV] [Ch:%d] Get Format : AHD 1080P 15P\n", decoder_info->ch);
1722
- }
1723
- else
1724
- {
1627
+ } else {
17251628 decoder_info->fmt_def = NC_VIVO_CH_FORMATDEF_UNKNOWN;
17261629 printk("[DRV] [Ch:%d] Get Format : Unknown Format \n", decoder_info->ch);
17271630 }
....@@ -1739,21 +1642,15 @@
17391642
17401643 chk1 = input_arry[0];
17411644
1742
- for(ii = 0; ii < cnt; ii++)
1743
- {
1645
+ for(ii = 0; ii < cnt; ii++) {
17441646 chk2 = input_arry[ii];
17451647
1746
- if( chk1 == chk2)
1747
- {
1648
+ if( chk1 == chk2) {
17481649 calc_array[0][inner_idx] += 1;
17491650 calc_array[1][inner_idx] = chk1;
1750
- }
1751
- else if( chk1 != chk2 )
1752
- {
1753
- for(ij = 0; ij < ii; ij++)
1754
- {
1755
- if( calc_array[1][ij] == chk2 )
1756
- {
1651
+ } else if( chk1 != chk2 ) {
1652
+ for(ij = 0; ij < ii; ij++) {
1653
+ if( calc_array[1][ij] == chk2 ) {
17571654 find_idx = ij;
17581655 calc_array[0][find_idx] += 1;
17591656 calc_array[1][find_idx] = chk2;
....@@ -1763,8 +1660,7 @@
17631660 need_update = 1;
17641661 }
17651662
1766
- if(need_update)
1767
- {
1663
+ if(need_update) {
17681664 inner_idx += 1;
17691665 calc_array[0][inner_idx] += 1;
17701666 calc_array[1][inner_idx] = chk2;
....@@ -1776,18 +1672,15 @@
17761672
17771673 max = calc_array[0][0];
17781674
1779
- for(ii = 0; ii < cnt; ii++)
1780
- {
1781
- if( max < calc_array[0][ii] )
1782
- {
1675
+ for(ii = 0; ii < cnt; ii++) {
1676
+ if( max < calc_array[0][ii] ) {
17831677 max_idx = ii;
17841678 max = calc_array[0][ii];
17851679 }
17861680 }
17871681
17881682
1789
- for(ii = 0; ii < cnt; ii++)
1790
- {
1683
+ for(ii = 0; ii < cnt; ii++) {
17911684 printk("[DRV] [ idx %d ] [ num %d ] [ val %x ]\n", ii, calc_array[0][ii], calc_array[1][ii]);
17921685 }
17931686
....@@ -1812,9 +1705,8 @@
18121705
18131706 gpio_i2c_write(nvp6158_iic_addr[devnum], 0xFF, 0x13);
18141707 gpio_i2c_write(nvp6158_iic_addr[devnum], 0x2B, ch % 4 );
1815
-
1816
- for(ii = 0; ii < check_time; ii++)
1817
- {
1708
+
1709
+ for(ii = 0; ii < check_time; ii++) {
18181710 msleep(100);
18191711 B13xAB[ii] = gpio_i2c_read(nvp6158_iic_addr[devnum], 0xAB);
18201712 printk("[DRV] [Ch:%d] %d time B13xAB : %x \n", ch, ii, B13xAB[ii]);
....@@ -1822,21 +1714,15 @@
18221714
18231715 check_point = __nvp6158_s_distinguish_2M_cvi_ahd_func( B13xAB, check_time );
18241716
1825
- if( fmtdef == CVI_FHD_25P )
1826
- {
1827
- if( ( check_point & 0xff ) <= 0x09 )
1828
- {
1829
-
1717
+ if( fmtdef == CVI_FHD_25P ) {
1718
+ if( ( check_point & 0xff ) <= 0x09 ) {
1719
+
18301720 decoder_info->fmt_def = AHD20_1080P_25P;
18311721 printk("[DRV] [Ch:%d] Get Format : CVI 2M 25P, Change Format : AHD 2M 25P\n", decoder_info->ch);
1832
- }
1833
- else
1834
- {
1722
+ } else {
18351723 printk("[DRV] [Ch:%d] Get Format : CVI 2M, Not Change Format\n", decoder_info->ch);
18361724 }
1837
- }
1838
- else
1839
- {
1725
+ } else {
18401726 decoder_info->fmt_def = fmtdef;
18411727 }
18421728 }