adv748x-afe.c (13419B)
1// SPDX-License-Identifier: GPL-2.0+ 2/* 3 * Driver for Analog Devices ADV748X 8 channel analog front end (AFE) receiver 4 * with standard definition processor (SDP) 5 * 6 * Copyright (C) 2017 Renesas Electronics Corp. 7 */ 8 9#include <linux/delay.h> 10#include <linux/module.h> 11#include <linux/mutex.h> 12#include <linux/v4l2-dv-timings.h> 13 14#include <media/v4l2-ctrls.h> 15#include <media/v4l2-device.h> 16#include <media/v4l2-dv-timings.h> 17#include <media/v4l2-ioctl.h> 18 19#include "adv748x.h" 20 21/* ----------------------------------------------------------------------------- 22 * SDP 23 */ 24 25#define ADV748X_AFE_STD_AD_PAL_BG_NTSC_J_SECAM 0x0 26#define ADV748X_AFE_STD_AD_PAL_BG_NTSC_J_SECAM_PED 0x1 27#define ADV748X_AFE_STD_AD_PAL_N_NTSC_J_SECAM 0x2 28#define ADV748X_AFE_STD_AD_PAL_N_NTSC_M_SECAM 0x3 29#define ADV748X_AFE_STD_NTSC_J 0x4 30#define ADV748X_AFE_STD_NTSC_M 0x5 31#define ADV748X_AFE_STD_PAL60 0x6 32#define ADV748X_AFE_STD_NTSC_443 0x7 33#define ADV748X_AFE_STD_PAL_BG 0x8 34#define ADV748X_AFE_STD_PAL_N 0x9 35#define ADV748X_AFE_STD_PAL_M 0xa 36#define ADV748X_AFE_STD_PAL_M_PED 0xb 37#define ADV748X_AFE_STD_PAL_COMB_N 0xc 38#define ADV748X_AFE_STD_PAL_COMB_N_PED 0xd 39#define ADV748X_AFE_STD_PAL_SECAM 0xe 40#define ADV748X_AFE_STD_PAL_SECAM_PED 0xf 41 42static int adv748x_afe_read_ro_map(struct adv748x_state *state, u8 reg) 43{ 44 int ret; 45 46 /* Select SDP Read-Only Main Map */ 47 ret = sdp_write(state, ADV748X_SDP_MAP_SEL, 48 ADV748X_SDP_MAP_SEL_RO_MAIN); 49 if (ret < 0) 50 return ret; 51 52 return sdp_read(state, reg); 53} 54 55static int adv748x_afe_status(struct adv748x_afe *afe, u32 *signal, 56 v4l2_std_id *std) 57{ 58 struct adv748x_state *state = adv748x_afe_to_state(afe); 59 int info; 60 61 /* Read status from reg 0x10 of SDP RO Map */ 62 info = adv748x_afe_read_ro_map(state, ADV748X_SDP_RO_10); 63 if (info < 0) 64 return info; 65 66 if (signal) 67 *signal = info & ADV748X_SDP_RO_10_IN_LOCK ? 68 0 : V4L2_IN_ST_NO_SIGNAL; 69 70 if (!std) 71 return 0; 72 73 /* Standard not valid if there is no signal */ 74 if (!(info & ADV748X_SDP_RO_10_IN_LOCK)) { 75 *std = V4L2_STD_UNKNOWN; 76 return 0; 77 } 78 79 switch (info & 0x70) { 80 case 0x00: 81 *std = V4L2_STD_NTSC; 82 break; 83 case 0x10: 84 *std = V4L2_STD_NTSC_443; 85 break; 86 case 0x20: 87 *std = V4L2_STD_PAL_M; 88 break; 89 case 0x30: 90 *std = V4L2_STD_PAL_60; 91 break; 92 case 0x40: 93 *std = V4L2_STD_PAL; 94 break; 95 case 0x50: 96 *std = V4L2_STD_SECAM; 97 break; 98 case 0x60: 99 *std = V4L2_STD_PAL_Nc | V4L2_STD_PAL_N; 100 break; 101 case 0x70: 102 *std = V4L2_STD_SECAM; 103 break; 104 default: 105 *std = V4L2_STD_UNKNOWN; 106 break; 107 } 108 109 return 0; 110} 111 112static void adv748x_afe_fill_format(struct adv748x_afe *afe, 113 struct v4l2_mbus_framefmt *fmt) 114{ 115 memset(fmt, 0, sizeof(*fmt)); 116 117 fmt->code = MEDIA_BUS_FMT_UYVY8_2X8; 118 fmt->colorspace = V4L2_COLORSPACE_SMPTE170M; 119 fmt->field = V4L2_FIELD_ALTERNATE; 120 121 fmt->width = 720; 122 fmt->height = afe->curr_norm & V4L2_STD_525_60 ? 480 : 576; 123 124 /* Field height */ 125 fmt->height /= 2; 126} 127 128static int adv748x_afe_std(v4l2_std_id std) 129{ 130 if (std == V4L2_STD_PAL_60) 131 return ADV748X_AFE_STD_PAL60; 132 if (std == V4L2_STD_NTSC_443) 133 return ADV748X_AFE_STD_NTSC_443; 134 if (std == V4L2_STD_PAL_N) 135 return ADV748X_AFE_STD_PAL_N; 136 if (std == V4L2_STD_PAL_M) 137 return ADV748X_AFE_STD_PAL_M; 138 if (std == V4L2_STD_PAL_Nc) 139 return ADV748X_AFE_STD_PAL_COMB_N; 140 if (std & V4L2_STD_NTSC) 141 return ADV748X_AFE_STD_NTSC_M; 142 if (std & V4L2_STD_PAL) 143 return ADV748X_AFE_STD_PAL_BG; 144 if (std & V4L2_STD_SECAM) 145 return ADV748X_AFE_STD_PAL_SECAM; 146 147 return -EINVAL; 148} 149 150static void adv748x_afe_set_video_standard(struct adv748x_state *state, 151 int sdpstd) 152{ 153 sdp_clrset(state, ADV748X_SDP_VID_SEL, ADV748X_SDP_VID_SEL_MASK, 154 (sdpstd & 0xf) << ADV748X_SDP_VID_SEL_SHIFT); 155} 156 157int adv748x_afe_s_input(struct adv748x_afe *afe, unsigned int input) 158{ 159 struct adv748x_state *state = adv748x_afe_to_state(afe); 160 161 return sdp_write(state, ADV748X_SDP_INSEL, input); 162} 163 164static int adv748x_afe_g_pixelaspect(struct v4l2_subdev *sd, 165 struct v4l2_fract *aspect) 166{ 167 struct adv748x_afe *afe = adv748x_sd_to_afe(sd); 168 169 if (afe->curr_norm & V4L2_STD_525_60) { 170 aspect->numerator = 11; 171 aspect->denominator = 10; 172 } else { 173 aspect->numerator = 54; 174 aspect->denominator = 59; 175 } 176 177 return 0; 178} 179 180/* ----------------------------------------------------------------------------- 181 * v4l2_subdev_video_ops 182 */ 183 184static int adv748x_afe_g_std(struct v4l2_subdev *sd, v4l2_std_id *norm) 185{ 186 struct adv748x_afe *afe = adv748x_sd_to_afe(sd); 187 188 *norm = afe->curr_norm; 189 190 return 0; 191} 192 193static int adv748x_afe_s_std(struct v4l2_subdev *sd, v4l2_std_id std) 194{ 195 struct adv748x_afe *afe = adv748x_sd_to_afe(sd); 196 struct adv748x_state *state = adv748x_afe_to_state(afe); 197 int afe_std = adv748x_afe_std(std); 198 199 if (afe_std < 0) 200 return afe_std; 201 202 mutex_lock(&state->mutex); 203 204 adv748x_afe_set_video_standard(state, afe_std); 205 afe->curr_norm = std; 206 207 mutex_unlock(&state->mutex); 208 209 return 0; 210} 211 212static int adv748x_afe_querystd(struct v4l2_subdev *sd, v4l2_std_id *std) 213{ 214 struct adv748x_afe *afe = adv748x_sd_to_afe(sd); 215 struct adv748x_state *state = adv748x_afe_to_state(afe); 216 int afe_std; 217 int ret; 218 219 mutex_lock(&state->mutex); 220 221 if (afe->streaming) { 222 ret = -EBUSY; 223 goto unlock; 224 } 225 226 /* Set auto detect mode */ 227 adv748x_afe_set_video_standard(state, 228 ADV748X_AFE_STD_AD_PAL_BG_NTSC_J_SECAM); 229 230 msleep(100); 231 232 /* Read detected standard */ 233 ret = adv748x_afe_status(afe, NULL, std); 234 235 afe_std = adv748x_afe_std(afe->curr_norm); 236 if (afe_std < 0) 237 goto unlock; 238 239 /* Restore original state */ 240 adv748x_afe_set_video_standard(state, afe_std); 241 242unlock: 243 mutex_unlock(&state->mutex); 244 245 return ret; 246} 247 248static int adv748x_afe_g_tvnorms(struct v4l2_subdev *sd, v4l2_std_id *norm) 249{ 250 *norm = V4L2_STD_ALL; 251 252 return 0; 253} 254 255static int adv748x_afe_g_input_status(struct v4l2_subdev *sd, u32 *status) 256{ 257 struct adv748x_afe *afe = adv748x_sd_to_afe(sd); 258 struct adv748x_state *state = adv748x_afe_to_state(afe); 259 int ret; 260 261 mutex_lock(&state->mutex); 262 263 ret = adv748x_afe_status(afe, status, NULL); 264 265 mutex_unlock(&state->mutex); 266 267 return ret; 268} 269 270static int adv748x_afe_s_stream(struct v4l2_subdev *sd, int enable) 271{ 272 struct adv748x_afe *afe = adv748x_sd_to_afe(sd); 273 struct adv748x_state *state = adv748x_afe_to_state(afe); 274 u32 signal = V4L2_IN_ST_NO_SIGNAL; 275 int ret; 276 277 mutex_lock(&state->mutex); 278 279 if (enable) { 280 ret = adv748x_afe_s_input(afe, afe->input); 281 if (ret) 282 goto unlock; 283 } 284 285 ret = adv748x_tx_power(afe->tx, enable); 286 if (ret) 287 goto unlock; 288 289 afe->streaming = enable; 290 291 adv748x_afe_status(afe, &signal, NULL); 292 if (signal != V4L2_IN_ST_NO_SIGNAL) 293 adv_dbg(state, "Detected SDP signal\n"); 294 else 295 adv_dbg(state, "Couldn't detect SDP video signal\n"); 296 297unlock: 298 mutex_unlock(&state->mutex); 299 300 return ret; 301} 302 303static const struct v4l2_subdev_video_ops adv748x_afe_video_ops = { 304 .g_std = adv748x_afe_g_std, 305 .s_std = adv748x_afe_s_std, 306 .querystd = adv748x_afe_querystd, 307 .g_tvnorms = adv748x_afe_g_tvnorms, 308 .g_input_status = adv748x_afe_g_input_status, 309 .s_stream = adv748x_afe_s_stream, 310 .g_pixelaspect = adv748x_afe_g_pixelaspect, 311}; 312 313/* ----------------------------------------------------------------------------- 314 * v4l2_subdev_pad_ops 315 */ 316 317static int adv748x_afe_propagate_pixelrate(struct adv748x_afe *afe) 318{ 319 struct v4l2_subdev *tx; 320 321 tx = adv748x_get_remote_sd(&afe->pads[ADV748X_AFE_SOURCE]); 322 if (!tx) 323 return -ENOLINK; 324 325 /* 326 * The ADV748x ADC sampling frequency is twice the externally supplied 327 * clock whose frequency is required to be 28.63636 MHz. It oversamples 328 * with a factor of 4 resulting in a pixel rate of 14.3180180 MHz. 329 */ 330 return adv748x_csi2_set_pixelrate(tx, 14318180); 331} 332 333static int adv748x_afe_enum_mbus_code(struct v4l2_subdev *sd, 334 struct v4l2_subdev_state *sd_state, 335 struct v4l2_subdev_mbus_code_enum *code) 336{ 337 if (code->index != 0) 338 return -EINVAL; 339 340 code->code = MEDIA_BUS_FMT_UYVY8_2X8; 341 342 return 0; 343} 344 345static int adv748x_afe_get_format(struct v4l2_subdev *sd, 346 struct v4l2_subdev_state *sd_state, 347 struct v4l2_subdev_format *sdformat) 348{ 349 struct adv748x_afe *afe = adv748x_sd_to_afe(sd); 350 struct v4l2_mbus_framefmt *mbusformat; 351 352 /* It makes no sense to get the format of the analog sink pads */ 353 if (sdformat->pad != ADV748X_AFE_SOURCE) 354 return -EINVAL; 355 356 if (sdformat->which == V4L2_SUBDEV_FORMAT_TRY) { 357 mbusformat = v4l2_subdev_get_try_format(sd, sd_state, 358 sdformat->pad); 359 sdformat->format = *mbusformat; 360 } else { 361 adv748x_afe_fill_format(afe, &sdformat->format); 362 adv748x_afe_propagate_pixelrate(afe); 363 } 364 365 return 0; 366} 367 368static int adv748x_afe_set_format(struct v4l2_subdev *sd, 369 struct v4l2_subdev_state *sd_state, 370 struct v4l2_subdev_format *sdformat) 371{ 372 struct v4l2_mbus_framefmt *mbusformat; 373 374 /* It makes no sense to get the format of the analog sink pads */ 375 if (sdformat->pad != ADV748X_AFE_SOURCE) 376 return -EINVAL; 377 378 if (sdformat->which == V4L2_SUBDEV_FORMAT_ACTIVE) 379 return adv748x_afe_get_format(sd, sd_state, sdformat); 380 381 mbusformat = v4l2_subdev_get_try_format(sd, sd_state, sdformat->pad); 382 *mbusformat = sdformat->format; 383 384 return 0; 385} 386 387static const struct v4l2_subdev_pad_ops adv748x_afe_pad_ops = { 388 .enum_mbus_code = adv748x_afe_enum_mbus_code, 389 .set_fmt = adv748x_afe_set_format, 390 .get_fmt = adv748x_afe_get_format, 391}; 392 393/* ----------------------------------------------------------------------------- 394 * v4l2_subdev_ops 395 */ 396 397static const struct v4l2_subdev_ops adv748x_afe_ops = { 398 .video = &adv748x_afe_video_ops, 399 .pad = &adv748x_afe_pad_ops, 400}; 401 402/* ----------------------------------------------------------------------------- 403 * Controls 404 */ 405 406static const char * const afe_ctrl_frp_menu[] = { 407 "Disabled", 408 "Solid Blue", 409 "Color Bars", 410 "Grey Ramp", 411 "Cb Ramp", 412 "Cr Ramp", 413 "Boundary" 414}; 415 416static int adv748x_afe_s_ctrl(struct v4l2_ctrl *ctrl) 417{ 418 struct adv748x_afe *afe = adv748x_ctrl_to_afe(ctrl); 419 struct adv748x_state *state = adv748x_afe_to_state(afe); 420 bool enable; 421 int ret; 422 423 ret = sdp_write(state, 0x0e, 0x00); 424 if (ret < 0) 425 return ret; 426 427 switch (ctrl->id) { 428 case V4L2_CID_BRIGHTNESS: 429 ret = sdp_write(state, ADV748X_SDP_BRI, ctrl->val); 430 break; 431 case V4L2_CID_HUE: 432 /* Hue is inverted according to HSL chart */ 433 ret = sdp_write(state, ADV748X_SDP_HUE, -ctrl->val); 434 break; 435 case V4L2_CID_CONTRAST: 436 ret = sdp_write(state, ADV748X_SDP_CON, ctrl->val); 437 break; 438 case V4L2_CID_SATURATION: 439 ret = sdp_write(state, ADV748X_SDP_SD_SAT_U, ctrl->val); 440 if (ret) 441 break; 442 ret = sdp_write(state, ADV748X_SDP_SD_SAT_V, ctrl->val); 443 break; 444 case V4L2_CID_TEST_PATTERN: 445 enable = !!ctrl->val; 446 447 /* Enable/Disable Color bar test patterns */ 448 ret = sdp_clrset(state, ADV748X_SDP_DEF, ADV748X_SDP_DEF_VAL_EN, 449 enable); 450 if (ret) 451 break; 452 ret = sdp_clrset(state, ADV748X_SDP_FRP, ADV748X_SDP_FRP_MASK, 453 enable ? ctrl->val - 1 : 0); 454 break; 455 default: 456 return -EINVAL; 457 } 458 459 return ret; 460} 461 462static const struct v4l2_ctrl_ops adv748x_afe_ctrl_ops = { 463 .s_ctrl = adv748x_afe_s_ctrl, 464}; 465 466static int adv748x_afe_init_controls(struct adv748x_afe *afe) 467{ 468 struct adv748x_state *state = adv748x_afe_to_state(afe); 469 470 v4l2_ctrl_handler_init(&afe->ctrl_hdl, 5); 471 472 /* Use our mutex for the controls */ 473 afe->ctrl_hdl.lock = &state->mutex; 474 475 v4l2_ctrl_new_std(&afe->ctrl_hdl, &adv748x_afe_ctrl_ops, 476 V4L2_CID_BRIGHTNESS, ADV748X_SDP_BRI_MIN, 477 ADV748X_SDP_BRI_MAX, 1, ADV748X_SDP_BRI_DEF); 478 v4l2_ctrl_new_std(&afe->ctrl_hdl, &adv748x_afe_ctrl_ops, 479 V4L2_CID_CONTRAST, ADV748X_SDP_CON_MIN, 480 ADV748X_SDP_CON_MAX, 1, ADV748X_SDP_CON_DEF); 481 v4l2_ctrl_new_std(&afe->ctrl_hdl, &adv748x_afe_ctrl_ops, 482 V4L2_CID_SATURATION, ADV748X_SDP_SAT_MIN, 483 ADV748X_SDP_SAT_MAX, 1, ADV748X_SDP_SAT_DEF); 484 v4l2_ctrl_new_std(&afe->ctrl_hdl, &adv748x_afe_ctrl_ops, 485 V4L2_CID_HUE, ADV748X_SDP_HUE_MIN, 486 ADV748X_SDP_HUE_MAX, 1, ADV748X_SDP_HUE_DEF); 487 488 v4l2_ctrl_new_std_menu_items(&afe->ctrl_hdl, &adv748x_afe_ctrl_ops, 489 V4L2_CID_TEST_PATTERN, 490 ARRAY_SIZE(afe_ctrl_frp_menu) - 1, 491 0, 0, afe_ctrl_frp_menu); 492 493 afe->sd.ctrl_handler = &afe->ctrl_hdl; 494 if (afe->ctrl_hdl.error) { 495 v4l2_ctrl_handler_free(&afe->ctrl_hdl); 496 return afe->ctrl_hdl.error; 497 } 498 499 return v4l2_ctrl_handler_setup(&afe->ctrl_hdl); 500} 501 502int adv748x_afe_init(struct adv748x_afe *afe) 503{ 504 struct adv748x_state *state = adv748x_afe_to_state(afe); 505 int ret; 506 unsigned int i; 507 508 afe->input = 0; 509 afe->streaming = false; 510 afe->curr_norm = V4L2_STD_NTSC_M; 511 512 adv748x_subdev_init(&afe->sd, state, &adv748x_afe_ops, 513 MEDIA_ENT_F_ATV_DECODER, "afe"); 514 515 /* Identify the first connector found as a default input if set */ 516 for (i = ADV748X_PORT_AIN0; i <= ADV748X_PORT_AIN7; i++) { 517 /* Inputs and ports are 1-indexed to match the data sheet */ 518 if (state->endpoints[i]) { 519 afe->input = i; 520 break; 521 } 522 } 523 524 /* Entity pads and sinks are 0-indexed to match the pads */ 525 for (i = ADV748X_AFE_SINK_AIN0; i <= ADV748X_AFE_SINK_AIN7; i++) 526 afe->pads[i].flags = MEDIA_PAD_FL_SINK; 527 528 afe->pads[ADV748X_AFE_SOURCE].flags = MEDIA_PAD_FL_SOURCE; 529 530 ret = media_entity_pads_init(&afe->sd.entity, ADV748X_AFE_NR_PADS, 531 afe->pads); 532 if (ret) 533 return ret; 534 535 ret = adv748x_afe_init_controls(afe); 536 if (ret) 537 goto error; 538 539 return 0; 540 541error: 542 media_entity_cleanup(&afe->sd.entity); 543 544 return ret; 545} 546 547void adv748x_afe_cleanup(struct adv748x_afe *afe) 548{ 549 v4l2_device_unregister_subdev(&afe->sd); 550 media_entity_cleanup(&afe->sd.entity); 551 v4l2_ctrl_handler_free(&afe->ctrl_hdl); 552}