Lines Matching +full:fixed +full:- +full:links
1 // SPDX-License-Identifier: GPL-2.0+
3 * vsp1_entity.c -- R-Car VSP1 Base Entity
5 * Copyright (C) 2013-2014 Renesas Electronics Corporation
13 #include <media/media-entity.h>
14 #include <media/v4l2-ctrls.h>
15 #include <media/v4l2-subdev.h>
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()
39 | (source->route->output << VI6_DPR_SMPPT_PT_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()
52 | (source->route->output << VI6_DPR_SMPPT_PT_SHIFT); in vsp1_entity_route_setup()
59 if (source->route->reg == 0) in vsp1_entity_route_setup()
62 route = source->sink->route->inputs[source->sink_pad]; in vsp1_entity_route_setup()
67 if (source->type == VSP1_ENTITY_BRS) in vsp1_entity_route_setup()
69 vsp1_dl_body_write(dlb, source->route->reg, route); in vsp1_entity_route_setup()
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()
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()
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()
99 /* -----------------------------------------------------------------------------
104 * vsp1_entity_get_state - Get the subdev state for an entity
123 return entity->state; in vsp1_entity_get_state()
131 * vsp1_entity_get_pad_format - Get a pad format from storage for an entity
148 * vsp1_entity_get_pad_selection - Get a pad selection from storage for entity
174 * vsp1_subdev_get_pad_format - Subdev pad get_fmt handler
180 * a direct drop-in for the operation handler.
189 state = vsp1_entity_get_state(entity, sd_state, fmt->which); in vsp1_subdev_get_pad_format()
191 return -EINVAL; in vsp1_subdev_get_pad_format()
193 mutex_lock(&entity->lock); in vsp1_subdev_get_pad_format()
194 fmt->format = *vsp1_entity_get_pad_format(entity, state, fmt->pad); in vsp1_subdev_get_pad_format()
195 mutex_unlock(&entity->lock); in vsp1_subdev_get_pad_format()
201 * vsp1_subdev_enum_mbus_code - Subdev pad enum_mbus_code handler
220 if (code->pad == 0) { in vsp1_subdev_enum_mbus_code()
221 if (code->index >= ncodes) in vsp1_subdev_enum_mbus_code()
222 return -EINVAL; in vsp1_subdev_enum_mbus_code()
224 code->code = codes[code->index]; in vsp1_subdev_enum_mbus_code()
233 if (code->index) in vsp1_subdev_enum_mbus_code()
234 return -EINVAL; in vsp1_subdev_enum_mbus_code()
236 state = vsp1_entity_get_state(entity, sd_state, code->which); in vsp1_subdev_enum_mbus_code()
238 return -EINVAL; in vsp1_subdev_enum_mbus_code()
240 mutex_lock(&entity->lock); in vsp1_subdev_enum_mbus_code()
242 code->code = format->code; in vsp1_subdev_enum_mbus_code()
243 mutex_unlock(&entity->lock); in vsp1_subdev_enum_mbus_code()
250 * vsp1_subdev_enum_frame_size - Subdev pad enum_frame_size handler
261 * minimum and maximum frame width and height on the sink pad, and a fixed
275 state = vsp1_entity_get_state(entity, sd_state, fse->which); in vsp1_subdev_enum_frame_size()
277 return -EINVAL; in vsp1_subdev_enum_frame_size()
279 format = vsp1_entity_get_pad_format(entity, state, fse->pad); in vsp1_subdev_enum_frame_size()
281 mutex_lock(&entity->lock); in vsp1_subdev_enum_frame_size()
283 if (fse->index || fse->code != format->code) { in vsp1_subdev_enum_frame_size()
284 ret = -EINVAL; in vsp1_subdev_enum_frame_size()
288 if (fse->pad == 0) { in vsp1_subdev_enum_frame_size()
289 fse->min_width = min_width; in vsp1_subdev_enum_frame_size()
290 fse->max_width = max_width; in vsp1_subdev_enum_frame_size()
291 fse->min_height = min_height; in vsp1_subdev_enum_frame_size()
292 fse->max_height = max_height; in vsp1_subdev_enum_frame_size()
295 * The size on the source pad are fixed and always identical to in vsp1_subdev_enum_frame_size()
298 fse->min_width = format->width; in vsp1_subdev_enum_frame_size()
299 fse->max_width = format->width; in vsp1_subdev_enum_frame_size()
300 fse->min_height = format->height; in vsp1_subdev_enum_frame_size()
301 fse->max_height = format->height; in vsp1_subdev_enum_frame_size()
305 mutex_unlock(&entity->lock); in vsp1_subdev_enum_frame_size()
310 * vsp1_subdev_set_pad_format - Subdev pad set_fmt handler
341 mutex_lock(&entity->lock); in vsp1_subdev_set_pad_format()
343 state = vsp1_entity_get_state(entity, sd_state, fmt->which); in vsp1_subdev_set_pad_format()
345 ret = -EINVAL; in vsp1_subdev_set_pad_format()
349 format = vsp1_entity_get_pad_format(entity, state, fmt->pad); in vsp1_subdev_set_pad_format()
351 if (fmt->pad == entity->source_pad) { in vsp1_subdev_set_pad_format()
353 fmt->format = *format; in vsp1_subdev_set_pad_format()
362 if (fmt->format.code == codes[i]) in vsp1_subdev_set_pad_format()
366 format->code = i < ncodes ? codes[i] : codes[0]; in vsp1_subdev_set_pad_format()
367 format->width = clamp_t(unsigned int, fmt->format.width, in vsp1_subdev_set_pad_format()
369 format->height = clamp_t(unsigned int, fmt->format.height, in vsp1_subdev_set_pad_format()
371 format->field = V4L2_FIELD_NONE; in vsp1_subdev_set_pad_format()
372 format->colorspace = V4L2_COLORSPACE_SRGB; in vsp1_subdev_set_pad_format()
374 fmt->format = *format; in vsp1_subdev_set_pad_format()
377 format = vsp1_entity_get_pad_format(entity, state, entity->source_pad); in vsp1_subdev_set_pad_format()
378 *format = fmt->format; in vsp1_subdev_set_pad_format()
381 selection = vsp1_entity_get_pad_selection(entity, state, fmt->pad, in vsp1_subdev_set_pad_format()
383 selection->left = 0; in vsp1_subdev_set_pad_format()
384 selection->top = 0; in vsp1_subdev_set_pad_format()
385 selection->width = format->width; in vsp1_subdev_set_pad_format()
386 selection->height = format->height; in vsp1_subdev_set_pad_format()
388 selection = vsp1_entity_get_pad_selection(entity, state, fmt->pad, in vsp1_subdev_set_pad_format()
390 selection->left = 0; in vsp1_subdev_set_pad_format()
391 selection->top = 0; in vsp1_subdev_set_pad_format()
392 selection->width = format->width; in vsp1_subdev_set_pad_format()
393 selection->height = format->height; in vsp1_subdev_set_pad_format()
396 mutex_unlock(&entity->lock); in vsp1_subdev_set_pad_format()
406 for (pad = 0; pad < subdev->entity.num_pads - 1; ++pad) { in vsp1_entity_init_state()
423 /* -----------------------------------------------------------------------------
439 source = media_entity_to_vsp1_entity(source_pad->entity); in vsp1_entity_link_setup_source()
441 if (!source->route) in vsp1_entity_link_setup_source()
446 = media_entity_to_vsp1_entity(sink_pad->entity); in vsp1_entity_link_setup_source()
449 * Fan-out is limited to one for the normal data path plus in vsp1_entity_link_setup_source()
452 if (sink->type != VSP1_ENTITY_HGO && in vsp1_entity_link_setup_source()
453 sink->type != VSP1_ENTITY_HGT) { in vsp1_entity_link_setup_source()
454 if (source->sink) in vsp1_entity_link_setup_source()
455 return -EBUSY; in vsp1_entity_link_setup_source()
456 source->sink = sink; in vsp1_entity_link_setup_source()
457 source->sink_pad = sink_pad->index; in vsp1_entity_link_setup_source()
460 source->sink = NULL; in vsp1_entity_link_setup_source()
461 source->sink_pad = 0; in vsp1_entity_link_setup_source()
474 sink = media_entity_to_vsp1_entity(sink_pad->entity); in vsp1_entity_link_setup_sink()
475 source = media_entity_to_vsp1_entity(source_pad->entity); in vsp1_entity_link_setup_sink()
478 /* Fan-in is limited to one. */ in vsp1_entity_link_setup_sink()
479 if (sink->sources[sink_pad->index]) in vsp1_entity_link_setup_sink()
480 return -EBUSY; in vsp1_entity_link_setup_sink()
482 sink->sources[sink_pad->index] = source; in vsp1_entity_link_setup_sink()
484 sink->sources[sink_pad->index] = NULL; in vsp1_entity_link_setup_sink()
494 if (local->flags & MEDIA_PAD_FL_SOURCE) in vsp1_entity_link_setup()
501 * vsp1_entity_remote_pad - Find the pad at the remote end of a link
505 * links originating or terminating at that pad until an enabled link is found.
507 * Our link setup implementation guarantees that the output fan-out will not be
508 * higher than one for the data pipelines, except for the links to the HGO and
510 * outgoing links this function ignores HGO and HGT entities and should thus be
521 list_for_each_entry(link, &pad->entity->links, list) { in vsp1_entity_remote_pad()
524 if (!(link->flags & MEDIA_LNK_FL_ENABLED)) in vsp1_entity_remote_pad()
528 if (link->sink == pad) in vsp1_entity_remote_pad()
529 return link->source; in vsp1_entity_remote_pad()
531 if (link->source != pad) in vsp1_entity_remote_pad()
535 if (!is_media_entity_v4l2_subdev(link->sink->entity)) in vsp1_entity_remote_pad()
536 return link->sink; in vsp1_entity_remote_pad()
538 entity = media_entity_to_vsp1_entity(link->sink->entity); in vsp1_entity_remote_pad()
539 if (entity->type != VSP1_ENTITY_HGO && in vsp1_entity_remote_pad()
540 entity->type != VSP1_ENTITY_HGT) in vsp1_entity_remote_pad()
541 return link->sink; in vsp1_entity_remote_pad()
548 /* -----------------------------------------------------------------------------
614 if (vsp1_routes[i].type == entity->type && in vsp1_entity_init()
615 vsp1_routes[i].index == entity->index) { in vsp1_entity_init()
616 entity->route = &vsp1_routes[i]; in vsp1_entity_init()
622 return -EINVAL; in vsp1_entity_init()
624 mutex_init(&entity->lock); in vsp1_entity_init()
626 entity->vsp1 = vsp1; in vsp1_entity_init()
627 entity->source_pad = num_pads - 1; in vsp1_entity_init()
630 entity->pads = devm_kcalloc(vsp1->dev, in vsp1_entity_init()
631 num_pads, sizeof(*entity->pads), in vsp1_entity_init()
633 if (entity->pads == NULL) in vsp1_entity_init()
634 return -ENOMEM; in vsp1_entity_init()
636 for (i = 0; i < num_pads - 1; ++i) in vsp1_entity_init()
637 entity->pads[i].flags = MEDIA_PAD_FL_SINK; in vsp1_entity_init()
639 entity->sources = devm_kcalloc(vsp1->dev, max(num_pads - 1, 1U), in vsp1_entity_init()
640 sizeof(*entity->sources), GFP_KERNEL); in vsp1_entity_init()
641 if (entity->sources == NULL) in vsp1_entity_init()
642 return -ENOMEM; in vsp1_entity_init()
644 /* Single-pad entities only have a sink. */ in vsp1_entity_init()
645 entity->pads[num_pads - 1].flags = num_pads > 1 ? MEDIA_PAD_FL_SOURCE in vsp1_entity_init()
649 ret = media_entity_pads_init(&entity->subdev.entity, num_pads, in vsp1_entity_init()
650 entity->pads); in vsp1_entity_init()
655 subdev = &entity->subdev; in vsp1_entity_init()
657 subdev->internal_ops = &vsp1_entity_internal_ops; in vsp1_entity_init()
659 subdev->entity.function = function; in vsp1_entity_init()
660 subdev->entity.ops = &vsp1->media_ops; in vsp1_entity_init()
661 subdev->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; in vsp1_entity_init()
663 snprintf(subdev->name, sizeof(subdev->name), "%s %s", in vsp1_entity_init()
664 dev_name(vsp1->dev), name); in vsp1_entity_init()
676 entity->state = __v4l2_subdev_state_alloc(&entity->subdev, in vsp1_entity_init()
677 "vsp1:state->lock", &key); in vsp1_entity_init()
678 if (IS_ERR(entity->state)) { in vsp1_entity_init()
679 media_entity_cleanup(&entity->subdev.entity); in vsp1_entity_init()
680 return PTR_ERR(entity->state); in vsp1_entity_init()
688 if (entity->ops && entity->ops->destroy) in vsp1_entity_destroy()
689 entity->ops->destroy(entity); in vsp1_entity_destroy()
690 if (entity->subdev.ctrl_handler) in vsp1_entity_destroy()
691 v4l2_ctrl_handler_free(entity->subdev.ctrl_handler); in vsp1_entity_destroy()
692 __v4l2_subdev_state_free(entity->state); in vsp1_entity_destroy()
693 media_entity_cleanup(&entity->subdev.entity); in vsp1_entity_destroy()