| .. | .. |
|---|
| 82 | 82 | I2C_BOARD_INFO("nvp6158", 0x60), |
|---|
| 83 | 83 | }; |
|---|
| 84 | 84 | static bool nvp6158_init_state; |
|---|
| 85 | | -unsigned int nvp6158_gCoaxFirmUpdateFlag[16]={0,}; |
|---|
| 86 | | -unsigned char nvp6158_det_mode[16]={NVP6158_DET_MODE_AUTO,}; |
|---|
| 85 | +unsigned int nvp6158_gCoaxFirmUpdateFlag[16] = {0,}; |
|---|
| 86 | +unsigned char nvp6158_det_mode[16] = {NVP6158_DET_MODE_AUTO,}; |
|---|
| 87 | 87 | struct semaphore nvp6158_lock; |
|---|
| 88 | 88 | extern unsigned char nvp6158_ch_mode_status[16]; |
|---|
| 89 | 89 | extern unsigned char nvp6158_ch_vfmt_status[16]; |
|---|
| .. | .. |
|---|
| 92 | 92 | #define NVP6158_DRIVER_VER "1.1.01" |
|---|
| 93 | 93 | #define NVP6158_HW_REG(reg) *((volatile unsigned int *)(reg)) |
|---|
| 94 | 94 | |
|---|
| 95 | | -int nvp6158_g_soc_chiptype=0x3521; |
|---|
| 95 | +int nvp6158_g_soc_chiptype = 0x3521; |
|---|
| 96 | 96 | int nvp6158_chip_id[4]; |
|---|
| 97 | 97 | int nvp6158_rev_id[4]; |
|---|
| 98 | 98 | |
|---|
| .. | .. |
|---|
| 144 | 144 | |
|---|
| 145 | 145 | /* check Device ID of maxium 4chip on the slave address, |
|---|
| 146 | 146 | * manage slave address. chip count. */ |
|---|
| 147 | | - for(chip=0;chip<4;chip++) |
|---|
| 148 | | - { |
|---|
| 147 | + for(chip = 0; chip < 4; chip ++) { |
|---|
| 149 | 148 | nvp6158_chip_id[chip] = nvp6158_check_id(nvp6158_iic_addr[chip]); |
|---|
| 150 | 149 | nvp6158_rev_id[chip] = nvp6158_check_rev(nvp6158_iic_addr[chip]); |
|---|
| 151 | | - if( (nvp6158_chip_id[chip] != NVP6158_R0_ID ) && |
|---|
| 152 | | - (nvp6158_chip_id[chip] != NVP6158C_R0_ID) && |
|---|
| 153 | | - (nvp6158_chip_id[chip] != NVP6168_R0_ID ) && |
|---|
| 154 | | - (nvp6158_chip_id[chip] != NVP6168C_R0_ID) ) |
|---|
| 155 | | - { |
|---|
| 150 | + if( (nvp6158_chip_id[chip] != NVP6158_R0_ID ) && (nvp6158_chip_id[chip] != NVP6158C_R0_ID) && |
|---|
| 151 | + (nvp6158_chip_id[chip] != NVP6168_R0_ID ) && (nvp6158_chip_id[chip] != NVP6168C_R0_ID)) { |
|---|
| 156 | 152 | printk("[NVP6158_DRV]Device ID Error... 0x%x\n", nvp6158_chip_id[chip]); |
|---|
| 157 | | - } |
|---|
| 158 | | - else |
|---|
| 159 | | - { |
|---|
| 153 | + } else { |
|---|
| 160 | 154 | printk("[NVP6158_DRV]Device (0x%x) ID OK... 0x%x\n", nvp6158_iic_addr[chip], nvp6158_chip_id[chip]); |
|---|
| 161 | 155 | printk("[NVP6158_DRV]Device (0x%x) REV ... 0x%x\n", nvp6158_iic_addr[chip], nvp6158_rev_id[chip]); |
|---|
| 162 | | - nvp6158_iic_addr[nvp6158_cnt] = nvp6158_iic_addr[chip]; |
|---|
| 156 | + nvp6158_iic_addr[nvp6158_cnt] = nvp6158_iic_addr[chip]; |
|---|
| 163 | 157 | if(nvp6158_cnt<chip) |
|---|
| 164 | 158 | nvp6158_iic_addr[chip] = 0xFF; |
|---|
| 165 | 159 | nvp6158_chip_id[nvp6158_cnt] = nvp6158_chip_id[chip]; |
|---|
| .. | .. |
|---|
| 169 | 163 | } |
|---|
| 170 | 164 | |
|---|
| 171 | 165 | printk("[NVP6158_DRV]Chip Count = %d\n", nvp6158_cnt); |
|---|
| 172 | | - printk("[NVP6158_DRV]Address [0x%x][0x%x][0x%x][0x%x]\n",nvp6158_iic_addr[0],nvp6158_iic_addr[1],nvp6158_iic_addr[2],nvp6158_iic_addr[3]); |
|---|
| 173 | | - printk("[NVP6158_DRV]Chip Id [0x%x][0x%x][0x%x][0x%x]\n",nvp6158_chip_id[0],nvp6158_chip_id[1],nvp6158_chip_id[2],nvp6158_chip_id[3]); |
|---|
| 174 | | - printk("[NVP6158_DRV]Rev Id [0x%x][0x%x][0x%x][0x%x]\n",nvp6158_rev_id[0],nvp6158_rev_id[1],nvp6158_rev_id[2],nvp6158_rev_id[3]); |
|---|
| 166 | + printk("[NVP6158_DRV]Address [0x%x][0x%x][0x%x][0x%x]\n", nvp6158_iic_addr[0], |
|---|
| 167 | + nvp6158_iic_addr[1], nvp6158_iic_addr[2], nvp6158_iic_addr[3]); |
|---|
| 168 | + printk("[NVP6158_DRV]Chip Id [0x%x][0x%x][0x%x][0x%x]\n", nvp6158_chip_id[0], |
|---|
| 169 | + nvp6158_chip_id[1], nvp6158_chip_id[2], nvp6158_chip_id[3]); |
|---|
| 170 | + printk("[NVP6158_DRV]Rev Id [0x%x][0x%x][0x%x][0x%x]\n", nvp6158_rev_id[0], |
|---|
| 171 | + nvp6158_rev_id[1], nvp6158_rev_id[2], nvp6158_rev_id[3]); |
|---|
| 175 | 172 | |
|---|
| 176 | 173 | ret = nvp6158_cnt; |
|---|
| 177 | 174 | |
|---|
| .. | .. |
|---|
| 196 | 193 | |
|---|
| 197 | 194 | printk("[NVP6158_DRV] %s(%d) \n", __func__, __LINE__); |
|---|
| 198 | 195 | /* initialize common value of AHD */ |
|---|
| 199 | | - for(chip=0;chip<nvp6158_cnt;chip++) |
|---|
| 200 | | - { |
|---|
| 196 | + for(chip = 0; chip < nvp6158_cnt; chip++) { |
|---|
| 201 | 197 | nvp6158_common_init(chip); |
|---|
| 202 | | - if(nvp6158_chip_id[chip]==NVP6158C_R0_ID || nvp6158_chip_id[chip]==NVP6158_R0_ID) |
|---|
| 198 | + if(nvp6158_chip_id[chip] == NVP6158C_R0_ID || nvp6158_chip_id[chip] == NVP6158_R0_ID) { |
|---|
| 203 | 199 | nvp6158_additional_for3MoverDef(chip); |
|---|
| 204 | | - else |
|---|
| 205 | | - { |
|---|
| 200 | + } else { |
|---|
| 206 | 201 | gpio_i2c_write(nvp6158_iic_addr[chip], 0xff, 0x01 ); |
|---|
| 207 | 202 | gpio_i2c_write(nvp6158_iic_addr[chip], 0x97, 0x00); // CH_RST ON |
|---|
| 208 | 203 | gpio_i2c_write(nvp6158_iic_addr[chip], 0x97, 0x0f); // CH_RST OFF |
|---|
| 209 | 204 | gpio_i2c_write(nvp6158_iic_addr[chip], 0x7a, 0x0f); // Clock Auto ON |
|---|
| 210 | 205 | gpio_i2c_write(nvp6158_iic_addr[chip], 0xca, 0xff); // VCLK_EN, VDO_EN |
|---|
| 211 | 206 | |
|---|
| 212 | | - for(ch=0; ch<4; ch++) |
|---|
| 213 | | - { |
|---|
| 214 | | - gpio_i2c_write(nvp6158_iic_addr[chip], 0xff, 0x05 +ch); |
|---|
| 207 | + for(ch = 0; ch < 4; ch++) { |
|---|
| 208 | + gpio_i2c_write(nvp6158_iic_addr[chip], 0xff, 0x05 + ch); |
|---|
| 215 | 209 | gpio_i2c_write(nvp6158_iic_addr[chip], 0x00, 0xd0); |
|---|
| 216 | 210 | |
|---|
| 217 | 211 | gpio_i2c_write(nvp6158_iic_addr[chip], 0x05, 0x04); |
|---|
| .. | .. |
|---|
| 290 | 284 | } |
|---|
| 291 | 285 | } |
|---|
| 292 | 286 | |
|---|
| 293 | | - for(ch=0;ch<nvp6158_cnt*4;ch++) |
|---|
| 294 | | - { |
|---|
| 287 | + for(ch = 0; ch < nvp6158_cnt * 4; ch++) { |
|---|
| 295 | 288 | nvp6158_det_mode[ch] = NVP6158_DET_MODE_AUTO; |
|---|
| 296 | | - vin_auto_det.ch = ch%4; |
|---|
| 297 | | - vin_auto_det.devnum = ch/4; |
|---|
| 289 | + vin_auto_det.ch = ch % 4; |
|---|
| 290 | + vin_auto_det.devnum = ch / 4; |
|---|
| 298 | 291 | #ifdef _NVP6168_USE_MANUAL_MODE_ |
|---|
| 299 | | - vin_manual_det.ch = ch%4; |
|---|
| 300 | | - vin_manual_det.dev_num = ch/4; |
|---|
| 292 | + vin_manual_det.ch = ch % 4; |
|---|
| 293 | + vin_manual_det.dev_num = ch / 4; |
|---|
| 301 | 294 | #endif |
|---|
| 302 | | - if(nvp6158_chip_id[0]==NVP6158C_R0_ID || nvp6158_chip_id[0]==NVP6158_R0_ID) |
|---|
| 303 | | - { |
|---|
| 295 | + if(nvp6158_chip_id[0] == NVP6158C_R0_ID || nvp6158_chip_id[0] == NVP6158_R0_ID) { |
|---|
| 304 | 296 | nvp6158_video_input_auto_detect_set(&vin_auto_det); |
|---|
| 305 | 297 | nvp6158_set_chnmode(ch, NC_VIVO_CH_FORMATDEF_UNKNOWN); |
|---|
| 306 | | - } |
|---|
| 307 | | - else |
|---|
| 308 | | - { |
|---|
| 298 | + } else { |
|---|
| 309 | 299 | nvp6168_video_input_auto_detect_set(&vin_auto_det); |
|---|
| 310 | 300 | #ifdef _NVP6168_USE_MANUAL_MODE_ |
|---|
| 311 | 301 | nvp6168_video_input_manual_mode_set(&vin_manual_det); |
|---|
| 312 | 302 | #endif |
|---|
| 313 | | - nvp6168_set_chnmode(ch, NC_VIVO_CH_FORMATDEF_UNKNOWN); |
|---|
| 303 | + nvp6168_set_chnmode(ch, NC_VIVO_CH_FORMATDEF_UNKNOWN); |
|---|
| 314 | 304 | } |
|---|
| 315 | 305 | } |
|---|
| 316 | 306 | |
|---|
| 317 | | - for(chip=0;chip<nvp6158_cnt;chip++) |
|---|
| 318 | | - { |
|---|
| 319 | | - if(nvp6158_chip_id[chip] == NVP6158_R0_ID || nvp6158_chip_id[chip] == NVP6168_R0_ID) |
|---|
| 320 | | - { |
|---|
| 307 | + for(chip = 0; chip < nvp6158_cnt; chip++) { |
|---|
| 308 | + if(nvp6158_chip_id[chip] == NVP6158_R0_ID || nvp6158_chip_id[chip] == NVP6168_R0_ID) { |
|---|
| 321 | 309 | //set nvp6158 output mode of 4port, 0~3 port is available |
|---|
| 322 | | - nvp6158_set_portmode(chip, 0, NVP6158_OUTMODE_1MUX_FHD, 0); |
|---|
| 310 | + nvp6158_set_portmode(chip, 0, NVP6158_OUTMODE_1MUX_FHD, 0); |
|---|
| 323 | 311 | nvp6158_set_portmode(chip, 1, NVP6158_OUTMODE_1MUX_FHD, 1); |
|---|
| 324 | 312 | nvp6158_set_portmode(chip, 2, NVP6158_OUTMODE_1MUX_FHD, 2); |
|---|
| 325 | 313 | nvp6158_set_portmode(chip, 3, NVP6158_OUTMODE_1MUX_FHD, 3); |
|---|
| 326 | | - } |
|---|
| 327 | | - else //if(nvp6158_chip_id[chip] == NVP6158C_R0_ID) |
|---|
| 328 | | - { |
|---|
| 314 | + } else {//if(nvp6158_chip_id[chip] == NVP6158C_R0_ID) |
|---|
| 329 | 315 | //set nvp6158C output mode of 2port, 1/2 port is available |
|---|
| 330 | | - nvp6158_set_portmode(chip, 1, NVP6158_OUTMODE_2MUX_FHD, 0); |
|---|
| 316 | + nvp6158_set_portmode(chip, 1, NVP6158_OUTMODE_2MUX_FHD, 0); |
|---|
| 331 | 317 | nvp6158_set_portmode(chip, 2, NVP6158_OUTMODE_2MUX_FHD, 1); |
|---|
| 332 | 318 | } |
|---|
| 333 | 319 | } |
|---|
| .. | .. |
|---|
| 340 | 326 | printk("[DRV] Nvp6158 Driver Open\n"); |
|---|
| 341 | 327 | printk("[DRV] Nvp6158 Driver Ver::%s\n", NVP6158_DRIVER_VER); |
|---|
| 342 | 328 | return 0; |
|---|
| 343 | | -} |
|---|
| 329 | +} |
|---|
| 344 | 330 | |
|---|
| 345 | 331 | int nvp6158_close(struct inode * inode, struct file * file) |
|---|
| 346 | 332 | { |
|---|
| .. | .. |
|---|
| 373 | 359 | /* you must skip other command to improve speed of f/w update |
|---|
| 374 | 360 | * when you are updating cam's f/w up. we need to review and test */ |
|---|
| 375 | 361 | //if( acp_dvr_checkFWUpdateStatus( cmd ) == -1 ) |
|---|
| 376 | | - { |
|---|
| 362 | + //{ |
|---|
| 377 | 363 | //printk(">>>>> DRV[%s:%d] Now cam f/w update mode. so Skip other command.\n", __func__, __LINE__ ); |
|---|
| 378 | 364 | //return 0; |
|---|
| 379 | | - } |
|---|
| 365 | + //} |
|---|
| 380 | 366 | down(&nvp6158_lock); |
|---|
| 381 | | - switch (cmd) |
|---|
| 382 | | - { |
|---|
| 367 | + switch (cmd) { |
|---|
| 383 | 368 | case IOC_VDEC_SET_I2C : // nextchip demoboard test |
|---|
| 384 | | - if (copy_from_user(&i2c, argp, sizeof(nvp6124_i2c_mode))) {up(&nvp6158_lock);return -1;} |
|---|
| 369 | + if (copy_from_user(&i2c, argp, sizeof(nvp6124_i2c_mode))) { |
|---|
| 370 | + up(&nvp6158_lock); |
|---|
| 371 | + return -1; |
|---|
| 372 | + } |
|---|
| 385 | 373 | |
|---|
| 386 | | - if(i2c.flag == 0) // read |
|---|
| 387 | | - { |
|---|
| 374 | + if(i2c.flag == 0) {// read |
|---|
| 388 | 375 | gpio_i2c_write(i2c.slaveaddr, 0xFF, i2c.bank); |
|---|
| 389 | 376 | i2c.data = gpio_i2c_read(i2c.slaveaddr, i2c.address); |
|---|
| 390 | | - } |
|---|
| 391 | | - else //write |
|---|
| 392 | | - { |
|---|
| 377 | + } else {//write |
|---|
| 393 | 378 | gpio_i2c_write(i2c.slaveaddr, 0xFF, i2c.bank); |
|---|
| 394 | 379 | gpio_i2c_write(i2c.slaveaddr, i2c.address, i2c.data); |
|---|
| 395 | 380 | } |
|---|
| .. | .. |
|---|
| 402 | 387 | printk("IOC_VDEC_GET_VIDEO_LOSS error\n"); |
|---|
| 403 | 388 | break; |
|---|
| 404 | 389 | case IOC_VDEC_GET_EQ_DIST: |
|---|
| 405 | | - if (copy_from_user(&s_eq_dist, argp, sizeof(video_equalizer_info_s))) {up(&nvp6158_lock);return -1;} |
|---|
| 406 | | - |
|---|
| 390 | + if (copy_from_user(&s_eq_dist, argp, sizeof(video_equalizer_info_s))) { |
|---|
| 391 | + up(&nvp6158_lock); |
|---|
| 392 | + return -1; |
|---|
| 393 | + } |
|---|
| 394 | + |
|---|
| 407 | 395 | s_eq_dist.distance = nvp6158_get_eq_dist(&s_eq_dist); |
|---|
| 408 | 396 | if(copy_to_user(argp, &s_eq_dist, sizeof(video_equalizer_info_s))) |
|---|
| 409 | 397 | printk("IOC_VDEC_GET_EQ_DIST error\n"); |
|---|
| 410 | | - break; |
|---|
| 398 | + break; |
|---|
| 411 | 399 | case IOC_VDEC_SET_EQUALIZER: |
|---|
| 412 | | - if (copy_from_user(&s_eq_dist, argp, sizeof(video_equalizer_info_s))) {up(&nvp6158_lock);return -1;} |
|---|
| 413 | | - if(nvp6158_chip_id[0]==NVP6158C_R0_ID || nvp6158_chip_id[0]==NVP6158_R0_ID) |
|---|
| 414 | | - nvp6158_set_equalizer(&s_eq_dist); |
|---|
| 400 | + if (copy_from_user(&s_eq_dist, argp, sizeof(video_equalizer_info_s))) { |
|---|
| 401 | + up(&nvp6158_lock); |
|---|
| 402 | + return -1; |
|---|
| 403 | + } |
|---|
| 404 | + if(nvp6158_chip_id[0] == NVP6158C_R0_ID || nvp6158_chip_id[0] == NVP6158_R0_ID) |
|---|
| 405 | + nvp6158_set_equalizer(&s_eq_dist); |
|---|
| 415 | 406 | else |
|---|
| 416 | 407 | nvp6168_set_equalizer(&s_eq_dist); |
|---|
| 417 | 408 | break; |
|---|
| 418 | | - case IOC_VDEC_GET_DRIVERVER: |
|---|
| 409 | + case IOC_VDEC_GET_DRIVERVER: |
|---|
| 419 | 410 | if(copy_to_user(argp, &NVP6158_DRIVER_VER, sizeof(NVP6158_DRIVER_VER))) |
|---|
| 420 | 411 | printk("IOC_VDEC_GET_DRIVERVER error\n"); |
|---|
| 421 | 412 | break; |
|---|
| .. | .. |
|---|
| 428 | 419 | { |
|---|
| 429 | 420 | ispdata.data = acp_isp_read(ispdata.ch, ispdata.addr); |
|---|
| 430 | 421 | if(copy_to_user(argp, &ispdata, sizeof(nvp6158_acp_rw_data))) |
|---|
| 431 | | - printk("IOC_VDEC_ACP_WRITE error\n"); |
|---|
| 422 | + printk("IOC_VDEC_ACP_WRITE error\n"); |
|---|
| 432 | 423 | }*/ |
|---|
| 433 | 424 | break; |
|---|
| 434 | 425 | case IOC_VDEC_ACP_WRITE_EXTENTION: |
|---|
| 435 | | - |
|---|
| 426 | + |
|---|
| 436 | 427 | break; |
|---|
| 437 | 428 | case IOC_VDEC_PTZ_ACP_READ: |
|---|
| 438 | 429 | //if (copy_from_user(&vfmt, argp, sizeof(nvp6158_input_videofmt))) |
|---|
| .. | .. |
|---|
| 445 | 436 | //if(((nvp6158_g_vloss>>i)&0x01) == 0x00) |
|---|
| 446 | 437 | // acp_read(&vfmt, i); |
|---|
| 447 | 438 | // } |
|---|
| 448 | | - //} |
|---|
| 439 | + //} |
|---|
| 449 | 440 | //if(copy_to_user(argp, &vfmt, sizeof(nvp6158_input_videofmt))) |
|---|
| 450 | | - // printk("IOC_VDEC_PTZ_ACP_READ error\n"); |
|---|
| 451 | | - break; |
|---|
| 441 | + // printk("IOC_VDEC_PTZ_ACP_READ error\n"); |
|---|
| 442 | + break; |
|---|
| 452 | 443 | case IOC_VDEC_PTZ_ACP_READ_EACH_CH: |
|---|
| 453 | | - if (copy_from_user(&vfmt_ch, argp, sizeof(nvp6158_input_videofmt_ch))) {up(&nvp6158_lock);return -1;} |
|---|
| 444 | + if (copy_from_user(&vfmt_ch, argp, sizeof(nvp6158_input_videofmt_ch))) { |
|---|
| 445 | + up(&nvp6158_lock); |
|---|
| 446 | + return -1; |
|---|
| 447 | + } |
|---|
| 454 | 448 | /* read A-CP */ |
|---|
| 455 | | - if(((nvp6158_g_vloss>>vfmt_ch.ch)&0x01) == 0x00) |
|---|
| 456 | | - { |
|---|
| 449 | + if(((nvp6158_g_vloss>>vfmt_ch.ch) & 0x01) == 0x00) { |
|---|
| 457 | 450 | //acp_read(&vfmt_ch.vfmt, vfmt_ch.ch); |
|---|
| 458 | 451 | } |
|---|
| 459 | 452 | |
|---|
| .. | .. |
|---|
| 461 | 454 | printk("IOC_VDEC_PTZ_ACP_READ_EACH_CH error\n"); |
|---|
| 462 | 455 | break; |
|---|
| 463 | 456 | case IOC_VDEC_GET_INPUT_VIDEO_FMT: |
|---|
| 464 | | - if (copy_from_user(&vfmt, argp, sizeof(NVP6158_INFORMATION_S))) {up(&nvp6158_lock);return -1;} |
|---|
| 465 | | - if(nvp6158_chip_id[0]==NVP6158C_R0_ID || nvp6158_chip_id[0]==NVP6158_R0_ID) |
|---|
| 457 | + if (copy_from_user(&vfmt, argp, sizeof(NVP6158_INFORMATION_S))) { |
|---|
| 458 | + up(&nvp6158_lock); |
|---|
| 459 | + return -1; |
|---|
| 460 | + } |
|---|
| 461 | + if(nvp6158_chip_id[0] == NVP6158C_R0_ID || nvp6158_chip_id[0] == NVP6158_R0_ID) |
|---|
| 466 | 462 | nvp6158_video_fmt_det(vfmt.ch, &vfmt); |
|---|
| 467 | 463 | else |
|---|
| 468 | 464 | nvp6168_video_fmt_det(vfmt.ch, &vfmt); |
|---|
| 469 | 465 | if(copy_to_user(argp, &vfmt, sizeof(NVP6158_INFORMATION_S))) |
|---|
| 470 | 466 | printk("IOC_VDEC_GET_INPUT_VIDEO_FMT error\n"); |
|---|
| 471 | | - break; |
|---|
| 467 | + break; |
|---|
| 472 | 468 | case IOC_VDEC_SET_CHDETMODE: |
|---|
| 473 | | - if (copy_from_user(&nvp6158_det_mode, argp, sizeof(unsigned char)*16)) {up(&nvp6158_lock);return -1;} |
|---|
| 474 | | - |
|---|
| 475 | | - for(i=0;i<(nvp6158_cnt*4);i++) |
|---|
| 476 | | - { |
|---|
| 477 | | - printk("IOC_VDEC_SET_CHNMODE nvp6158_det_mode[%d]==%d\n", i, nvp6158_det_mode[i]); |
|---|
| 478 | | - if(nvp6158_chip_id[0]==NVP6158C_R0_ID || nvp6158_chip_id[0]==NVP6158_R0_ID) |
|---|
| 469 | + if (copy_from_user(&nvp6158_det_mode, argp, sizeof(unsigned char) * 16)) { |
|---|
| 470 | + up(&nvp6158_lock); |
|---|
| 471 | + return -1; |
|---|
| 472 | + } |
|---|
| 473 | + for(i = 0; i<(nvp6158_cnt * 4); i++) { |
|---|
| 474 | + printk("IOC_VDEC_SET_CHNMODE nvp6158_det_mode[%d]==%d\n", |
|---|
| 475 | + i, nvp6158_det_mode[i]); |
|---|
| 476 | + if(nvp6158_chip_id[0] == NVP6158C_R0_ID || nvp6158_chip_id[0] == NVP6158_R0_ID) |
|---|
| 479 | 477 | nvp6158_set_chnmode(i, NC_VIVO_CH_FORMATDEF_UNKNOWN); |
|---|
| 480 | 478 | else |
|---|
| 481 | 479 | nvp6168_set_chnmode(i, NC_VIVO_CH_FORMATDEF_UNKNOWN); |
|---|
| 482 | 480 | } |
|---|
| 483 | | - break; |
|---|
| 481 | + break; |
|---|
| 484 | 482 | case IOC_VDEC_SET_CHNMODE: |
|---|
| 485 | | - if (copy_from_user(&schnmode, argp, sizeof(nvp6158_chn_mode))) {up(&nvp6158_lock);return -1;} |
|---|
| 486 | | - if(nvp6158_chip_id[0]==NVP6158C_R0_ID || nvp6158_chip_id[0]==NVP6158_R0_ID) |
|---|
| 487 | | - { |
|---|
| 483 | + if (copy_from_user(&schnmode, argp, sizeof(nvp6158_chn_mode))) { |
|---|
| 484 | + up(&nvp6158_lock); |
|---|
| 485 | + return -1; |
|---|
| 486 | + } |
|---|
| 487 | + if(nvp6158_chip_id[0] == NVP6158C_R0_ID || nvp6158_chip_id[0] == NVP6158_R0_ID) { |
|---|
| 488 | 488 | if(0 == nvp6158_set_chnmode(schnmode.ch, schnmode.chmode)) |
|---|
| 489 | 489 | printk("IOC_VDEC_SET_CHNMODE OK\n"); |
|---|
| 490 | | - } |
|---|
| 491 | | - else |
|---|
| 492 | | - { |
|---|
| 490 | + } else { |
|---|
| 493 | 491 | if(0 == nvp6168_set_chnmode(schnmode.ch, schnmode.chmode)) |
|---|
| 494 | 492 | printk("IOC_VDEC_SET_CHNMODE OK\n"); |
|---|
| 495 | 493 | } |
|---|
| 496 | 494 | break; |
|---|
| 497 | 495 | case IOC_VDEC_SET_OUTPORTMODE: |
|---|
| 498 | | - if(copy_from_user(&optmode, argp, sizeof(nvp6158_opt_mode))) {up(&nvp6158_lock);return -1;} |
|---|
| 496 | + if(copy_from_user(&optmode, argp, sizeof(nvp6158_opt_mode))) { |
|---|
| 497 | + up(&nvp6158_lock); |
|---|
| 498 | + return -1; |
|---|
| 499 | + } |
|---|
| 499 | 500 | nvp6158_set_portmode(optmode.chipsel, optmode.portsel, optmode.portmode, optmode.chid); |
|---|
| 500 | | - break; |
|---|
| 501 | + break; |
|---|
| 501 | 502 | case IOC_VDEC_SET_BRIGHTNESS: |
|---|
| 502 | | - if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) {up(&nvp6158_lock);return -1;} |
|---|
| 503 | + if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) { |
|---|
| 504 | + up(&nvp6158_lock); |
|---|
| 505 | + return -1; |
|---|
| 506 | + } |
|---|
| 503 | 507 | //nvp6158_video_set_brightness(v_adj.ch, v_adj.value, nvp6158_ch_vfmt_status[v_adj.ch]); |
|---|
| 504 | 508 | break; |
|---|
| 505 | 509 | case IOC_VDEC_SET_CONTRAST: |
|---|
| 506 | | - if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) {up(&nvp6158_lock);return -1;} |
|---|
| 510 | + if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) { |
|---|
| 511 | + up(&nvp6158_lock); |
|---|
| 512 | + return -1; |
|---|
| 513 | + } |
|---|
| 507 | 514 | //nvp6158_video_set_contrast(v_adj.ch, v_adj.value, nvp6158_ch_vfmt_status[v_adj.ch]); |
|---|
| 508 | 515 | break; |
|---|
| 509 | 516 | case IOC_VDEC_SET_HUE: |
|---|
| 510 | | - if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) {up(&nvp6158_lock);return -1;} |
|---|
| 517 | + if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) { |
|---|
| 518 | + up(&nvp6158_lock); |
|---|
| 519 | + return -1; |
|---|
| 520 | + } |
|---|
| 511 | 521 | //nvp6158_video_set_hue(v_adj.ch, v_adj.value, nvp6158_ch_vfmt_status[v_adj.ch]); |
|---|
| 512 | 522 | break; |
|---|
| 513 | 523 | case IOC_VDEC_SET_SATURATION: |
|---|
| 514 | | - if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) {up(&nvp6158_lock);return -1;} |
|---|
| 524 | + if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) { |
|---|
| 525 | + up(&nvp6158_lock); |
|---|
| 526 | + return -1; |
|---|
| 527 | + } |
|---|
| 515 | 528 | //nvp6158_video_set_saturation(v_adj.ch, v_adj.value, nvp6158_ch_vfmt_status[v_adj.ch]); |
|---|
| 516 | 529 | break; |
|---|
| 517 | 530 | case IOC_VDEC_SET_SHARPNESS: |
|---|
| 518 | | - if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) {up(&nvp6158_lock);return -1;} |
|---|
| 531 | + if(copy_from_user(&v_adj, argp, sizeof(nvp6158_video_adjust))) { |
|---|
| 532 | + up(&nvp6158_lock); |
|---|
| 533 | + return -1; |
|---|
| 534 | + } |
|---|
| 519 | 535 | nvp6158_video_set_sharpness(v_adj.ch, v_adj.value); |
|---|
| 520 | 536 | break; |
|---|
| 521 | 537 | /*----------------------- Coaxial Protocol ----------------------*/ |
|---|
| .. | .. |
|---|
| 541 | 557 | break; |
|---|
| 542 | 558 | case IOC_VDEC_COAX_TX_CVI_NEW_CMD_SEND: //SK_CHANGE 170703 |
|---|
| 543 | 559 | if(copy_from_user(&coax_val, argp, sizeof(nvp6158_coax_str))) |
|---|
| 544 | | - printk(" IOC_VDEC_COAX_TX_CMD_SEND error\n"); |
|---|
| 560 | + printk(" IOC_VDEC_COAX_TX_CMD_SEND error\n"); |
|---|
| 545 | 561 | nvp6158_coax_tx_cvi_new_cmd_send(&coax_val); |
|---|
| 546 | 562 | break; |
|---|
| 547 | 563 | case IOC_VDEC_COAX_RX_INIT: |
|---|
| .. | .. |
|---|
| 575 | 591 | /*=========== Coaxial Protocol Firmware Update ==============*/ |
|---|
| 576 | 592 | case IOC_VDEC_COAX_FW_ACP_HEADER_GET: |
|---|
| 577 | 593 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 578 | | - printk("IOC_VDEC_COAX_FW_READY_CMD_SET error\n"); |
|---|
| 594 | + printk("IOC_VDEC_COAX_FW_READY_CMD_SET error\n"); |
|---|
| 579 | 595 | nvp6158_coax_fw_ready_header_check_from_isp_recv(&coax_fw_val); |
|---|
| 580 | 596 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 581 | 597 | break; |
|---|
| 582 | 598 | case IOC_VDEC_COAX_FW_READY_CMD_SET: |
|---|
| 583 | 599 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 584 | | - printk("IOC_VDEC_COAX_FW_READY_CMD_SET error\n"); |
|---|
| 600 | + printk("IOC_VDEC_COAX_FW_READY_CMD_SET error\n"); |
|---|
| 585 | 601 | nvp6158_coax_fw_ready_cmd_to_isp_send(&coax_fw_val); |
|---|
| 586 | 602 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 587 | 603 | break; |
|---|
| 588 | 604 | case IOC_VDEC_COAX_FW_READY_ACK_GET: |
|---|
| 589 | 605 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 590 | | - printk("IOC_VDEC_COAX_FW_READY_ISP_STATUS_GET error\n"); |
|---|
| 606 | + printk("IOC_VDEC_COAX_FW_READY_ISP_STATUS_GET error\n"); |
|---|
| 591 | 607 | nvp6158_coax_fw_ready_cmd_ack_from_isp_recv(&coax_fw_val); |
|---|
| 592 | 608 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 593 | 609 | break; |
|---|
| 594 | 610 | case IOC_VDEC_COAX_FW_START_CMD_SET: |
|---|
| 595 | 611 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 596 | | - printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 612 | + printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 597 | 613 | nvp6158_coax_fw_start_cmd_to_isp_send(&coax_fw_val); |
|---|
| 598 | 614 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 599 | 615 | break; |
|---|
| 600 | 616 | case IOC_VDEC_COAX_FW_START_ACK_GET: |
|---|
| 601 | 617 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 602 | | - printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 618 | + printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 603 | 619 | nvp6158_coax_fw_start_cmd_ack_from_isp_recv(&coax_fw_val); |
|---|
| 604 | 620 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 605 | 621 | break; |
|---|
| 606 | 622 | case IOC_VDEC_COAX_FW_SEND_DATA_SET: |
|---|
| 607 | 623 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 608 | | - printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 624 | + printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 609 | 625 | nvp6158_coax_fw_one_packet_data_to_isp_send(&coax_fw_val); |
|---|
| 610 | 626 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 611 | 627 | break; |
|---|
| 612 | 628 | case IOC_VDEC_COAX_FW_SEND_ACK_GET: |
|---|
| 613 | 629 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 614 | | - printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 630 | + printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 615 | 631 | nvp6158_coax_fw_one_packet_data_ack_from_isp_recv(&coax_fw_val); |
|---|
| 616 | 632 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 617 | 633 | break; |
|---|
| 618 | 634 | case IOC_VDEC_COAX_FW_END_CMD_SET: |
|---|
| 619 | 635 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 620 | | - printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 636 | + printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 621 | 637 | nvp6158_coax_fw_end_cmd_to_isp_send(&coax_fw_val); |
|---|
| 622 | 638 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 623 | 639 | break; |
|---|
| 624 | 640 | case IOC_VDEC_COAX_FW_END_ACK_GET: |
|---|
| 625 | 641 | if(copy_from_user(&coax_fw_val, argp, sizeof(FIRMWARE_UP_FILE_INFO))) |
|---|
| 626 | | - printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 642 | + printk("IOC_VDEC_COAX_FW_START_CMD_SET error\n"); |
|---|
| 627 | 643 | nvp6158_coax_fw_end_cmd_ack_from_isp_recv(&coax_fw_val); |
|---|
| 628 | 644 | cpy2usr_ret = copy_to_user(argp, &coax_fw_val, sizeof(FIRMWARE_UP_FILE_INFO)); |
|---|
| 629 | 645 | break; |
|---|
| .. | .. |
|---|
| 681 | 697 | int chip = 0; |
|---|
| 682 | 698 | |
|---|
| 683 | 699 | printk("[NVP6158_DRV] %s(%d) \n", __func__, __LINE__); |
|---|
| 684 | | - for(ch=0;ch<nvp6158_cnt*4;ch++) |
|---|
| 685 | | - { |
|---|
| 686 | | - nvp6158_set_chnmode(ch, AHD20_1080P_30P); |
|---|
| 700 | + for(ch = 0; ch < nvp6158_cnt * 4; ch++) { |
|---|
| 701 | + nvp6158_set_chnmode(ch, AHD20_1080P_30P); |
|---|
| 687 | 702 | } |
|---|
| 688 | 703 | |
|---|
| 689 | | - for(chip=0;chip<nvp6158_cnt;chip++) |
|---|
| 690 | | - { |
|---|
| 704 | + for(chip = 0; chip < nvp6158_cnt; chip++) { |
|---|
| 691 | 705 | nvp6158_set_portmode(chip, 1, NVP6158_OUTMODE_1MUX_FHD, 0); |
|---|
| 692 | 706 | nvp6158_set_portmode(chip, 2, NVP6158_OUTMODE_1MUX_FHD, 1); |
|---|
| 693 | 707 | } |
|---|
| .. | .. |
|---|
| 712 | 726 | int chip = 0; |
|---|
| 713 | 727 | |
|---|
| 714 | 728 | printk("[NVP6158_DRV] %s(%d) \n", __func__, __LINE__); |
|---|
| 715 | | - for(ch=0;ch<nvp6158_cnt*4;ch++) |
|---|
| 716 | | - { |
|---|
| 717 | | - nvp6158_set_chnmode(ch, AHD20_720P_30P); |
|---|
| 729 | + for(ch = 0; ch < nvp6158_cnt * 4; ch++) { |
|---|
| 730 | + nvp6158_set_chnmode(ch, AHD20_720P_30P); |
|---|
| 718 | 731 | } |
|---|
| 719 | 732 | |
|---|
| 720 | | - for(chip=0;chip<nvp6158_cnt;chip++) |
|---|
| 721 | | - { |
|---|
| 733 | + for(chip = 0; chip < nvp6158_cnt; chip ++) { |
|---|
| 722 | 734 | nvp6158_set_portmode(chip, 1, NVP6158_OUTMODE_1MUX_BT1120S_720P, 1); |
|---|
| 723 | 735 | nvp6158_set_portmode(chip, 2, NVP6158_OUTMODE_1MUX_BT1120S_720P, 1); |
|---|
| 724 | 736 | } |
|---|
| .. | .. |
|---|
| 730 | 742 | int chip = 0; |
|---|
| 731 | 743 | |
|---|
| 732 | 744 | printk("[NVP6158_DRV] %s(%d) \n", __func__, __LINE__); |
|---|
| 733 | | - for(ch=0;ch<nvp6158_cnt*4;ch++) |
|---|
| 734 | | - { |
|---|
| 735 | | - nvp6158_set_chnmode(ch, AHD20_1080P_30P); |
|---|
| 745 | + for(ch = 0; ch < nvp6158_cnt * 4; ch++) { |
|---|
| 746 | + nvp6158_set_chnmode(ch, AHD20_1080P_30P); |
|---|
| 736 | 747 | } |
|---|
| 737 | 748 | |
|---|
| 738 | | - for(chip=0;chip<nvp6158_cnt;chip++) |
|---|
| 739 | | - { |
|---|
| 749 | + for(chip = 0; chip < nvp6158_cnt; chip++) { |
|---|
| 740 | 750 | nvp6158_set_portmode(chip, 1, NVP6158_OUTMODE_1MUX_BT1120S_1080P, 0); |
|---|
| 741 | 751 | nvp6158_set_portmode(chip, 2, NVP6158_OUTMODE_1MUX_BT1120S_1080P, 0); |
|---|
| 742 | 752 | } |
|---|
| .. | .. |
|---|
| 756 | 766 | nvp6158_video_decoder_init(); |
|---|
| 757 | 767 | /* initialize Audio |
|---|
| 758 | 768 | * recmaster, pbmaster, ch_num, samplerate, bits */ |
|---|
| 759 | | - if(nvp6158_chip_id[0]==NVP6158C_R0_ID || nvp6158_chip_id[0]==NVP6158_R0_ID) |
|---|
| 769 | + if(nvp6158_chip_id[0] == NVP6158C_R0_ID || nvp6158_chip_id[0] == NVP6158_R0_ID) |
|---|
| 760 | 770 | nvp6158_audio_init(1,0,16,0,0); |
|---|
| 761 | 771 | else |
|---|
| 762 | 772 | nvp6168_audio_init(1,0,16,0,0); |
|---|
| 763 | 773 | |
|---|
| 764 | | - switch (fmt_idx) |
|---|
| 765 | | - { |
|---|
| 774 | + switch (fmt_idx) { |
|---|
| 766 | 775 | /* normal output */ |
|---|
| 767 | 776 | case AHD20_720P_25P: |
|---|
| 768 | 777 | for (ch = 0; ch < nvp6158_cnt * 4; ch++) |
|---|
| .. | .. |
|---|
| 833 | 842 | break; |
|---|
| 834 | 843 | default: |
|---|
| 835 | 844 | for (ch = 0; ch < nvp6158_cnt * 4; ch++) |
|---|
| 836 | | - nvp6158_set_chnmode(ch, AHD20_1080P_30P); |
|---|
| 837 | | - break; |
|---|
| 845 | + nvp6158_set_chnmode(ch, AHD20_1080P_30P); |
|---|
| 846 | + break; |
|---|
| 838 | 847 | } |
|---|
| 839 | 848 | |
|---|
| 840 | 849 | nvp6158_set_colorpattern(); |
|---|
| 841 | 850 | //nvp6158_set_colorpattern2(); |
|---|
| 842 | 851 | //nvp6158_set_colorpattern3(); |
|---|
| 843 | 852 | |
|---|
| 844 | | - switch (mode) |
|---|
| 845 | | - { |
|---|
| 853 | + switch (mode) { |
|---|
| 846 | 854 | /* normal output */ |
|---|
| 847 | 855 | case BT656_1MUX: |
|---|
| 848 | 856 | if ((fmt_idx == AHD20_1080P_25P) || (fmt_idx == AHD20_1080P_30P)) { |
|---|
| .. | .. |
|---|
| 970 | 978 | break; |
|---|
| 971 | 979 | default: |
|---|
| 972 | 980 | printk("mode %d not supported yet\n", mode); |
|---|
| 973 | | - break; |
|---|
| 981 | + break; |
|---|
| 974 | 982 | } |
|---|
| 975 | 983 | up(&nvp6158_lock); |
|---|
| 976 | 984 | } |
|---|
| .. | .. |
|---|
| 984 | 992 | gpio_i2c_write(0x60, 0xFF, 0x01); |
|---|
| 985 | 993 | gpio_i2c_write(0x60, 0xCA, 0x00); |
|---|
| 986 | 994 | |
|---|
| 987 | | - for(ch=0;ch < 4;ch++) { |
|---|
| 995 | + for(ch = 0; ch < 4;ch++) { |
|---|
| 988 | 996 | nvp6158_channel_reset(ch); |
|---|
| 989 | 997 | } |
|---|
| 990 | 998 | up(&nvp6158_lock); |
|---|
| .. | .. |
|---|
| 1004 | 1012 | printk("[DRV] I2C Client Init \n"); |
|---|
| 1005 | 1013 | i2c_adap = i2c_get_adapter(i2c_bus); |
|---|
| 1006 | 1014 | |
|---|
| 1007 | | - nvp6158_client = i2c_new_device(i2c_adap, &nvp6158_hi_info); |
|---|
| 1015 | + nvp6158_client = i2c_new_client_device(i2c_adap, &nvp6158_hi_info); |
|---|
| 1008 | 1016 | i2c_put_adapter(i2c_adap); |
|---|
| 1009 | 1017 | |
|---|
| 1010 | 1018 | return 0; |
|---|