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, sd_state, 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, sd_state,  in vsp1_entity_get_pad_selection()
169 		return v4l2_subdev_get_try_crop(&entity->subdev, sd_state,  in vsp1_entity_get_pad_selection()
189 	for (pad = 0; pad < subdev->entity.num_pads - 1; ++pad) {  in vsp1_entity_init_cfg()
215 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_get_pad_format()  local
218 	config = vsp1_entity_get_pad_config(entity, sd_state, fmt->which);  in vsp1_subdev_get_pad_format()
222 	mutex_lock(&entity->lock);  in vsp1_subdev_get_pad_format()
223 	fmt->format = *vsp1_entity_get_pad_format(entity, config, fmt->pad);  in vsp1_subdev_get_pad_format()
224 	mutex_unlock(&entity->lock);  in vsp1_subdev_get_pad_format()
247 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_enum_mbus_code()  local
259 		 * The entity can't perform format conversion, the sink format  in vsp1_subdev_enum_mbus_code()
265 		config = vsp1_entity_get_pad_config(entity, sd_state,  in vsp1_subdev_enum_mbus_code()
270 		mutex_lock(&entity->lock);  in vsp1_subdev_enum_mbus_code()
271 		format = vsp1_entity_get_pad_format(entity, config, 0);  in vsp1_subdev_enum_mbus_code()
273 		mutex_unlock(&entity->lock);  in vsp1_subdev_enum_mbus_code()
300 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_enum_frame_size()  local
305 	config = vsp1_entity_get_pad_config(entity, sd_state, fse->which);  in vsp1_subdev_enum_frame_size()
309 	format = vsp1_entity_get_pad_format(entity, config, fse->pad);  in vsp1_subdev_enum_frame_size()
311 	mutex_lock(&entity->lock);  in vsp1_subdev_enum_frame_size()
335 	mutex_unlock(&entity->lock);  in vsp1_subdev_enum_frame_size()
364 	struct vsp1_entity *entity = to_vsp1_entity(subdev);  in vsp1_subdev_set_pad_format()  local
371 	mutex_lock(&entity->lock);  in vsp1_subdev_set_pad_format()
373 	config = vsp1_entity_get_pad_config(entity, sd_state, fmt->which);  in vsp1_subdev_set_pad_format()
379 	format = vsp1_entity_get_pad_format(entity, config, fmt->pad);  in vsp1_subdev_set_pad_format()
381 	if (fmt->pad == entity->source_pad) {  in vsp1_subdev_set_pad_format()
407 	format = vsp1_entity_get_pad_format(entity, config, entity->source_pad);  in vsp1_subdev_set_pad_format()
411 	selection = vsp1_entity_get_pad_selection(entity, config, fmt->pad,  in vsp1_subdev_set_pad_format()
418 	selection = vsp1_entity_get_pad_selection(entity, config, fmt->pad,  in vsp1_subdev_set_pad_format()
426 	mutex_unlock(&entity->lock);  in vsp1_subdev_set_pad_format()
435 media_entity_to_vsp1_entity(struct media_entity *entity)  in media_entity_to_vsp1_entity()  argument
437 	return container_of(entity, struct vsp1_entity, subdev.entity);  in media_entity_to_vsp1_entity()
446 	source = media_entity_to_vsp1_entity(source_pad->entity);  in vsp1_entity_link_setup_source()
453 			= media_entity_to_vsp1_entity(sink_pad->entity);  in vsp1_entity_link_setup_source()
481 	sink = media_entity_to_vsp1_entity(sink_pad->entity);  in vsp1_entity_link_setup_sink()
482 	source = media_entity_to_vsp1_entity(source_pad->entity);  in vsp1_entity_link_setup_sink()
497 int vsp1_entity_link_setup(struct media_entity *entity,  in vsp1_entity_link_setup()  argument
528 	list_for_each_entry(link, &pad->entity->links, list) {  in vsp1_entity_remote_pad()
529 		struct vsp1_entity *entity;  in vsp1_entity_remote_pad()  local
542 		if (!is_media_entity_v4l2_subdev(link->sink->entity))  in vsp1_entity_remote_pad()
545 		entity = media_entity_to_vsp1_entity(link->sink->entity);  in vsp1_entity_remote_pad()
546 		if (entity->type != VSP1_ENTITY_HGO &&  in vsp1_entity_remote_pad()
547 		    entity->type != VSP1_ENTITY_HGT)  in vsp1_entity_remote_pad()
611 int vsp1_entity_init(struct vsp1_device *vsp1, struct vsp1_entity *entity,  in vsp1_entity_init()  argument
621 		if (vsp1_routes[i].type == entity->type &&  in vsp1_entity_init()
622 		    vsp1_routes[i].index == entity->index) {  in vsp1_entity_init()
623 			entity->route = &vsp1_routes[i];  in vsp1_entity_init()
631 	mutex_init(&entity->lock);  in vsp1_entity_init()
633 	entity->vsp1 = vsp1;  in vsp1_entity_init()
634 	entity->source_pad = num_pads - 1;  in vsp1_entity_init()
637 	entity->pads = devm_kcalloc(vsp1->dev,  in vsp1_entity_init()
638 				    num_pads, sizeof(*entity->pads),  in vsp1_entity_init()
640 	if (entity->pads == NULL)  in vsp1_entity_init()
644 		entity->pads[i].flags = MEDIA_PAD_FL_SINK;  in vsp1_entity_init()
646 	entity->sources = devm_kcalloc(vsp1->dev, max(num_pads - 1, 1U),  in vsp1_entity_init()
647 				       sizeof(*entity->sources), GFP_KERNEL);  in vsp1_entity_init()
648 	if (entity->sources == NULL)  in vsp1_entity_init()
652 	entity->pads[num_pads - 1].flags = num_pads > 1 ? MEDIA_PAD_FL_SOURCE  in vsp1_entity_init()
655 	/* Initialize the media entity. */  in vsp1_entity_init()
656 	ret = media_entity_pads_init(&entity->subdev.entity, num_pads,  in vsp1_entity_init()
657 				     entity->pads);  in vsp1_entity_init()
662 	subdev = &entity->subdev;  in vsp1_entity_init()
665 	subdev->entity.function = function;  in vsp1_entity_init()
666 	subdev->entity.ops = &vsp1->media_ops;  in vsp1_entity_init()
682 	entity->config = __v4l2_subdev_state_alloc(&entity->subdev,  in vsp1_entity_init()
684 	if (IS_ERR(entity->config)) {  in vsp1_entity_init()
685 		media_entity_cleanup(&entity->subdev.entity);  in vsp1_entity_init()
686 		return PTR_ERR(entity->config);  in vsp1_entity_init()
692 void vsp1_entity_destroy(struct vsp1_entity *entity)  in vsp1_entity_destroy()  argument
694 	if (entity->ops && entity->ops->destroy)  in vsp1_entity_destroy()
695 		entity->ops->destroy(entity);  in vsp1_entity_destroy()
696 	if (entity->subdev.ctrl_handler)  in vsp1_entity_destroy()
697 		v4l2_ctrl_handler_free(entity->subdev.ctrl_handler);  in vsp1_entity_destroy()
698 	__v4l2_subdev_state_free(entity->config);  in vsp1_entity_destroy()
699 	media_entity_cleanup(&entity->subdev.entity);  in vsp1_entity_destroy()