3  * Driver for Renesas R-Car VIN
20 #include "rcar-vin.h"
107 const struct rvin_video_format *rvin_format_from_pixel(struct rvin_dev *vin,  in rvin_format_from_pixel()  argument
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()
143 static u32 rvin_format_bytesperline(struct rvin_dev *vin,  in rvin_format_bytesperline()  argument
149 	fmt = rvin_format_from_pixel(vin, pix->pixelformat);  in rvin_format_bytesperline()
182 static void rvin_format_align(struct rvin_dev *vin, struct v4l2_pix_format *pix)  in rvin_format_align()  argument
186 	if (!rvin_format_from_pixel(vin, pix->pixelformat))  in rvin_format_align()
223 	/* Limit to VIN capabilities */  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()
230 	vin_dbg(vin, "Format %ux%u bpl: %u size: %u\n",  in rvin_format_align()
238 static int rvin_reset_format(struct rvin_dev *vin)  in rvin_reset_format()  argument
242 		.pad = vin->parallel.source_pad,  in rvin_reset_format()
246 	ret = v4l2_subdev_call(vin_to_source(vin), pad, get_fmt, NULL, &fmt);  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()
273 static int rvin_try_format(struct rvin_dev *vin, u32 which,  in rvin_try_format()  argument
277 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_try_format()
282 		.pad = vin->parallel.source_pad,  in rvin_try_format()
296 	if (!rvin_format_from_pixel(vin, pix->pixelformat))  in rvin_try_format()
299 	v4l2_fill_mbus_format(&format.format, pix, vin->mbus_code);  in rvin_try_format()
326 	rvin_format_align(vin, pix);  in rvin_try_format()
344 	struct rvin_dev *vin = video_drvdata(file);  in rvin_try_fmt_vid_cap()  local
346 	return rvin_try_format(vin, V4L2_SUBDEV_FORMAT_TRY, &f->fmt.pix, NULL);  in rvin_try_fmt_vid_cap()
352 	struct rvin_dev *vin = video_drvdata(file);  in rvin_s_fmt_vid_cap()  local
356 	if (vb2_is_busy(&vin->queue))  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()
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()
380 	struct rvin_dev *vin = video_drvdata(file);  in rvin_g_fmt_vid_cap()  local
382 	f->fmt.pix = vin->format;  in rvin_g_fmt_vid_cap()
390 	struct rvin_dev *vin = video_drvdata(file);  in rvin_enum_fmt_vid_cap()  local
397 	 * with VIN, so all supported YCbCr and RGB media bus codes can produce  in rvin_enum_fmt_vid_cap()
459 		if (rvin_format_from_pixel(vin, rvin_formats[i].fourcc))  in rvin_enum_fmt_vid_cap()
471 static int rvin_remote_rectangle(struct rvin_dev *vin, struct v4l2_rect *rect)  in rvin_remote_rectangle()  argument
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()
489 		sd = vin_to_source(vin);  in rvin_remote_rectangle()
490 		index = vin->parallel.source_pad;  in rvin_remote_rectangle()
503 		switch (vin->format.field) {  in rvin_remote_rectangle()
520 	struct rvin_dev *vin = video_drvdata(file);  in rvin_g_selection()  local
523 	if (!vin->scaler)  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()
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()
559 	struct rvin_dev *vin = video_drvdata(file);  in rvin_s_selection()  local
569 	if (!vin->scaler)  in rvin_s_selection()
580 		ret = rvin_remote_rectangle(vin, &max_rect);  in rvin_s_selection()
592 		vin->crop = s->r = r;  in rvin_s_selection()
594 		vin_dbg(vin, "Cropped %dx%d@%d:%d of %dx%d\n",  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()
610 		while ((r.top * vin->format.bytesperline) & HW_BUFFER_MASK)  in rvin_s_selection()
613 		fmt = rvin_format_from_pixel(vin, vin->format.pixelformat);  in rvin_s_selection()
617 		vin->compose = s->r = r;  in rvin_s_selection()
619 		vin_dbg(vin, "Compose %dx%d@%d:%d in %dx%d\n",  in rvin_s_selection()
621 			vin->format.width, vin->format.height);  in rvin_s_selection()
628 	rvin_crop_scale_comp(vin);  in rvin_s_selection()
636 	struct rvin_dev *vin = video_drvdata(file);  in rvin_g_parm()  local
637 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_g_parm()
639 	return v4l2_g_parm_cap(&vin->vdev, sd, parm);  in rvin_g_parm()
645 	struct rvin_dev *vin = video_drvdata(file);  in rvin_s_parm()  local
646 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_s_parm()
648 	return v4l2_s_parm_cap(&vin->vdev, sd, parm);  in rvin_s_parm()
654 	struct rvin_dev *vin = video_drvdata(file);  in rvin_g_pixelaspect()  local
655 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_g_pixelaspect()
666 	struct rvin_dev *vin = video_drvdata(file);  in rvin_enum_input()  local
667 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_enum_input()
684 		i->std = vin->vdev.tvnorms;  in rvin_enum_input()
707 	struct rvin_dev *vin = video_drvdata(file);  in rvin_querystd()  local
708 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_querystd()
715 	struct rvin_dev *vin = video_drvdata(file);  in rvin_s_std()  local
718 	ret = v4l2_subdev_call(vin_to_source(vin), video, s_std, a);  in rvin_s_std()
722 	vin->std = a;  in rvin_s_std()
725 	return rvin_reset_format(vin);  in rvin_s_std()
730 	struct rvin_dev *vin = video_drvdata(file);  in rvin_g_std()  local
732 	if (v4l2_subdev_has_op(vin_to_source(vin), pad, dv_timings_cap))  in rvin_g_std()
735 	*a = vin->std;  in rvin_g_std()
753 	struct rvin_dev *vin = video_drvdata(file);  in rvin_enum_dv_timings()  local
754 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_enum_dv_timings()
760 	timings->pad = vin->parallel.sink_pad;  in rvin_enum_dv_timings()
772 	struct rvin_dev *vin = video_drvdata(file);  in rvin_s_dv_timings()  local
773 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_s_dv_timings()
777 			       vin->parallel.sink_pad, timings);  in rvin_s_dv_timings()
782 	return rvin_reset_format(vin);  in rvin_s_dv_timings()
788 	struct rvin_dev *vin = video_drvdata(file);  in rvin_g_dv_timings()  local
789 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_g_dv_timings()
792 				vin->parallel.sink_pad, timings);  in rvin_g_dv_timings()
798 	struct rvin_dev *vin = video_drvdata(file);  in rvin_query_dv_timings()  local
799 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_query_dv_timings()
802 				vin->parallel.sink_pad, timings);  in rvin_query_dv_timings()
808 	struct rvin_dev *vin = video_drvdata(file);  in rvin_dv_timings_cap()  local
809 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_dv_timings_cap()
815 	cap->pad = vin->parallel.sink_pad;  in rvin_dv_timings_cap()
826 	struct rvin_dev *vin = video_drvdata(file);  in rvin_g_edid()  local
827 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_g_edid()
833 	edid->pad = vin->parallel.sink_pad;  in rvin_g_edid()
844 	struct rvin_dev *vin = video_drvdata(file);  in rvin_s_edid()  local
845 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_s_edid()
851 	edid->pad = vin->parallel.sink_pad;  in rvin_s_edid()
911 static void rvin_mc_try_format(struct rvin_dev *vin,  in rvin_mc_try_format()  argument
926 	rvin_format_align(vin, pix);  in rvin_mc_try_format()
932 	struct rvin_dev *vin = video_drvdata(file);  in rvin_mc_try_fmt_vid_cap()  local
934 	rvin_mc_try_format(vin, &f->fmt.pix);  in rvin_mc_try_fmt_vid_cap()
942 	struct rvin_dev *vin = video_drvdata(file);  in rvin_mc_s_fmt_vid_cap()  local
944 	if (vb2_is_busy(&vin->queue))  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()
989 static int rvin_power_parallel(struct rvin_dev *vin, bool on)  in rvin_power_parallel()  argument
991 	struct v4l2_subdev *sd = vin_to_source(vin);  in rvin_power_parallel()
1004 	struct rvin_dev *vin = video_drvdata(file);  in rvin_open()  local
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()
1024 		ret = rvin_power_parallel(vin, true);  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()
1040 		rvin_power_parallel(vin, false);  in rvin_open()
1044 	mutex_unlock(&vin->lock);  in rvin_open()
1046 	pm_runtime_put(vin->dev);  in rvin_open()
1053 	struct rvin_dev *vin = video_drvdata(file);  in rvin_release()  local
1057 	mutex_lock(&vin->lock);  in rvin_release()
1065 	if (vin->info->use_mc) {  in rvin_release()
1066 		v4l2_pipeline_pm_put(&vin->vdev.entity);  in rvin_release()
1069 			rvin_power_parallel(vin, false);  in rvin_release()
1072 	mutex_unlock(&vin->lock);  in rvin_release()
1074 	pm_runtime_put(vin->dev);  in rvin_release()
1089 void rvin_v4l2_unregister(struct rvin_dev *vin)  in rvin_v4l2_unregister()  argument
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()
1101 static void rvin_notify_video_device(struct rvin_dev *vin,  in rvin_notify_video_device()  argument
1106 		v4l2_event_queue(&vin->vdev, arg);  in rvin_notify_video_device()
1119 	struct rvin_dev *vin =  in rvin_notify()  local
1124 	if (!vin->info->use_mc) {  in rvin_notify()
1125 		rvin_notify_video_device(vin, notification, arg);  in rvin_notify()
1129 	group = vin->group;  in rvin_notify()
1132 		vin = group->vin[i];  in rvin_notify()
1133 		if (!vin)  in rvin_notify()
1136 		pad = media_pad_remote_pad_first(&vin->pad);  in rvin_notify()
1144 		rvin_notify_video_device(vin, notification, arg);  in rvin_notify()
1148 int rvin_v4l2_register(struct rvin_dev *vin)  in rvin_v4l2_register()  argument
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()
1160 	vdev->lock = &vin->lock;  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()
1177 		rvin_reset_format(vin);  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()
1184 		vin_err(vin, "Failed to register video device\n");  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()