disp: msm: dp: support dp for rb5

adjust aux channel by dts setting.
support max resolution cfg by dts.

Change-Id: I13e48630cf62edc6353f13d0f42cadb2cbd9423d
Signed-off-by: xiangxuy <quic_xiangxuy@quicinc.com>

6 files changed, 137 insertions, 41 deletions

diff --git a/msm/dp/dp_aux.c b/msm/dp/dp_aux.c
index b9ae7386..4a1f54ee 100644
--- a/msm/dp/dp_aux.c
+++ b/msm/dp/dp_aux.c
@@ -1,5 +1,6 @@
 // SPDX-License-Identifier: GPL-2.0-only
 /*
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  * Copyright (c) 2012-2019, The Linux Foundation. All rights reserved.
  */
 
@@ -771,11 +772,16 @@ static int dp_aux_configure_aux_switch(struct dp_aux *dp_aux,
 	aux = container_of(dp_aux, struct dp_aux_private, dp_aux);
 
 	if (!aux->aux_switch_node) {
-		DP_DEBUG("undefined fsa4480 handle\n");
+		DP_DEBUG("undefined aux switch handle\n");
 		rc = -EINVAL;
 		goto end;
 	}
 
+	if (strcmp(aux->aux_switch_node->name, "fsa4480")) {
+		DP_DEBUG("Not an fsa4480 aux switch\n");
+		goto end;
+	}
+
 	if (enable) {
 		switch (orientation) {
 		case ORIENTATION_CC1:
diff --git a/msm/dp/dp_debug.c b/msm/dp/dp_debug.c
index 6303c1cf..0bccc7bf 100644
--- a/msm/dp/dp_debug.c
+++ b/msm/dp/dp_debug.c
@@ -1,5 +1,6 @@
 // SPDX-License-Identifier: GPL-2.0-only
 /*
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  * Copyright (c) 2017-2020, The Linux Foundation. All rights reserved.
  */
 
@@ -2284,6 +2285,7 @@ struct dp_debug *dp_debug_get(struct dp_debug_in *in)
 	dp_debug->dp_mst_connector_list.con_id = -1;
 	dp_debug->dp_mst_connector_list.conn = NULL;
 	dp_debug->dp_mst_connector_list.debug_en = false;
+	mutex_init(&dp_debug->dp_mst_connector_list.lock);
 
 	dp_debug->max_pclk_khz = debug->parser->max_pclk_khz;
 
diff --git a/msm/dp/dp_display.c b/msm/dp/dp_display.c
index 623b3022..26554a45 100644
--- a/msm/dp/dp_display.c
+++ b/msm/dp/dp_display.c
@@ -1,5 +1,6 @@
 // SPDX-License-Identifier: GPL-2.0-only
 /*
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  * Copyright (c) 2017-2021, The Linux Foundation. All rights reserved.
  */
 
@@ -721,6 +722,11 @@ static void dp_display_send_hpd_event(struct dp_display_private *dp)
 	kobject_uevent_env(&dev->primary->kdev->kobj, KOBJ_CHANGE,
 			envp);
 
+	if (dev->mode_config.funcs->output_poll_changed)
+		dev->mode_config.funcs->output_poll_changed(dev);
+
+	drm_client_dev_hotplug(dev);
+
 	if (connector->status == connector_status_connected) {
 		dp_display_state_add(DP_STATE_CONNECT_NOTIFIED);
 		dp_display_state_remove(DP_STATE_DISCONNECT_NOTIFIED);
@@ -976,6 +982,8 @@ static int dp_display_process_hpd_high(struct dp_display_private *dp)
 
 	dp->dp_display.max_pclk_khz = min(dp->parser->max_pclk_khz,
 					dp->debug->max_pclk_khz);
+	dp->dp_display.max_hdisplay = dp->parser->max_hdisplay;
+	dp->dp_display.max_vdisplay = dp->parser->max_vdisplay;
 
 	/*
 	 * If dp video session is not restored from a previous session teardown
@@ -2316,43 +2324,22 @@ end:
 	return 0;
 }
 
-static enum drm_mode_status dp_display_validate_mode(
+static int dp_display_validate_resources(
 		struct dp_display *dp_display,
 		void *panel, struct drm_display_mode *mode,
 		const struct msm_resource_caps_info *avail_res)
 {
 	struct dp_display_private *dp;
-	u32 mode_rate_khz = 0, supported_rate_khz = 0, mode_bpp = 0;
 	struct dp_panel *dp_panel;
 	struct dp_debug *debug;
-	enum drm_mode_status mode_status = MODE_BAD;
-	bool in_list = false;
-	struct dp_mst_connector *mst_connector;
-	int hdis, vdis, vref, ar, _hdis, _vdis, _vref, _ar, rate;
 	struct dp_display_mode dp_mode;
+	u32 mode_rate_khz, supported_rate_khz, mode_bpp, num_lm;
+	int rc, tmds_max_clock, rate;
 	bool dsc_en;
-	u32 num_lm = 0;
-	int rc = 0, tmds_max_clock = 0;
-
-	if (!dp_display || !mode || !panel ||
-			!avail_res || !avail_res->max_mixer_width) {
-		DP_ERR("invalid params\n");
-		return mode_status;
-	}
 
 	dp = container_of(dp_display, struct dp_display_private, dp_display);
-
-	mutex_lock(&dp->session_lock);
-
 	dp_panel = panel;
-	if (!dp_panel->connector) {
-		DP_ERR("invalid connector\n");
-		goto end;
-	}
-
 	debug = dp->debug;
-	if (!debug)
-		goto end;
 
 	dp_display->convert_to_dp_mode(dp_display, panel, mode, &dp_mode);
 
@@ -2366,36 +2353,65 @@ static enum drm_mode_status dp_display_validate_mode(
 	tmds_max_clock = dp_panel->connector->display_info.max_tmds_clock;
 
 	if (mode_rate_khz > supported_rate_khz) {
-		DP_MST_DEBUG("pclk:%d, supported_rate:%d\n",
+		DP_DEBUG("pclk:%d, supported_rate:%d\n",
 				mode->clock, supported_rate_khz);
-		goto end;
+		return -EINVAL;
 	}
 
 	if (mode->clock > dp_display->max_pclk_khz) {
-		DP_MST_DEBUG("clk:%d, max:%d\n", mode->clock,
+		DP_DEBUG("clk:%d, max:%d\n", mode->clock,
 				dp_display->max_pclk_khz);
-		goto end;
+		return -EINVAL;
+	}
+
+	if ((dp_display->max_hdisplay > 0) && (dp_display->max_vdisplay > 0) &&
+			((mode->hdisplay > dp_display->max_hdisplay) ||
+			(mode->vdisplay > dp_display->max_vdisplay))) {
+		DP_DEBUG("hdisplay:%d, max-hdisplay:%d",
+			mode->hdisplay, dp_display->max_hdisplay);
+		DP_DEBUG("vdisplay:%d, max-vdisplay:%d\n",
+			mode->vdisplay, dp_display->max_vdisplay);
+		return -EINVAL;
 	}
 
 	if (tmds_max_clock > 0 && mode->clock > tmds_max_clock) {
-		DP_MST_DEBUG("clk:%d, max tmds:%d\n", mode->clock,
+		DP_DEBUG("clk:%d, max tmds:%d\n", mode->clock,
 				tmds_max_clock);
-		goto end;
+		return -EINVAL;
 	}
 
 	rc = msm_get_mixer_count(dp->priv, mode, avail_res, &num_lm);
 	if (rc) {
 		DP_ERR("error getting mixer count. rc:%d\n", rc);
-		goto end;
+		return -EINVAL;
 	}
 
 	if (num_lm > avail_res->num_lm ||
 			(num_lm == 2 && !avail_res->num_3dmux)) {
-		DP_MST_DEBUG("num_lm:%d, req lm:%d 3dmux:%d\n", num_lm,
+		DP_DEBUG("num_lm:%d, req lm:%d 3dmux:%d\n", num_lm,
 				avail_res->num_lm, avail_res->num_3dmux);
-		goto end;
+		return -EINVAL;
 	}
 
+	return 0;
+}
+
+static int dp_display_check_overrides(
+		struct dp_display *dp_display,
+		void *panel, struct drm_display_mode *mode,
+		const struct msm_resource_caps_info *avail_res)
+{
+	struct dp_mst_connector *mst_connector;
+	struct dp_display_private *dp;
+	struct dp_panel *dp_panel;
+	struct dp_debug *debug;
+	bool in_list = false;
+	int hdis, vdis, vref, ar, _hdis, _vdis, _vref, _ar;
+
+	dp = container_of(dp_display, struct dp_display_private, dp_display);
+	dp_panel = panel;
+	debug = dp->debug;
+
 	/*
 	 * If the connector exists in the mst connector list and if debug is
 	 * enabled for that connector, use the mst connector settings from the
@@ -2404,6 +2420,7 @@ static enum drm_mode_status dp_display_validate_mode(
 	mutex_lock(&debug->dp_mst_connector_list.lock);
 
 	if (list_empty(&debug->dp_mst_connector_list.list)) {
+		DP_MST_DEBUG("MST connect list is empty\n");
 		mutex_unlock(&debug->dp_mst_connector_list.lock);
 		goto verify_default;
 	}
@@ -2414,10 +2431,9 @@ static enum drm_mode_status dp_display_validate_mode(
 			in_list = true;
 
 			if (!mst_connector->debug_en) {
-				mode_status = MODE_OK;
 				mutex_unlock(
 				&debug->dp_mst_connector_list.lock);
-				goto end;
+				return 0;
 			}
 
 			hdis = mst_connector->hdisplay;
@@ -2432,28 +2448,76 @@ static enum drm_mode_status dp_display_validate_mode(
 
 			if (hdis == _hdis && vdis == _vdis && vref == _vref &&
 					ar == _ar) {
-				mode_status = MODE_OK;
 				mutex_unlock(
 				&debug->dp_mst_connector_list.lock);
-				goto end;
+				return 0;
 			}
-
 			break;
 		}
 	}
 
 	mutex_unlock(&debug->dp_mst_connector_list.lock);
-
 	if (in_list)
-		goto end;
+		return -EINVAL;
 
 verify_default:
 	if (debug->debug_en && (mode->hdisplay != debug->hdisplay ||
 			mode->vdisplay != debug->vdisplay ||
 			mode->vrefresh != debug->vrefresh ||
 			mode->picture_aspect_ratio != debug->aspect_ratio))
+		return -EINVAL;
+
+	return 0;
+}
+
+static enum drm_mode_status dp_display_validate_mode(
+		struct dp_display *dp_display,
+		void *panel, struct drm_display_mode *mode,
+		const struct msm_resource_caps_info *avail_res)
+{
+	struct dp_display_private *dp;
+
+	struct dp_panel *dp_panel;
+	struct dp_debug *debug;
+	enum drm_mode_status mode_status = MODE_BAD;
+
+	if (!dp_display || !mode || !panel ||
+			!avail_res || !avail_res->max_mixer_width) {
+		DP_ERR("invalid params\n");
+		return mode_status;
+	}
+
+	dp = container_of(dp_display, struct dp_display_private, dp_display);
+
+	mutex_lock(&dp->session_lock);
+
+	dp_panel = panel;
+	if (!dp_panel->connector) {
+		DP_ERR("invalid connector\n");
+		goto end;
+	}
+
+	debug = dp->debug;
+	if (!debug) {
+		DP_ERR("invalid debug node\n");
+		goto end;
+	}
+
+	if (dp_display_validate_resources(dp_display, panel, mode, avail_res)) {
+		DP_DEBUG("DP bad mode %dx%d@%d\n",
+			mode->hdisplay, mode->vdisplay, mode->clock);
+		goto end;
+	}
+
+	if (dp_display_check_overrides(dp_display, panel,
+				mode, avail_res)) {
+		DP_MST_DEBUG("DP overrides ignore mode %dx%d@%d\n",
+			mode->hdisplay, mode->vdisplay, mode->clock);
 		goto end;
+	}
 
+	DP_DEBUG("DP ok mode %dx%d@%d\n",
+			mode->hdisplay, mode->vdisplay, mode->clock);
 	mode_status = MODE_OK;
 end:
 	mutex_unlock(&dp->session_lock);
@@ -2656,6 +2720,11 @@ static int dp_display_init_aux_switch(struct dp_display_private *dp)
 		goto end;
 	}
 
+	if (strcmp(dp->aux_switch_node->name, "fsa4480")) {
+		DP_DEBUG("Not an fsa4480 aux switch\n");
+		goto end;
+	}
+
 	nb.notifier_call = dp_display_fsa4480_callback;
 	nb.priority = 0;
 
diff --git a/msm/dp/dp_display.h b/msm/dp/dp_display.h
index 3f4b8d9b..0172889c 100644
--- a/msm/dp/dp_display.h
+++ b/msm/dp/dp_display.h
@@ -1,5 +1,6 @@
 /* SPDX-License-Identifier: GPL-2.0-only */
 /*
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  * Copyright (c) 2017-2021, The Linux Foundation. All rights reserved.
  */
 
@@ -70,6 +71,8 @@ struct dp_display {
 	bool is_sst_connected;
 	bool is_mst_supported;
 	u32 max_pclk_khz;
+	u32 max_hdisplay;
+	u32 max_vdisplay;
 	u32 no_mst_encoder;
 	void *dp_mst_prv_info;
 	bool is_primary;
diff --git a/msm/dp/dp_parser.c b/msm/dp/dp_parser.c
index 4c37aa2c..e33f7814 100644
--- a/msm/dp/dp_parser.c
+++ b/msm/dp/dp_parser.c
@@ -1,5 +1,6 @@
 // SPDX-License-Identifier: GPL-2.0-only
 /*
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  * Copyright (c) 2012-2021, The Linux Foundation. All rights reserved.
  */
 
@@ -170,6 +171,16 @@ static int dp_parser_misc(struct dp_parser *parser)
 	if (!parser->display_type)
 		parser->display_type = "unknown";
 
+	rc = of_property_read_u32(of_node,
+		"qcom,max-hdisplay", &parser->max_hdisplay);
+	if (rc)
+		parser->max_hdisplay = 0;
+
+	rc = of_property_read_u32(of_node,
+		"qcom,max-vdisplay", &parser->max_vdisplay);
+	if (rc)
+		parser->max_vdisplay = 0;
+
 	return 0;
 }
 
diff --git a/msm/dp/dp_parser.h b/msm/dp/dp_parser.h
index 5d937ca2..61cbe383 100644
--- a/msm/dp/dp_parser.h
+++ b/msm/dp/dp_parser.h
@@ -1,5 +1,6 @@
 /* SPDX-License-Identifier: GPL-2.0-only */
 /*
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  * Copyright (c) 2012-2021, The Linux Foundation. All rights reserved.
  */
 
@@ -186,6 +187,8 @@ static inline char *dp_phy_aux_config_type_to_string(u32 cfg_type)
  * @l_pnswap: P/N swap status on each lane
  * @max_pclk_khz: maximum pixel clock supported for the platform
  * @max_lclk_khz: maximum link clock supported for the platform
+ * @max_hdisplay: maximum supported horizontal display by the platform for dp
+ * @max_vdisplay: maximum supported vertical display by the platform for dp
  * @hw_cfg: DP HW specific settings
  * @has_mst: MST feature enable status
  * @has_mst_sideband: MST sideband feature enable status
@@ -217,6 +220,8 @@ struct dp_parser {
 	struct dp_aux_cfg aux_cfg[AUX_CFG_LEN];
 	u32 max_pclk_khz;
 	u32 max_lclk_khz;
+	u32 max_hdisplay;
+	u32 max_vdisplay;
 	struct dp_hw_cfg hw_cfg;
 	bool has_mst;
 	bool has_mst_sideband;