drivers/media/i2c/adv748x/adv748x-afe.c

   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
  42 static 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
  55 static 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
 112 static 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
 128 static 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
 150 static 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
 157 int 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
 164 static 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
 184 static 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
 193 static 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
 212 static 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
 242 unlock:
 243         mutex_unlock(&state->mutex);
 244
 245         return ret;
 246 }
 247
 248 static 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
 255 static 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
 270 static 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
 297 unlock:
 298         mutex_unlock(&state->mutex);
 299
 300         return ret;
 301 }
 302
 303 static 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
 317 static 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
 333 static 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
 345 static 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
 368 static 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
 387 static 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
 397 static 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
 406 static 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
 416 static 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
 462 static const struct v4l2_ctrl_ops adv748x_afe_ctrl_ops = {
 463         .s_ctrl = adv748x_afe_s_ctrl,
 464 };
 465
 466 static 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
 502 int 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         adv748x_afe_s_input(afe, afe->input);
 525
 526         adv_dbg(state, "AFE Default input set to %d\n", afe->input);
 527
 528         /* Entity pads and sinks are 0-indexed to match the pads */
 529         for (i = ADV748X_AFE_SINK_AIN0; i <= ADV748X_AFE_SINK_AIN7; i++)
 530                 afe->pads[i].flags = MEDIA_PAD_FL_SINK;
 531
 532         afe->pads[ADV748X_AFE_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
 533
 534         ret = media_entity_pads_init(&afe->sd.entity, ADV748X_AFE_NR_PADS,
 535                         afe->pads);
 536         if (ret)
 537                 return ret;
 538
 539         ret = adv748x_afe_init_controls(afe);
 540         if (ret)
 541                 goto error;
 542
 543         return 0;
 544
 545 error:
 546         media_entity_cleanup(&afe->sd.entity);
 547
 548         return ret;
 549 }
 550
 551 void adv748x_afe_cleanup(struct adv748x_afe *afe)
 552 {
 553         v4l2_device_unregister_subdev(&afe->sd);
 554         media_entity_cleanup(&afe->sd.entity);
 555         v4l2_ctrl_handler_free(&afe->ctrl_hdl);
 556 }