Lines Matching +full:top +full:- +full:left
1 // SPDX-License-Identifier: GPL-2.0+
3 * Driver for Renesas R-Car VIN
6 * Copyright (C) 2011-2013 Renesas Solutions Corp.
10 * Based on the soc-camera rcar_vin driver
15 #include <media/v4l2-event.h>
16 #include <media/v4l2-ioctl.h>
17 #include <media/v4l2-mc.h>
18 #include <media/v4l2-rect.h>
20 #include "rcar-vin.h"
28 /* -----------------------------------------------------------------------------
94 if (vin->info->model == RCAR_M1) in rvin_format_from_pixel()
102 if (!vin->info->nv12 || !(BIT(vin->id) & 0x3333)) in rvin_format_from_pixel()
122 fmt = rvin_format_from_pixel(vin, pix->pixelformat); in rvin_format_bytesperline()
125 return -EINVAL; in rvin_format_bytesperline()
127 switch (pix->pixelformat) { in rvin_format_bytesperline()
137 if (V4L2_FIELD_IS_SEQUENTIAL(pix->field)) in rvin_format_bytesperline()
140 return ALIGN(pix->width, align) * fmt->bpp; in rvin_format_bytesperline()
145 switch (pix->pixelformat) { in rvin_format_sizeimage()
147 return pix->bytesperline * pix->height * 3 / 2; in rvin_format_sizeimage()
149 return pix->bytesperline * pix->height * 2; in rvin_format_sizeimage()
151 return pix->bytesperline * pix->height; in rvin_format_sizeimage()
159 if (!rvin_format_from_pixel(vin, pix->pixelformat)) in rvin_format_align()
160 pix->pixelformat = RVIN_DEFAULT_FORMAT; in rvin_format_align()
162 switch (pix->field) { in rvin_format_align()
174 pix->field = RVIN_DEFAULT_FIELD; in rvin_format_align()
179 switch (pix->pixelformat) { in rvin_format_align()
190 v4l_bound_align_image(&pix->width, 2, vin->info->max_width, walign, in rvin_format_align()
191 &pix->height, 4, vin->info->max_height, 2, 0); in rvin_format_align()
193 pix->bytesperline = rvin_format_bytesperline(vin, pix); in rvin_format_align()
194 pix->sizeimage = rvin_format_sizeimage(pix); in rvin_format_align()
197 pix->width, pix->height, pix->bytesperline, pix->sizeimage); in rvin_format_align()
200 /* -----------------------------------------------------------------------------
208 .pad = vin->parallel.source_pad, in rvin_reset_format()
216 v4l2_fill_pix_format(&vin->format, &fmt.format); in rvin_reset_format()
218 vin->src_rect.top = 0; in rvin_reset_format()
219 vin->src_rect.left = 0; in rvin_reset_format()
220 vin->src_rect.width = vin->format.width; in rvin_reset_format()
221 vin->src_rect.height = vin->format.height; in rvin_reset_format()
224 if (vin->format.field == V4L2_FIELD_ALTERNATE) { in rvin_reset_format()
225 vin->format.field = V4L2_FIELD_INTERLACED; in rvin_reset_format()
226 vin->format.height *= 2; in rvin_reset_format()
229 rvin_format_align(vin, &vin->format); in rvin_reset_format()
231 vin->crop = vin->src_rect; in rvin_reset_format()
233 vin->compose.top = 0; in rvin_reset_format()
234 vin->compose.left = 0; in rvin_reset_format()
235 vin->compose.width = vin->format.width; in rvin_reset_format()
236 vin->compose.height = vin->format.height; in rvin_reset_format()
249 .pad = vin->parallel.source_pad, in rvin_try_format()
259 if (!rvin_format_from_pixel(vin, pix->pixelformat)) in rvin_try_format()
260 pix->pixelformat = RVIN_DEFAULT_FORMAT; in rvin_try_format()
262 v4l2_fill_mbus_format(&format.format, pix, vin->mbus_code); in rvin_try_format()
265 field = pix->field; in rvin_try_format()
266 width = pix->width; in rvin_try_format()
267 height = pix->height; in rvin_try_format()
270 if (ret < 0 && ret != -ENOIOCTLCMD) in rvin_try_format()
277 src_rect->top = 0; in rvin_try_format()
278 src_rect->left = 0; in rvin_try_format()
279 src_rect->width = pix->width; in rvin_try_format()
280 src_rect->height = pix->height; in rvin_try_format()
284 pix->field = field; in rvin_try_format()
286 pix->width = width; in rvin_try_format()
287 pix->height = height; in rvin_try_format()
301 strscpy(cap->driver, KBUILD_MODNAME, sizeof(cap->driver)); in rvin_querycap()
302 strscpy(cap->card, "R_Car_VIN", sizeof(cap->card)); in rvin_querycap()
303 snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s", in rvin_querycap()
304 dev_name(vin->dev)); in rvin_querycap()
313 return rvin_try_format(vin, V4L2_SUBDEV_FORMAT_TRY, &f->fmt.pix, NULL); in rvin_try_fmt_vid_cap()
323 if (vb2_is_busy(&vin->queue)) in rvin_s_fmt_vid_cap()
324 return -EBUSY; in rvin_s_fmt_vid_cap()
326 ret = rvin_try_format(vin, V4L2_SUBDEV_FORMAT_ACTIVE, &f->fmt.pix, in rvin_s_fmt_vid_cap()
331 vin->format = f->fmt.pix; in rvin_s_fmt_vid_cap()
333 fmt_rect.top = 0; in rvin_s_fmt_vid_cap()
334 fmt_rect.left = 0; in rvin_s_fmt_vid_cap()
335 fmt_rect.width = vin->format.width; in rvin_s_fmt_vid_cap()
336 fmt_rect.height = vin->format.height; in rvin_s_fmt_vid_cap()
338 v4l2_rect_map_inside(&vin->crop, &src_rect); in rvin_s_fmt_vid_cap()
339 v4l2_rect_map_inside(&vin->compose, &fmt_rect); in rvin_s_fmt_vid_cap()
340 vin->src_rect = src_rect; in rvin_s_fmt_vid_cap()
350 f->fmt.pix = vin->format; in rvin_g_fmt_vid_cap()
373 switch (f->mbus_code) { in rvin_enum_fmt_vid_cap()
382 if (f->index) in rvin_enum_fmt_vid_cap()
383 return -EINVAL; in rvin_enum_fmt_vid_cap()
384 f->pixelformat = V4L2_PIX_FMT_SBGGR8; in rvin_enum_fmt_vid_cap()
387 if (f->index) in rvin_enum_fmt_vid_cap()
388 return -EINVAL; in rvin_enum_fmt_vid_cap()
389 f->pixelformat = V4L2_PIX_FMT_SGBRG8; in rvin_enum_fmt_vid_cap()
392 if (f->index) in rvin_enum_fmt_vid_cap()
393 return -EINVAL; in rvin_enum_fmt_vid_cap()
394 f->pixelformat = V4L2_PIX_FMT_SGRBG8; in rvin_enum_fmt_vid_cap()
397 if (f->index) in rvin_enum_fmt_vid_cap()
398 return -EINVAL; in rvin_enum_fmt_vid_cap()
399 f->pixelformat = V4L2_PIX_FMT_SRGGB8; in rvin_enum_fmt_vid_cap()
402 return -EINVAL; in rvin_enum_fmt_vid_cap()
405 matched = -1; in rvin_enum_fmt_vid_cap()
410 if (matched == f->index) { in rvin_enum_fmt_vid_cap()
411 f->pixelformat = rvin_formats[i].fourcc; in rvin_enum_fmt_vid_cap()
416 return -EINVAL; in rvin_enum_fmt_vid_cap()
424 if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) in rvin_g_selection()
425 return -EINVAL; in rvin_g_selection()
427 switch (s->target) { in rvin_g_selection()
430 s->r.left = s->r.top = 0; in rvin_g_selection()
431 s->r.width = vin->src_rect.width; in rvin_g_selection()
432 s->r.height = vin->src_rect.height; in rvin_g_selection()
435 s->r = vin->crop; in rvin_g_selection()
439 s->r.left = s->r.top = 0; in rvin_g_selection()
440 s->r.width = vin->format.width; in rvin_g_selection()
441 s->r.height = vin->format.height; in rvin_g_selection()
444 s->r = vin->compose; in rvin_g_selection()
447 return -EINVAL; in rvin_g_selection()
458 struct v4l2_rect r = s->r; in rvin_s_selection()
465 if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) in rvin_s_selection()
466 return -EINVAL; in rvin_s_selection()
470 switch (s->target) { in rvin_s_selection()
473 max_rect.top = max_rect.left = 0; in rvin_s_selection()
474 max_rect.width = vin->src_rect.width; in rvin_s_selection()
475 max_rect.height = vin->src_rect.height; in rvin_s_selection()
478 v4l_bound_align_image(&r.width, 6, vin->src_rect.width, 0, in rvin_s_selection()
479 &r.height, 2, vin->src_rect.height, 0, 0); in rvin_s_selection()
481 r.top = clamp_t(s32, r.top, 0, in rvin_s_selection()
482 vin->src_rect.height - r.height); in rvin_s_selection()
483 r.left = clamp_t(s32, r.left, 0, vin->src_rect.width - r.width); in rvin_s_selection()
485 vin->crop = s->r = r; in rvin_s_selection()
488 r.width, r.height, r.left, r.top, in rvin_s_selection()
489 vin->src_rect.width, vin->src_rect.height); in rvin_s_selection()
493 max_rect.top = max_rect.left = 0; in rvin_s_selection()
494 max_rect.width = vin->format.width; in rvin_s_selection()
495 max_rect.height = vin->format.height; in rvin_s_selection()
501 * Make sure the top and left values meets this requirement. in rvin_s_selection()
503 while ((r.top * vin->format.bytesperline) & HW_BUFFER_MASK) in rvin_s_selection()
504 r.top--; in rvin_s_selection()
506 fmt = rvin_format_from_pixel(vin, vin->format.pixelformat); in rvin_s_selection()
507 while ((r.left * fmt->bpp) & HW_BUFFER_MASK) in rvin_s_selection()
508 r.left--; in rvin_s_selection()
510 vin->compose = s->r = r; in rvin_s_selection()
513 r.width, r.height, r.left, r.top, in rvin_s_selection()
514 vin->format.width, vin->format.height); in rvin_s_selection()
517 return -EINVAL; in rvin_s_selection()
533 return -EINVAL; in rvin_g_pixelaspect()
545 if (i->index != 0) in rvin_enum_input()
546 return -EINVAL; in rvin_enum_input()
548 ret = v4l2_subdev_call(sd, video, g_input_status, &i->status); in rvin_enum_input()
549 if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV) in rvin_enum_input()
552 i->type = V4L2_INPUT_TYPE_CAMERA; in rvin_enum_input()
555 i->capabilities = V4L2_IN_CAP_DV_TIMINGS; in rvin_enum_input()
556 i->std = 0; in rvin_enum_input()
558 i->capabilities = V4L2_IN_CAP_STD; in rvin_enum_input()
559 i->std = vin->vdev.tvnorms; in rvin_enum_input()
562 strscpy(i->name, "Camera", sizeof(i->name)); in rvin_enum_input()
576 return -EINVAL; in rvin_s_input()
597 vin->std = a; in rvin_s_std()
608 return -ENOIOCTLCMD; in rvin_g_std()
610 *a = vin->std; in rvin_g_std()
618 switch (sub->type) { in rvin_subscribe_event()
632 if (timings->pad) in rvin_enum_dv_timings()
633 return -EINVAL; in rvin_enum_dv_timings()
635 timings->pad = vin->parallel.sink_pad; in rvin_enum_dv_timings()
639 timings->pad = 0; in rvin_enum_dv_timings()
684 if (cap->pad) in rvin_dv_timings_cap()
685 return -EINVAL; in rvin_dv_timings_cap()
687 cap->pad = vin->parallel.sink_pad; in rvin_dv_timings_cap()
691 cap->pad = 0; in rvin_dv_timings_cap()
702 if (edid->pad) in rvin_g_edid()
703 return -EINVAL; in rvin_g_edid()
705 edid->pad = vin->parallel.sink_pad; in rvin_g_edid()
709 edid->pad = 0; in rvin_g_edid()
720 if (edid->pad) in rvin_s_edid()
721 return -EINVAL; in rvin_s_edid()
723 edid->pad = vin->parallel.sink_pad; in rvin_s_edid()
727 edid->pad = 0; in rvin_s_edid()
776 /* -----------------------------------------------------------------------------
789 pix->colorspace = RVIN_DEFAULT_COLORSPACE; in rvin_mc_try_format()
790 pix->xfer_func = V4L2_MAP_XFER_FUNC_DEFAULT(pix->colorspace); in rvin_mc_try_format()
791 pix->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(pix->colorspace); in rvin_mc_try_format()
792 pix->quantization = V4L2_MAP_QUANTIZATION_DEFAULT(true, pix->colorspace, in rvin_mc_try_format()
793 pix->ycbcr_enc); in rvin_mc_try_format()
803 rvin_mc_try_format(vin, &f->fmt.pix); in rvin_mc_try_fmt_vid_cap()
813 if (vb2_is_busy(&vin->queue)) in rvin_mc_s_fmt_vid_cap()
814 return -EBUSY; in rvin_mc_s_fmt_vid_cap()
816 rvin_mc_try_format(vin, &f->fmt.pix); in rvin_mc_s_fmt_vid_cap()
818 vin->format = f->fmt.pix; in rvin_mc_s_fmt_vid_cap()
820 vin->crop.top = 0; in rvin_mc_s_fmt_vid_cap()
821 vin->crop.left = 0; in rvin_mc_s_fmt_vid_cap()
822 vin->crop.width = vin->format.width; in rvin_mc_s_fmt_vid_cap()
823 vin->crop.height = vin->format.height; in rvin_mc_s_fmt_vid_cap()
824 vin->compose = vin->crop; in rvin_mc_s_fmt_vid_cap()
851 /* -----------------------------------------------------------------------------
862 if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV) in rvin_power_parallel()
873 ret = pm_runtime_resume_and_get(vin->dev); in rvin_open()
877 ret = mutex_lock_interruptible(&vin->lock); in rvin_open()
881 file->private_data = vin; in rvin_open()
887 if (vin->info->use_mc) in rvin_open()
888 ret = v4l2_pipeline_pm_get(&vin->vdev.entity); in rvin_open()
895 ret = v4l2_ctrl_handler_setup(&vin->ctrl_handler); in rvin_open()
899 mutex_unlock(&vin->lock); in rvin_open()
903 if (vin->info->use_mc) in rvin_open()
904 v4l2_pipeline_pm_put(&vin->vdev.entity); in rvin_open()
910 mutex_unlock(&vin->lock); in rvin_open()
912 pm_runtime_put(vin->dev); in rvin_open()
923 mutex_lock(&vin->lock); in rvin_release()
925 /* Save the singular status before we call the clean-up helper */ in rvin_release()
928 /* the release helper will cleanup any on-going streaming */ in rvin_release()
931 if (vin->info->use_mc) { in rvin_release()
932 v4l2_pipeline_pm_put(&vin->vdev.entity); in rvin_release()
938 mutex_unlock(&vin->lock); in rvin_release()
940 pm_runtime_put(vin->dev); in rvin_release()
957 if (!video_is_registered(&vin->vdev)) in rvin_v4l2_unregister()
960 v4l2_info(&vin->v4l2_dev, "Removing %s\n", in rvin_v4l2_unregister()
961 video_device_node_name(&vin->vdev)); in rvin_v4l2_unregister()
964 video_unregister_device(&vin->vdev); in rvin_v4l2_unregister()
972 v4l2_event_queue(&vin->vdev, arg); in rvin_notify_video_device()
986 container_of(sd->v4l2_dev, struct rvin_dev, v4l2_dev); in rvin_notify()
990 if (!vin->info->use_mc) { in rvin_notify()
995 group = vin->group; in rvin_notify()
998 vin = group->vin[i]; in rvin_notify()
1002 pad = media_entity_remote_pad(&vin->pad); in rvin_notify()
1006 remote = media_entity_to_v4l2_subdev(pad->entity); in rvin_notify()
1016 struct video_device *vdev = &vin->vdev; in rvin_v4l2_register()
1019 vin->v4l2_dev.notify = rvin_notify; in rvin_v4l2_register()
1022 vdev->v4l2_dev = &vin->v4l2_dev; in rvin_v4l2_register()
1023 vdev->queue = &vin->queue; in rvin_v4l2_register()
1024 snprintf(vdev->name, sizeof(vdev->name), "VIN%u output", vin->id); in rvin_v4l2_register()
1025 vdev->release = video_device_release_empty; in rvin_v4l2_register()
1026 vdev->lock = &vin->lock; in rvin_v4l2_register()
1027 vdev->fops = &rvin_fops; in rvin_v4l2_register()
1028 vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING | in rvin_v4l2_register()
1032 vin->format.pixelformat = RVIN_DEFAULT_FORMAT; in rvin_v4l2_register()
1033 vin->format.width = RVIN_DEFAULT_WIDTH; in rvin_v4l2_register()
1034 vin->format.height = RVIN_DEFAULT_HEIGHT; in rvin_v4l2_register()
1035 vin->format.field = RVIN_DEFAULT_FIELD; in rvin_v4l2_register()
1036 vin->format.colorspace = RVIN_DEFAULT_COLORSPACE; in rvin_v4l2_register()
1038 if (vin->info->use_mc) { in rvin_v4l2_register()
1039 vdev->device_caps |= V4L2_CAP_IO_MC; in rvin_v4l2_register()
1040 vdev->ioctl_ops = &rvin_mc_ioctl_ops; in rvin_v4l2_register()
1042 vdev->ioctl_ops = &rvin_ioctl_ops; in rvin_v4l2_register()
1046 rvin_format_align(vin, &vin->format); in rvin_v4l2_register()
1048 ret = video_register_device(&vin->vdev, VFL_TYPE_VIDEO, -1); in rvin_v4l2_register()
1054 video_set_drvdata(&vin->vdev, vin); in rvin_v4l2_register()
1056 v4l2_info(&vin->v4l2_dev, "Device registered as %s\n", in rvin_v4l2_register()
1057 video_device_node_name(&vin->vdev)); in rvin_v4l2_register()