Hdmi: add workaround to avoid display shaking in specific monitor

When detect iex monitor, adjust npll for pixel clock.(1366x768@60,
1360x768@60, 1024x768@75)

Change-Id: I054de1c38e68aa4777b9a67df24acbff83308fac

Author: Gary_Gen

drivers/clk/rockchip/clk-pll.c

@@ -350,7 +350,6 @@ rockchip_rk3066_pll_clk_set_by_auto(struct rockchip_clk_pll *pll,
 			}
 		}
 	}
-
 	/* output the best PLL setting */
 	if ((nr_out <= PLL_NR_MAX) && (no_out > 0)) {
 		rate_table->nr = nr_out;
@@ -359,7 +358,6 @@ rockchip_rk3066_pll_clk_set_by_auto(struct rockchip_clk_pll *pll,
 	} else {
 		return NULL;
 	}
-
 	return rate_table;
 }
 
@@ -368,8 +366,17 @@ static const struct rockchip_pll_rate_table *rockchip_get_pll_settings(
 {
 	const struct rockchip_pll_rate_table  *rate_table = pll->rate_table;
 	int i;
+	bool iex_monitor = false;
+
+	iex_monitor = detect_iex_monitor();
 
 	for (i = 0; i < pll->rate_count; i++) {
+		if( (rate == 85750000) && !iex_monitor)
+			continue;
+		if( (rate == 85500000) && (rate_table[i].nr == 4) && iex_monitor)
+			continue;
+		if( (rate == 78750000) && !iex_monitor)
+			continue;
 		if (rate == rate_table[i].rate) {
 			if (i < pll->sel) {
 				pll->scaling = rate;

drivers/clk/rockchip/clk-rk3288.c

@@ -146,7 +146,10 @@ static struct rockchip_pll_rate_table rk3288_npll_rates[] = {
 	RK3066_PLL_RATE_NB(146250000, 6, 585, 16, 32),
 	RK3066_PLL_RATE_NB(108000000, 1, 54, 12, 32),
 	RK3066_PLL_RATE_NB(106500000, 4, 213, 12, 32),
+	RK3066_PLL_RATE_NB(85750000, 4, 343, 12, 32),//1366*768@60 iex
 	RK3066_PLL_RATE_NB(85500000, 4, 171, 12, 32),
+	RK3066_PLL_RATE_NB(85500000, 2, 171, 12, 32),//1360*768@60 iex
+	RK3066_PLL_RATE_NB(78750000, 4, 210, 16, 32),//1024*768@75 iex
 	RK3066_PLL_RATE_NB(74250000, 4, 198, 16, 32),
 };
 

drivers/clk/rockchip/clk.h

@@ -185,6 +185,8 @@ struct clk;
 #define RK3399_PMU_RSTNHOLD_CON(x)	((x) * 0x4 + 0x120)
 #define RK3399_PMU_GATEDIS_CON(x)	((x) * 0x4 + 0x130)
 
+extern bool detect_iex_monitor(void);
+
 enum rockchip_pll_type {
 	pll_rk3036,
 	pll_rk3066,

drivers/gpu/drm/drm_edid.c

@@ -1264,6 +1264,10 @@ static const u8 edid_header[] = {
 	0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00
 };
 
+static const u8 iex_edid[] = {
+	0x24, 0xb8, 0x85, 0x01
+};
+
 /**
  * drm_edid_header_is_valid - sanity check the header of the base EDID block
  * @raw_edid: pointer to raw base EDID block
@@ -1284,6 +1288,21 @@ int drm_edid_header_is_valid(const u8 *raw_edid)
 }
 EXPORT_SYMBOL(drm_edid_header_is_valid);
 
+bool drm_dect_iex_edid(struct edid *edid)
+{
+	int i, score = 0;
+	u8 *raw_edid = (u8 *)edid;
+	for (i = 0; i < sizeof(iex_edid); i++)
+		if (raw_edid[8+i] == iex_edid[i])
+			score++;
+
+	if (score == 4)
+		return true;
+	else
+		return false;
+}
+EXPORT_SYMBOL(drm_dect_iex_edid);
+
 static int edid_fixup __read_mostly = 6;
 module_param_named(edid_fixup, edid_fixup, int, 0400);
 MODULE_PARM_DESC(edid_fixup,

drivers/gpu/drm/drm_probe_helper.c

@@ -56,6 +56,7 @@
  */
 
 static bool drm_kms_helper_poll = true;
+static bool drm_iex_monitor = false;
 module_param_named(poll, drm_kms_helper_poll, bool, 0600);
 
 static enum drm_mode_status
@@ -131,6 +132,7 @@ static int drm_helper_probe_single_connector_modes_merge_bits(struct drm_connect
 							      uint32_t maxX, uint32_t maxY, bool merge_type_bits)
 {
 	struct drm_device *dev = connector->dev;
+	struct edid *edid_manufacturer;
 	struct drm_display_mode *mode;
 	const struct drm_connector_helper_funcs *connector_funcs =
 		connector->helper_private;
@@ -259,6 +261,9 @@ static int drm_helper_probe_single_connector_modes_merge_bits(struct drm_connect
 
 	DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector->base.id,
 			connector->name);
+
+	edid_manufacturer = (struct edid *) connector->edid_blob_ptr->data;
+	drm_iex_monitor = drm_dect_iex_edid(edid_manufacturer);
 	list_for_each_entry(mode, &connector->modes, head) {
 		drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
 		drm_mode_debug_printmodeline(mode);
@@ -267,6 +272,12 @@ static int drm_helper_probe_single_connector_modes_merge_bits(struct drm_connect
 	return count;
 }
 
+bool detect_iex_monitor(void)
+{
+	return drm_iex_monitor;
+}
+EXPORT_SYMBOL(detect_iex_monitor);
+
 /**
  * drm_helper_probe_single_connector_modes - get complete set of display modes
  * @connector: connector to probe

include/drm/drm_crtc.h

@@ -2011,6 +2011,7 @@ extern void drm_set_preferred_mode(struct drm_connector *connector,
 				   int hpref, int vpref);
 
 extern int drm_edid_header_is_valid(const u8 *raw_edid);
+extern bool drm_dect_iex_edid(struct edid *edid);
 extern bool drm_edid_block_valid(u8 *raw_edid, int block, bool print_bad_edid,
 				 bool *edid_corrupt);
 extern bool drm_edid_is_valid(struct edid *edid);