1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * adv7180.c Analog Devices ADV7180 video decoder driver 4 * Copyright (c) 2009 Intel Corporation 5 * Copyright (C) 2013 Cogent Embedded, Inc. 6 * Copyright (C) 2013 Renesas Solutions Corp. 7 */ 8 #include <linux/module.h> 9 #include <linux/init.h> 10 #include <linux/errno.h> 11 #include <linux/kernel.h> 12 #include <linux/interrupt.h> 13 #include <linux/i2c.h> 14 #include <linux/slab.h> 15 #include <linux/of.h> 16 #include <linux/gpio/consumer.h> 17 #include <linux/videodev2.h> 18 #include <media/v4l2-ioctl.h> 19 #include <media/v4l2-event.h> 20 #include <media/v4l2-device.h> 21 #include <media/v4l2-ctrls.h> 22 #include <linux/mutex.h> 23 #include <linux/delay.h> 24 25 #define ADV7180_STD_AD_PAL_BG_NTSC_J_SECAM 0x0 26 #define ADV7180_STD_AD_PAL_BG_NTSC_J_SECAM_PED 0x1 27 #define ADV7180_STD_AD_PAL_N_NTSC_J_SECAM 0x2 28 #define ADV7180_STD_AD_PAL_N_NTSC_M_SECAM 0x3 29 #define ADV7180_STD_NTSC_J 0x4 30 #define ADV7180_STD_NTSC_M 0x5 31 #define ADV7180_STD_PAL60 0x6 32 #define ADV7180_STD_NTSC_443 0x7 33 #define ADV7180_STD_PAL_BG 0x8 34 #define ADV7180_STD_PAL_N 0x9 35 #define ADV7180_STD_PAL_M 0xa 36 #define ADV7180_STD_PAL_M_PED 0xb 37 #define ADV7180_STD_PAL_COMB_N 0xc 38 #define ADV7180_STD_PAL_COMB_N_PED 0xd 39 #define ADV7180_STD_PAL_SECAM 0xe 40 #define ADV7180_STD_PAL_SECAM_PED 0xf 41 42 #define ADV7180_REG_INPUT_CONTROL 0x0000 43 #define ADV7180_INPUT_CONTROL_INSEL_MASK 0x0f 44 45 #define ADV7182_REG_INPUT_VIDSEL 0x0002 46 #define ADV7182_REG_INPUT_RESERVED BIT(2) 47 48 #define ADV7180_REG_OUTPUT_CONTROL 0x0003 49 #define ADV7180_REG_EXTENDED_OUTPUT_CONTROL 0x0004 50 #define ADV7180_EXTENDED_OUTPUT_CONTROL_NTSCDIS 0xC5 51 52 #define ADV7180_REG_AUTODETECT_ENABLE 0x0007 53 #define ADV7180_AUTODETECT_DEFAULT 0x7f 54 /* Contrast */ 55 #define ADV7180_REG_CON 0x0008 /*Unsigned */ 56 #define ADV7180_CON_MIN 0 57 #define ADV7180_CON_DEF 128 58 #define ADV7180_CON_MAX 255 59 /* Brightness*/ 60 #define ADV7180_REG_BRI 0x000a /*Signed */ 61 #define ADV7180_BRI_MIN -128 62 #define ADV7180_BRI_DEF 0 63 #define ADV7180_BRI_MAX 127 64 /* Hue */ 65 #define ADV7180_REG_HUE 0x000b /*Signed, inverted */ 66 #define ADV7180_HUE_MIN -127 67 #define ADV7180_HUE_DEF 0 68 #define ADV7180_HUE_MAX 128 69 70 #define ADV7180_REG_DEF_VALUE_Y 0x000c 71 #define ADV7180_DEF_VAL_EN 0x1 72 #define ADV7180_DEF_VAL_AUTO_EN 0x2 73 #define ADV7180_REG_CTRL 0x000e 74 #define ADV7180_CTRL_IRQ_SPACE 0x20 75 76 #define ADV7180_REG_PWR_MAN 0x0f 77 #define ADV7180_PWR_MAN_ON 0x04 78 #define ADV7180_PWR_MAN_OFF 0x24 79 #define ADV7180_PWR_MAN_RES 0x80 80 81 #define ADV7180_REG_STATUS1 0x0010 82 #define ADV7180_STATUS1_IN_LOCK 0x01 83 #define ADV7180_STATUS1_AUTOD_MASK 0x70 84 #define ADV7180_STATUS1_AUTOD_NTSM_M_J 0x00 85 #define ADV7180_STATUS1_AUTOD_NTSC_4_43 0x10 86 #define ADV7180_STATUS1_AUTOD_PAL_M 0x20 87 #define ADV7180_STATUS1_AUTOD_PAL_60 0x30 88 #define ADV7180_STATUS1_AUTOD_PAL_B_G 0x40 89 #define ADV7180_STATUS1_AUTOD_SECAM 0x50 90 #define ADV7180_STATUS1_AUTOD_PAL_COMB 0x60 91 #define ADV7180_STATUS1_AUTOD_SECAM_525 0x70 92 93 #define ADV7180_REG_IDENT 0x0011 94 #define ADV7180_ID_7180 0x18 95 96 #define ADV7180_REG_STATUS3 0x0013 97 #define ADV7180_REG_ANALOG_CLAMP_CTL 0x0014 98 #define ADV7180_REG_SHAP_FILTER_CTL_1 0x0017 99 #define ADV7180_REG_CTRL_2 0x001d 100 #define ADV7180_REG_VSYNC_FIELD_CTL_1 0x0031 101 #define ADV7180_VSYNC_FIELD_CTL_1_NEWAV 0x12 102 #define ADV7180_REG_MANUAL_WIN_CTL_1 0x003d 103 #define ADV7180_REG_MANUAL_WIN_CTL_2 0x003e 104 #define ADV7180_REG_MANUAL_WIN_CTL_3 0x003f 105 #define ADV7180_REG_LOCK_CNT 0x0051 106 #define ADV7180_REG_CVBS_TRIM 0x0052 107 #define ADV7180_REG_CLAMP_ADJ 0x005a 108 #define ADV7180_REG_RES_CIR 0x005f 109 #define ADV7180_REG_DIFF_MODE 0x0060 110 111 #define ADV7180_REG_ICONF1 0x2040 112 #define ADV7180_ICONF1_ACTIVE_LOW 0x01 113 #define ADV7180_ICONF1_PSYNC_ONLY 0x10 114 #define ADV7180_ICONF1_ACTIVE_TO_CLR 0xC0 115 /* Saturation */ 116 #define ADV7180_REG_SD_SAT_CB 0x00e3 /*Unsigned */ 117 #define ADV7180_REG_SD_SAT_CR 0x00e4 /*Unsigned */ 118 #define ADV7180_SAT_MIN 0 119 #define ADV7180_SAT_DEF 128 120 #define ADV7180_SAT_MAX 255 121 122 #define ADV7180_IRQ1_LOCK 0x01 123 #define ADV7180_IRQ1_UNLOCK 0x02 124 #define ADV7180_REG_ISR1 0x2042 125 #define ADV7180_REG_ICR1 0x2043 126 #define ADV7180_REG_IMR1 0x2044 127 #define ADV7180_REG_IMR2 0x2048 128 #define ADV7180_IRQ3_AD_CHANGE 0x08 129 #define ADV7180_REG_ISR3 0x204A 130 #define ADV7180_REG_ICR3 0x204B 131 #define ADV7180_REG_IMR3 0x204C 132 #define ADV7180_REG_IMR4 0x2050 133 134 #define ADV7180_REG_NTSC_V_BIT_END 0x00E6 135 #define ADV7180_NTSC_V_BIT_END_MANUAL_NVEND 0x4F 136 137 #define ADV7180_REG_VPP_SLAVE_ADDR 0xFD 138 #define ADV7180_REG_CSI_SLAVE_ADDR 0xFE 139 140 #define ADV7180_REG_ACE_CTRL1 0x4080 141 #define ADV7180_REG_ACE_CTRL5 0x4084 142 #define ADV7180_REG_FLCONTROL 0x40e0 143 #define ADV7180_FLCONTROL_FL_ENABLE 0x1 144 145 #define ADV7180_REG_RST_CLAMP 0x809c 146 #define ADV7180_REG_AGC_ADJ1 0x80b6 147 #define ADV7180_REG_AGC_ADJ2 0x80c0 148 149 #define ADV7180_CSI_REG_PWRDN 0x00 150 #define ADV7180_CSI_PWRDN 0x80 151 152 #define ADV7180_INPUT_CVBS_AIN1 0x00 153 #define ADV7180_INPUT_CVBS_AIN2 0x01 154 #define ADV7180_INPUT_CVBS_AIN3 0x02 155 #define ADV7180_INPUT_CVBS_AIN4 0x03 156 #define ADV7180_INPUT_CVBS_AIN5 0x04 157 #define ADV7180_INPUT_CVBS_AIN6 0x05 158 #define ADV7180_INPUT_SVIDEO_AIN1_AIN2 0x06 159 #define ADV7180_INPUT_SVIDEO_AIN3_AIN4 0x07 160 #define ADV7180_INPUT_SVIDEO_AIN5_AIN6 0x08 161 #define ADV7180_INPUT_YPRPB_AIN1_AIN2_AIN3 0x09 162 #define ADV7180_INPUT_YPRPB_AIN4_AIN5_AIN6 0x0a 163 164 #define ADV7182_INPUT_CVBS_AIN1 0x00 165 #define ADV7182_INPUT_CVBS_AIN2 0x01 166 #define ADV7182_INPUT_CVBS_AIN3 0x02 167 #define ADV7182_INPUT_CVBS_AIN4 0x03 168 #define ADV7182_INPUT_CVBS_AIN5 0x04 169 #define ADV7182_INPUT_CVBS_AIN6 0x05 170 #define ADV7182_INPUT_CVBS_AIN7 0x06 171 #define ADV7182_INPUT_CVBS_AIN8 0x07 172 #define ADV7182_INPUT_SVIDEO_AIN1_AIN2 0x08 173 #define ADV7182_INPUT_SVIDEO_AIN3_AIN4 0x09 174 #define ADV7182_INPUT_SVIDEO_AIN5_AIN6 0x0a 175 #define ADV7182_INPUT_SVIDEO_AIN7_AIN8 0x0b 176 #define ADV7182_INPUT_YPRPB_AIN1_AIN2_AIN3 0x0c 177 #define ADV7182_INPUT_YPRPB_AIN4_AIN5_AIN6 0x0d 178 #define ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2 0x0e 179 #define ADV7182_INPUT_DIFF_CVBS_AIN3_AIN4 0x0f 180 #define ADV7182_INPUT_DIFF_CVBS_AIN5_AIN6 0x10 181 #define ADV7182_INPUT_DIFF_CVBS_AIN7_AIN8 0x11 182 183 #define ADV7180_DEFAULT_CSI_I2C_ADDR 0x44 184 #define ADV7180_DEFAULT_VPP_I2C_ADDR 0x42 185 186 #define V4L2_CID_ADV_FAST_SWITCH (V4L2_CID_USER_ADV7180_BASE + 0x00) 187 188 /* Initial number of frames to skip to avoid possible garbage */ 189 #define ADV7180_NUM_OF_SKIP_FRAMES 2 190 191 struct adv7180_state; 192 193 #define ADV7180_FLAG_RESET_POWERED BIT(0) 194 #define ADV7180_FLAG_V2 BIT(1) 195 #define ADV7180_FLAG_MIPI_CSI2 BIT(2) 196 #define ADV7180_FLAG_I2P BIT(3) 197 198 struct adv7180_chip_info { 199 unsigned int flags; 200 unsigned int valid_input_mask; 201 int (*set_std)(struct adv7180_state *st, unsigned int std); 202 int (*select_input)(struct adv7180_state *st, unsigned int input); 203 int (*init)(struct adv7180_state *state); 204 }; 205 206 struct adv7180_state { 207 struct v4l2_ctrl_handler ctrl_hdl; 208 struct v4l2_subdev sd; 209 struct media_pad pad; 210 struct mutex mutex; /* mutual excl. when accessing chip */ 211 int irq; 212 struct gpio_desc *pwdn_gpio; 213 struct gpio_desc *rst_gpio; 214 v4l2_std_id curr_norm; 215 bool powered; 216 bool streaming; 217 u8 input; 218 219 struct i2c_client *client; 220 unsigned int register_page; 221 struct i2c_client *csi_client; 222 struct i2c_client *vpp_client; 223 const struct adv7180_chip_info *chip_info; 224 enum v4l2_field field; 225 bool force_bt656_4; 226 }; 227 #define to_adv7180_sd(_ctrl) (&container_of(_ctrl->handler, \ 228 struct adv7180_state, \ 229 ctrl_hdl)->sd) 230 231 static int adv7180_select_page(struct adv7180_state *state, unsigned int page) 232 { 233 if (state->register_page != page) { 234 i2c_smbus_write_byte_data(state->client, ADV7180_REG_CTRL, 235 page); 236 state->register_page = page; 237 } 238 239 return 0; 240 } 241 242 static int adv7180_write(struct adv7180_state *state, unsigned int reg, 243 unsigned int value) 244 { 245 lockdep_assert_held(&state->mutex); 246 adv7180_select_page(state, reg >> 8); 247 return i2c_smbus_write_byte_data(state->client, reg & 0xff, value); 248 } 249 250 static int adv7180_read(struct adv7180_state *state, unsigned int reg) 251 { 252 lockdep_assert_held(&state->mutex); 253 adv7180_select_page(state, reg >> 8); 254 return i2c_smbus_read_byte_data(state->client, reg & 0xff); 255 } 256 257 static int adv7180_csi_write(struct adv7180_state *state, unsigned int reg, 258 unsigned int value) 259 { 260 return i2c_smbus_write_byte_data(state->csi_client, reg, value); 261 } 262 263 static int adv7180_set_video_standard(struct adv7180_state *state, 264 unsigned int std) 265 { 266 return state->chip_info->set_std(state, std); 267 } 268 269 static int adv7180_vpp_write(struct adv7180_state *state, unsigned int reg, 270 unsigned int value) 271 { 272 return i2c_smbus_write_byte_data(state->vpp_client, reg, value); 273 } 274 275 static v4l2_std_id adv7180_std_to_v4l2(u8 status1) 276 { 277 /* in case V4L2_IN_ST_NO_SIGNAL */ 278 if (!(status1 & ADV7180_STATUS1_IN_LOCK)) 279 return V4L2_STD_UNKNOWN; 280 281 switch (status1 & ADV7180_STATUS1_AUTOD_MASK) { 282 case ADV7180_STATUS1_AUTOD_NTSM_M_J: 283 return V4L2_STD_NTSC; 284 case ADV7180_STATUS1_AUTOD_NTSC_4_43: 285 return V4L2_STD_NTSC_443; 286 case ADV7180_STATUS1_AUTOD_PAL_M: 287 return V4L2_STD_PAL_M; 288 case ADV7180_STATUS1_AUTOD_PAL_60: 289 return V4L2_STD_PAL_60; 290 case ADV7180_STATUS1_AUTOD_PAL_B_G: 291 return V4L2_STD_PAL; 292 case ADV7180_STATUS1_AUTOD_SECAM: 293 return V4L2_STD_SECAM; 294 case ADV7180_STATUS1_AUTOD_PAL_COMB: 295 return V4L2_STD_PAL_Nc | V4L2_STD_PAL_N; 296 case ADV7180_STATUS1_AUTOD_SECAM_525: 297 return V4L2_STD_SECAM; 298 default: 299 return V4L2_STD_UNKNOWN; 300 } 301 } 302 303 static int v4l2_std_to_adv7180(v4l2_std_id std) 304 { 305 if (std == V4L2_STD_PAL_60) 306 return ADV7180_STD_PAL60; 307 if (std == V4L2_STD_NTSC_443) 308 return ADV7180_STD_NTSC_443; 309 if (std == V4L2_STD_PAL_N) 310 return ADV7180_STD_PAL_N; 311 if (std == V4L2_STD_PAL_M) 312 return ADV7180_STD_PAL_M; 313 if (std == V4L2_STD_PAL_Nc) 314 return ADV7180_STD_PAL_COMB_N; 315 316 if (std & V4L2_STD_PAL) 317 return ADV7180_STD_PAL_BG; 318 if (std & V4L2_STD_NTSC) 319 return ADV7180_STD_NTSC_M; 320 if (std & V4L2_STD_SECAM) 321 return ADV7180_STD_PAL_SECAM; 322 323 return -EINVAL; 324 } 325 326 static u32 adv7180_status_to_v4l2(u8 status1) 327 { 328 if (!(status1 & ADV7180_STATUS1_IN_LOCK)) 329 return V4L2_IN_ST_NO_SIGNAL; 330 331 return 0; 332 } 333 334 static int __adv7180_status(struct adv7180_state *state, u32 *status, 335 v4l2_std_id *std) 336 { 337 int status1 = adv7180_read(state, ADV7180_REG_STATUS1); 338 339 if (status1 < 0) 340 return status1; 341 342 if (status) 343 *status = adv7180_status_to_v4l2(status1); 344 if (std) 345 *std = adv7180_std_to_v4l2(status1); 346 347 return 0; 348 } 349 350 static inline struct adv7180_state *to_state(struct v4l2_subdev *sd) 351 { 352 return container_of(sd, struct adv7180_state, sd); 353 } 354 355 static int adv7180_querystd(struct v4l2_subdev *sd, v4l2_std_id *std) 356 { 357 struct adv7180_state *state = to_state(sd); 358 int err = mutex_lock_interruptible(&state->mutex); 359 if (err) 360 return err; 361 362 if (state->streaming) { 363 err = -EBUSY; 364 goto unlock; 365 } 366 367 err = adv7180_set_video_standard(state, 368 ADV7180_STD_AD_PAL_BG_NTSC_J_SECAM); 369 if (err) 370 goto unlock; 371 372 msleep(100); 373 __adv7180_status(state, NULL, std); 374 375 err = v4l2_std_to_adv7180(state->curr_norm); 376 if (err < 0) 377 goto unlock; 378 379 err = adv7180_set_video_standard(state, err); 380 381 unlock: 382 mutex_unlock(&state->mutex); 383 return err; 384 } 385 386 static int adv7180_s_routing(struct v4l2_subdev *sd, u32 input, 387 u32 output, u32 config) 388 { 389 struct adv7180_state *state = to_state(sd); 390 int ret = mutex_lock_interruptible(&state->mutex); 391 392 if (ret) 393 return ret; 394 395 if (input > 31 || !(BIT(input) & state->chip_info->valid_input_mask)) { 396 ret = -EINVAL; 397 goto out; 398 } 399 400 ret = state->chip_info->select_input(state, input); 401 402 if (ret == 0) 403 state->input = input; 404 out: 405 mutex_unlock(&state->mutex); 406 return ret; 407 } 408 409 static int adv7180_g_input_status(struct v4l2_subdev *sd, u32 *status) 410 { 411 struct adv7180_state *state = to_state(sd); 412 int ret = mutex_lock_interruptible(&state->mutex); 413 if (ret) 414 return ret; 415 416 ret = __adv7180_status(state, status, NULL); 417 mutex_unlock(&state->mutex); 418 return ret; 419 } 420 421 static int adv7180_program_std(struct adv7180_state *state) 422 { 423 int ret; 424 425 ret = v4l2_std_to_adv7180(state->curr_norm); 426 if (ret < 0) 427 return ret; 428 429 ret = adv7180_set_video_standard(state, ret); 430 if (ret < 0) 431 return ret; 432 return 0; 433 } 434 435 static int adv7180_s_std(struct v4l2_subdev *sd, v4l2_std_id std) 436 { 437 struct adv7180_state *state = to_state(sd); 438 int ret = mutex_lock_interruptible(&state->mutex); 439 440 if (ret) 441 return ret; 442 443 /* Make sure we can support this std */ 444 ret = v4l2_std_to_adv7180(std); 445 if (ret < 0) 446 goto out; 447 448 state->curr_norm = std; 449 450 ret = adv7180_program_std(state); 451 out: 452 mutex_unlock(&state->mutex); 453 return ret; 454 } 455 456 static int adv7180_g_std(struct v4l2_subdev *sd, v4l2_std_id *norm) 457 { 458 struct adv7180_state *state = to_state(sd); 459 460 *norm = state->curr_norm; 461 462 return 0; 463 } 464 465 static int adv7180_g_frame_interval(struct v4l2_subdev *sd, 466 struct v4l2_subdev_frame_interval *fi) 467 { 468 struct adv7180_state *state = to_state(sd); 469 470 if (state->curr_norm & V4L2_STD_525_60) { 471 fi->interval.numerator = 1001; 472 fi->interval.denominator = 30000; 473 } else { 474 fi->interval.numerator = 1; 475 fi->interval.denominator = 25; 476 } 477 478 return 0; 479 } 480 481 static void adv7180_set_power_pin(struct adv7180_state *state, bool on) 482 { 483 if (!state->pwdn_gpio) 484 return; 485 486 if (on) { 487 gpiod_set_value_cansleep(state->pwdn_gpio, 0); 488 usleep_range(5000, 10000); 489 } else { 490 gpiod_set_value_cansleep(state->pwdn_gpio, 1); 491 } 492 } 493 494 static void adv7180_set_reset_pin(struct adv7180_state *state, bool on) 495 { 496 if (!state->rst_gpio) 497 return; 498 499 if (on) { 500 gpiod_set_value_cansleep(state->rst_gpio, 1); 501 } else { 502 gpiod_set_value_cansleep(state->rst_gpio, 0); 503 usleep_range(5000, 10000); 504 } 505 } 506 507 static int adv7180_set_power(struct adv7180_state *state, bool on) 508 { 509 u8 val; 510 int ret; 511 512 if (on) 513 val = ADV7180_PWR_MAN_ON; 514 else 515 val = ADV7180_PWR_MAN_OFF; 516 517 ret = adv7180_write(state, ADV7180_REG_PWR_MAN, val); 518 if (ret) 519 return ret; 520 521 if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) { 522 if (on) { 523 adv7180_csi_write(state, 0xDE, 0x02); 524 adv7180_csi_write(state, 0xD2, 0xF7); 525 adv7180_csi_write(state, 0xD8, 0x65); 526 adv7180_csi_write(state, 0xE0, 0x09); 527 adv7180_csi_write(state, 0x2C, 0x00); 528 if (state->field == V4L2_FIELD_NONE) 529 adv7180_csi_write(state, 0x1D, 0x80); 530 adv7180_csi_write(state, 0x00, 0x00); 531 } else { 532 adv7180_csi_write(state, 0x00, 0x80); 533 } 534 } 535 536 return 0; 537 } 538 539 static int adv7180_s_power(struct v4l2_subdev *sd, int on) 540 { 541 struct adv7180_state *state = to_state(sd); 542 int ret; 543 544 ret = mutex_lock_interruptible(&state->mutex); 545 if (ret) 546 return ret; 547 548 ret = adv7180_set_power(state, on); 549 if (ret == 0) 550 state->powered = on; 551 552 mutex_unlock(&state->mutex); 553 return ret; 554 } 555 556 static const char * const test_pattern_menu[] = { 557 "Single color", 558 "Color bars", 559 "Luma ramp", 560 "Boundary box", 561 "Disable", 562 }; 563 564 static int adv7180_test_pattern(struct adv7180_state *state, int value) 565 { 566 unsigned int reg = 0; 567 568 /* Map menu value into register value */ 569 if (value < 3) 570 reg = value; 571 if (value == 3) 572 reg = 5; 573 574 adv7180_write(state, ADV7180_REG_ANALOG_CLAMP_CTL, reg); 575 576 if (value == ARRAY_SIZE(test_pattern_menu) - 1) { 577 reg = adv7180_read(state, ADV7180_REG_DEF_VALUE_Y); 578 reg &= ~ADV7180_DEF_VAL_EN; 579 adv7180_write(state, ADV7180_REG_DEF_VALUE_Y, reg); 580 return 0; 581 } 582 583 reg = adv7180_read(state, ADV7180_REG_DEF_VALUE_Y); 584 reg |= ADV7180_DEF_VAL_EN | ADV7180_DEF_VAL_AUTO_EN; 585 adv7180_write(state, ADV7180_REG_DEF_VALUE_Y, reg); 586 587 return 0; 588 } 589 590 static int adv7180_s_ctrl(struct v4l2_ctrl *ctrl) 591 { 592 struct v4l2_subdev *sd = to_adv7180_sd(ctrl); 593 struct adv7180_state *state = to_state(sd); 594 int ret = mutex_lock_interruptible(&state->mutex); 595 int val; 596 597 if (ret) 598 return ret; 599 val = ctrl->val; 600 switch (ctrl->id) { 601 case V4L2_CID_BRIGHTNESS: 602 ret = adv7180_write(state, ADV7180_REG_BRI, val); 603 break; 604 case V4L2_CID_HUE: 605 /*Hue is inverted according to HSL chart */ 606 ret = adv7180_write(state, ADV7180_REG_HUE, -val); 607 break; 608 case V4L2_CID_CONTRAST: 609 ret = adv7180_write(state, ADV7180_REG_CON, val); 610 break; 611 case V4L2_CID_SATURATION: 612 /* 613 *This could be V4L2_CID_BLUE_BALANCE/V4L2_CID_RED_BALANCE 614 *Let's not confuse the user, everybody understands saturation 615 */ 616 ret = adv7180_write(state, ADV7180_REG_SD_SAT_CB, val); 617 if (ret < 0) 618 break; 619 ret = adv7180_write(state, ADV7180_REG_SD_SAT_CR, val); 620 break; 621 case V4L2_CID_ADV_FAST_SWITCH: 622 if (ctrl->val) { 623 /* ADI required write */ 624 adv7180_write(state, 0x80d9, 0x44); 625 adv7180_write(state, ADV7180_REG_FLCONTROL, 626 ADV7180_FLCONTROL_FL_ENABLE); 627 } else { 628 /* ADI required write */ 629 adv7180_write(state, 0x80d9, 0xc4); 630 adv7180_write(state, ADV7180_REG_FLCONTROL, 0x00); 631 } 632 break; 633 case V4L2_CID_TEST_PATTERN: 634 ret = adv7180_test_pattern(state, val); 635 break; 636 default: 637 ret = -EINVAL; 638 } 639 640 mutex_unlock(&state->mutex); 641 return ret; 642 } 643 644 static const struct v4l2_ctrl_ops adv7180_ctrl_ops = { 645 .s_ctrl = adv7180_s_ctrl, 646 }; 647 648 static const struct v4l2_ctrl_config adv7180_ctrl_fast_switch = { 649 .ops = &adv7180_ctrl_ops, 650 .id = V4L2_CID_ADV_FAST_SWITCH, 651 .name = "Fast Switching", 652 .type = V4L2_CTRL_TYPE_BOOLEAN, 653 .min = 0, 654 .max = 1, 655 .step = 1, 656 }; 657 658 static int adv7180_init_controls(struct adv7180_state *state) 659 { 660 v4l2_ctrl_handler_init(&state->ctrl_hdl, 4); 661 662 v4l2_ctrl_new_std(&state->ctrl_hdl, &adv7180_ctrl_ops, 663 V4L2_CID_BRIGHTNESS, ADV7180_BRI_MIN, 664 ADV7180_BRI_MAX, 1, ADV7180_BRI_DEF); 665 v4l2_ctrl_new_std(&state->ctrl_hdl, &adv7180_ctrl_ops, 666 V4L2_CID_CONTRAST, ADV7180_CON_MIN, 667 ADV7180_CON_MAX, 1, ADV7180_CON_DEF); 668 v4l2_ctrl_new_std(&state->ctrl_hdl, &adv7180_ctrl_ops, 669 V4L2_CID_SATURATION, ADV7180_SAT_MIN, 670 ADV7180_SAT_MAX, 1, ADV7180_SAT_DEF); 671 v4l2_ctrl_new_std(&state->ctrl_hdl, &adv7180_ctrl_ops, 672 V4L2_CID_HUE, ADV7180_HUE_MIN, 673 ADV7180_HUE_MAX, 1, ADV7180_HUE_DEF); 674 v4l2_ctrl_new_custom(&state->ctrl_hdl, &adv7180_ctrl_fast_switch, NULL); 675 676 v4l2_ctrl_new_std_menu_items(&state->ctrl_hdl, &adv7180_ctrl_ops, 677 V4L2_CID_TEST_PATTERN, 678 ARRAY_SIZE(test_pattern_menu) - 1, 679 0, ARRAY_SIZE(test_pattern_menu) - 1, 680 test_pattern_menu); 681 682 state->sd.ctrl_handler = &state->ctrl_hdl; 683 if (state->ctrl_hdl.error) { 684 int err = state->ctrl_hdl.error; 685 686 v4l2_ctrl_handler_free(&state->ctrl_hdl); 687 return err; 688 } 689 v4l2_ctrl_handler_setup(&state->ctrl_hdl); 690 691 return 0; 692 } 693 static void adv7180_exit_controls(struct adv7180_state *state) 694 { 695 v4l2_ctrl_handler_free(&state->ctrl_hdl); 696 } 697 698 static int adv7180_enum_mbus_code(struct v4l2_subdev *sd, 699 struct v4l2_subdev_state *sd_state, 700 struct v4l2_subdev_mbus_code_enum *code) 701 { 702 if (code->index != 0) 703 return -EINVAL; 704 705 code->code = MEDIA_BUS_FMT_UYVY8_2X8; 706 707 return 0; 708 } 709 710 static int adv7180_mbus_fmt(struct v4l2_subdev *sd, 711 struct v4l2_mbus_framefmt *fmt) 712 { 713 struct adv7180_state *state = to_state(sd); 714 715 fmt->code = MEDIA_BUS_FMT_UYVY8_2X8; 716 fmt->colorspace = V4L2_COLORSPACE_SMPTE170M; 717 fmt->width = 720; 718 fmt->height = state->curr_norm & V4L2_STD_525_60 ? 480 : 576; 719 720 if (state->field == V4L2_FIELD_ALTERNATE) 721 fmt->height /= 2; 722 723 return 0; 724 } 725 726 static int adv7180_set_field_mode(struct adv7180_state *state) 727 { 728 if (!(state->chip_info->flags & ADV7180_FLAG_I2P)) 729 return 0; 730 731 if (state->field == V4L2_FIELD_NONE) { 732 if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) { 733 adv7180_csi_write(state, 0x01, 0x20); 734 adv7180_csi_write(state, 0x02, 0x28); 735 adv7180_csi_write(state, 0x03, 0x38); 736 adv7180_csi_write(state, 0x04, 0x30); 737 adv7180_csi_write(state, 0x05, 0x30); 738 adv7180_csi_write(state, 0x06, 0x80); 739 adv7180_csi_write(state, 0x07, 0x70); 740 adv7180_csi_write(state, 0x08, 0x50); 741 } 742 adv7180_vpp_write(state, 0xa3, 0x00); 743 adv7180_vpp_write(state, 0x5b, 0x00); 744 adv7180_vpp_write(state, 0x55, 0x80); 745 } else { 746 if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) { 747 adv7180_csi_write(state, 0x01, 0x18); 748 adv7180_csi_write(state, 0x02, 0x18); 749 adv7180_csi_write(state, 0x03, 0x30); 750 adv7180_csi_write(state, 0x04, 0x20); 751 adv7180_csi_write(state, 0x05, 0x28); 752 adv7180_csi_write(state, 0x06, 0x40); 753 adv7180_csi_write(state, 0x07, 0x58); 754 adv7180_csi_write(state, 0x08, 0x30); 755 } 756 adv7180_vpp_write(state, 0xa3, 0x70); 757 adv7180_vpp_write(state, 0x5b, 0x80); 758 adv7180_vpp_write(state, 0x55, 0x00); 759 } 760 761 return 0; 762 } 763 764 static int adv7180_get_pad_format(struct v4l2_subdev *sd, 765 struct v4l2_subdev_state *sd_state, 766 struct v4l2_subdev_format *format) 767 { 768 struct adv7180_state *state = to_state(sd); 769 770 if (format->which == V4L2_SUBDEV_FORMAT_TRY) { 771 format->format = *v4l2_subdev_get_try_format(sd, sd_state, 0); 772 } else { 773 adv7180_mbus_fmt(sd, &format->format); 774 format->format.field = state->field; 775 } 776 777 return 0; 778 } 779 780 static int adv7180_set_pad_format(struct v4l2_subdev *sd, 781 struct v4l2_subdev_state *sd_state, 782 struct v4l2_subdev_format *format) 783 { 784 struct adv7180_state *state = to_state(sd); 785 struct v4l2_mbus_framefmt *framefmt; 786 int ret; 787 788 switch (format->format.field) { 789 case V4L2_FIELD_NONE: 790 if (state->chip_info->flags & ADV7180_FLAG_I2P) 791 break; 792 fallthrough; 793 default: 794 format->format.field = V4L2_FIELD_ALTERNATE; 795 break; 796 } 797 798 ret = adv7180_mbus_fmt(sd, &format->format); 799 800 if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) { 801 if (state->field != format->format.field) { 802 state->field = format->format.field; 803 adv7180_set_power(state, false); 804 adv7180_set_field_mode(state); 805 adv7180_set_power(state, true); 806 } 807 } else { 808 framefmt = v4l2_subdev_get_try_format(sd, sd_state, 0); 809 *framefmt = format->format; 810 } 811 812 return ret; 813 } 814 815 static int adv7180_init_cfg(struct v4l2_subdev *sd, 816 struct v4l2_subdev_state *sd_state) 817 { 818 struct v4l2_subdev_format fmt = { 819 .which = sd_state ? V4L2_SUBDEV_FORMAT_TRY 820 : V4L2_SUBDEV_FORMAT_ACTIVE, 821 }; 822 823 return adv7180_set_pad_format(sd, sd_state, &fmt); 824 } 825 826 static int adv7180_get_mbus_config(struct v4l2_subdev *sd, 827 unsigned int pad, 828 struct v4l2_mbus_config *cfg) 829 { 830 struct adv7180_state *state = to_state(sd); 831 832 if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) { 833 cfg->type = V4L2_MBUS_CSI2_DPHY; 834 cfg->bus.mipi_csi2.num_data_lanes = 1; 835 cfg->bus.mipi_csi2.flags = 0; 836 } else { 837 /* 838 * The ADV7180 sensor supports BT.601/656 output modes. 839 * The BT.656 is default and not yet configurable by s/w. 840 */ 841 cfg->bus.parallel.flags = V4L2_MBUS_MASTER | 842 V4L2_MBUS_PCLK_SAMPLE_RISING | 843 V4L2_MBUS_DATA_ACTIVE_HIGH; 844 cfg->type = V4L2_MBUS_BT656; 845 } 846 847 return 0; 848 } 849 850 static int adv7180_get_skip_frames(struct v4l2_subdev *sd, u32 *frames) 851 { 852 *frames = ADV7180_NUM_OF_SKIP_FRAMES; 853 854 return 0; 855 } 856 857 static int adv7180_g_pixelaspect(struct v4l2_subdev *sd, struct v4l2_fract *aspect) 858 { 859 struct adv7180_state *state = to_state(sd); 860 861 if (state->curr_norm & V4L2_STD_525_60) { 862 aspect->numerator = 11; 863 aspect->denominator = 10; 864 } else { 865 aspect->numerator = 54; 866 aspect->denominator = 59; 867 } 868 869 return 0; 870 } 871 872 static int adv7180_g_tvnorms(struct v4l2_subdev *sd, v4l2_std_id *norm) 873 { 874 *norm = V4L2_STD_ALL; 875 return 0; 876 } 877 878 static int adv7180_s_stream(struct v4l2_subdev *sd, int enable) 879 { 880 struct adv7180_state *state = to_state(sd); 881 int ret; 882 883 /* It's always safe to stop streaming, no need to take the lock */ 884 if (!enable) { 885 state->streaming = enable; 886 return 0; 887 } 888 889 /* Must wait until querystd released the lock */ 890 ret = mutex_lock_interruptible(&state->mutex); 891 if (ret) 892 return ret; 893 state->streaming = enable; 894 mutex_unlock(&state->mutex); 895 return 0; 896 } 897 898 static int adv7180_subscribe_event(struct v4l2_subdev *sd, 899 struct v4l2_fh *fh, 900 struct v4l2_event_subscription *sub) 901 { 902 switch (sub->type) { 903 case V4L2_EVENT_SOURCE_CHANGE: 904 return v4l2_src_change_event_subdev_subscribe(sd, fh, sub); 905 case V4L2_EVENT_CTRL: 906 return v4l2_ctrl_subdev_subscribe_event(sd, fh, sub); 907 default: 908 return -EINVAL; 909 } 910 } 911 912 static const struct v4l2_subdev_video_ops adv7180_video_ops = { 913 .s_std = adv7180_s_std, 914 .g_std = adv7180_g_std, 915 .g_frame_interval = adv7180_g_frame_interval, 916 .querystd = adv7180_querystd, 917 .g_input_status = adv7180_g_input_status, 918 .s_routing = adv7180_s_routing, 919 .g_pixelaspect = adv7180_g_pixelaspect, 920 .g_tvnorms = adv7180_g_tvnorms, 921 .s_stream = adv7180_s_stream, 922 }; 923 924 static const struct v4l2_subdev_core_ops adv7180_core_ops = { 925 .s_power = adv7180_s_power, 926 .subscribe_event = adv7180_subscribe_event, 927 .unsubscribe_event = v4l2_event_subdev_unsubscribe, 928 }; 929 930 static const struct v4l2_subdev_pad_ops adv7180_pad_ops = { 931 .init_cfg = adv7180_init_cfg, 932 .enum_mbus_code = adv7180_enum_mbus_code, 933 .set_fmt = adv7180_set_pad_format, 934 .get_fmt = adv7180_get_pad_format, 935 .get_mbus_config = adv7180_get_mbus_config, 936 }; 937 938 static const struct v4l2_subdev_sensor_ops adv7180_sensor_ops = { 939 .g_skip_frames = adv7180_get_skip_frames, 940 }; 941 942 static const struct v4l2_subdev_ops adv7180_ops = { 943 .core = &adv7180_core_ops, 944 .video = &adv7180_video_ops, 945 .pad = &adv7180_pad_ops, 946 .sensor = &adv7180_sensor_ops, 947 }; 948 949 static irqreturn_t adv7180_irq(int irq, void *devid) 950 { 951 struct adv7180_state *state = devid; 952 u8 isr3; 953 954 mutex_lock(&state->mutex); 955 isr3 = adv7180_read(state, ADV7180_REG_ISR3); 956 /* clear */ 957 adv7180_write(state, ADV7180_REG_ICR3, isr3); 958 959 if (isr3 & ADV7180_IRQ3_AD_CHANGE) { 960 static const struct v4l2_event src_ch = { 961 .type = V4L2_EVENT_SOURCE_CHANGE, 962 .u.src_change.changes = V4L2_EVENT_SRC_CH_RESOLUTION, 963 }; 964 965 v4l2_subdev_notify_event(&state->sd, &src_ch); 966 } 967 mutex_unlock(&state->mutex); 968 969 return IRQ_HANDLED; 970 } 971 972 static int adv7180_init(struct adv7180_state *state) 973 { 974 int ret; 975 976 /* ITU-R BT.656-4 compatible */ 977 ret = adv7180_write(state, ADV7180_REG_EXTENDED_OUTPUT_CONTROL, 978 ADV7180_EXTENDED_OUTPUT_CONTROL_NTSCDIS); 979 if (ret < 0) 980 return ret; 981 982 /* Manually set V bit end position in NTSC mode */ 983 return adv7180_write(state, ADV7180_REG_NTSC_V_BIT_END, 984 ADV7180_NTSC_V_BIT_END_MANUAL_NVEND); 985 } 986 987 static int adv7180_set_std(struct adv7180_state *state, unsigned int std) 988 { 989 return adv7180_write(state, ADV7180_REG_INPUT_CONTROL, 990 (std << 4) | state->input); 991 } 992 993 static int adv7180_select_input(struct adv7180_state *state, unsigned int input) 994 { 995 int ret; 996 997 ret = adv7180_read(state, ADV7180_REG_INPUT_CONTROL); 998 if (ret < 0) 999 return ret; 1000 1001 ret &= ~ADV7180_INPUT_CONTROL_INSEL_MASK; 1002 ret |= input; 1003 return adv7180_write(state, ADV7180_REG_INPUT_CONTROL, ret); 1004 } 1005 1006 static int adv7182_init(struct adv7180_state *state) 1007 { 1008 if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) 1009 adv7180_write(state, ADV7180_REG_CSI_SLAVE_ADDR, 1010 ADV7180_DEFAULT_CSI_I2C_ADDR << 1); 1011 1012 if (state->chip_info->flags & ADV7180_FLAG_I2P) 1013 adv7180_write(state, ADV7180_REG_VPP_SLAVE_ADDR, 1014 ADV7180_DEFAULT_VPP_I2C_ADDR << 1); 1015 1016 if (state->chip_info->flags & ADV7180_FLAG_V2) { 1017 /* ADI recommended writes for improved video quality */ 1018 adv7180_write(state, 0x0080, 0x51); 1019 adv7180_write(state, 0x0081, 0x51); 1020 adv7180_write(state, 0x0082, 0x68); 1021 } 1022 1023 /* ADI required writes */ 1024 if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) { 1025 adv7180_write(state, ADV7180_REG_OUTPUT_CONTROL, 0x4e); 1026 adv7180_write(state, ADV7180_REG_EXTENDED_OUTPUT_CONTROL, 0x57); 1027 adv7180_write(state, ADV7180_REG_CTRL_2, 0xc0); 1028 } else { 1029 if (state->chip_info->flags & ADV7180_FLAG_V2) { 1030 if (state->force_bt656_4) { 1031 /* ITU-R BT.656-4 compatible */ 1032 adv7180_write(state, 1033 ADV7180_REG_EXTENDED_OUTPUT_CONTROL, 1034 ADV7180_EXTENDED_OUTPUT_CONTROL_NTSCDIS); 1035 /* Manually set NEWAVMODE */ 1036 adv7180_write(state, 1037 ADV7180_REG_VSYNC_FIELD_CTL_1, 1038 ADV7180_VSYNC_FIELD_CTL_1_NEWAV); 1039 /* Manually set V bit end position in NTSC mode */ 1040 adv7180_write(state, 1041 ADV7180_REG_NTSC_V_BIT_END, 1042 ADV7180_NTSC_V_BIT_END_MANUAL_NVEND); 1043 } else { 1044 adv7180_write(state, 1045 ADV7180_REG_EXTENDED_OUTPUT_CONTROL, 1046 0x17); 1047 } 1048 } 1049 else 1050 adv7180_write(state, 1051 ADV7180_REG_EXTENDED_OUTPUT_CONTROL, 1052 0x07); 1053 adv7180_write(state, ADV7180_REG_OUTPUT_CONTROL, 0x0c); 1054 adv7180_write(state, ADV7180_REG_CTRL_2, 0x40); 1055 } 1056 1057 adv7180_write(state, 0x0013, 0x00); 1058 1059 return 0; 1060 } 1061 1062 static int adv7182_set_std(struct adv7180_state *state, unsigned int std) 1063 { 1064 /* Failing to set the reserved bit can result in increased video noise */ 1065 return adv7180_write(state, ADV7182_REG_INPUT_VIDSEL, 1066 (std << 4) | ADV7182_REG_INPUT_RESERVED); 1067 } 1068 1069 enum adv7182_input_type { 1070 ADV7182_INPUT_TYPE_CVBS, 1071 ADV7182_INPUT_TYPE_DIFF_CVBS, 1072 ADV7182_INPUT_TYPE_SVIDEO, 1073 ADV7182_INPUT_TYPE_YPBPR, 1074 }; 1075 1076 static enum adv7182_input_type adv7182_get_input_type(unsigned int input) 1077 { 1078 switch (input) { 1079 case ADV7182_INPUT_CVBS_AIN1: 1080 case ADV7182_INPUT_CVBS_AIN2: 1081 case ADV7182_INPUT_CVBS_AIN3: 1082 case ADV7182_INPUT_CVBS_AIN4: 1083 case ADV7182_INPUT_CVBS_AIN5: 1084 case ADV7182_INPUT_CVBS_AIN6: 1085 case ADV7182_INPUT_CVBS_AIN7: 1086 case ADV7182_INPUT_CVBS_AIN8: 1087 return ADV7182_INPUT_TYPE_CVBS; 1088 case ADV7182_INPUT_SVIDEO_AIN1_AIN2: 1089 case ADV7182_INPUT_SVIDEO_AIN3_AIN4: 1090 case ADV7182_INPUT_SVIDEO_AIN5_AIN6: 1091 case ADV7182_INPUT_SVIDEO_AIN7_AIN8: 1092 return ADV7182_INPUT_TYPE_SVIDEO; 1093 case ADV7182_INPUT_YPRPB_AIN1_AIN2_AIN3: 1094 case ADV7182_INPUT_YPRPB_AIN4_AIN5_AIN6: 1095 return ADV7182_INPUT_TYPE_YPBPR; 1096 case ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2: 1097 case ADV7182_INPUT_DIFF_CVBS_AIN3_AIN4: 1098 case ADV7182_INPUT_DIFF_CVBS_AIN5_AIN6: 1099 case ADV7182_INPUT_DIFF_CVBS_AIN7_AIN8: 1100 return ADV7182_INPUT_TYPE_DIFF_CVBS; 1101 default: /* Will never happen */ 1102 return 0; 1103 } 1104 } 1105 1106 /* ADI recommended writes to registers 0x52, 0x53, 0x54 */ 1107 static unsigned int adv7182_lbias_settings[][3] = { 1108 [ADV7182_INPUT_TYPE_CVBS] = { 0xCB, 0x4E, 0x80 }, 1109 [ADV7182_INPUT_TYPE_DIFF_CVBS] = { 0xC0, 0x4E, 0x80 }, 1110 [ADV7182_INPUT_TYPE_SVIDEO] = { 0x0B, 0xCE, 0x80 }, 1111 [ADV7182_INPUT_TYPE_YPBPR] = { 0x0B, 0x4E, 0xC0 }, 1112 }; 1113 1114 static unsigned int adv7280_lbias_settings[][3] = { 1115 [ADV7182_INPUT_TYPE_CVBS] = { 0xCD, 0x4E, 0x80 }, 1116 [ADV7182_INPUT_TYPE_DIFF_CVBS] = { 0xC0, 0x4E, 0x80 }, 1117 [ADV7182_INPUT_TYPE_SVIDEO] = { 0x0B, 0xCE, 0x80 }, 1118 [ADV7182_INPUT_TYPE_YPBPR] = { 0x0B, 0x4E, 0xC0 }, 1119 }; 1120 1121 static int adv7182_select_input(struct adv7180_state *state, unsigned int input) 1122 { 1123 enum adv7182_input_type input_type; 1124 unsigned int *lbias; 1125 unsigned int i; 1126 int ret; 1127 1128 ret = adv7180_write(state, ADV7180_REG_INPUT_CONTROL, input); 1129 if (ret) 1130 return ret; 1131 1132 /* Reset clamp circuitry - ADI recommended writes */ 1133 adv7180_write(state, ADV7180_REG_RST_CLAMP, 0x00); 1134 adv7180_write(state, ADV7180_REG_RST_CLAMP, 0xff); 1135 1136 input_type = adv7182_get_input_type(input); 1137 1138 switch (input_type) { 1139 case ADV7182_INPUT_TYPE_CVBS: 1140 case ADV7182_INPUT_TYPE_DIFF_CVBS: 1141 /* ADI recommends to use the SH1 filter */ 1142 adv7180_write(state, ADV7180_REG_SHAP_FILTER_CTL_1, 0x41); 1143 break; 1144 default: 1145 adv7180_write(state, ADV7180_REG_SHAP_FILTER_CTL_1, 0x01); 1146 break; 1147 } 1148 1149 if (state->chip_info->flags & ADV7180_FLAG_V2) 1150 lbias = adv7280_lbias_settings[input_type]; 1151 else 1152 lbias = adv7182_lbias_settings[input_type]; 1153 1154 for (i = 0; i < ARRAY_SIZE(adv7182_lbias_settings[0]); i++) 1155 adv7180_write(state, ADV7180_REG_CVBS_TRIM + i, lbias[i]); 1156 1157 if (input_type == ADV7182_INPUT_TYPE_DIFF_CVBS) { 1158 /* ADI required writes to make differential CVBS work */ 1159 adv7180_write(state, ADV7180_REG_RES_CIR, 0xa8); 1160 adv7180_write(state, ADV7180_REG_CLAMP_ADJ, 0x90); 1161 adv7180_write(state, ADV7180_REG_DIFF_MODE, 0xb0); 1162 adv7180_write(state, ADV7180_REG_AGC_ADJ1, 0x08); 1163 adv7180_write(state, ADV7180_REG_AGC_ADJ2, 0xa0); 1164 } else { 1165 adv7180_write(state, ADV7180_REG_RES_CIR, 0xf0); 1166 adv7180_write(state, ADV7180_REG_CLAMP_ADJ, 0xd0); 1167 adv7180_write(state, ADV7180_REG_DIFF_MODE, 0x10); 1168 adv7180_write(state, ADV7180_REG_AGC_ADJ1, 0x9c); 1169 adv7180_write(state, ADV7180_REG_AGC_ADJ2, 0x00); 1170 } 1171 1172 return 0; 1173 } 1174 1175 static const struct adv7180_chip_info adv7180_info = { 1176 .flags = ADV7180_FLAG_RESET_POWERED, 1177 /* We cannot discriminate between LQFP and 40-pin LFCSP, so accept 1178 * all inputs and let the card driver take care of validation 1179 */ 1180 .valid_input_mask = BIT(ADV7180_INPUT_CVBS_AIN1) | 1181 BIT(ADV7180_INPUT_CVBS_AIN2) | 1182 BIT(ADV7180_INPUT_CVBS_AIN3) | 1183 BIT(ADV7180_INPUT_CVBS_AIN4) | 1184 BIT(ADV7180_INPUT_CVBS_AIN5) | 1185 BIT(ADV7180_INPUT_CVBS_AIN6) | 1186 BIT(ADV7180_INPUT_SVIDEO_AIN1_AIN2) | 1187 BIT(ADV7180_INPUT_SVIDEO_AIN3_AIN4) | 1188 BIT(ADV7180_INPUT_SVIDEO_AIN5_AIN6) | 1189 BIT(ADV7180_INPUT_YPRPB_AIN1_AIN2_AIN3) | 1190 BIT(ADV7180_INPUT_YPRPB_AIN4_AIN5_AIN6), 1191 .init = adv7180_init, 1192 .set_std = adv7180_set_std, 1193 .select_input = adv7180_select_input, 1194 }; 1195 1196 static const struct adv7180_chip_info adv7182_info = { 1197 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1198 BIT(ADV7182_INPUT_CVBS_AIN2) | 1199 BIT(ADV7182_INPUT_CVBS_AIN3) | 1200 BIT(ADV7182_INPUT_CVBS_AIN4) | 1201 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1202 BIT(ADV7182_INPUT_SVIDEO_AIN3_AIN4) | 1203 BIT(ADV7182_INPUT_YPRPB_AIN1_AIN2_AIN3) | 1204 BIT(ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2) | 1205 BIT(ADV7182_INPUT_DIFF_CVBS_AIN3_AIN4), 1206 .init = adv7182_init, 1207 .set_std = adv7182_set_std, 1208 .select_input = adv7182_select_input, 1209 }; 1210 1211 static const struct adv7180_chip_info adv7280_info = { 1212 .flags = ADV7180_FLAG_V2 | ADV7180_FLAG_I2P, 1213 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1214 BIT(ADV7182_INPUT_CVBS_AIN2) | 1215 BIT(ADV7182_INPUT_CVBS_AIN3) | 1216 BIT(ADV7182_INPUT_CVBS_AIN4) | 1217 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1218 BIT(ADV7182_INPUT_SVIDEO_AIN3_AIN4) | 1219 BIT(ADV7182_INPUT_YPRPB_AIN1_AIN2_AIN3), 1220 .init = adv7182_init, 1221 .set_std = adv7182_set_std, 1222 .select_input = adv7182_select_input, 1223 }; 1224 1225 static const struct adv7180_chip_info adv7280_m_info = { 1226 .flags = ADV7180_FLAG_V2 | ADV7180_FLAG_MIPI_CSI2 | ADV7180_FLAG_I2P, 1227 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1228 BIT(ADV7182_INPUT_CVBS_AIN2) | 1229 BIT(ADV7182_INPUT_CVBS_AIN3) | 1230 BIT(ADV7182_INPUT_CVBS_AIN4) | 1231 BIT(ADV7182_INPUT_CVBS_AIN5) | 1232 BIT(ADV7182_INPUT_CVBS_AIN6) | 1233 BIT(ADV7182_INPUT_CVBS_AIN7) | 1234 BIT(ADV7182_INPUT_CVBS_AIN8) | 1235 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1236 BIT(ADV7182_INPUT_SVIDEO_AIN3_AIN4) | 1237 BIT(ADV7182_INPUT_SVIDEO_AIN5_AIN6) | 1238 BIT(ADV7182_INPUT_SVIDEO_AIN7_AIN8) | 1239 BIT(ADV7182_INPUT_YPRPB_AIN1_AIN2_AIN3) | 1240 BIT(ADV7182_INPUT_YPRPB_AIN4_AIN5_AIN6), 1241 .init = adv7182_init, 1242 .set_std = adv7182_set_std, 1243 .select_input = adv7182_select_input, 1244 }; 1245 1246 static const struct adv7180_chip_info adv7281_info = { 1247 .flags = ADV7180_FLAG_V2 | ADV7180_FLAG_MIPI_CSI2, 1248 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1249 BIT(ADV7182_INPUT_CVBS_AIN2) | 1250 BIT(ADV7182_INPUT_CVBS_AIN7) | 1251 BIT(ADV7182_INPUT_CVBS_AIN8) | 1252 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1253 BIT(ADV7182_INPUT_SVIDEO_AIN7_AIN8) | 1254 BIT(ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2) | 1255 BIT(ADV7182_INPUT_DIFF_CVBS_AIN7_AIN8), 1256 .init = adv7182_init, 1257 .set_std = adv7182_set_std, 1258 .select_input = adv7182_select_input, 1259 }; 1260 1261 static const struct adv7180_chip_info adv7281_m_info = { 1262 .flags = ADV7180_FLAG_V2 | ADV7180_FLAG_MIPI_CSI2, 1263 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1264 BIT(ADV7182_INPUT_CVBS_AIN2) | 1265 BIT(ADV7182_INPUT_CVBS_AIN3) | 1266 BIT(ADV7182_INPUT_CVBS_AIN4) | 1267 BIT(ADV7182_INPUT_CVBS_AIN7) | 1268 BIT(ADV7182_INPUT_CVBS_AIN8) | 1269 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1270 BIT(ADV7182_INPUT_SVIDEO_AIN3_AIN4) | 1271 BIT(ADV7182_INPUT_SVIDEO_AIN7_AIN8) | 1272 BIT(ADV7182_INPUT_YPRPB_AIN1_AIN2_AIN3) | 1273 BIT(ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2) | 1274 BIT(ADV7182_INPUT_DIFF_CVBS_AIN3_AIN4) | 1275 BIT(ADV7182_INPUT_DIFF_CVBS_AIN7_AIN8), 1276 .init = adv7182_init, 1277 .set_std = adv7182_set_std, 1278 .select_input = adv7182_select_input, 1279 }; 1280 1281 static const struct adv7180_chip_info adv7281_ma_info = { 1282 .flags = ADV7180_FLAG_V2 | ADV7180_FLAG_MIPI_CSI2, 1283 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1284 BIT(ADV7182_INPUT_CVBS_AIN2) | 1285 BIT(ADV7182_INPUT_CVBS_AIN3) | 1286 BIT(ADV7182_INPUT_CVBS_AIN4) | 1287 BIT(ADV7182_INPUT_CVBS_AIN5) | 1288 BIT(ADV7182_INPUT_CVBS_AIN6) | 1289 BIT(ADV7182_INPUT_CVBS_AIN7) | 1290 BIT(ADV7182_INPUT_CVBS_AIN8) | 1291 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1292 BIT(ADV7182_INPUT_SVIDEO_AIN3_AIN4) | 1293 BIT(ADV7182_INPUT_SVIDEO_AIN5_AIN6) | 1294 BIT(ADV7182_INPUT_SVIDEO_AIN7_AIN8) | 1295 BIT(ADV7182_INPUT_YPRPB_AIN1_AIN2_AIN3) | 1296 BIT(ADV7182_INPUT_YPRPB_AIN4_AIN5_AIN6) | 1297 BIT(ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2) | 1298 BIT(ADV7182_INPUT_DIFF_CVBS_AIN3_AIN4) | 1299 BIT(ADV7182_INPUT_DIFF_CVBS_AIN5_AIN6) | 1300 BIT(ADV7182_INPUT_DIFF_CVBS_AIN7_AIN8), 1301 .init = adv7182_init, 1302 .set_std = adv7182_set_std, 1303 .select_input = adv7182_select_input, 1304 }; 1305 1306 static const struct adv7180_chip_info adv7282_info = { 1307 .flags = ADV7180_FLAG_V2 | ADV7180_FLAG_I2P, 1308 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1309 BIT(ADV7182_INPUT_CVBS_AIN2) | 1310 BIT(ADV7182_INPUT_CVBS_AIN7) | 1311 BIT(ADV7182_INPUT_CVBS_AIN8) | 1312 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1313 BIT(ADV7182_INPUT_SVIDEO_AIN7_AIN8) | 1314 BIT(ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2) | 1315 BIT(ADV7182_INPUT_DIFF_CVBS_AIN7_AIN8), 1316 .init = adv7182_init, 1317 .set_std = adv7182_set_std, 1318 .select_input = adv7182_select_input, 1319 }; 1320 1321 static const struct adv7180_chip_info adv7282_m_info = { 1322 .flags = ADV7180_FLAG_V2 | ADV7180_FLAG_MIPI_CSI2 | ADV7180_FLAG_I2P, 1323 .valid_input_mask = BIT(ADV7182_INPUT_CVBS_AIN1) | 1324 BIT(ADV7182_INPUT_CVBS_AIN2) | 1325 BIT(ADV7182_INPUT_CVBS_AIN3) | 1326 BIT(ADV7182_INPUT_CVBS_AIN4) | 1327 BIT(ADV7182_INPUT_CVBS_AIN7) | 1328 BIT(ADV7182_INPUT_CVBS_AIN8) | 1329 BIT(ADV7182_INPUT_SVIDEO_AIN1_AIN2) | 1330 BIT(ADV7182_INPUT_SVIDEO_AIN3_AIN4) | 1331 BIT(ADV7182_INPUT_SVIDEO_AIN7_AIN8) | 1332 BIT(ADV7182_INPUT_DIFF_CVBS_AIN1_AIN2) | 1333 BIT(ADV7182_INPUT_DIFF_CVBS_AIN3_AIN4) | 1334 BIT(ADV7182_INPUT_DIFF_CVBS_AIN7_AIN8), 1335 .init = adv7182_init, 1336 .set_std = adv7182_set_std, 1337 .select_input = adv7182_select_input, 1338 }; 1339 1340 static int init_device(struct adv7180_state *state) 1341 { 1342 int ret; 1343 1344 mutex_lock(&state->mutex); 1345 1346 adv7180_set_power_pin(state, true); 1347 adv7180_set_reset_pin(state, false); 1348 1349 adv7180_write(state, ADV7180_REG_PWR_MAN, ADV7180_PWR_MAN_RES); 1350 usleep_range(5000, 10000); 1351 1352 ret = state->chip_info->init(state); 1353 if (ret) 1354 goto out_unlock; 1355 1356 ret = adv7180_program_std(state); 1357 if (ret) 1358 goto out_unlock; 1359 1360 adv7180_set_field_mode(state); 1361 1362 /* register for interrupts */ 1363 if (state->irq > 0) { 1364 /* config the Interrupt pin to be active low */ 1365 ret = adv7180_write(state, ADV7180_REG_ICONF1, 1366 ADV7180_ICONF1_ACTIVE_LOW | 1367 ADV7180_ICONF1_PSYNC_ONLY); 1368 if (ret < 0) 1369 goto out_unlock; 1370 1371 ret = adv7180_write(state, ADV7180_REG_IMR1, 0); 1372 if (ret < 0) 1373 goto out_unlock; 1374 1375 ret = adv7180_write(state, ADV7180_REG_IMR2, 0); 1376 if (ret < 0) 1377 goto out_unlock; 1378 1379 /* enable AD change interrupts interrupts */ 1380 ret = adv7180_write(state, ADV7180_REG_IMR3, 1381 ADV7180_IRQ3_AD_CHANGE); 1382 if (ret < 0) 1383 goto out_unlock; 1384 1385 ret = adv7180_write(state, ADV7180_REG_IMR4, 0); 1386 if (ret < 0) 1387 goto out_unlock; 1388 } 1389 1390 out_unlock: 1391 mutex_unlock(&state->mutex); 1392 1393 return ret; 1394 } 1395 1396 static int adv7180_probe(struct i2c_client *client) 1397 { 1398 const struct i2c_device_id *id = i2c_client_get_device_id(client); 1399 struct device_node *np = client->dev.of_node; 1400 struct adv7180_state *state; 1401 struct v4l2_subdev *sd; 1402 int ret; 1403 1404 /* Check if the adapter supports the needed features */ 1405 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 1406 return -EIO; 1407 1408 state = devm_kzalloc(&client->dev, sizeof(*state), GFP_KERNEL); 1409 if (state == NULL) 1410 return -ENOMEM; 1411 1412 state->client = client; 1413 state->field = V4L2_FIELD_ALTERNATE; 1414 state->chip_info = (struct adv7180_chip_info *)id->driver_data; 1415 1416 state->pwdn_gpio = devm_gpiod_get_optional(&client->dev, "powerdown", 1417 GPIOD_OUT_HIGH); 1418 if (IS_ERR(state->pwdn_gpio)) { 1419 ret = PTR_ERR(state->pwdn_gpio); 1420 v4l_err(client, "request for power pin failed: %d\n", ret); 1421 return ret; 1422 } 1423 1424 state->rst_gpio = devm_gpiod_get_optional(&client->dev, "reset", 1425 GPIOD_OUT_HIGH); 1426 if (IS_ERR(state->rst_gpio)) { 1427 ret = PTR_ERR(state->rst_gpio); 1428 v4l_err(client, "request for reset pin failed: %d\n", ret); 1429 return ret; 1430 } 1431 1432 if (of_property_read_bool(np, "adv,force-bt656-4")) 1433 state->force_bt656_4 = true; 1434 1435 if (state->chip_info->flags & ADV7180_FLAG_MIPI_CSI2) { 1436 state->csi_client = i2c_new_dummy_device(client->adapter, 1437 ADV7180_DEFAULT_CSI_I2C_ADDR); 1438 if (IS_ERR(state->csi_client)) 1439 return PTR_ERR(state->csi_client); 1440 } 1441 1442 if (state->chip_info->flags & ADV7180_FLAG_I2P) { 1443 state->vpp_client = i2c_new_dummy_device(client->adapter, 1444 ADV7180_DEFAULT_VPP_I2C_ADDR); 1445 if (IS_ERR(state->vpp_client)) { 1446 ret = PTR_ERR(state->vpp_client); 1447 goto err_unregister_csi_client; 1448 } 1449 } 1450 1451 state->irq = client->irq; 1452 mutex_init(&state->mutex); 1453 state->curr_norm = V4L2_STD_NTSC; 1454 if (state->chip_info->flags & ADV7180_FLAG_RESET_POWERED) 1455 state->powered = true; 1456 else 1457 state->powered = false; 1458 state->input = 0; 1459 sd = &state->sd; 1460 v4l2_i2c_subdev_init(sd, client, &adv7180_ops); 1461 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS; 1462 1463 ret = adv7180_init_controls(state); 1464 if (ret) 1465 goto err_unregister_vpp_client; 1466 1467 state->pad.flags = MEDIA_PAD_FL_SOURCE; 1468 sd->entity.function = MEDIA_ENT_F_ATV_DECODER; 1469 ret = media_entity_pads_init(&sd->entity, 1, &state->pad); 1470 if (ret) 1471 goto err_free_ctrl; 1472 1473 ret = init_device(state); 1474 if (ret) 1475 goto err_media_entity_cleanup; 1476 1477 if (state->irq) { 1478 ret = request_threaded_irq(client->irq, NULL, adv7180_irq, 1479 IRQF_ONESHOT | IRQF_TRIGGER_FALLING, 1480 KBUILD_MODNAME, state); 1481 if (ret) 1482 goto err_media_entity_cleanup; 1483 } 1484 1485 ret = v4l2_async_register_subdev(sd); 1486 if (ret) 1487 goto err_free_irq; 1488 1489 mutex_lock(&state->mutex); 1490 ret = adv7180_read(state, ADV7180_REG_IDENT); 1491 mutex_unlock(&state->mutex); 1492 if (ret < 0) 1493 goto err_v4l2_async_unregister; 1494 1495 v4l_info(client, "chip id 0x%x found @ 0x%02x (%s)\n", 1496 ret, client->addr, client->adapter->name); 1497 1498 return 0; 1499 1500 err_v4l2_async_unregister: 1501 v4l2_async_unregister_subdev(sd); 1502 err_free_irq: 1503 if (state->irq > 0) 1504 free_irq(client->irq, state); 1505 err_media_entity_cleanup: 1506 media_entity_cleanup(&sd->entity); 1507 err_free_ctrl: 1508 adv7180_exit_controls(state); 1509 err_unregister_vpp_client: 1510 i2c_unregister_device(state->vpp_client); 1511 err_unregister_csi_client: 1512 i2c_unregister_device(state->csi_client); 1513 mutex_destroy(&state->mutex); 1514 return ret; 1515 } 1516 1517 static void adv7180_remove(struct i2c_client *client) 1518 { 1519 struct v4l2_subdev *sd = i2c_get_clientdata(client); 1520 struct adv7180_state *state = to_state(sd); 1521 1522 v4l2_async_unregister_subdev(sd); 1523 1524 if (state->irq > 0) 1525 free_irq(client->irq, state); 1526 1527 media_entity_cleanup(&sd->entity); 1528 adv7180_exit_controls(state); 1529 1530 i2c_unregister_device(state->vpp_client); 1531 i2c_unregister_device(state->csi_client); 1532 1533 adv7180_set_reset_pin(state, true); 1534 adv7180_set_power_pin(state, false); 1535 1536 mutex_destroy(&state->mutex); 1537 } 1538 1539 static const struct i2c_device_id adv7180_id[] = { 1540 { "adv7180", (kernel_ulong_t)&adv7180_info }, 1541 { "adv7180cp", (kernel_ulong_t)&adv7180_info }, 1542 { "adv7180st", (kernel_ulong_t)&adv7180_info }, 1543 { "adv7182", (kernel_ulong_t)&adv7182_info }, 1544 { "adv7280", (kernel_ulong_t)&adv7280_info }, 1545 { "adv7280-m", (kernel_ulong_t)&adv7280_m_info }, 1546 { "adv7281", (kernel_ulong_t)&adv7281_info }, 1547 { "adv7281-m", (kernel_ulong_t)&adv7281_m_info }, 1548 { "adv7281-ma", (kernel_ulong_t)&adv7281_ma_info }, 1549 { "adv7282", (kernel_ulong_t)&adv7282_info }, 1550 { "adv7282-m", (kernel_ulong_t)&adv7282_m_info }, 1551 {}, 1552 }; 1553 MODULE_DEVICE_TABLE(i2c, adv7180_id); 1554 1555 #ifdef CONFIG_PM_SLEEP 1556 static int adv7180_suspend(struct device *dev) 1557 { 1558 struct v4l2_subdev *sd = dev_get_drvdata(dev); 1559 struct adv7180_state *state = to_state(sd); 1560 1561 return adv7180_set_power(state, false); 1562 } 1563 1564 static int adv7180_resume(struct device *dev) 1565 { 1566 struct v4l2_subdev *sd = dev_get_drvdata(dev); 1567 struct adv7180_state *state = to_state(sd); 1568 int ret; 1569 1570 ret = init_device(state); 1571 if (ret < 0) 1572 return ret; 1573 1574 ret = adv7180_set_power(state, state->powered); 1575 if (ret) 1576 return ret; 1577 1578 return 0; 1579 } 1580 1581 static SIMPLE_DEV_PM_OPS(adv7180_pm_ops, adv7180_suspend, adv7180_resume); 1582 #define ADV7180_PM_OPS (&adv7180_pm_ops) 1583 1584 #else 1585 #define ADV7180_PM_OPS NULL 1586 #endif 1587 1588 #ifdef CONFIG_OF 1589 static const struct of_device_id adv7180_of_id[] = { 1590 { .compatible = "adi,adv7180", }, 1591 { .compatible = "adi,adv7180cp", }, 1592 { .compatible = "adi,adv7180st", }, 1593 { .compatible = "adi,adv7182", }, 1594 { .compatible = "adi,adv7280", }, 1595 { .compatible = "adi,adv7280-m", }, 1596 { .compatible = "adi,adv7281", }, 1597 { .compatible = "adi,adv7281-m", }, 1598 { .compatible = "adi,adv7281-ma", }, 1599 { .compatible = "adi,adv7282", }, 1600 { .compatible = "adi,adv7282-m", }, 1601 { }, 1602 }; 1603 1604 MODULE_DEVICE_TABLE(of, adv7180_of_id); 1605 #endif 1606 1607 static struct i2c_driver adv7180_driver = { 1608 .driver = { 1609 .name = KBUILD_MODNAME, 1610 .pm = ADV7180_PM_OPS, 1611 .of_match_table = of_match_ptr(adv7180_of_id), 1612 }, 1613 .probe_new = adv7180_probe, 1614 .remove = adv7180_remove, 1615 .id_table = adv7180_id, 1616 }; 1617 1618 module_i2c_driver(adv7180_driver); 1619 1620 MODULE_DESCRIPTION("Analog Devices ADV7180 video decoder driver"); 1621 MODULE_AUTHOR("Mocean Laboratories"); 1622 MODULE_LICENSE("GPL v2"); 1623