ti-processor-sdk-linux/drivers/gpu/drm/omapdrm/omap_overlay.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2018 Texas Instruments Incorporated -  http://www.ti.com/
 * Author: Benoit Parrot, <bparrot@ti.com>
 */

#include <drm/drm_atomic.h>
#include <drm/drm_atomic_helper.h>
#include <drm/drm_plane_helper.h>

#include "omap_dmm_tiler.h"
#include "omap_drv.h"

/*
 * overlay funcs
 */
static const char * const overlay_id_to_name[] = {
	[OMAP_DSS_GFX] = "gfx",
	[OMAP_DSS_VIDEO1] = "vid1",
	[OMAP_DSS_VIDEO2] = "vid2",
	[OMAP_DSS_VIDEO3] = "vid3",
};

static struct omap_hw_overlay *
omap_plane_find_free_overlay(struct drm_device *dev,
			     struct drm_plane *hwoverlay_to_plane[],
			     u32 caps, u32 fourcc, u32 crtc_mask)
{
	struct omap_drm_private *priv = dev->dev_private;
	const struct dispc_ops *ops = priv->dispc_ops;
	int i;

	DBG("caps: %x fourcc: %x crtc: %x", caps, fourcc, crtc_mask);

	for (i = 0; i < priv->num_ovls; i++) {
		struct omap_hw_overlay *cur = priv->overlays[i];

		DBG("%d: id: %d cur->caps: %x cur->crtc: %x",
		    cur->idx, cur->overlay_id, cur->caps, cur->possible_crtcs);

		/* skip if already in-use */
		if (hwoverlay_to_plane[cur->idx])
			continue;

		/* check if allowed on crtc */
		if (!(cur->possible_crtcs & crtc_mask))
			continue;

		/* skip if doesn't support some required caps: */
		if (caps & ~cur->caps)
			continue;

		/* check supported format */
		if (!ops->ovl_color_mode_supported(priv->dispc,
						   cur->overlay_id,
						   fourcc))
			continue;

		return cur;
	}

	DBG("no match");
	return NULL;
}

int omap_overlay_assign(struct drm_atomic_state *s, struct drm_plane *plane,
			u32 caps, u32 fourcc, u32 crtc_mask,
			struct omap_hw_overlay **overlay,
			struct omap_hw_overlay **r_overlay)
{
	struct omap_drm_private *priv = s->dev->dev_private;
	struct omap_global_state *new_global_state, *old_global_state;
	struct drm_plane **overlay_map;
	struct omap_hw_overlay *ovl, *r_ovl;
	u32 save_possible_crtcs;

	new_global_state = omap_get_global_state(s);
	if (IS_ERR(new_global_state))
		return PTR_ERR(new_global_state);

	/*
	 * grab old_state after omap_get_global_state(),
	 * since now we hold lock:
	 */
	old_global_state = omap_get_existing_global_state(priv);
	DBG("new_global_state: %p old_global_state: %p",
	    new_global_state, old_global_state);

	overlay_map = new_global_state->hwoverlay_to_plane;

	if (!*overlay) {
		ovl = omap_plane_find_free_overlay(s->dev, overlay_map,
						   caps, fourcc, crtc_mask);
		if (!ovl)
			return -ENOMEM;

		/* in case we need to backtrack */
		save_possible_crtcs = ovl->possible_crtcs;

		ovl->possible_crtcs = crtc_mask;
		overlay_map[ovl->idx] = plane;
		*overlay = ovl;

		if (r_overlay) {
			r_ovl = omap_plane_find_free_overlay(s->dev,
							     overlay_map,
							     caps, fourcc,
							     crtc_mask);
			if (!r_ovl) {
				ovl->possible_crtcs = save_possible_crtcs;
				overlay_map[ovl->idx] = NULL;
				*overlay = NULL;
				return -ENOMEM;
			}

			r_ovl->possible_crtcs = crtc_mask;
			overlay_map[r_ovl->idx] = plane;
			*r_overlay = r_ovl;
		}

		DBG("%s: assign to plane %s caps %x on crtc %x",
		    (*overlay)->name, plane->name, caps, crtc_mask);

		if (r_overlay) {
			DBG("%s: assign to right of plane %s caps %x on crtc %x",
			    (*r_overlay)->name, plane->name, caps, crtc_mask);
		}
	}

	return 0;
}

void omap_overlay_release(struct drm_atomic_state *s,
			  struct drm_plane *plane,
			  struct omap_hw_overlay *overlay)
{
	struct omap_global_state *state = omap_get_global_state(s);
	struct drm_plane **overlay_map = state->hwoverlay_to_plane;

	if (!overlay)
		return;

	if (WARN_ON(!overlay_map[overlay->idx]))
		return;
	/*
	 * Check that the overlay we are releasing is actually
	 * assigned to the plane we are trying to release it from.
	 */
	if (overlay_map[overlay->idx] == plane) {
		DBG("%s: release from plane %s", overlay->name, plane->name);

		overlay_map[overlay->idx] = NULL;
	}
}

void omap_overlay_disable(struct drm_atomic_state *s,
			  struct drm_plane *plane,
			  struct omap_hw_overlay *overlay)
{
	struct omap_drm_private *priv = s->dev->dev_private;
	struct drm_plane **overlay_map;
	struct omap_global_state *old_state;

	old_state = omap_get_existing_global_state(priv);
	overlay_map = old_state->hwoverlay_to_plane;

	if (!overlay)
		return;

	/*
	 * Check that the overlay we are trying to disable has not
	 * been re-assigned to another plane already
	 */
	if (!overlay_map[overlay->idx]) {
		DBG("%s: on %s disabled", overlay->name, plane->name);

		/* disable the overlay */
		priv->dispc_ops->ovl_enable(priv->dispc,
					    overlay->overlay_id, false);

		/*
		 * Since we are disabling this overlay in this
		 * atomic cycle we can reset the available crtcs
		 * it can be used on
		 */
		overlay->possible_crtcs = (1 << priv->num_pipes) - 1;
	}

	/*
	 * Otherwise the overlay is still in use so leave it alone
	 */
}

static void omap_overlay_destroy(struct omap_hw_overlay *overlay)
{
	kfree(overlay);
}

static struct omap_hw_overlay *omap_overlay_init(enum omap_plane_id overlay_id,
						 enum omap_overlay_caps caps)
{
	struct omap_hw_overlay *overlay;

	overlay = kzalloc(sizeof(*overlay), GFP_KERNEL);
	if (!overlay)
		return ERR_PTR(-ENOMEM);

	overlay->name = overlay_id_to_name[overlay_id];
	overlay->overlay_id = overlay_id;
	overlay->caps = caps;
	/*
	 * When this is called priv->num_crtcs is not known yet.
	 * Use a safe mask value to start with, it will get updated to the
	 * proper value after the first use.
	 */
	overlay->possible_crtcs = 0xff;

	return overlay;
}

int omap_hwoverlays_init(struct omap_drm_private *priv)
{
	static const enum omap_plane_id hw_plane_ids[] = {
			OMAP_DSS_GFX, OMAP_DSS_VIDEO1,
			OMAP_DSS_VIDEO2, OMAP_DSS_VIDEO3,
	};
	u32 num_overlays = priv->dispc_ops->get_num_ovls(priv->dispc);
	enum omap_overlay_caps caps;
	int i, ret;

	for (i = 0; i < num_overlays; i++) {
		struct omap_hw_overlay *overlay;

		caps = priv->dispc_ops->ovl_get_caps(priv->dispc, hw_plane_ids[i]);
		overlay = omap_overlay_init(hw_plane_ids[i], caps);
		if (IS_ERR(overlay)) {
			ret = PTR_ERR(overlay);
			dev_err(priv->dev, "failed to construct overlay for %s (%d)\n",
				overlay_id_to_name[i], ret);
			return ret;
		}
		overlay->idx = priv->num_ovls;
		priv->overlays[priv->num_ovls++] = overlay;
	}

	return 0;
}

void omap_hwoverlays_destroy(struct omap_drm_private *priv)
{
	int i;

	for (i = 0; i < priv->num_ovls; i++) {
		omap_overlay_destroy(priv->overlays[i]);
		priv->overlays[i] = NULL;
	}
}