drivers/media/platform/exynos4-is/fimc-isp-video.c

   1 /*
   2  * Samsung EXYNOS4x12 FIMC-IS (Imaging Subsystem) driver
   3  *
   4  * FIMC-IS ISP video input and video output DMA interface driver
   5  *
   6  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
   7  * Author: Sylwester Nawrocki <s.nawrocki@samsung.com>
   8  *
   9  * The hardware handling code derived from a driver written by
  10  * Younghwan Joo <yhwan.joo@samsung.com>.
  11  *
  12  * This program is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License version 2 as
  14  * published by the Free Software Foundation.
  15  */
  16
  17 #include <linux/bitops.h>
  18 #include <linux/device.h>
  19 #include <linux/delay.h>
  20 #include <linux/errno.h>
  21 #include <linux/kernel.h>
  22 #include <linux/module.h>
  23 #include <linux/types.h>
  24 #include <linux/printk.h>
  25 #include <linux/pm_runtime.h>
  26 #include <linux/slab.h>
  27 #include <linux/videodev2.h>
  28
  29 #include <media/v4l2-device.h>
  30 #include <media/v4l2-ioctl.h>
  31 #include <media/videobuf2-core.h>
  32 #include <media/videobuf2-dma-contig.h>
  33 #include <media/s5p_fimc.h>
  34
  35 #include "common.h"
  36 #include "media-dev.h"
  37 #include "fimc-is.h"
  38 #include "fimc-isp-video.h"
  39 #include "fimc-is-param.h"
  40
  41 static int isp_video_capture_queue_setup(struct vb2_queue *vq,
  42                         const struct v4l2_format *pfmt,
  43                         unsigned int *num_buffers, unsigned int *num_planes,
  44                         unsigned int sizes[], void *allocators[])
  45 {
  46         struct fimc_isp *isp = vb2_get_drv_priv(vq);
  47         struct v4l2_pix_format_mplane *vid_fmt = &isp->video_capture.pixfmt;
  48         const struct v4l2_pix_format_mplane *pixm = NULL;
  49         const struct fimc_fmt *fmt;
  50         unsigned int wh, i;
  51
  52         if (pfmt) {
  53                 pixm = &pfmt->fmt.pix_mp;
  54                 fmt = fimc_isp_find_format(&pixm->pixelformat, NULL, -1);
  55                 wh = pixm->width * pixm->height;
  56         } else {
  57                 fmt = isp->video_capture.format;
  58                 wh = vid_fmt->width * vid_fmt->height;
  59         }
  60
  61         if (fmt == NULL)
  62                 return -EINVAL;
  63
  64         *num_buffers = clamp_t(u32, *num_buffers, FIMC_ISP_REQ_BUFS_MIN,
  65                                                 FIMC_ISP_REQ_BUFS_MAX);
  66         *num_planes = fmt->memplanes;
  67
  68         for (i = 0; i < fmt->memplanes; i++) {
  69                 unsigned int size = (wh * fmt->depth[i]) / 8;
  70                 if (pixm)
  71                         sizes[i] = max(size, pixm->plane_fmt[i].sizeimage);
  72                 else
  73                         sizes[i] = size;
  74                 allocators[i] = isp->alloc_ctx;
  75         }
  76
  77         return 0;
  78 }
  79
  80 static inline struct param_dma_output *__get_isp_dma2(struct fimc_is *is)
  81 {
  82         return &__get_curr_is_config(is)->isp.dma2_output;
  83 }
  84
  85 static int isp_video_capture_start_streaming(struct vb2_queue *q,
  86                                                 unsigned int count)
  87 {
  88         struct fimc_isp *isp = vb2_get_drv_priv(q);
  89         struct fimc_is *is = fimc_isp_to_is(isp);
  90         struct param_dma_output *dma = __get_isp_dma2(is);
  91         struct fimc_is_video *video = &isp->video_capture;
  92         int ret;
  93
  94         if (!test_bit(ST_ISP_VID_CAP_BUF_PREP, &isp->state) ||
  95             test_bit(ST_ISP_VID_CAP_STREAMING, &isp->state))
  96                 return 0;
  97
  98
  99         dma->cmd = DMA_OUTPUT_COMMAND_ENABLE;
 100         dma->notify_dma_done = DMA_OUTPUT_NOTIFY_DMA_DONE_ENABLE;
 101         dma->buffer_address = is->is_dma_p_region +
 102                                 DMA2_OUTPUT_ADDR_ARRAY_OFFS;
 103         dma->buffer_number = video->reqbufs_count;
 104         dma->dma_out_mask = video->buf_mask;
 105
 106         isp_dbg(2, &video->ve.vdev,
 107                 "buf_count: %d, planes: %d, dma addr table: %#x\n",
 108                 video->buf_count, video->format->memplanes,
 109                 dma->buffer_address);
 110
 111         fimc_is_mem_barrier();
 112
 113         fimc_is_set_param_bit(is, PARAM_ISP_DMA2_OUTPUT);
 114         __fimc_is_hw_update_param(is, PARAM_ISP_DMA2_OUTPUT);
 115
 116         ret = fimc_is_itf_s_param(is, false);
 117         if (ret < 0)
 118                 return ret;
 119
 120         ret = fimc_pipeline_call(&video->ve, set_stream, 1);
 121         if (ret < 0)
 122                 return ret;
 123
 124         set_bit(ST_ISP_VID_CAP_STREAMING, &isp->state);
 125         return ret;
 126 }
 127
 128 static void isp_video_capture_stop_streaming(struct vb2_queue *q)
 129 {
 130         struct fimc_isp *isp = vb2_get_drv_priv(q);
 131         struct fimc_is *is = fimc_isp_to_is(isp);
 132         struct param_dma_output *dma = __get_isp_dma2(is);
 133         int ret;
 134
 135         ret = fimc_pipeline_call(&isp->video_capture.ve, set_stream, 0);
 136         if (ret < 0)
 137                 return;
 138
 139         dma->cmd = DMA_OUTPUT_COMMAND_DISABLE;
 140         dma->notify_dma_done = DMA_OUTPUT_NOTIFY_DMA_DONE_DISABLE;
 141         dma->buffer_number = 0;
 142         dma->buffer_address = 0;
 143         dma->dma_out_mask = 0;
 144
 145         fimc_is_set_param_bit(is, PARAM_ISP_DMA2_OUTPUT);
 146         __fimc_is_hw_update_param(is, PARAM_ISP_DMA2_OUTPUT);
 147
 148         ret = fimc_is_itf_s_param(is, false);
 149         if (ret < 0)
 150                 dev_warn(&is->pdev->dev, "%s: DMA stop failed\n", __func__);
 151
 152         fimc_is_hw_set_isp_buf_mask(is, 0);
 153
 154         clear_bit(ST_ISP_VID_CAP_BUF_PREP, &isp->state);
 155         clear_bit(ST_ISP_VID_CAP_STREAMING, &isp->state);
 156
 157         isp->video_capture.buf_count = 0;
 158 }
 159
 160 static int isp_video_capture_buffer_prepare(struct vb2_buffer *vb)
 161 {
 162         struct fimc_isp *isp = vb2_get_drv_priv(vb->vb2_queue);
 163         struct fimc_is_video *video = &isp->video_capture;
 164         int i;
 165
 166         if (video->format == NULL)
 167                 return -EINVAL;
 168
 169         for (i = 0; i < video->format->memplanes; i++) {
 170                 unsigned long size = video->pixfmt.plane_fmt[i].sizeimage;
 171
 172                 if (vb2_plane_size(vb, i) < size) {
 173                         v4l2_err(&video->ve.vdev,
 174                                  "User buffer too small (%ld < %ld)\n",
 175                                  vb2_plane_size(vb, i), size);
 176                         return -EINVAL;
 177                 }
 178                 vb2_set_plane_payload(vb, i, size);
 179         }
 180
 181         /* Check if we get one of the already known buffers. */
 182         if (test_bit(ST_ISP_VID_CAP_BUF_PREP, &isp->state)) {
 183                 dma_addr_t dma_addr = vb2_dma_contig_plane_dma_addr(vb, 0);
 184                 int i;
 185
 186                 for (i = 0; i < video->buf_count; i++)
 187                         if (video->buffers[i]->dma_addr[0] == dma_addr)
 188                                 return 0;
 189                 return -ENXIO;
 190         }
 191
 192         return 0;
 193 }
 194
 195 static void isp_video_capture_buffer_queue(struct vb2_buffer *vb)
 196 {
 197         struct fimc_isp *isp = vb2_get_drv_priv(vb->vb2_queue);
 198         struct fimc_is_video *video = &isp->video_capture;
 199         struct fimc_is *is = fimc_isp_to_is(isp);
 200         struct isp_video_buf *ivb = to_isp_video_buf(vb);
 201         unsigned long flags;
 202         unsigned int i;
 203
 204         if (test_bit(ST_ISP_VID_CAP_BUF_PREP, &isp->state)) {
 205                 spin_lock_irqsave(&is->slock, flags);
 206                 video->buf_mask |= BIT(ivb->index);
 207                 spin_unlock_irqrestore(&is->slock, flags);
 208         } else {
 209                 unsigned int num_planes = video->format->memplanes;
 210
 211                 ivb->index = video->buf_count;
 212                 video->buffers[ivb->index] = ivb;
 213
 214                 for (i = 0; i < num_planes; i++) {
 215                         int buf_index = ivb->index * num_planes + i;
 216
 217                         ivb->dma_addr[i] = vb2_dma_contig_plane_dma_addr(vb, i);
 218                         is->is_p_region->shared[32 + buf_index] =
 219                                                         ivb->dma_addr[i];
 220
 221                         isp_dbg(2, &video->ve.vdev,
 222                                 "dma_buf %d (%d/%d/%d) addr: %#x\n",
 223                                 buf_index, ivb->index, i, vb->v4l2_buf.index,
 224                                 ivb->dma_addr[i]);
 225                 }
 226
 227                 if (++video->buf_count < video->reqbufs_count)
 228                         return;
 229
 230                 video->buf_mask = (1UL << video->buf_count) - 1;
 231                 set_bit(ST_ISP_VID_CAP_BUF_PREP, &isp->state);
 232         }
 233
 234         if (!test_bit(ST_ISP_VID_CAP_STREAMING, &isp->state))
 235                 isp_video_capture_start_streaming(vb->vb2_queue, 0);
 236 }
 237
 238 /*
 239  * FIMC-IS ISP input and output DMA interface interrupt handler.
 240  * Locking: called with is->slock spinlock held.
 241  */
 242 void fimc_isp_video_irq_handler(struct fimc_is *is)
 243 {
 244         struct fimc_is_video *video = &is->isp.video_capture;
 245         struct vb2_buffer *vb;
 246         int buf_index;
 247
 248         /* TODO: Ensure the DMA is really stopped in stop_streaming callback */
 249         if (!test_bit(ST_ISP_VID_CAP_STREAMING, &is->isp.state))
 250                 return;
 251
 252         buf_index = (is->i2h_cmd.args[1] - 1) % video->buf_count;
 253         vb = &video->buffers[buf_index]->vb;
 254
 255         v4l2_get_timestamp(&vb->v4l2_buf.timestamp);
 256         vb2_buffer_done(vb, VB2_BUF_STATE_DONE);
 257
 258         video->buf_mask &= ~BIT(buf_index);
 259         fimc_is_hw_set_isp_buf_mask(is, video->buf_mask);
 260 }
 261
 262 static const struct vb2_ops isp_video_capture_qops = {
 263         .queue_setup     = isp_video_capture_queue_setup,
 264         .buf_prepare     = isp_video_capture_buffer_prepare,
 265         .buf_queue       = isp_video_capture_buffer_queue,
 266         .wait_prepare    = vb2_ops_wait_prepare,
 267         .wait_finish     = vb2_ops_wait_finish,
 268         .start_streaming = isp_video_capture_start_streaming,
 269         .stop_streaming  = isp_video_capture_stop_streaming,
 270 };
 271
 272 static int isp_video_open(struct file *file)
 273 {
 274         struct fimc_isp *isp = video_drvdata(file);
 275         struct exynos_video_entity *ve = &isp->video_capture.ve;
 276         struct media_entity *me = &ve->vdev.entity;
 277         int ret;
 278
 279         if (mutex_lock_interruptible(&isp->video_lock))
 280                 return -ERESTARTSYS;
 281
 282         ret = v4l2_fh_open(file);
 283         if (ret < 0)
 284                 goto unlock;
 285
 286         ret = pm_runtime_get_sync(&isp->pdev->dev);
 287         if (ret < 0)
 288                 goto rel_fh;
 289
 290         if (v4l2_fh_is_singular_file(file)) {
 291                 mutex_lock(&me->parent->graph_mutex);
 292
 293                 ret = fimc_pipeline_call(ve, open, me, true);
 294
 295                 /* Mark the video pipeline as in use. */
 296                 if (ret == 0)
 297                         me->use_count++;
 298
 299                 mutex_unlock(&me->parent->graph_mutex);
 300         }
 301         if (!ret)
 302                 goto unlock;
 303 rel_fh:
 304         v4l2_fh_release(file);
 305 unlock:
 306         mutex_unlock(&isp->video_lock);
 307         return ret;
 308 }
 309
 310 static int isp_video_release(struct file *file)
 311 {
 312         struct fimc_isp *isp = video_drvdata(file);
 313         struct fimc_is_video *ivc = &isp->video_capture;
 314         struct media_entity *entity = &ivc->ve.vdev.entity;
 315         struct media_device *mdev = entity->parent;
 316         int ret = 0;
 317
 318         mutex_lock(&isp->video_lock);
 319
 320         if (v4l2_fh_is_singular_file(file) && ivc->streaming) {
 321                 media_entity_pipeline_stop(entity);
 322                 ivc->streaming = 0;
 323         }
 324
 325         vb2_fop_release(file);
 326
 327         if (v4l2_fh_is_singular_file(file)) {
 328                 fimc_pipeline_call(&ivc->ve, close);
 329
 330                 mutex_lock(&mdev->graph_mutex);
 331                 entity->use_count--;
 332                 mutex_unlock(&mdev->graph_mutex);
 333         }
 334
 335         pm_runtime_put(&isp->pdev->dev);
 336         mutex_unlock(&isp->video_lock);
 337
 338         return ret;
 339 }
 340
 341 static const struct v4l2_file_operations isp_video_fops = {
 342         .owner          = THIS_MODULE,
 343         .open           = isp_video_open,
 344         .release        = isp_video_release,
 345         .poll           = vb2_fop_poll,
 346         .unlocked_ioctl = video_ioctl2,
 347         .mmap           = vb2_fop_mmap,
 348 };
 349
 350 /*
 351  * Video node ioctl operations
 352  */
 353 static int isp_video_querycap(struct file *file, void *priv,
 354                                         struct v4l2_capability *cap)
 355 {
 356         struct fimc_isp *isp = video_drvdata(file);
 357
 358         __fimc_vidioc_querycap(&isp->pdev->dev, cap, V4L2_CAP_STREAMING);
 359         return 0;
 360 }
 361
 362 static int isp_video_enum_fmt_mplane(struct file *file, void *priv,
 363                                         struct v4l2_fmtdesc *f)
 364 {
 365         const struct fimc_fmt *fmt;
 366
 367         if (f->index >= FIMC_ISP_NUM_FORMATS)
 368                 return -EINVAL;
 369
 370         fmt = fimc_isp_find_format(NULL, NULL, f->index);
 371         if (WARN_ON(fmt == NULL))
 372                 return -EINVAL;
 373
 374         strlcpy(f->description, fmt->name, sizeof(f->description));
 375         f->pixelformat = fmt->fourcc;
 376
 377         return 0;
 378 }
 379
 380 static int isp_video_g_fmt_mplane(struct file *file, void *fh,
 381                                         struct v4l2_format *f)
 382 {
 383         struct fimc_isp *isp = video_drvdata(file);
 384
 385         f->fmt.pix_mp = isp->video_capture.pixfmt;
 386         return 0;
 387 }
 388
 389 static void __isp_video_try_fmt(struct fimc_isp *isp,
 390                                 struct v4l2_pix_format_mplane *pixm,
 391                                 const struct fimc_fmt **fmt)
 392 {
 393         *fmt = fimc_isp_find_format(&pixm->pixelformat, NULL, 2);
 394
 395         pixm->colorspace = V4L2_COLORSPACE_SRGB;
 396         pixm->field = V4L2_FIELD_NONE;
 397         pixm->num_planes = (*fmt)->memplanes;
 398         pixm->pixelformat = (*fmt)->fourcc;
 399         /*
 400          * TODO: double check with the docmentation these width/height
 401          * constraints are correct.
 402          */
 403         v4l_bound_align_image(&pixm->width, FIMC_ISP_SOURCE_WIDTH_MIN,
 404                               FIMC_ISP_SOURCE_WIDTH_MAX, 3,
 405                               &pixm->height, FIMC_ISP_SOURCE_HEIGHT_MIN,
 406                               FIMC_ISP_SOURCE_HEIGHT_MAX, 0, 0);
 407 }
 408
 409 static int isp_video_try_fmt_mplane(struct file *file, void *fh,
 410                                         struct v4l2_format *f)
 411 {
 412         struct fimc_isp *isp = video_drvdata(file);
 413
 414         __isp_video_try_fmt(isp, &f->fmt.pix_mp, NULL);
 415         return 0;
 416 }
 417
 418 static int isp_video_s_fmt_mplane(struct file *file, void *priv,
 419                                         struct v4l2_format *f)
 420 {
 421         struct fimc_isp *isp = video_drvdata(file);
 422         struct fimc_is *is = fimc_isp_to_is(isp);
 423         struct v4l2_pix_format_mplane *pixm = &f->fmt.pix_mp;
 424         const struct fimc_fmt *ifmt = NULL;
 425         struct param_dma_output *dma = __get_isp_dma2(is);
 426
 427         __isp_video_try_fmt(isp, pixm, &ifmt);
 428
 429         if (WARN_ON(ifmt == NULL))
 430                 return -EINVAL;
 431
 432         dma->format = DMA_OUTPUT_FORMAT_BAYER;
 433         dma->order = DMA_OUTPUT_ORDER_GB_BG;
 434         dma->plane = ifmt->memplanes;
 435         dma->bitwidth = ifmt->depth[0];
 436         dma->width = pixm->width;
 437         dma->height = pixm->height;
 438
 439         fimc_is_mem_barrier();
 440
 441         isp->video_capture.format = ifmt;
 442         isp->video_capture.pixfmt = *pixm;
 443
 444         return 0;
 445 }
 446
 447 /*
 448  * Check for source/sink format differences at each link.
 449  * Return 0 if the formats match or -EPIPE otherwise.
 450  */
 451 static int isp_video_pipeline_validate(struct fimc_isp *isp)
 452 {
 453         struct v4l2_subdev *sd = &isp->subdev;
 454         struct v4l2_subdev_format sink_fmt, src_fmt;
 455         struct media_pad *pad;
 456         int ret;
 457
 458         while (1) {
 459                 /* Retrieve format at the sink pad */
 460                 pad = &sd->entity.pads[0];
 461                 if (!(pad->flags & MEDIA_PAD_FL_SINK))
 462                         break;
 463                 sink_fmt.pad = pad->index;
 464                 sink_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE;
 465                 ret = v4l2_subdev_call(sd, pad, get_fmt, NULL, &sink_fmt);
 466                 if (ret < 0 && ret != -ENOIOCTLCMD)
 467                         return -EPIPE;
 468
 469                 /* Retrieve format at the source pad */
 470                 pad = media_entity_remote_pad(pad);
 471                 if (pad == NULL ||
 472                     media_entity_type(pad->entity) != MEDIA_ENT_T_V4L2_SUBDEV)
 473                         break;
 474
 475                 sd = media_entity_to_v4l2_subdev(pad->entity);
 476                 src_fmt.pad = pad->index;
 477                 src_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE;
 478                 ret = v4l2_subdev_call(sd, pad, get_fmt, NULL, &src_fmt);
 479                 if (ret < 0 && ret != -ENOIOCTLCMD)
 480                         return -EPIPE;
 481
 482                 if (src_fmt.format.width != sink_fmt.format.width ||
 483                     src_fmt.format.height != sink_fmt.format.height ||
 484                     src_fmt.format.code != sink_fmt.format.code)
 485                         return -EPIPE;
 486         }
 487
 488         return 0;
 489 }
 490
 491 static int isp_video_streamon(struct file *file, void *priv,
 492                                       enum v4l2_buf_type type)
 493 {
 494         struct fimc_isp *isp = video_drvdata(file);
 495         struct exynos_video_entity *ve = &isp->video_capture.ve;
 496         struct media_entity *me = &ve->vdev.entity;
 497         int ret;
 498
 499         ret = media_entity_pipeline_start(me, &ve->pipe->mp);
 500         if (ret < 0)
 501                 return ret;
 502
 503         ret = isp_video_pipeline_validate(isp);
 504         if (ret < 0)
 505                 goto p_stop;
 506
 507         ret = vb2_ioctl_streamon(file, priv, type);
 508         if (ret < 0)
 509                 goto p_stop;
 510
 511         isp->video_capture.streaming = 1;
 512         return 0;
 513 p_stop:
 514         media_entity_pipeline_stop(me);
 515         return ret;
 516 }
 517
 518 static int isp_video_streamoff(struct file *file, void *priv,
 519                                         enum v4l2_buf_type type)
 520 {
 521         struct fimc_isp *isp = video_drvdata(file);
 522         struct fimc_is_video *video = &isp->video_capture;
 523         int ret;
 524
 525         ret = vb2_ioctl_streamoff(file, priv, type);
 526         if (ret < 0)
 527                 return ret;
 528
 529         media_entity_pipeline_stop(&video->ve.vdev.entity);
 530         video->streaming = 0;
 531         return 0;
 532 }
 533
 534 static int isp_video_reqbufs(struct file *file, void *priv,
 535                                 struct v4l2_requestbuffers *rb)
 536 {
 537         struct fimc_isp *isp = video_drvdata(file);
 538         int ret;
 539
 540         ret = vb2_ioctl_reqbufs(file, priv, rb);
 541         if (ret < 0)
 542                 return ret;
 543
 544         if (rb->count && rb->count < FIMC_ISP_REQ_BUFS_MIN) {
 545                 rb->count = 0;
 546                 vb2_ioctl_reqbufs(file, priv, rb);
 547                 ret = -ENOMEM;
 548         }
 549
 550         isp->video_capture.reqbufs_count = rb->count;
 551         return ret;
 552 }
 553
 554 static const struct v4l2_ioctl_ops isp_video_ioctl_ops = {
 555         .vidioc_querycap                = isp_video_querycap,
 556         .vidioc_enum_fmt_vid_cap_mplane = isp_video_enum_fmt_mplane,
 557         .vidioc_try_fmt_vid_cap_mplane  = isp_video_try_fmt_mplane,
 558         .vidioc_s_fmt_vid_cap_mplane    = isp_video_s_fmt_mplane,
 559         .vidioc_g_fmt_vid_cap_mplane    = isp_video_g_fmt_mplane,
 560         .vidioc_reqbufs                 = isp_video_reqbufs,
 561         .vidioc_querybuf                = vb2_ioctl_querybuf,
 562         .vidioc_prepare_buf             = vb2_ioctl_prepare_buf,
 563         .vidioc_create_bufs             = vb2_ioctl_create_bufs,
 564         .vidioc_qbuf                    = vb2_ioctl_qbuf,
 565         .vidioc_dqbuf                   = vb2_ioctl_dqbuf,
 566         .vidioc_streamon                = isp_video_streamon,
 567         .vidioc_streamoff               = isp_video_streamoff,
 568 };
 569
 570 int fimc_isp_video_device_register(struct fimc_isp *isp,
 571                                    struct v4l2_device *v4l2_dev,
 572                                    enum v4l2_buf_type type)
 573 {
 574         struct vb2_queue *q = &isp->video_capture.vb_queue;
 575         struct fimc_is_video *iv;
 576         struct video_device *vdev;
 577         int ret;
 578
 579         if (type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
 580                 iv = &isp->video_capture;
 581         else
 582                 return -ENOSYS;
 583
 584         mutex_init(&isp->video_lock);
 585         INIT_LIST_HEAD(&iv->pending_buf_q);
 586         INIT_LIST_HEAD(&iv->active_buf_q);
 587         iv->format = fimc_isp_find_format(NULL, NULL, 0);
 588         iv->pixfmt.width = IS_DEFAULT_WIDTH;
 589         iv->pixfmt.height = IS_DEFAULT_HEIGHT;
 590         iv->pixfmt.pixelformat = iv->format->fourcc;
 591         iv->pixfmt.colorspace = V4L2_COLORSPACE_SRGB;
 592         iv->reqbufs_count = 0;
 593
 594         memset(q, 0, sizeof(*q));
 595         q->type = type;
 596         q->io_modes = VB2_MMAP | VB2_USERPTR;
 597         q->ops = &isp_video_capture_qops;
 598         q->mem_ops = &vb2_dma_contig_memops;
 599         q->buf_struct_size = sizeof(struct isp_video_buf);
 600         q->drv_priv = isp;
 601         q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
 602         q->lock = &isp->video_lock;
 603
 604         ret = vb2_queue_init(q);
 605         if (ret < 0)
 606                 return ret;
 607
 608         vdev = &iv->ve.vdev;
 609         memset(vdev, 0, sizeof(*vdev));
 610         snprintf(vdev->name, sizeof(vdev->name), "fimc-is-isp.%s",
 611                         type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE ?
 612                         "capture" : "output");
 613         vdev->queue = q;
 614         vdev->fops = &isp_video_fops;
 615         vdev->ioctl_ops = &isp_video_ioctl_ops;
 616         vdev->v4l2_dev = v4l2_dev;
 617         vdev->minor = -1;
 618         vdev->release = video_device_release_empty;
 619         vdev->lock = &isp->video_lock;
 620
 621         iv->pad.flags = MEDIA_PAD_FL_SINK;
 622         ret = media_entity_init(&vdev->entity, 1, &iv->pad, 0);
 623         if (ret < 0)
 624                 return ret;
 625
 626         video_set_drvdata(vdev, isp);
 627
 628         ret = video_register_device(vdev, VFL_TYPE_GRABBER, -1);
 629         if (ret < 0) {
 630                 media_entity_cleanup(&vdev->entity);
 631                 return ret;
 632         }
 633
 634         v4l2_info(v4l2_dev, "Registered %s as /dev/%s\n",
 635                   vdev->name, video_device_node_name(vdev));
 636
 637         return 0;
 638 }
 639
 640 void fimc_isp_video_device_unregister(struct fimc_isp *isp,
 641                                       enum v4l2_buf_type type)
 642 {
 643         struct exynos_video_entity *ve;
 644
 645         if (type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
 646                 ve = &isp->video_capture.ve;
 647         else
 648                 return;
 649
 650         mutex_lock(&isp->video_lock);
 651
 652         if (video_is_registered(&ve->vdev)) {
 653                 video_unregister_device(&ve->vdev);
 654                 media_entity_cleanup(&ve->vdev.entity);
 655                 ve->pipe = NULL;
 656         }
 657
 658         mutex_unlock(&isp->video_lock);
 659 }