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