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 /* -----------------------------------------------------------------------------
114 if (vin->info->model == RCAR_M1) in rvin_format_from_pixel()
122 if (!vin->info->nv12 || !(BIT(vin->id) & 0x3333)) in rvin_format_from_pixel()
129 if (!vin->info->raw10) in rvin_format_from_pixel()
149 fmt = rvin_format_from_pixel(vin, pix->pixelformat); in rvin_format_bytesperline()
152 return -EINVAL; in rvin_format_bytesperline()
154 switch (pix->pixelformat) { in rvin_format_bytesperline()
164 if (V4L2_FIELD_IS_SEQUENTIAL(pix->field)) in rvin_format_bytesperline()
167 return ALIGN(pix->width, align) * fmt->bpp; in rvin_format_bytesperline()
172 switch (pix->pixelformat) { in rvin_format_sizeimage()
174 return pix->bytesperline * pix->height * 3 / 2; in rvin_format_sizeimage()
176 return pix->bytesperline * pix->height * 2; in rvin_format_sizeimage()
178 return pix->bytesperline * pix->height; in rvin_format_sizeimage()
186 if (!rvin_format_from_pixel(vin, pix->pixelformat)) in rvin_format_align()
187 pix->pixelformat = RVIN_DEFAULT_FORMAT; in rvin_format_align()
189 switch (pix->field) { in rvin_format_align()
201 pix->field = RVIN_DEFAULT_FIELD; in rvin_format_align()
206 switch (pix->pixelformat) { in rvin_format_align()
224 v4l_bound_align_image(&pix->width, 5, vin->info->max_width, walign, in rvin_format_align()
225 &pix->height, 2, vin->info->max_height, 0, 0); in rvin_format_align()
227 pix->bytesperline = rvin_format_bytesperline(vin, pix); in rvin_format_align()
228 pix->sizeimage = rvin_format_sizeimage(pix); in rvin_format_align()
231 pix->width, pix->height, pix->bytesperline, pix->sizeimage); in rvin_format_align()
234 /* -----------------------------------------------------------------------------
242 .pad = vin->parallel.source_pad, in rvin_reset_format()
250 v4l2_fill_pix_format(&vin->format, &fmt.format); in rvin_reset_format()
252 vin->crop.top = 0; in rvin_reset_format()
253 vin->crop.left = 0; in rvin_reset_format()
254 vin->crop.width = vin->format.width; in rvin_reset_format()
255 vin->crop.height = vin->format.height; in rvin_reset_format()
258 if (vin->format.field == V4L2_FIELD_ALTERNATE) { in rvin_reset_format()
259 vin->format.field = V4L2_FIELD_INTERLACED; in rvin_reset_format()
260 vin->format.height *= 2; in rvin_reset_format()
263 rvin_format_align(vin, &vin->format); in rvin_reset_format()
265 vin->compose.top = 0; in rvin_reset_format()
266 vin->compose.left = 0; in rvin_reset_format()
267 vin->compose.width = vin->format.width; in rvin_reset_format()
268 vin->compose.height = vin->format.height; in rvin_reset_format()
282 .pad = vin->parallel.source_pad, in rvin_try_format()
292 sd_state = __v4l2_subdev_state_alloc(sd, "rvin:state->lock", &key); in rvin_try_format()
296 if (!rvin_format_from_pixel(vin, pix->pixelformat)) in rvin_try_format()
297 pix->pixelformat = RVIN_DEFAULT_FORMAT; in rvin_try_format()
299 v4l2_fill_mbus_format(&format.format, pix, vin->mbus_code); in rvin_try_format()
302 field = pix->field; in rvin_try_format()
303 width = pix->width; in rvin_try_format()
304 height = pix->height; in rvin_try_format()
307 if (ret < 0 && ret != -ENOIOCTLCMD) in rvin_try_format()
314 src_rect->top = 0; in rvin_try_format()
315 src_rect->left = 0; in rvin_try_format()
316 src_rect->width = pix->width; in rvin_try_format()
317 src_rect->height = pix->height; in rvin_try_format()
321 pix->field = field; in rvin_try_format()
323 pix->width = width; in rvin_try_format()
324 pix->height = height; in rvin_try_format()
336 strscpy(cap->driver, KBUILD_MODNAME, sizeof(cap->driver)); in rvin_querycap()
337 strscpy(cap->card, "R_Car_VIN", sizeof(cap->card)); in rvin_querycap()
346 return rvin_try_format(vin, V4L2_SUBDEV_FORMAT_TRY, &f->fmt.pix, NULL); in rvin_try_fmt_vid_cap()
356 if (vb2_is_busy(&vin->queue)) in rvin_s_fmt_vid_cap()
357 return -EBUSY; in rvin_s_fmt_vid_cap()
359 ret = rvin_try_format(vin, V4L2_SUBDEV_FORMAT_ACTIVE, &f->fmt.pix, in rvin_s_fmt_vid_cap()
364 vin->format = f->fmt.pix; in rvin_s_fmt_vid_cap()
366 fmt_rect.top = 0; in rvin_s_fmt_vid_cap()
367 fmt_rect.left = 0; in rvin_s_fmt_vid_cap()
368 fmt_rect.width = vin->format.width; in rvin_s_fmt_vid_cap()
369 fmt_rect.height = vin->format.height; in rvin_s_fmt_vid_cap()
371 v4l2_rect_map_inside(&vin->crop, &src_rect); in rvin_s_fmt_vid_cap()
372 v4l2_rect_map_inside(&vin->compose, &fmt_rect); in rvin_s_fmt_vid_cap()
382 f->fmt.pix = vin->format; in rvin_g_fmt_vid_cap()
405 switch (f->mbus_code) { in rvin_enum_fmt_vid_cap()
414 if (f->index) in rvin_enum_fmt_vid_cap()
415 return -EINVAL; in rvin_enum_fmt_vid_cap()
416 f->pixelformat = V4L2_PIX_FMT_SBGGR8; in rvin_enum_fmt_vid_cap()
419 if (f->index) in rvin_enum_fmt_vid_cap()
420 return -EINVAL; in rvin_enum_fmt_vid_cap()
421 f->pixelformat = V4L2_PIX_FMT_SGBRG8; in rvin_enum_fmt_vid_cap()
424 if (f->index) in rvin_enum_fmt_vid_cap()
425 return -EINVAL; in rvin_enum_fmt_vid_cap()
426 f->pixelformat = V4L2_PIX_FMT_SGRBG8; in rvin_enum_fmt_vid_cap()
429 if (f->index) in rvin_enum_fmt_vid_cap()
430 return -EINVAL; in rvin_enum_fmt_vid_cap()
431 f->pixelformat = V4L2_PIX_FMT_SRGGB8; in rvin_enum_fmt_vid_cap()
434 if (f->index) in rvin_enum_fmt_vid_cap()
435 return -EINVAL; in rvin_enum_fmt_vid_cap()
436 f->pixelformat = V4L2_PIX_FMT_SBGGR10; in rvin_enum_fmt_vid_cap()
439 if (f->index) in rvin_enum_fmt_vid_cap()
440 return -EINVAL; in rvin_enum_fmt_vid_cap()
441 f->pixelformat = V4L2_PIX_FMT_SGBRG10; in rvin_enum_fmt_vid_cap()
444 if (f->index) in rvin_enum_fmt_vid_cap()
445 return -EINVAL; in rvin_enum_fmt_vid_cap()
446 f->pixelformat = V4L2_PIX_FMT_SGRBG10; in rvin_enum_fmt_vid_cap()
449 if (f->index) in rvin_enum_fmt_vid_cap()
450 return -EINVAL; in rvin_enum_fmt_vid_cap()
451 f->pixelformat = V4L2_PIX_FMT_SRGGB10; in rvin_enum_fmt_vid_cap()
454 return -EINVAL; in rvin_enum_fmt_vid_cap()
457 matched = -1; in rvin_enum_fmt_vid_cap()
462 if (matched == f->index) { in rvin_enum_fmt_vid_cap()
463 f->pixelformat = rvin_formats[i].fourcc; in rvin_enum_fmt_vid_cap()
468 return -EINVAL; in rvin_enum_fmt_vid_cap()
480 if (vin->info->use_mc) { in rvin_remote_rectangle()
481 struct media_pad *pad = media_pad_remote_pad_first(&vin->pad); in rvin_remote_rectangle()
484 return -EINVAL; in rvin_remote_rectangle()
486 sd = media_entity_to_v4l2_subdev(pad->entity); in rvin_remote_rectangle()
487 index = pad->index; in rvin_remote_rectangle()
490 index = vin->parallel.source_pad; in rvin_remote_rectangle()
498 rect->left = rect->top = 0; in rvin_remote_rectangle()
499 rect->width = fmt.format.width; in rvin_remote_rectangle()
500 rect->height = fmt.format.height; in rvin_remote_rectangle()
503 switch (vin->format.field) { in rvin_remote_rectangle()
509 rect->height *= 2; in rvin_remote_rectangle()
523 if (!vin->scaler) in rvin_g_selection()
524 return -ENOIOCTLCMD; in rvin_g_selection()
526 if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) in rvin_g_selection()
527 return -EINVAL; in rvin_g_selection()
529 switch (s->target) { in rvin_g_selection()
532 ret = rvin_remote_rectangle(vin, &s->r); in rvin_g_selection()
538 s->r = vin->crop; in rvin_g_selection()
542 s->r.left = s->r.top = 0; in rvin_g_selection()
543 s->r.width = vin->format.width; in rvin_g_selection()
544 s->r.height = vin->format.height; in rvin_g_selection()
547 s->r = vin->compose; in rvin_g_selection()
550 return -EINVAL; in rvin_g_selection()
561 struct v4l2_rect r = s->r; in rvin_s_selection()
569 if (!vin->scaler) in rvin_s_selection()
570 return -ENOIOCTLCMD; in rvin_s_selection()
572 if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) in rvin_s_selection()
573 return -EINVAL; in rvin_s_selection()
577 switch (s->target) { in rvin_s_selection()
589 r.top = clamp_t(s32, r.top, 0, max_rect.height - r.height); in rvin_s_selection()
590 r.left = clamp_t(s32, r.left, 0, max_rect.width - r.width); in rvin_s_selection()
592 vin->crop = s->r = r; in rvin_s_selection()
595 r.width, r.height, r.left, r.top, in rvin_s_selection()
600 max_rect.top = max_rect.left = 0; in rvin_s_selection()
601 max_rect.width = vin->format.width; in rvin_s_selection()
602 max_rect.height = vin->format.height; in rvin_s_selection()
608 * Make sure the top and left values meets this requirement. in rvin_s_selection()
610 while ((r.top * vin->format.bytesperline) & HW_BUFFER_MASK) in rvin_s_selection()
611 r.top--; in rvin_s_selection()
613 fmt = rvin_format_from_pixel(vin, vin->format.pixelformat); in rvin_s_selection()
614 while ((r.left * fmt->bpp) & HW_BUFFER_MASK) in rvin_s_selection()
615 r.left--; in rvin_s_selection()
617 vin->compose = s->r = r; in rvin_s_selection()
620 r.width, r.height, r.left, r.top, in rvin_s_selection()
621 vin->format.width, vin->format.height); in rvin_s_selection()
624 return -EINVAL; in rvin_s_selection()
639 return v4l2_g_parm_cap(&vin->vdev, sd, parm); in rvin_g_parm()
648 return v4l2_s_parm_cap(&vin->vdev, sd, parm); in rvin_s_parm()
658 return -EINVAL; in rvin_g_pixelaspect()
670 if (i->index != 0) in rvin_enum_input()
671 return -EINVAL; in rvin_enum_input()
673 ret = v4l2_subdev_call(sd, video, g_input_status, &i->status); in rvin_enum_input()
674 if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV) in rvin_enum_input()
677 i->type = V4L2_INPUT_TYPE_CAMERA; in rvin_enum_input()
680 i->capabilities = V4L2_IN_CAP_DV_TIMINGS; in rvin_enum_input()
681 i->std = 0; in rvin_enum_input()
683 i->capabilities = V4L2_IN_CAP_STD; in rvin_enum_input()
684 i->std = vin->vdev.tvnorms; in rvin_enum_input()
687 strscpy(i->name, "Camera", sizeof(i->name)); in rvin_enum_input()
701 return -EINVAL; in rvin_s_input()
722 vin->std = a; in rvin_s_std()
733 return -ENOIOCTLCMD; in rvin_g_std()
735 *a = vin->std; in rvin_g_std()
743 switch (sub->type) { in rvin_subscribe_event()
757 if (timings->pad) in rvin_enum_dv_timings()
758 return -EINVAL; in rvin_enum_dv_timings()
760 timings->pad = vin->parallel.sink_pad; in rvin_enum_dv_timings()
764 timings->pad = 0; in rvin_enum_dv_timings()
777 vin->parallel.sink_pad, timings); in rvin_s_dv_timings()
792 vin->parallel.sink_pad, timings); in rvin_g_dv_timings()
802 vin->parallel.sink_pad, timings); in rvin_query_dv_timings()
812 if (cap->pad) in rvin_dv_timings_cap()
813 return -EINVAL; in rvin_dv_timings_cap()
815 cap->pad = vin->parallel.sink_pad; in rvin_dv_timings_cap()
819 cap->pad = 0; in rvin_dv_timings_cap()
830 if (edid->pad) in rvin_g_edid()
831 return -EINVAL; in rvin_g_edid()
833 edid->pad = vin->parallel.sink_pad; in rvin_g_edid()
837 edid->pad = 0; in rvin_g_edid()
848 if (edid->pad) in rvin_s_edid()
849 return -EINVAL; in rvin_s_edid()
851 edid->pad = vin->parallel.sink_pad; in rvin_s_edid()
855 edid->pad = 0; in rvin_s_edid()
907 /* -----------------------------------------------------------------------------
920 pix->colorspace = RVIN_DEFAULT_COLORSPACE; in rvin_mc_try_format()
921 pix->xfer_func = V4L2_MAP_XFER_FUNC_DEFAULT(pix->colorspace); in rvin_mc_try_format()
922 pix->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(pix->colorspace); in rvin_mc_try_format()
923 pix->quantization = V4L2_MAP_QUANTIZATION_DEFAULT(true, pix->colorspace, in rvin_mc_try_format()
924 pix->ycbcr_enc); in rvin_mc_try_format()
934 rvin_mc_try_format(vin, &f->fmt.pix); in rvin_mc_try_fmt_vid_cap()
944 if (vb2_is_busy(&vin->queue)) in rvin_mc_s_fmt_vid_cap()
945 return -EBUSY; in rvin_mc_s_fmt_vid_cap()
947 rvin_mc_try_format(vin, &f->fmt.pix); in rvin_mc_s_fmt_vid_cap()
949 vin->format = f->fmt.pix; in rvin_mc_s_fmt_vid_cap()
951 vin->crop.top = 0; in rvin_mc_s_fmt_vid_cap()
952 vin->crop.left = 0; in rvin_mc_s_fmt_vid_cap()
953 vin->crop.width = vin->format.width; in rvin_mc_s_fmt_vid_cap()
954 vin->crop.height = vin->format.height; in rvin_mc_s_fmt_vid_cap()
955 vin->compose = vin->crop; in rvin_mc_s_fmt_vid_cap()
985 /* -----------------------------------------------------------------------------
996 if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV) in rvin_power_parallel()
1007 ret = pm_runtime_resume_and_get(vin->dev); in rvin_open()
1011 ret = mutex_lock_interruptible(&vin->lock); in rvin_open()
1015 file->private_data = vin; in rvin_open()
1021 if (vin->info->use_mc) in rvin_open()
1022 ret = v4l2_pipeline_pm_get(&vin->vdev.entity); in rvin_open()
1029 ret = v4l2_ctrl_handler_setup(&vin->ctrl_handler); in rvin_open()
1033 mutex_unlock(&vin->lock); in rvin_open()
1037 if (vin->info->use_mc) in rvin_open()
1038 v4l2_pipeline_pm_put(&vin->vdev.entity); in rvin_open()
1044 mutex_unlock(&vin->lock); in rvin_open()
1046 pm_runtime_put(vin->dev); in rvin_open()
1057 mutex_lock(&vin->lock); in rvin_release()
1059 /* Save the singular status before we call the clean-up helper */ in rvin_release()
1062 /* the release helper will cleanup any on-going streaming */ in rvin_release()
1065 if (vin->info->use_mc) { in rvin_release()
1066 v4l2_pipeline_pm_put(&vin->vdev.entity); in rvin_release()
1072 mutex_unlock(&vin->lock); in rvin_release()
1074 pm_runtime_put(vin->dev); in rvin_release()
1091 if (!video_is_registered(&vin->vdev)) in rvin_v4l2_unregister()
1094 v4l2_info(&vin->v4l2_dev, "Removing %s\n", in rvin_v4l2_unregister()
1095 video_device_node_name(&vin->vdev)); in rvin_v4l2_unregister()
1098 video_unregister_device(&vin->vdev); in rvin_v4l2_unregister()
1106 v4l2_event_queue(&vin->vdev, arg); in rvin_notify_video_device()
1120 container_of(sd->v4l2_dev, struct rvin_dev, v4l2_dev); in rvin_notify()
1124 if (!vin->info->use_mc) { in rvin_notify()
1129 group = vin->group; in rvin_notify()
1132 vin = group->vin[i]; in rvin_notify()
1136 pad = media_pad_remote_pad_first(&vin->pad); in rvin_notify()
1140 remote = media_entity_to_v4l2_subdev(pad->entity); in rvin_notify()
1150 struct video_device *vdev = &vin->vdev; in rvin_v4l2_register()
1153 vin->v4l2_dev.notify = rvin_notify; in rvin_v4l2_register()
1156 vdev->v4l2_dev = &vin->v4l2_dev; in rvin_v4l2_register()
1157 vdev->queue = &vin->queue; in rvin_v4l2_register()
1158 snprintf(vdev->name, sizeof(vdev->name), "VIN%u output", vin->id); in rvin_v4l2_register()
1159 vdev->release = video_device_release_empty; in rvin_v4l2_register()
1160 vdev->lock = &vin->lock; in rvin_v4l2_register()
1161 vdev->fops = &rvin_fops; in rvin_v4l2_register()
1162 vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING | in rvin_v4l2_register()
1166 vin->format.pixelformat = RVIN_DEFAULT_FORMAT; in rvin_v4l2_register()
1167 vin->format.width = RVIN_DEFAULT_WIDTH; in rvin_v4l2_register()
1168 vin->format.height = RVIN_DEFAULT_HEIGHT; in rvin_v4l2_register()
1169 vin->format.field = RVIN_DEFAULT_FIELD; in rvin_v4l2_register()
1170 vin->format.colorspace = RVIN_DEFAULT_COLORSPACE; in rvin_v4l2_register()
1172 if (vin->info->use_mc) { in rvin_v4l2_register()
1173 vdev->device_caps |= V4L2_CAP_IO_MC; in rvin_v4l2_register()
1174 vdev->ioctl_ops = &rvin_mc_ioctl_ops; in rvin_v4l2_register()
1176 vdev->ioctl_ops = &rvin_ioctl_ops; in rvin_v4l2_register()
1180 rvin_format_align(vin, &vin->format); in rvin_v4l2_register()
1182 ret = video_register_device(&vin->vdev, VFL_TYPE_VIDEO, -1); in rvin_v4l2_register()
1188 video_set_drvdata(&vin->vdev, vin); in rvin_v4l2_register()
1190 v4l2_info(&vin->v4l2_dev, "Device registered as %s\n", in rvin_v4l2_register()
1191 video_device_node_name(&vin->vdev)); in rvin_v4l2_register()