From f8d3c11f678278cc71c6cdb4c5e0bbbe50708d65 Mon Sep 17 00:00:00 2001
From: Andy Yan <andy.yan@rock-chips.com>
Date: Sat, 18 Sep 2021 15:20:17 +0800
Subject: [PATCH] drm/rockchip: vop2: Support set unique possible_crtcs by
 plane_mask

Enabled by:

&vop2 {
	disable-win-move;
};

Change-Id: Idc15f713b74650ac910233538d186ad799e25124
Signed-off-by: Andy Yan <andy.yan@rock-chips.com>
---
 drivers/gpu/drm/rockchip/rockchip_drm_vop2.c | 29 ++++++++++++++++++++
 1 file changed, 29 insertions(+)

diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_vop2.c b/drivers/gpu/drm/rockchip/rockchip_drm_vop2.c
index 1e99065bbc6f..090a4f3892b3 100644
--- a/drivers/gpu/drm/rockchip/rockchip_drm_vop2.c
+++ b/drivers/gpu/drm/rockchip/rockchip_drm_vop2.c
@@ -634,6 +634,9 @@ struct vop2 {
 	bool support_multi_area;
 	bool disable_afbc_win;
 
+	/* no move win from one vp to another */
+	bool disable_win_move;
+
 	bool loader_protect;
 
 	const struct vop2_data *data;
@@ -934,6 +937,21 @@ static const struct vop2_connector_if_data *vop2_find_connector_if_data(struct v
 	return NULL;
 }
 
+static struct drm_crtc *vop2_find_crtc_by_plane_mask(struct vop2 *vop2, uint8_t phys_id)
+{
+	struct vop2_video_port *vp;
+	int i;
+
+	for (i = 0; i < vop2->data->nr_vps; i++) {
+		vp = &vop2->vps[i];
+		if (vp->plane_mask & BIT(phys_id))
+			return &vp->rockchip_crtc.crtc;
+	}
+
+	return NULL;
+}
+
+
 static void vop2_load_hdr2sdr_table(struct vop2_video_port *vp)
 {
 	struct vop2 *vop2 = vp->vop2;
@@ -7520,6 +7538,8 @@ static int vop2_create_crtc(struct vop2 *vop2)
 		vp->id = vp_data->id;
 		vp->regs = vp_data->regs;
 		vp->cursor_win_id = -1;
+		if (vop2->disable_win_move)
+			possible_crtcs = BIT(registered_num_crtcs);
 
 		/*
 		 * we assume a vp with a zere plane_mask(set from dts or bootloader)
@@ -7676,6 +7696,14 @@ static int vop2_create_crtc(struct vop2 *vop2)
 		if (registered_num_crtcs < 2 && vop2_is_mirror_win(win))
 			continue;
 
+		if (vop2->disable_win_move) {
+			crtc = vop2_find_crtc_by_plane_mask(vop2, win->phys_id);
+			if (crtc)
+				possible_crtcs = drm_crtc_mask(crtc);
+			else
+				possible_crtcs = (1 << vop2_data->nr_vps) - 1;
+		}
+
 		ret = vop2_plane_init(vop2, win, possible_crtcs);
 		if (ret)
 			DRM_WARN("failed to init overlay plane %s\n", win->name);
@@ -7897,6 +7925,7 @@ static int vop2_bind(struct device *dev, struct device *master, void *data)
 
 	vop2->support_multi_area = of_property_read_bool(dev->of_node, "support-multi-area");
 	vop2->disable_afbc_win = of_property_read_bool(dev->of_node, "disable-afbc-win");
+	vop2->disable_win_move = of_property_read_bool(dev->of_node, "disable-win-move");
 
 	ret = vop2_pd_data_init(vop2);
 	if (ret)