3  * vsp1_entity.c  --  R-Car VSP1 Base Entity
13 #include <media/media-entity.h>
23 void vsp1_entity_route_setup(struct vsp1_entity *entity,  in vsp1_entity_route_setup()  argument
30 	if (entity->type == VSP1_ENTITY_HGO) {  in vsp1_entity_route_setup()
37 		source = entity->sources[0];  in vsp1_entity_route_setup()
38 		smppt = (pipe->output->entity.index << VI6_DPR_SMPPT_TGW_SHIFT)  in vsp1_entity_route_setup()
43 	} else if (entity->type == VSP1_ENTITY_HGT) {  in vsp1_entity_route_setup()
50 		source = entity->sources[0];  in vsp1_entity_route_setup()
51 		smppt = (pipe->output->entity.index << VI6_DPR_SMPPT_TGW_SHIFT)  in vsp1_entity_route_setup()
58 	source = entity;  in vsp1_entity_route_setup()
72 void vsp1_entity_configure_stream(struct vsp1_entity *entity,  in vsp1_entity_configure_stream()  argument
77 	if (entity->ops->configure_stream)  in vsp1_entity_configure_stream()
78 		entity->ops->configure_stream(entity, pipe, dl, dlb);  in vsp1_entity_configure_stream()
81 void vsp1_entity_configure_frame(struct vsp1_entity *entity,  in vsp1_entity_configure_frame()  argument
86 	if (entity->ops->configure_frame)  in vsp1_entity_configure_frame()
87 		entity->ops->configure_frame(entity, pipe, dl, dlb);  in vsp1_entity_configure_frame()
90 void vsp1_entity_configure_partition(struct vsp1_entity *entity,  in vsp1_entity_configure_partition()  argument
95 	if (entity->ops->configure_partition)  in vsp1_entity_configure_partition()
96 		entity->ops->configure_partition(entity, pipe, dl, dlb);  in vsp1_entity_configure_partition()
104  * vsp1_entity_get_pad_config - Get the pad configuration for an entity
105  * @entity: the entity
110  * the entity lock to access the returned configuration.
115  * entity structure.
118 vsp1_entity_get_pad_config(struct vsp1_entity *entity,  in vsp1_entity_get_pad_config()  argument
124 		return entity->config;  in vsp1_entity_get_pad_config()
132  * vsp1_entity_get_pad_format - Get a pad format from storage for an entity
133  * @entity: the entity
137  * Return the format stored in the given configuration for an entity's pad. The
141 vsp1_entity_get_pad_format(struct vsp1_entity *entity,  in vsp1_entity_get_pad_format()  argument
145 	return v4l2_subdev_get_try_format(&entity->subdev, cfg, pad);  in vsp1_entity_get_pad_format()
149  * vsp1_entity_get_pad_selection - Get a pad selection from storage for entity
150  * @entity: the entity
156  * entity's pad. The configuration can be an ACTIVE or TRY configuration. The
160 vsp1_entity_get_pad_selection(struct vsp1_entity *entity,  in vsp1_entity_get_pad_selection()  argument
166 		return v4l2_subdev_get_try_compose(&entity->subdev, cfg, pad);  in vsp1_entity_get_pad_selection()
168 		return v4l2_subdev_get_try_crop(&entity->subdev, cfg, pad);  in vsp1_entity_get_pad_selection()
188 	for (pad = 0; pad < subdev->entity.num_pads - 1; ++pad) {  in vsp1_entity_init_cfg()
214 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_get_pad_format()  local
217 	config = vsp1_entity_get_pad_config(entity, cfg, fmt->which);  in vsp1_subdev_get_pad_format()
221 	mutex_lock(&entity->lock);  in vsp1_subdev_get_pad_format()
222 	fmt->format = *vsp1_entity_get_pad_format(entity, config, fmt->pad);  in vsp1_subdev_get_pad_format()
223 	mutex_unlock(&entity->lock);  in vsp1_subdev_get_pad_format()
246 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_enum_mbus_code()  local
258 		 * The entity can't perform format conversion, the sink format  in vsp1_subdev_enum_mbus_code()
264 		config = vsp1_entity_get_pad_config(entity, cfg, code->which);  in vsp1_subdev_enum_mbus_code()
268 		mutex_lock(&entity->lock);  in vsp1_subdev_enum_mbus_code()
269 		format = vsp1_entity_get_pad_format(entity, config, 0);  in vsp1_subdev_enum_mbus_code()
271 		mutex_unlock(&entity->lock);  in vsp1_subdev_enum_mbus_code()
298 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_enum_frame_size()  local
303 	config = vsp1_entity_get_pad_config(entity, cfg, fse->which);  in vsp1_subdev_enum_frame_size()
307 	format = vsp1_entity_get_pad_format(entity, config, fse->pad);  in vsp1_subdev_enum_frame_size()
309 	mutex_lock(&entity->lock);  in vsp1_subdev_enum_frame_size()
333 	mutex_unlock(&entity->lock);  in vsp1_subdev_enum_frame_size()
362 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_set_pad_format()  local
369 	mutex_lock(&entity->lock);  in vsp1_subdev_set_pad_format()
371 	config = vsp1_entity_get_pad_config(entity, cfg, fmt->which);  in vsp1_subdev_set_pad_format()
377 	format = vsp1_entity_get_pad_format(entity, config, fmt->pad);  in vsp1_subdev_set_pad_format()
379 	if (fmt->pad == entity->source_pad) {  in vsp1_subdev_set_pad_format()
405 	format = vsp1_entity_get_pad_format(entity, config, entity->source_pad);  in vsp1_subdev_set_pad_format()
409 	selection = vsp1_entity_get_pad_selection(entity, config, fmt->pad,  in vsp1_subdev_set_pad_format()
416 	selection = vsp1_entity_get_pad_selection(entity, config, fmt->pad,  in vsp1_subdev_set_pad_format()
424 	mutex_unlock(&entity->lock);  in vsp1_subdev_set_pad_format()
433 media_entity_to_vsp1_entity(struct media_entity *entity)  in media_entity_to_vsp1_entity()  argument
435 	return container_of(entity, struct vsp1_entity, subdev.entity);  in media_entity_to_vsp1_entity()
444 	source = media_entity_to_vsp1_entity(source_pad->entity);  in vsp1_entity_link_setup_source()
451 			= media_entity_to_vsp1_entity(sink_pad->entity);  in vsp1_entity_link_setup_source()
479 	sink = media_entity_to_vsp1_entity(sink_pad->entity);  in vsp1_entity_link_setup_sink()
480 	source = media_entity_to_vsp1_entity(source_pad->entity);  in vsp1_entity_link_setup_sink()
495 int vsp1_entity_link_setup(struct media_entity *entity,  in vsp1_entity_link_setup()  argument
526 	list_for_each_entry(link, &pad->entity->links, list) {  in vsp1_entity_remote_pad()
527 		struct vsp1_entity *entity;  in vsp1_entity_remote_pad()  local
540 		if (!is_media_entity_v4l2_subdev(link->sink->entity))  in vsp1_entity_remote_pad()
543 		entity = media_entity_to_vsp1_entity(link->sink->entity);  in vsp1_entity_remote_pad()
544 		if (entity->type != VSP1_ENTITY_HGO &&  in vsp1_entity_remote_pad()
545 		    entity->type != VSP1_ENTITY_HGT)  in vsp1_entity_remote_pad()
609 int vsp1_entity_init(struct vsp1_device *vsp1, struct vsp1_entity *entity,  in vsp1_entity_init()  argument
618 		if (vsp1_routes[i].type == entity->type &&  in vsp1_entity_init()
619 		    vsp1_routes[i].index == entity->index) {  in vsp1_entity_init()
620 			entity->route = &vsp1_routes[i];  in vsp1_entity_init()
628 	mutex_init(&entity->lock);  in vsp1_entity_init()
630 	entity->vsp1 = vsp1;  in vsp1_entity_init()
631 	entity->source_pad = num_pads - 1;  in vsp1_entity_init()
634 	entity->pads = devm_kcalloc(vsp1->dev,  in vsp1_entity_init()
635 				    num_pads, sizeof(*entity->pads),  in vsp1_entity_init()
637 	if (entity->pads == NULL)  in vsp1_entity_init()
641 		entity->pads[i].flags = MEDIA_PAD_FL_SINK;  in vsp1_entity_init()
643 	entity->sources = devm_kcalloc(vsp1->dev, max(num_pads - 1, 1U),  in vsp1_entity_init()
644 				       sizeof(*entity->sources), GFP_KERNEL);  in vsp1_entity_init()
645 	if (entity->sources == NULL)  in vsp1_entity_init()
649 	entity->pads[num_pads - 1].flags = num_pads > 1 ? MEDIA_PAD_FL_SOURCE  in vsp1_entity_init()
652 	/* Initialize the media entity. */  in vsp1_entity_init()
653 	ret = media_entity_pads_init(&entity->subdev.entity, num_pads,  in vsp1_entity_init()
654 				     entity->pads);  in vsp1_entity_init()
659 	subdev = &entity->subdev;  in vsp1_entity_init()
662 	subdev->entity.function = function;  in vsp1_entity_init()
663 	subdev->entity.ops = &vsp1->media_ops;  in vsp1_entity_init()
675 	entity->config = v4l2_subdev_alloc_pad_config(&entity->subdev);  in vsp1_entity_init()
676 	if (entity->config == NULL) {  in vsp1_entity_init()
677 		media_entity_cleanup(&entity->subdev.entity);  in vsp1_entity_init()
684 void vsp1_entity_destroy(struct vsp1_entity *entity)  in vsp1_entity_destroy()  argument
686 	if (entity->ops && entity->ops->destroy)  in vsp1_entity_destroy()
687 		entity->ops->destroy(entity);  in vsp1_entity_destroy()
688 	if (entity->subdev.ctrl_handler)  in vsp1_entity_destroy()
689 		v4l2_ctrl_handler_free(entity->subdev.ctrl_handler);  in vsp1_entity_destroy()
690 	v4l2_subdev_free_pad_config(entity->config);  in vsp1_entity_destroy()
691 	media_entity_cleanup(&entity->subdev.entity);  in vsp1_entity_destroy()