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

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Driver for Analog Devices ADV748X CSI-2 Transmitter
   4  *
   5  * Copyright (C) 2017 Renesas Electronics Corp.
   6  */
   7
   8 #include <linux/module.h>
   9 #include <linux/mutex.h>
  10
  11 #include <media/v4l2-ctrls.h>
  12 #include <media/v4l2-device.h>
  13 #include <media/v4l2-ioctl.h>
  14
  15 #include "adv748x.h"
  16
  17 int adv748x_csi2_set_virtual_channel(struct adv748x_csi2 *tx, unsigned int vc)
  18 {
  19         return tx_write(tx, ADV748X_CSI_VC_REF, vc << ADV748X_CSI_VC_REF_SHIFT);
  20 }
  21
  22 /**
  23  * adv748x_csi2_register_link : Register and link internal entities
  24  *
  25  * @tx: CSI2 private entity
  26  * @v4l2_dev: Video registration device
  27  * @src: Source subdevice to establish link
  28  * @src_pad: Pad number of source to link to this @tx
  29  * @enable: Link enabled flag
  30  *
  31  * Ensure that the subdevice is registered against the v4l2_device, and link the
  32  * source pad to the sink pad of the CSI2 bus entity.
  33  */
  34 static int adv748x_csi2_register_link(struct adv748x_csi2 *tx,
  35                                       struct v4l2_device *v4l2_dev,
  36                                       struct v4l2_subdev *src,
  37                                       unsigned int src_pad,
  38                                       bool enable)
  39 {
  40         int ret;
  41
  42         if (!src->v4l2_dev) {
  43                 ret = v4l2_device_register_subdev(v4l2_dev, src);
  44                 if (ret)
  45                         return ret;
  46         }
  47
  48         ret = media_create_pad_link(&src->entity, src_pad,
  49                                     &tx->sd.entity, ADV748X_CSI2_SINK,
  50                                     enable ? MEDIA_LNK_FL_ENABLED : 0);
  51         if (ret)
  52                 return ret;
  53
  54         if (enable)
  55                 tx->src = src;
  56
  57         return 0;
  58 }
  59
  60 /* -----------------------------------------------------------------------------
  61  * v4l2_subdev_internal_ops
  62  *
  63  * We use the internal registered operation to be able to ensure that our
  64  * incremental subdevices (not connected in the forward path) can be registered
  65  * against the resulting video path and media device.
  66  */
  67
  68 static int adv748x_csi2_registered(struct v4l2_subdev *sd)
  69 {
  70         struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
  71         struct adv748x_state *state = tx->state;
  72         int ret;
  73
  74         adv_dbg(state, "Registered %s (%s)", is_txa(tx) ? "TXA":"TXB",
  75                         sd->name);
  76
  77         /*
  78          * Link TXA to AFE and HDMI, and TXB to AFE only as TXB cannot output
  79          * HDMI.
  80          *
  81          * The HDMI->TXA link is enabled by default, as is the AFE->TXB one.
  82          */
  83         if (is_afe_enabled(state)) {
  84                 ret = adv748x_csi2_register_link(tx, sd->v4l2_dev,
  85                                                  &state->afe.sd,
  86                                                  ADV748X_AFE_SOURCE,
  87                                                  is_txb(tx));
  88                 if (ret)
  89                         return ret;
  90
  91                 /* TXB can output AFE signals only. */
  92                 if (is_txb(tx))
  93                         state->afe.tx = tx;
  94         }
  95
  96         /* Register link to HDMI for TXA only. */
  97         if (is_txb(tx) || !is_hdmi_enabled(state))
  98                 return 0;
  99
 100         ret = adv748x_csi2_register_link(tx, sd->v4l2_dev, &state->hdmi.sd,
 101                                          ADV748X_HDMI_SOURCE, true);
 102         if (ret)
 103                 return ret;
 104
 105         /* The default HDMI output is TXA. */
 106         state->hdmi.tx = tx;
 107
 108         return 0;
 109 }
 110
 111 static const struct v4l2_subdev_internal_ops adv748x_csi2_internal_ops = {
 112         .registered = adv748x_csi2_registered,
 113 };
 114
 115 /* -----------------------------------------------------------------------------
 116  * v4l2_subdev_video_ops
 117  */
 118
 119 static int adv748x_csi2_s_stream(struct v4l2_subdev *sd, int enable)
 120 {
 121         struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
 122         struct v4l2_subdev *src;
 123
 124         src = adv748x_get_remote_sd(&tx->pads[ADV748X_CSI2_SINK]);
 125         if (!src)
 126                 return -EPIPE;
 127
 128         return v4l2_subdev_call(src, video, s_stream, enable);
 129 }
 130
 131 static const struct v4l2_subdev_video_ops adv748x_csi2_video_ops = {
 132         .s_stream = adv748x_csi2_s_stream,
 133 };
 134
 135 /* -----------------------------------------------------------------------------
 136  * v4l2_subdev_pad_ops
 137  *
 138  * The CSI2 bus pads are ignorant to the data sizes or formats.
 139  * But we must support setting the pad formats for format propagation.
 140  */
 141
 142 static struct v4l2_mbus_framefmt *
 143 adv748x_csi2_get_pad_format(struct v4l2_subdev *sd,
 144                             struct v4l2_subdev_pad_config *cfg,
 145                             unsigned int pad, u32 which)
 146 {
 147         struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
 148
 149         if (which == V4L2_SUBDEV_FORMAT_TRY)
 150                 return v4l2_subdev_get_try_format(sd, cfg, pad);
 151
 152         return &tx->format;
 153 }
 154
 155 static int adv748x_csi2_get_format(struct v4l2_subdev *sd,
 156                                    struct v4l2_subdev_pad_config *cfg,
 157                                    struct v4l2_subdev_format *sdformat)
 158 {
 159         struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
 160         struct adv748x_state *state = tx->state;
 161         struct v4l2_mbus_framefmt *mbusformat;
 162
 163         mbusformat = adv748x_csi2_get_pad_format(sd, cfg, sdformat->pad,
 164                                                  sdformat->which);
 165         if (!mbusformat)
 166                 return -EINVAL;
 167
 168         mutex_lock(&state->mutex);
 169
 170         sdformat->format = *mbusformat;
 171
 172         mutex_unlock(&state->mutex);
 173
 174         return 0;
 175 }
 176
 177 static int adv748x_csi2_set_format(struct v4l2_subdev *sd,
 178                                    struct v4l2_subdev_pad_config *cfg,
 179                                    struct v4l2_subdev_format *sdformat)
 180 {
 181         struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
 182         struct adv748x_state *state = tx->state;
 183         struct v4l2_mbus_framefmt *mbusformat;
 184         int ret = 0;
 185
 186         mbusformat = adv748x_csi2_get_pad_format(sd, cfg, sdformat->pad,
 187                                                  sdformat->which);
 188         if (!mbusformat)
 189                 return -EINVAL;
 190
 191         mutex_lock(&state->mutex);
 192
 193         if (sdformat->pad == ADV748X_CSI2_SOURCE) {
 194                 const struct v4l2_mbus_framefmt *sink_fmt;
 195
 196                 sink_fmt = adv748x_csi2_get_pad_format(sd, cfg,
 197                                                        ADV748X_CSI2_SINK,
 198                                                        sdformat->which);
 199
 200                 if (!sink_fmt) {
 201                         ret = -EINVAL;
 202                         goto unlock;
 203                 }
 204
 205                 sdformat->format = *sink_fmt;
 206         }
 207
 208         *mbusformat = sdformat->format;
 209
 210 unlock:
 211         mutex_unlock(&state->mutex);
 212
 213         return ret;
 214 }
 215
 216 static int adv748x_csi2_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
 217                                         struct v4l2_mbus_config *config)
 218 {
 219         struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
 220
 221         if (pad != ADV748X_CSI2_SOURCE)
 222                 return -EINVAL;
 223
 224         config->type = V4L2_MBUS_CSI2_DPHY;
 225         switch (tx->active_lanes) {
 226         case 1:
 227                 config->flags = V4L2_MBUS_CSI2_1_LANE;
 228                 break;
 229
 230         case 2:
 231                 config->flags = V4L2_MBUS_CSI2_2_LANE;
 232                 break;
 233
 234         case 3:
 235                 config->flags = V4L2_MBUS_CSI2_3_LANE;
 236                 break;
 237
 238         case 4:
 239                 config->flags = V4L2_MBUS_CSI2_4_LANE;
 240                 break;
 241         }
 242
 243         return 0;
 244 }
 245
 246 static const struct v4l2_subdev_pad_ops adv748x_csi2_pad_ops = {
 247         .get_fmt = adv748x_csi2_get_format,
 248         .set_fmt = adv748x_csi2_set_format,
 249         .get_mbus_config = adv748x_csi2_get_mbus_config,
 250 };
 251
 252 /* -----------------------------------------------------------------------------
 253  * v4l2_subdev_ops
 254  */
 255
 256 static const struct v4l2_subdev_ops adv748x_csi2_ops = {
 257         .video = &adv748x_csi2_video_ops,
 258         .pad = &adv748x_csi2_pad_ops,
 259 };
 260
 261 /* -----------------------------------------------------------------------------
 262  * Subdev module and controls
 263  */
 264
 265 int adv748x_csi2_set_pixelrate(struct v4l2_subdev *sd, s64 rate)
 266 {
 267         struct adv748x_csi2 *tx = adv748x_sd_to_csi2(sd);
 268
 269         if (!tx->pixel_rate)
 270                 return -EINVAL;
 271
 272         return v4l2_ctrl_s_ctrl_int64(tx->pixel_rate, rate);
 273 }
 274
 275 static int adv748x_csi2_s_ctrl(struct v4l2_ctrl *ctrl)
 276 {
 277         switch (ctrl->id) {
 278         case V4L2_CID_PIXEL_RATE:
 279                 return 0;
 280         default:
 281                 return -EINVAL;
 282         }
 283 }
 284
 285 static const struct v4l2_ctrl_ops adv748x_csi2_ctrl_ops = {
 286         .s_ctrl = adv748x_csi2_s_ctrl,
 287 };
 288
 289 static int adv748x_csi2_init_controls(struct adv748x_csi2 *tx)
 290 {
 291
 292         v4l2_ctrl_handler_init(&tx->ctrl_hdl, 1);
 293
 294         tx->pixel_rate = v4l2_ctrl_new_std(&tx->ctrl_hdl,
 295                                            &adv748x_csi2_ctrl_ops,
 296                                            V4L2_CID_PIXEL_RATE, 1, INT_MAX,
 297                                            1, 1);
 298
 299         tx->sd.ctrl_handler = &tx->ctrl_hdl;
 300         if (tx->ctrl_hdl.error) {
 301                 v4l2_ctrl_handler_free(&tx->ctrl_hdl);
 302                 return tx->ctrl_hdl.error;
 303         }
 304
 305         return v4l2_ctrl_handler_setup(&tx->ctrl_hdl);
 306 }
 307
 308 int adv748x_csi2_init(struct adv748x_state *state, struct adv748x_csi2 *tx)
 309 {
 310         int ret;
 311
 312         if (!is_tx_enabled(tx))
 313                 return 0;
 314
 315         adv748x_subdev_init(&tx->sd, state, &adv748x_csi2_ops,
 316                             MEDIA_ENT_F_VID_IF_BRIDGE,
 317                             is_txa(tx) ? "txa" : "txb");
 318
 319         /* Ensure that matching is based upon the endpoint fwnodes */
 320         tx->sd.fwnode = of_fwnode_handle(state->endpoints[tx->port]);
 321
 322         /* Register internal ops for incremental subdev registration */
 323         tx->sd.internal_ops = &adv748x_csi2_internal_ops;
 324
 325         tx->pads[ADV748X_CSI2_SINK].flags = MEDIA_PAD_FL_SINK;
 326         tx->pads[ADV748X_CSI2_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
 327
 328         ret = media_entity_pads_init(&tx->sd.entity, ADV748X_CSI2_NR_PADS,
 329                                      tx->pads);
 330         if (ret)
 331                 return ret;
 332
 333         ret = adv748x_csi2_init_controls(tx);
 334         if (ret)
 335                 goto err_free_media;
 336
 337         ret = v4l2_async_register_subdev(&tx->sd);
 338         if (ret)
 339                 goto err_free_ctrl;
 340
 341         return 0;
 342
 343 err_free_ctrl:
 344         v4l2_ctrl_handler_free(&tx->ctrl_hdl);
 345 err_free_media:
 346         media_entity_cleanup(&tx->sd.entity);
 347
 348         return ret;
 349 }
 350
 351 void adv748x_csi2_cleanup(struct adv748x_csi2 *tx)
 352 {
 353         if (!is_tx_enabled(tx))
 354                 return;
 355
 356         v4l2_async_unregister_subdev(&tx->sd);
 357         media_entity_cleanup(&tx->sd.entity);
 358         v4l2_ctrl_handler_free(&tx->ctrl_hdl);
 359 }