renesas/rcar-vin/rcar-v4l2.c

20 #include "rcar-vin.h"
91 const struct rvin_video_format *rvin_format_from_pixel(struct rvin_dev *vin,
98 		if (vin->info->model == RCAR_M1)
106 		if (!vin->info->nv12 || !(BIT(vin->id) & 0x3333))
120 static u32 rvin_format_bytesperline(struct rvin_dev *vin,
126 	fmt = rvin_format_from_pixel(vin, pix->pixelformat);
159 static void rvin_format_align(struct rvin_dev *vin, struct v4l2_pix_format *pix)
163 	if (!rvin_format_from_pixel(vin, pix->pixelformat))
201 	v4l_bound_align_image(&pix->width, 5, vin->info->max_width, walign,
202 			      &pix->height, 2, vin->info->max_height, 0, 0);
204 	pix->bytesperline = rvin_format_bytesperline(vin, pix);
207 	vin_dbg(vin, "Format %ux%u bpl: %u size: %u\n",
215 static int rvin_reset_format(struct rvin_dev *vin)
219 		.pad = vin->parallel.source_pad,
223 	ret = v4l2_subdev_call(vin_to_source(vin), pad, get_fmt, NULL, &fmt);
227 	v4l2_fill_pix_format(&vin->format, &fmt.format);
229 	vin->crop.top = 0;
230 	vin->crop.left = 0;
231 	vin->crop.width = vin->format.width;
232 	vin->crop.height = vin->format.height;
235 	if (vin->format.field == V4L2_FIELD_ALTERNATE) {
236 		vin->format.field = V4L2_FIELD_INTERLACED;
237 		vin->format.height *= 2;
240 	rvin_format_align(vin, &vin->format);
242 	vin->compose.top = 0;
243 	vin->compose.left = 0;
244 	vin->compose.width = vin->format.width;
245 	vin->compose.height = vin->format.height;
250 static int rvin_try_format(struct rvin_dev *vin, u32 which,
254 	struct v4l2_subdev *sd = vin_to_source(vin);
259 		.pad = vin->parallel.source_pad,
273 	if (!rvin_format_from_pixel(vin, pix->pixelformat))
276 	v4l2_fill_mbus_format(&format.format, pix, vin->mbus_code);
303 	rvin_format_align(vin, pix);
321 	struct rvin_dev *vin = video_drvdata(file);
323 	return rvin_try_format(vin, V4L2_SUBDEV_FORMAT_TRY, &f->fmt.pix, NULL);
329 	struct rvin_dev *vin = video_drvdata(file);
333 	if (vb2_is_busy(&vin->queue))
336 	ret = rvin_try_format(vin, V4L2_SUBDEV_FORMAT_ACTIVE, &f->fmt.pix,
341 	vin->format = f->fmt.pix;
345 	fmt_rect.width = vin->format.width;
346 	fmt_rect.height = vin->format.height;
348 	v4l2_rect_map_inside(&vin->crop, &src_rect);
349 	v4l2_rect_map_inside(&vin->compose, &fmt_rect);
357 	struct rvin_dev *vin = video_drvdata(file);
359 	f->fmt.pix = vin->format;
367 	struct rvin_dev *vin = video_drvdata(file);
416 		if (rvin_format_from_pixel(vin, rvin_formats[i].fourcc))
428 static int rvin_remote_rectangle(struct rvin_dev *vin, struct v4l2_rect *rect)
437 	if (vin->info->use_mc) {
438 		struct media_pad *pad = media_pad_remote_pad_first(&vin->pad);
446 		sd = vin_to_source(vin);
447 		index = vin->parallel.source_pad;
460 		switch (vin->format.field) {
477 	struct rvin_dev *vin = video_drvdata(file);
480 	if (!vin->scaler)
489 		ret = rvin_remote_rectangle(vin, &s->r);
495 		s->r = vin->crop;
500 		s->r.width = vin->format.width;
501 		s->r.height = vin->format.height;
504 		s->r = vin->compose;
516 	struct rvin_dev *vin = video_drvdata(file);
526 	if (!vin->scaler)
537 		ret = rvin_remote_rectangle(vin, &max_rect);
549 		vin->crop = s->r = r;
551 		vin_dbg(vin, "Cropped %dx%d@%d:%d of %dx%d\n",
558 		max_rect.width = vin->format.width;
559 		max_rect.height = vin->format.height;
567 		while ((r.top * vin->format.bytesperline) & HW_BUFFER_MASK)
570 		fmt = rvin_format_from_pixel(vin, vin->format.pixelformat);
574 		vin->compose = s->r = r;
576 		vin_dbg(vin, "Compose %dx%d@%d:%d in %dx%d\n",
578 			vin->format.width, vin->format.height);
585 	rvin_crop_scale_comp(vin);
593 	struct rvin_dev *vin = video_drvdata(file);
594 	struct v4l2_subdev *sd = vin_to_source(vin);
596 	return v4l2_g_parm_cap(&vin->vdev, sd, parm);
602 	struct rvin_dev *vin = video_drvdata(file);
603 	struct v4l2_subdev *sd = vin_to_source(vin);
605 	return v4l2_s_parm_cap(&vin->vdev, sd, parm);
611 	struct rvin_dev *vin = video_drvdata(file);
612 	struct v4l2_subdev *sd = vin_to_source(vin);
623 	struct rvin_dev *vin = video_drvdata(file);
624 	struct v4l2_subdev *sd = vin_to_source(vin);
641 		i->std = vin->vdev.tvnorms;
664 	struct rvin_dev *vin = video_drvdata(file);
665 	struct v4l2_subdev *sd = vin_to_source(vin);
672 	struct rvin_dev *vin = video_drvdata(file);
675 	ret = v4l2_subdev_call(vin_to_source(vin), video, s_std, a);
679 	vin->std = a;
682 	return rvin_reset_format(vin);
687 	struct rvin_dev *vin = video_drvdata(file);
689 	if (v4l2_subdev_has_op(vin_to_source(vin), pad, dv_timings_cap))
692 	*a = vin->std;
710 	struct rvin_dev *vin = video_drvdata(file);
711 	struct v4l2_subdev *sd = vin_to_source(vin);
717 	timings->pad = vin->parallel.sink_pad;
729 	struct rvin_dev *vin = video_drvdata(file);
730 	struct v4l2_subdev *sd = vin_to_source(vin);
738 	return rvin_reset_format(vin);
744 	struct rvin_dev *vin = video_drvdata(file);
745 	struct v4l2_subdev *sd = vin_to_source(vin);
753 	struct rvin_dev *vin = video_drvdata(file);
754 	struct v4l2_subdev *sd = vin_to_source(vin);
762 	struct rvin_dev *vin = video_drvdata(file);
763 	struct v4l2_subdev *sd = vin_to_source(vin);
769 	cap->pad = vin->parallel.sink_pad;
780 	struct rvin_dev *vin = video_drvdata(file);
781 	struct v4l2_subdev *sd = vin_to_source(vin);
787 	edid->pad = vin->parallel.sink_pad;
798 	struct rvin_dev *vin = video_drvdata(file);
799 	struct v4l2_subdev *sd = vin_to_source(vin);
805 	edid->pad = vin->parallel.sink_pad;
865 static void rvin_mc_try_format(struct rvin_dev *vin,
880 	rvin_format_align(vin, pix);
886 	struct rvin_dev *vin = video_drvdata(file);
888 	rvin_mc_try_format(vin, &f->fmt.pix);
896 	struct rvin_dev *vin = video_drvdata(file);
898 	if (vb2_is_busy(&vin->queue))
901 	rvin_mc_try_format(vin, &f->fmt.pix);
903 	vin->format = f->fmt.pix;
905 	vin->crop.top = 0;
906 	vin->crop.left = 0;
907 	vin->crop.width = vin->format.width;
908 	vin->crop.height = vin->format.height;
909 	vin->compose = vin->crop;
943 static int rvin_power_parallel(struct rvin_dev *vin, bool on)
945 	struct v4l2_subdev *sd = vin_to_source(vin);
958 	struct rvin_dev *vin = video_drvdata(file);
961 	ret = pm_runtime_resume_and_get(vin->dev);
965 	ret = mutex_lock_interruptible(&vin->lock);
969 	file->private_data = vin;
975 	if (vin->info->use_mc)
976 		ret = v4l2_pipeline_pm_get(&vin->vdev.entity);
978 		ret = rvin_power_parallel(vin, true);
983 	ret = v4l2_ctrl_handler_setup(&vin->ctrl_handler);
987 	mutex_unlock(&vin->lock);
991 	if (vin->info->use_mc)
992 		v4l2_pipeline_pm_put(&vin->vdev.entity);
994 		rvin_power_parallel(vin, false);
998 	mutex_unlock(&vin->lock);
1000 	pm_runtime_put(vin->dev);
1007 	struct rvin_dev *vin = video_drvdata(file);
1011 	mutex_lock(&vin->lock);
1019 	if (vin->info->use_mc) {
1020 		v4l2_pipeline_pm_put(&vin->vdev.entity);
1023 			rvin_power_parallel(vin, false);
1026 	mutex_unlock(&vin->lock);
1028 	pm_runtime_put(vin->dev);
1043 void rvin_v4l2_unregister(struct rvin_dev *vin)
1045 	if (!video_is_registered(&vin->vdev))
1048 	v4l2_info(&vin->v4l2_dev, "Removing %s\n",
1049 		  video_device_node_name(&vin->vdev));
1052 	video_unregister_device(&vin->vdev);
1055 static void rvin_notify_video_device(struct rvin_dev *vin,
1060 		v4l2_event_queue(&vin->vdev, arg);
1073 	struct rvin_dev *vin =
1078 	if (!vin->info->use_mc) {
1079 		rvin_notify_video_device(vin, notification, arg);
1083 	group = vin->group;
1086 		vin = group->vin[i];
1087 		if (!vin)
1090 		pad = media_pad_remote_pad_first(&vin->pad);
1098 		rvin_notify_video_device(vin, notification, arg);
1102 int rvin_v4l2_register(struct rvin_dev *vin)
1104 	struct video_device *vdev = &vin->vdev;
1107 	vin->v4l2_dev.notify = rvin_notify;
1110 	vdev->v4l2_dev = &vin->v4l2_dev;
1111 	vdev->queue = &vin->queue;
1112 	snprintf(vdev->name, sizeof(vdev->name), "VIN%u output", vin->id);
1114 	vdev->lock = &vin->lock;
1120 	vin->format.pixelformat	= RVIN_DEFAULT_FORMAT;
1121 	vin->format.width = RVIN_DEFAULT_WIDTH;
1122 	vin->format.height = RVIN_DEFAULT_HEIGHT;
1123 	vin->format.field = RVIN_DEFAULT_FIELD;
1124 	vin->format.colorspace = RVIN_DEFAULT_COLORSPACE;
1126 	if (vin->info->use_mc) {
1131 		rvin_reset_format(vin);
1134 	rvin_format_align(vin, &vin->format);
1136 	ret = video_register_device(&vin->vdev, VFL_TYPE_VIDEO, -1);
1138 		vin_err(vin, "Failed to register video device\n");
1142 	video_set_drvdata(&vin->vdev, vin);
1144 	v4l2_info(&vin->v4l2_dev, "Device registered as %s\n",
1145 		  video_device_node_name(&vin->vdev));