xref: /openbmc/linux/drivers/gpu/drm/bridge/tc358767.c (revision 99fc8e963a4c0203dba26a77cf737db6081bca14)
17caff0fcSAndrey Gusakov /*
27caff0fcSAndrey Gusakov  * tc358767 eDP bridge driver
37caff0fcSAndrey Gusakov  *
47caff0fcSAndrey Gusakov  * Copyright (C) 2016 CogentEmbedded Inc
57caff0fcSAndrey Gusakov  * Author: Andrey Gusakov <andrey.gusakov@cogentembedded.com>
67caff0fcSAndrey Gusakov  *
77caff0fcSAndrey Gusakov  * Copyright (C) 2016 Pengutronix, Philipp Zabel <p.zabel@pengutronix.de>
87caff0fcSAndrey Gusakov  *
97caff0fcSAndrey Gusakov  * Initially based on: drivers/gpu/drm/i2c/tda998x_drv.c
107caff0fcSAndrey Gusakov  *
117caff0fcSAndrey Gusakov  * Copyright (C) 2012 Texas Instruments
127caff0fcSAndrey Gusakov  * Author: Rob Clark <robdclark@gmail.com>
137caff0fcSAndrey Gusakov  *
147caff0fcSAndrey Gusakov  * This program is free software; you can redistribute it and/or modify
157caff0fcSAndrey Gusakov  * it under the terms of the GNU General Public License as published by
167caff0fcSAndrey Gusakov  * the Free Software Foundation; either version 2 of the License, or
177caff0fcSAndrey Gusakov  * (at your option) any later version.
187caff0fcSAndrey Gusakov  *
197caff0fcSAndrey Gusakov  * This program is distributed in the hope that it will be useful,
207caff0fcSAndrey Gusakov  * but WITHOUT ANY WARRANTY; without even the implied warranty of
217caff0fcSAndrey Gusakov  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
227caff0fcSAndrey Gusakov  * GNU General Public License for more details.
237caff0fcSAndrey Gusakov  */
247caff0fcSAndrey Gusakov 
257caff0fcSAndrey Gusakov #include <linux/clk.h>
267caff0fcSAndrey Gusakov #include <linux/device.h>
277caff0fcSAndrey Gusakov #include <linux/gpio/consumer.h>
287caff0fcSAndrey Gusakov #include <linux/i2c.h>
297caff0fcSAndrey Gusakov #include <linux/kernel.h>
307caff0fcSAndrey Gusakov #include <linux/module.h>
317caff0fcSAndrey Gusakov #include <linux/regmap.h>
327caff0fcSAndrey Gusakov #include <linux/slab.h>
337caff0fcSAndrey Gusakov 
347caff0fcSAndrey Gusakov #include <drm/drm_atomic_helper.h>
357caff0fcSAndrey Gusakov #include <drm/drm_crtc_helper.h>
367caff0fcSAndrey Gusakov #include <drm/drm_dp_helper.h>
377caff0fcSAndrey Gusakov #include <drm/drm_edid.h>
387caff0fcSAndrey Gusakov #include <drm/drm_of.h>
397caff0fcSAndrey Gusakov #include <drm/drm_panel.h>
407caff0fcSAndrey Gusakov 
417caff0fcSAndrey Gusakov /* Registers */
427caff0fcSAndrey Gusakov 
437caff0fcSAndrey Gusakov /* Display Parallel Interface */
447caff0fcSAndrey Gusakov #define DPIPXLFMT		0x0440
457caff0fcSAndrey Gusakov #define VS_POL_ACTIVE_LOW		(1 << 10)
467caff0fcSAndrey Gusakov #define HS_POL_ACTIVE_LOW		(1 << 9)
477caff0fcSAndrey Gusakov #define DE_POL_ACTIVE_HIGH		(0 << 8)
487caff0fcSAndrey Gusakov #define SUB_CFG_TYPE_CONFIG1		(0 << 2) /* LSB aligned */
497caff0fcSAndrey Gusakov #define SUB_CFG_TYPE_CONFIG2		(1 << 2) /* Loosely Packed */
507caff0fcSAndrey Gusakov #define SUB_CFG_TYPE_CONFIG3		(2 << 2) /* LSB aligned 8-bit */
517caff0fcSAndrey Gusakov #define DPI_BPP_RGB888			(0 << 0)
527caff0fcSAndrey Gusakov #define DPI_BPP_RGB666			(1 << 0)
537caff0fcSAndrey Gusakov #define DPI_BPP_RGB565			(2 << 0)
547caff0fcSAndrey Gusakov 
557caff0fcSAndrey Gusakov /* Video Path */
567caff0fcSAndrey Gusakov #define VPCTRL0			0x0450
577caff0fcSAndrey Gusakov #define OPXLFMT_RGB666			(0 << 8)
587caff0fcSAndrey Gusakov #define OPXLFMT_RGB888			(1 << 8)
597caff0fcSAndrey Gusakov #define FRMSYNC_DISABLED		(0 << 4) /* Video Timing Gen Disabled */
607caff0fcSAndrey Gusakov #define FRMSYNC_ENABLED			(1 << 4) /* Video Timing Gen Enabled */
617caff0fcSAndrey Gusakov #define MSF_DISABLED			(0 << 0) /* Magic Square FRC disabled */
627caff0fcSAndrey Gusakov #define MSF_ENABLED			(1 << 0) /* Magic Square FRC enabled */
637caff0fcSAndrey Gusakov #define HTIM01			0x0454
647caff0fcSAndrey Gusakov #define HTIM02			0x0458
657caff0fcSAndrey Gusakov #define VTIM01			0x045c
667caff0fcSAndrey Gusakov #define VTIM02			0x0460
677caff0fcSAndrey Gusakov #define VFUEN0			0x0464
687caff0fcSAndrey Gusakov #define VFUEN				BIT(0)   /* Video Frame Timing Upload */
697caff0fcSAndrey Gusakov 
707caff0fcSAndrey Gusakov /* System */
717caff0fcSAndrey Gusakov #define TC_IDREG		0x0500
727caff0fcSAndrey Gusakov #define SYSCTRL			0x0510
737caff0fcSAndrey Gusakov #define DP0_AUDSRC_NO_INPUT		(0 << 3)
747caff0fcSAndrey Gusakov #define DP0_AUDSRC_I2S_RX		(1 << 3)
757caff0fcSAndrey Gusakov #define DP0_VIDSRC_NO_INPUT		(0 << 0)
767caff0fcSAndrey Gusakov #define DP0_VIDSRC_DSI_RX		(1 << 0)
777caff0fcSAndrey Gusakov #define DP0_VIDSRC_DPI_RX		(2 << 0)
787caff0fcSAndrey Gusakov #define DP0_VIDSRC_COLOR_BAR		(3 << 0)
797caff0fcSAndrey Gusakov 
807caff0fcSAndrey Gusakov /* Control */
817caff0fcSAndrey Gusakov #define DP0CTL			0x0600
827caff0fcSAndrey Gusakov #define VID_MN_GEN			BIT(6)   /* Auto-generate M/N values */
837caff0fcSAndrey Gusakov #define EF_EN				BIT(5)   /* Enable Enhanced Framing */
847caff0fcSAndrey Gusakov #define VID_EN				BIT(1)   /* Video transmission enable */
857caff0fcSAndrey Gusakov #define DP_EN				BIT(0)   /* Enable DPTX function */
867caff0fcSAndrey Gusakov 
877caff0fcSAndrey Gusakov /* Clocks */
887caff0fcSAndrey Gusakov #define DP0_VIDMNGEN0		0x0610
897caff0fcSAndrey Gusakov #define DP0_VIDMNGEN1		0x0614
907caff0fcSAndrey Gusakov #define DP0_VMNGENSTATUS	0x0618
917caff0fcSAndrey Gusakov 
927caff0fcSAndrey Gusakov /* Main Channel */
937caff0fcSAndrey Gusakov #define DP0_SECSAMPLE		0x0640
947caff0fcSAndrey Gusakov #define DP0_VIDSYNCDELAY	0x0644
957caff0fcSAndrey Gusakov #define DP0_TOTALVAL		0x0648
967caff0fcSAndrey Gusakov #define DP0_STARTVAL		0x064c
977caff0fcSAndrey Gusakov #define DP0_ACTIVEVAL		0x0650
987caff0fcSAndrey Gusakov #define DP0_SYNCVAL		0x0654
997caff0fcSAndrey Gusakov #define DP0_MISC		0x0658
1007caff0fcSAndrey Gusakov #define TU_SIZE_RECOMMENDED		(0x3f << 16) /* LSCLK cycles per TU */
1017caff0fcSAndrey Gusakov #define BPC_6				(0 << 5)
1027caff0fcSAndrey Gusakov #define BPC_8				(1 << 5)
1037caff0fcSAndrey Gusakov 
1047caff0fcSAndrey Gusakov /* AUX channel */
1057caff0fcSAndrey Gusakov #define DP0_AUXCFG0		0x0660
1067caff0fcSAndrey Gusakov #define DP0_AUXCFG1		0x0664
1077caff0fcSAndrey Gusakov #define AUX_RX_FILTER_EN		BIT(16)
1087caff0fcSAndrey Gusakov 
1097caff0fcSAndrey Gusakov #define DP0_AUXADDR		0x0668
1107caff0fcSAndrey Gusakov #define DP0_AUXWDATA(i)		(0x066c + (i) * 4)
1117caff0fcSAndrey Gusakov #define DP0_AUXRDATA(i)		(0x067c + (i) * 4)
1127caff0fcSAndrey Gusakov #define DP0_AUXSTATUS		0x068c
1137caff0fcSAndrey Gusakov #define AUX_STATUS_MASK			0xf0
1147caff0fcSAndrey Gusakov #define AUX_STATUS_SHIFT		4
1157caff0fcSAndrey Gusakov #define AUX_TIMEOUT			BIT(1)
1167caff0fcSAndrey Gusakov #define AUX_BUSY			BIT(0)
1177caff0fcSAndrey Gusakov #define DP0_AUXI2CADR		0x0698
1187caff0fcSAndrey Gusakov 
1197caff0fcSAndrey Gusakov /* Link Training */
1207caff0fcSAndrey Gusakov #define DP0_SRCCTRL		0x06a0
1217caff0fcSAndrey Gusakov #define DP0_SRCCTRL_SCRMBLDIS		BIT(13)
1227caff0fcSAndrey Gusakov #define DP0_SRCCTRL_EN810B		BIT(12)
1237caff0fcSAndrey Gusakov #define DP0_SRCCTRL_NOTP		(0 << 8)
1247caff0fcSAndrey Gusakov #define DP0_SRCCTRL_TP1			(1 << 8)
1257caff0fcSAndrey Gusakov #define DP0_SRCCTRL_TP2			(2 << 8)
1267caff0fcSAndrey Gusakov #define DP0_SRCCTRL_LANESKEW		BIT(7)
1277caff0fcSAndrey Gusakov #define DP0_SRCCTRL_SSCG		BIT(3)
1287caff0fcSAndrey Gusakov #define DP0_SRCCTRL_LANES_1		(0 << 2)
1297caff0fcSAndrey Gusakov #define DP0_SRCCTRL_LANES_2		(1 << 2)
1307caff0fcSAndrey Gusakov #define DP0_SRCCTRL_BW27		(1 << 1)
1317caff0fcSAndrey Gusakov #define DP0_SRCCTRL_BW162		(0 << 1)
1327caff0fcSAndrey Gusakov #define DP0_SRCCTRL_AUTOCORRECT		BIT(0)
1337caff0fcSAndrey Gusakov #define DP0_LTSTAT		0x06d0
1347caff0fcSAndrey Gusakov #define LT_LOOPDONE			BIT(13)
1357caff0fcSAndrey Gusakov #define LT_STATUS_MASK			(0x1f << 8)
1367caff0fcSAndrey Gusakov #define LT_CHANNEL1_EQ_BITS		(DP_CHANNEL_EQ_BITS << 4)
1377caff0fcSAndrey Gusakov #define LT_INTERLANE_ALIGN_DONE		BIT(3)
1387caff0fcSAndrey Gusakov #define LT_CHANNEL0_EQ_BITS		(DP_CHANNEL_EQ_BITS)
1397caff0fcSAndrey Gusakov #define DP0_SNKLTCHGREQ		0x06d4
1407caff0fcSAndrey Gusakov #define DP0_LTLOOPCTRL		0x06d8
1417caff0fcSAndrey Gusakov #define DP0_SNKLTCTRL		0x06e4
1427caff0fcSAndrey Gusakov 
1437caff0fcSAndrey Gusakov /* PHY */
1447caff0fcSAndrey Gusakov #define DP_PHY_CTRL		0x0800
1457caff0fcSAndrey Gusakov #define DP_PHY_RST			BIT(28)  /* DP PHY Global Soft Reset */
1467caff0fcSAndrey Gusakov #define BGREN				BIT(25)  /* AUX PHY BGR Enable */
1477caff0fcSAndrey Gusakov #define PWR_SW_EN			BIT(24)  /* PHY Power Switch Enable */
1487caff0fcSAndrey Gusakov #define PHY_M1_RST			BIT(12)  /* Reset PHY1 Main Channel */
1497caff0fcSAndrey Gusakov #define PHY_RDY				BIT(16)  /* PHY Main Channels Ready */
1507caff0fcSAndrey Gusakov #define PHY_M0_RST			BIT(8)   /* Reset PHY0 Main Channel */
1517caff0fcSAndrey Gusakov #define PHY_A0_EN			BIT(1)   /* PHY Aux Channel0 Enable */
1527caff0fcSAndrey Gusakov #define PHY_M0_EN			BIT(0)   /* PHY Main Channel0 Enable */
1537caff0fcSAndrey Gusakov 
1547caff0fcSAndrey Gusakov /* PLL */
1557caff0fcSAndrey Gusakov #define DP0_PLLCTRL		0x0900
1567caff0fcSAndrey Gusakov #define DP1_PLLCTRL		0x0904	/* not defined in DS */
1577caff0fcSAndrey Gusakov #define PXL_PLLCTRL		0x0908
1587caff0fcSAndrey Gusakov #define PLLUPDATE			BIT(2)
1597caff0fcSAndrey Gusakov #define PLLBYP				BIT(1)
1607caff0fcSAndrey Gusakov #define PLLEN				BIT(0)
1617caff0fcSAndrey Gusakov #define PXL_PLLPARAM		0x0914
1627caff0fcSAndrey Gusakov #define IN_SEL_REFCLK			(0 << 14)
1637caff0fcSAndrey Gusakov #define SYS_PLLPARAM		0x0918
1647caff0fcSAndrey Gusakov #define REF_FREQ_38M4			(0 << 8) /* 38.4 MHz */
1657caff0fcSAndrey Gusakov #define REF_FREQ_19M2			(1 << 8) /* 19.2 MHz */
1667caff0fcSAndrey Gusakov #define REF_FREQ_26M			(2 << 8) /* 26 MHz */
1677caff0fcSAndrey Gusakov #define REF_FREQ_13M			(3 << 8) /* 13 MHz */
1687caff0fcSAndrey Gusakov #define SYSCLK_SEL_LSCLK		(0 << 4)
1697caff0fcSAndrey Gusakov #define LSCLK_DIV_1			(0 << 0)
1707caff0fcSAndrey Gusakov #define LSCLK_DIV_2			(1 << 0)
1717caff0fcSAndrey Gusakov 
1727caff0fcSAndrey Gusakov /* Test & Debug */
1737caff0fcSAndrey Gusakov #define TSTCTL			0x0a00
1747caff0fcSAndrey Gusakov #define PLL_DBG			0x0a04
1757caff0fcSAndrey Gusakov 
1767caff0fcSAndrey Gusakov static bool tc_test_pattern;
1777caff0fcSAndrey Gusakov module_param_named(test, tc_test_pattern, bool, 0644);
1787caff0fcSAndrey Gusakov 
1797caff0fcSAndrey Gusakov struct tc_edp_link {
1807caff0fcSAndrey Gusakov 	struct drm_dp_link	base;
1817caff0fcSAndrey Gusakov 	u8			assr;
1827caff0fcSAndrey Gusakov 	int			scrambler_dis;
1837caff0fcSAndrey Gusakov 	int			spread;
1847caff0fcSAndrey Gusakov 	int			coding8b10b;
1857caff0fcSAndrey Gusakov 	u8			swing;
1867caff0fcSAndrey Gusakov 	u8			preemp;
1877caff0fcSAndrey Gusakov };
1887caff0fcSAndrey Gusakov 
1897caff0fcSAndrey Gusakov struct tc_data {
1907caff0fcSAndrey Gusakov 	struct device		*dev;
1917caff0fcSAndrey Gusakov 	struct regmap		*regmap;
1927caff0fcSAndrey Gusakov 	struct drm_dp_aux	aux;
1937caff0fcSAndrey Gusakov 
1947caff0fcSAndrey Gusakov 	struct drm_bridge	bridge;
1957caff0fcSAndrey Gusakov 	struct drm_connector	connector;
1967caff0fcSAndrey Gusakov 	struct drm_panel	*panel;
1977caff0fcSAndrey Gusakov 
1987caff0fcSAndrey Gusakov 	/* link settings */
1997caff0fcSAndrey Gusakov 	struct tc_edp_link	link;
2007caff0fcSAndrey Gusakov 
2017caff0fcSAndrey Gusakov 	/* display edid */
2027caff0fcSAndrey Gusakov 	struct edid		*edid;
2037caff0fcSAndrey Gusakov 	/* current mode */
2047caff0fcSAndrey Gusakov 	struct drm_display_mode	*mode;
2057caff0fcSAndrey Gusakov 
2067caff0fcSAndrey Gusakov 	u32			rev;
2077caff0fcSAndrey Gusakov 	u8			assr;
2087caff0fcSAndrey Gusakov 
2097caff0fcSAndrey Gusakov 	struct gpio_desc	*sd_gpio;
2107caff0fcSAndrey Gusakov 	struct gpio_desc	*reset_gpio;
2117caff0fcSAndrey Gusakov 	struct clk		*refclk;
2127caff0fcSAndrey Gusakov };
2137caff0fcSAndrey Gusakov 
2147caff0fcSAndrey Gusakov static inline struct tc_data *aux_to_tc(struct drm_dp_aux *a)
2157caff0fcSAndrey Gusakov {
2167caff0fcSAndrey Gusakov 	return container_of(a, struct tc_data, aux);
2177caff0fcSAndrey Gusakov }
2187caff0fcSAndrey Gusakov 
2197caff0fcSAndrey Gusakov static inline struct tc_data *bridge_to_tc(struct drm_bridge *b)
2207caff0fcSAndrey Gusakov {
2217caff0fcSAndrey Gusakov 	return container_of(b, struct tc_data, bridge);
2227caff0fcSAndrey Gusakov }
2237caff0fcSAndrey Gusakov 
2247caff0fcSAndrey Gusakov static inline struct tc_data *connector_to_tc(struct drm_connector *c)
2257caff0fcSAndrey Gusakov {
2267caff0fcSAndrey Gusakov 	return container_of(c, struct tc_data, connector);
2277caff0fcSAndrey Gusakov }
2287caff0fcSAndrey Gusakov 
2297caff0fcSAndrey Gusakov /* Simple macros to avoid repeated error checks */
2307caff0fcSAndrey Gusakov #define tc_write(reg, var)					\
2317caff0fcSAndrey Gusakov 	do {							\
2327caff0fcSAndrey Gusakov 		ret = regmap_write(tc->regmap, reg, var);	\
2337caff0fcSAndrey Gusakov 		if (ret)					\
2347caff0fcSAndrey Gusakov 			goto err;				\
2357caff0fcSAndrey Gusakov 	} while (0)
2367caff0fcSAndrey Gusakov #define tc_read(reg, var)					\
2377caff0fcSAndrey Gusakov 	do {							\
2387caff0fcSAndrey Gusakov 		ret = regmap_read(tc->regmap, reg, var);	\
2397caff0fcSAndrey Gusakov 		if (ret)					\
2407caff0fcSAndrey Gusakov 			goto err;				\
2417caff0fcSAndrey Gusakov 	} while (0)
2427caff0fcSAndrey Gusakov 
2437caff0fcSAndrey Gusakov static inline int tc_poll_timeout(struct regmap *map, unsigned int addr,
2447caff0fcSAndrey Gusakov 				  unsigned int cond_mask,
2457caff0fcSAndrey Gusakov 				  unsigned int cond_value,
2467caff0fcSAndrey Gusakov 				  unsigned long sleep_us, u64 timeout_us)
2477caff0fcSAndrey Gusakov {
2487caff0fcSAndrey Gusakov 	ktime_t timeout = ktime_add_us(ktime_get(), timeout_us);
2497caff0fcSAndrey Gusakov 	unsigned int val;
2507caff0fcSAndrey Gusakov 	int ret;
2517caff0fcSAndrey Gusakov 
2527caff0fcSAndrey Gusakov 	for (;;) {
2537caff0fcSAndrey Gusakov 		ret = regmap_read(map, addr, &val);
2547caff0fcSAndrey Gusakov 		if (ret)
2557caff0fcSAndrey Gusakov 			break;
2567caff0fcSAndrey Gusakov 		if ((val & cond_mask) == cond_value)
2577caff0fcSAndrey Gusakov 			break;
2587caff0fcSAndrey Gusakov 		if (timeout_us && ktime_compare(ktime_get(), timeout) > 0) {
2597caff0fcSAndrey Gusakov 			ret = regmap_read(map, addr, &val);
2607caff0fcSAndrey Gusakov 			break;
2617caff0fcSAndrey Gusakov 		}
2627caff0fcSAndrey Gusakov 		if (sleep_us)
2637caff0fcSAndrey Gusakov 			usleep_range((sleep_us >> 2) + 1, sleep_us);
2647caff0fcSAndrey Gusakov 	}
2657caff0fcSAndrey Gusakov 	return ret ?: (((val & cond_mask) == cond_value) ? 0 : -ETIMEDOUT);
2667caff0fcSAndrey Gusakov }
2677caff0fcSAndrey Gusakov 
2687caff0fcSAndrey Gusakov static int tc_aux_wait_busy(struct tc_data *tc, unsigned int timeout_ms)
2697caff0fcSAndrey Gusakov {
2707caff0fcSAndrey Gusakov 	return tc_poll_timeout(tc->regmap, DP0_AUXSTATUS, AUX_BUSY, 0,
2717caff0fcSAndrey Gusakov 			       1000, 1000 * timeout_ms);
2727caff0fcSAndrey Gusakov }
2737caff0fcSAndrey Gusakov 
2747caff0fcSAndrey Gusakov static int tc_aux_get_status(struct tc_data *tc, u8 *reply)
2757caff0fcSAndrey Gusakov {
2767caff0fcSAndrey Gusakov 	int ret;
2777caff0fcSAndrey Gusakov 	u32 value;
2787caff0fcSAndrey Gusakov 
2797caff0fcSAndrey Gusakov 	ret = regmap_read(tc->regmap, DP0_AUXSTATUS, &value);
2807caff0fcSAndrey Gusakov 	if (ret < 0)
2817caff0fcSAndrey Gusakov 		return ret;
2827caff0fcSAndrey Gusakov 	if (value & AUX_BUSY) {
2837caff0fcSAndrey Gusakov 		if (value & AUX_TIMEOUT) {
2847caff0fcSAndrey Gusakov 			dev_err(tc->dev, "i2c access timeout!\n");
2857caff0fcSAndrey Gusakov 			return -ETIMEDOUT;
2867caff0fcSAndrey Gusakov 		}
2877caff0fcSAndrey Gusakov 		return -EBUSY;
2887caff0fcSAndrey Gusakov 	}
2897caff0fcSAndrey Gusakov 
2907caff0fcSAndrey Gusakov 	*reply = (value & AUX_STATUS_MASK) >> AUX_STATUS_SHIFT;
2917caff0fcSAndrey Gusakov 	return 0;
2927caff0fcSAndrey Gusakov }
2937caff0fcSAndrey Gusakov 
2947caff0fcSAndrey Gusakov static ssize_t tc_aux_transfer(struct drm_dp_aux *aux,
2957caff0fcSAndrey Gusakov 			       struct drm_dp_aux_msg *msg)
2967caff0fcSAndrey Gusakov {
2977caff0fcSAndrey Gusakov 	struct tc_data *tc = aux_to_tc(aux);
2987caff0fcSAndrey Gusakov 	size_t size = min_t(size_t, 8, msg->size);
2997caff0fcSAndrey Gusakov 	u8 request = msg->request & ~DP_AUX_I2C_MOT;
3007caff0fcSAndrey Gusakov 	u8 *buf = msg->buffer;
3017caff0fcSAndrey Gusakov 	u32 tmp = 0;
3027caff0fcSAndrey Gusakov 	int i = 0;
3037caff0fcSAndrey Gusakov 	int ret;
3047caff0fcSAndrey Gusakov 
3057caff0fcSAndrey Gusakov 	if (size == 0)
3067caff0fcSAndrey Gusakov 		return 0;
3077caff0fcSAndrey Gusakov 
3087caff0fcSAndrey Gusakov 	ret = tc_aux_wait_busy(tc, 100);
3097caff0fcSAndrey Gusakov 	if (ret)
3107caff0fcSAndrey Gusakov 		goto err;
3117caff0fcSAndrey Gusakov 
3127caff0fcSAndrey Gusakov 	if (request == DP_AUX_I2C_WRITE || request == DP_AUX_NATIVE_WRITE) {
3137caff0fcSAndrey Gusakov 		/* Store data */
3147caff0fcSAndrey Gusakov 		while (i < size) {
3157caff0fcSAndrey Gusakov 			if (request == DP_AUX_NATIVE_WRITE)
3167caff0fcSAndrey Gusakov 				tmp = tmp | (buf[i] << (8 * (i & 0x3)));
3177caff0fcSAndrey Gusakov 			else
3187caff0fcSAndrey Gusakov 				tmp = (tmp << 8) | buf[i];
3197caff0fcSAndrey Gusakov 			i++;
3207caff0fcSAndrey Gusakov 			if (((i % 4) == 0) || (i == size)) {
3217caff0fcSAndrey Gusakov 				tc_write(DP0_AUXWDATA(i >> 2), tmp);
3227caff0fcSAndrey Gusakov 				tmp = 0;
3237caff0fcSAndrey Gusakov 			}
3247caff0fcSAndrey Gusakov 		}
3257caff0fcSAndrey Gusakov 	} else if (request != DP_AUX_I2C_READ &&
3267caff0fcSAndrey Gusakov 		   request != DP_AUX_NATIVE_READ) {
3277caff0fcSAndrey Gusakov 		return -EINVAL;
3287caff0fcSAndrey Gusakov 	}
3297caff0fcSAndrey Gusakov 
3307caff0fcSAndrey Gusakov 	/* Store address */
3317caff0fcSAndrey Gusakov 	tc_write(DP0_AUXADDR, msg->address);
3327caff0fcSAndrey Gusakov 	/* Start transfer */
3337caff0fcSAndrey Gusakov 	tc_write(DP0_AUXCFG0, ((size - 1) << 8) | request);
3347caff0fcSAndrey Gusakov 
3357caff0fcSAndrey Gusakov 	ret = tc_aux_wait_busy(tc, 100);
3367caff0fcSAndrey Gusakov 	if (ret)
3377caff0fcSAndrey Gusakov 		goto err;
3387caff0fcSAndrey Gusakov 
3397caff0fcSAndrey Gusakov 	ret = tc_aux_get_status(tc, &msg->reply);
3407caff0fcSAndrey Gusakov 	if (ret)
3417caff0fcSAndrey Gusakov 		goto err;
3427caff0fcSAndrey Gusakov 
3437caff0fcSAndrey Gusakov 	if (request == DP_AUX_I2C_READ || request == DP_AUX_NATIVE_READ) {
3447caff0fcSAndrey Gusakov 		/* Read data */
3457caff0fcSAndrey Gusakov 		while (i < size) {
3467caff0fcSAndrey Gusakov 			if ((i % 4) == 0)
3477caff0fcSAndrey Gusakov 				tc_read(DP0_AUXRDATA(i >> 2), &tmp);
3487caff0fcSAndrey Gusakov 			buf[i] = tmp & 0xff;
3497caff0fcSAndrey Gusakov 			tmp = tmp >> 8;
3507caff0fcSAndrey Gusakov 			i++;
3517caff0fcSAndrey Gusakov 		}
3527caff0fcSAndrey Gusakov 	}
3537caff0fcSAndrey Gusakov 
3547caff0fcSAndrey Gusakov 	return size;
3557caff0fcSAndrey Gusakov err:
3567caff0fcSAndrey Gusakov 	return ret;
3577caff0fcSAndrey Gusakov }
3587caff0fcSAndrey Gusakov 
3597caff0fcSAndrey Gusakov static const char * const training_pattern1_errors[] = {
3607caff0fcSAndrey Gusakov 	"No errors",
3617caff0fcSAndrey Gusakov 	"Aux write error",
3627caff0fcSAndrey Gusakov 	"Aux read error",
3637caff0fcSAndrey Gusakov 	"Max voltage reached error",
3647caff0fcSAndrey Gusakov 	"Loop counter expired error",
3657caff0fcSAndrey Gusakov 	"res", "res", "res"
3667caff0fcSAndrey Gusakov };
3677caff0fcSAndrey Gusakov 
3687caff0fcSAndrey Gusakov static const char * const training_pattern2_errors[] = {
3697caff0fcSAndrey Gusakov 	"No errors",
3707caff0fcSAndrey Gusakov 	"Aux write error",
3717caff0fcSAndrey Gusakov 	"Aux read error",
3727caff0fcSAndrey Gusakov 	"Clock recovery failed error",
3737caff0fcSAndrey Gusakov 	"Loop counter expired error",
3747caff0fcSAndrey Gusakov 	"res", "res", "res"
3757caff0fcSAndrey Gusakov };
3767caff0fcSAndrey Gusakov 
3777caff0fcSAndrey Gusakov static u32 tc_srcctrl(struct tc_data *tc)
3787caff0fcSAndrey Gusakov {
3797caff0fcSAndrey Gusakov 	/*
3807caff0fcSAndrey Gusakov 	 * No training pattern, skew lane 1 data by two LSCLK cycles with
3817caff0fcSAndrey Gusakov 	 * respect to lane 0 data, AutoCorrect Mode = 0
3827caff0fcSAndrey Gusakov 	 */
3837caff0fcSAndrey Gusakov 	u32 reg = DP0_SRCCTRL_NOTP | DP0_SRCCTRL_LANESKEW;
3847caff0fcSAndrey Gusakov 
3857caff0fcSAndrey Gusakov 	if (tc->link.scrambler_dis)
3867caff0fcSAndrey Gusakov 		reg |= DP0_SRCCTRL_SCRMBLDIS;	/* Scrambler Disabled */
3877caff0fcSAndrey Gusakov 	if (tc->link.coding8b10b)
3887caff0fcSAndrey Gusakov 		/* Enable 8/10B Encoder (TxData[19:16] not used) */
3897caff0fcSAndrey Gusakov 		reg |= DP0_SRCCTRL_EN810B;
3907caff0fcSAndrey Gusakov 	if (tc->link.spread)
3917caff0fcSAndrey Gusakov 		reg |= DP0_SRCCTRL_SSCG;	/* Spread Spectrum Enable */
3927caff0fcSAndrey Gusakov 	if (tc->link.base.num_lanes == 2)
3937caff0fcSAndrey Gusakov 		reg |= DP0_SRCCTRL_LANES_2;	/* Two Main Channel Lanes */
3947caff0fcSAndrey Gusakov 	if (tc->link.base.rate != 162000)
3957caff0fcSAndrey Gusakov 		reg |= DP0_SRCCTRL_BW27;	/* 2.7 Gbps link */
3967caff0fcSAndrey Gusakov 	return reg;
3977caff0fcSAndrey Gusakov }
3987caff0fcSAndrey Gusakov 
3997caff0fcSAndrey Gusakov static void tc_wait_pll_lock(struct tc_data *tc)
4007caff0fcSAndrey Gusakov {
4017caff0fcSAndrey Gusakov 	/* Wait for PLL to lock: up to 2.09 ms, depending on refclk */
4027caff0fcSAndrey Gusakov 	usleep_range(3000, 6000);
4037caff0fcSAndrey Gusakov }
4047caff0fcSAndrey Gusakov 
4057caff0fcSAndrey Gusakov static int tc_pxl_pll_en(struct tc_data *tc, u32 refclk, u32 pixelclock)
4067caff0fcSAndrey Gusakov {
4077caff0fcSAndrey Gusakov 	int ret;
4087caff0fcSAndrey Gusakov 	int i_pre, best_pre = 1;
4097caff0fcSAndrey Gusakov 	int i_post, best_post = 1;
4107caff0fcSAndrey Gusakov 	int div, best_div = 1;
4117caff0fcSAndrey Gusakov 	int mul, best_mul = 1;
4127caff0fcSAndrey Gusakov 	int delta, best_delta;
4137caff0fcSAndrey Gusakov 	int ext_div[] = {1, 2, 3, 5, 7};
4147caff0fcSAndrey Gusakov 	int best_pixelclock = 0;
4157caff0fcSAndrey Gusakov 	int vco_hi = 0;
4167caff0fcSAndrey Gusakov 
4177caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "PLL: requested %d pixelclock, ref %d\n", pixelclock,
4187caff0fcSAndrey Gusakov 		refclk);
4197caff0fcSAndrey Gusakov 	best_delta = pixelclock;
4207caff0fcSAndrey Gusakov 	/* Loop over all possible ext_divs, skipping invalid configurations */
4217caff0fcSAndrey Gusakov 	for (i_pre = 0; i_pre < ARRAY_SIZE(ext_div); i_pre++) {
4227caff0fcSAndrey Gusakov 		/*
4237caff0fcSAndrey Gusakov 		 * refclk / ext_pre_div should be in the 1 to 200 MHz range.
4247caff0fcSAndrey Gusakov 		 * We don't allow any refclk > 200 MHz, only check lower bounds.
4257caff0fcSAndrey Gusakov 		 */
4267caff0fcSAndrey Gusakov 		if (refclk / ext_div[i_pre] < 1000000)
4277caff0fcSAndrey Gusakov 			continue;
4287caff0fcSAndrey Gusakov 		for (i_post = 0; i_post < ARRAY_SIZE(ext_div); i_post++) {
4297caff0fcSAndrey Gusakov 			for (div = 1; div <= 16; div++) {
4307caff0fcSAndrey Gusakov 				u32 clk;
4317caff0fcSAndrey Gusakov 				u64 tmp;
4327caff0fcSAndrey Gusakov 
4337caff0fcSAndrey Gusakov 				tmp = pixelclock * ext_div[i_pre] *
4347caff0fcSAndrey Gusakov 				      ext_div[i_post] * div;
4357caff0fcSAndrey Gusakov 				do_div(tmp, refclk);
4367caff0fcSAndrey Gusakov 				mul = tmp;
4377caff0fcSAndrey Gusakov 
4387caff0fcSAndrey Gusakov 				/* Check limits */
4397caff0fcSAndrey Gusakov 				if ((mul < 1) || (mul > 128))
4407caff0fcSAndrey Gusakov 					continue;
4417caff0fcSAndrey Gusakov 
4427caff0fcSAndrey Gusakov 				clk = (refclk / ext_div[i_pre] / div) * mul;
4437caff0fcSAndrey Gusakov 				/*
4447caff0fcSAndrey Gusakov 				 * refclk * mul / (ext_pre_div * pre_div)
4457caff0fcSAndrey Gusakov 				 * should be in the 150 to 650 MHz range
4467caff0fcSAndrey Gusakov 				 */
4477caff0fcSAndrey Gusakov 				if ((clk > 650000000) || (clk < 150000000))
4487caff0fcSAndrey Gusakov 					continue;
4497caff0fcSAndrey Gusakov 
4507caff0fcSAndrey Gusakov 				clk = clk / ext_div[i_post];
4517caff0fcSAndrey Gusakov 				delta = clk - pixelclock;
4527caff0fcSAndrey Gusakov 
4537caff0fcSAndrey Gusakov 				if (abs(delta) < abs(best_delta)) {
4547caff0fcSAndrey Gusakov 					best_pre = i_pre;
4557caff0fcSAndrey Gusakov 					best_post = i_post;
4567caff0fcSAndrey Gusakov 					best_div = div;
4577caff0fcSAndrey Gusakov 					best_mul = mul;
4587caff0fcSAndrey Gusakov 					best_delta = delta;
4597caff0fcSAndrey Gusakov 					best_pixelclock = clk;
4607caff0fcSAndrey Gusakov 				}
4617caff0fcSAndrey Gusakov 			}
4627caff0fcSAndrey Gusakov 		}
4637caff0fcSAndrey Gusakov 	}
4647caff0fcSAndrey Gusakov 	if (best_pixelclock == 0) {
4657caff0fcSAndrey Gusakov 		dev_err(tc->dev, "Failed to calc clock for %d pixelclock\n",
4667caff0fcSAndrey Gusakov 			pixelclock);
4677caff0fcSAndrey Gusakov 		return -EINVAL;
4687caff0fcSAndrey Gusakov 	}
4697caff0fcSAndrey Gusakov 
4707caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "PLL: got %d, delta %d\n", best_pixelclock,
4717caff0fcSAndrey Gusakov 		best_delta);
4727caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "PLL: %d / %d / %d * %d / %d\n", refclk,
4737caff0fcSAndrey Gusakov 		ext_div[best_pre], best_div, best_mul, ext_div[best_post]);
4747caff0fcSAndrey Gusakov 
4757caff0fcSAndrey Gusakov 	/* if VCO >= 300 MHz */
4767caff0fcSAndrey Gusakov 	if (refclk / ext_div[best_pre] / best_div * best_mul >= 300000000)
4777caff0fcSAndrey Gusakov 		vco_hi = 1;
4787caff0fcSAndrey Gusakov 	/* see DS */
4797caff0fcSAndrey Gusakov 	if (best_div == 16)
4807caff0fcSAndrey Gusakov 		best_div = 0;
4817caff0fcSAndrey Gusakov 	if (best_mul == 128)
4827caff0fcSAndrey Gusakov 		best_mul = 0;
4837caff0fcSAndrey Gusakov 
4847caff0fcSAndrey Gusakov 	/* Power up PLL and switch to bypass */
4857caff0fcSAndrey Gusakov 	tc_write(PXL_PLLCTRL, PLLBYP | PLLEN);
4867caff0fcSAndrey Gusakov 
4877caff0fcSAndrey Gusakov 	tc_write(PXL_PLLPARAM,
4887caff0fcSAndrey Gusakov 		 (vco_hi << 24) |		/* For PLL VCO >= 300 MHz = 1 */
4897caff0fcSAndrey Gusakov 		 (ext_div[best_pre] << 20) |	/* External Pre-divider */
4907caff0fcSAndrey Gusakov 		 (ext_div[best_post] << 16) |	/* External Post-divider */
4917caff0fcSAndrey Gusakov 		 IN_SEL_REFCLK |		/* Use RefClk as PLL input */
4927caff0fcSAndrey Gusakov 		 (best_div << 8) |		/* Divider for PLL RefClk */
4937caff0fcSAndrey Gusakov 		 (best_mul << 0));		/* Multiplier for PLL */
4947caff0fcSAndrey Gusakov 
4957caff0fcSAndrey Gusakov 	/* Force PLL parameter update and disable bypass */
4967caff0fcSAndrey Gusakov 	tc_write(PXL_PLLCTRL, PLLUPDATE | PLLEN);
4977caff0fcSAndrey Gusakov 
4987caff0fcSAndrey Gusakov 	tc_wait_pll_lock(tc);
4997caff0fcSAndrey Gusakov 
5007caff0fcSAndrey Gusakov 	return 0;
5017caff0fcSAndrey Gusakov err:
5027caff0fcSAndrey Gusakov 	return ret;
5037caff0fcSAndrey Gusakov }
5047caff0fcSAndrey Gusakov 
5057caff0fcSAndrey Gusakov static int tc_pxl_pll_dis(struct tc_data *tc)
5067caff0fcSAndrey Gusakov {
5077caff0fcSAndrey Gusakov 	/* Enable PLL bypass, power down PLL */
5087caff0fcSAndrey Gusakov 	return regmap_write(tc->regmap, PXL_PLLCTRL, PLLBYP);
5097caff0fcSAndrey Gusakov }
5107caff0fcSAndrey Gusakov 
5117caff0fcSAndrey Gusakov static int tc_stream_clock_calc(struct tc_data *tc)
5127caff0fcSAndrey Gusakov {
5137caff0fcSAndrey Gusakov 	int ret;
5147caff0fcSAndrey Gusakov 	/*
5157caff0fcSAndrey Gusakov 	 * If the Stream clock and Link Symbol clock are
5167caff0fcSAndrey Gusakov 	 * asynchronous with each other, the value of M changes over
5177caff0fcSAndrey Gusakov 	 * time. This way of generating link clock and stream
5187caff0fcSAndrey Gusakov 	 * clock is called Asynchronous Clock mode. The value M
5197caff0fcSAndrey Gusakov 	 * must change while the value N stays constant. The
5207caff0fcSAndrey Gusakov 	 * value of N in this Asynchronous Clock mode must be set
5217caff0fcSAndrey Gusakov 	 * to 2^15 or 32,768.
5227caff0fcSAndrey Gusakov 	 *
5237caff0fcSAndrey Gusakov 	 * LSCLK = 1/10 of high speed link clock
5247caff0fcSAndrey Gusakov 	 *
5257caff0fcSAndrey Gusakov 	 * f_STRMCLK = M/N * f_LSCLK
5267caff0fcSAndrey Gusakov 	 * M/N = f_STRMCLK / f_LSCLK
5277caff0fcSAndrey Gusakov 	 *
5287caff0fcSAndrey Gusakov 	 */
5297caff0fcSAndrey Gusakov 	tc_write(DP0_VIDMNGEN1, 32768);
5307caff0fcSAndrey Gusakov 
5317caff0fcSAndrey Gusakov 	return 0;
5327caff0fcSAndrey Gusakov err:
5337caff0fcSAndrey Gusakov 	return ret;
5347caff0fcSAndrey Gusakov }
5357caff0fcSAndrey Gusakov 
5367caff0fcSAndrey Gusakov static int tc_aux_link_setup(struct tc_data *tc)
5377caff0fcSAndrey Gusakov {
5387caff0fcSAndrey Gusakov 	unsigned long rate;
5397caff0fcSAndrey Gusakov 	u32 value;
5407caff0fcSAndrey Gusakov 	int ret;
5417caff0fcSAndrey Gusakov 
5427caff0fcSAndrey Gusakov 	rate = clk_get_rate(tc->refclk);
5437caff0fcSAndrey Gusakov 	switch (rate) {
5447caff0fcSAndrey Gusakov 	case 38400000:
5457caff0fcSAndrey Gusakov 		value = REF_FREQ_38M4;
5467caff0fcSAndrey Gusakov 		break;
5477caff0fcSAndrey Gusakov 	case 26000000:
5487caff0fcSAndrey Gusakov 		value = REF_FREQ_26M;
5497caff0fcSAndrey Gusakov 		break;
5507caff0fcSAndrey Gusakov 	case 19200000:
5517caff0fcSAndrey Gusakov 		value = REF_FREQ_19M2;
5527caff0fcSAndrey Gusakov 		break;
5537caff0fcSAndrey Gusakov 	case 13000000:
5547caff0fcSAndrey Gusakov 		value = REF_FREQ_13M;
5557caff0fcSAndrey Gusakov 		break;
5567caff0fcSAndrey Gusakov 	default:
5577caff0fcSAndrey Gusakov 		dev_err(tc->dev, "Invalid refclk rate: %lu Hz\n", rate);
5587caff0fcSAndrey Gusakov 		return -EINVAL;
5597caff0fcSAndrey Gusakov 	}
5607caff0fcSAndrey Gusakov 
5617caff0fcSAndrey Gusakov 	/* Setup DP-PHY / PLL */
5627caff0fcSAndrey Gusakov 	value |= SYSCLK_SEL_LSCLK | LSCLK_DIV_2;
5637caff0fcSAndrey Gusakov 	tc_write(SYS_PLLPARAM, value);
5647caff0fcSAndrey Gusakov 
5657caff0fcSAndrey Gusakov 	tc_write(DP_PHY_CTRL, BGREN | PWR_SW_EN | BIT(2) | PHY_A0_EN);
5667caff0fcSAndrey Gusakov 
5677caff0fcSAndrey Gusakov 	/*
5687caff0fcSAndrey Gusakov 	 * Initially PLLs are in bypass. Force PLL parameter update,
5697caff0fcSAndrey Gusakov 	 * disable PLL bypass, enable PLL
5707caff0fcSAndrey Gusakov 	 */
5717caff0fcSAndrey Gusakov 	tc_write(DP0_PLLCTRL, PLLUPDATE | PLLEN);
5727caff0fcSAndrey Gusakov 	tc_wait_pll_lock(tc);
5737caff0fcSAndrey Gusakov 
5747caff0fcSAndrey Gusakov 	tc_write(DP1_PLLCTRL, PLLUPDATE | PLLEN);
5757caff0fcSAndrey Gusakov 	tc_wait_pll_lock(tc);
5767caff0fcSAndrey Gusakov 
5777caff0fcSAndrey Gusakov 	ret = tc_poll_timeout(tc->regmap, DP_PHY_CTRL, PHY_RDY, PHY_RDY, 1,
5787caff0fcSAndrey Gusakov 			      1000);
5797caff0fcSAndrey Gusakov 	if (ret == -ETIMEDOUT) {
5807caff0fcSAndrey Gusakov 		dev_err(tc->dev, "Timeout waiting for PHY to become ready");
5817caff0fcSAndrey Gusakov 		return ret;
5827caff0fcSAndrey Gusakov 	} else if (ret)
5837caff0fcSAndrey Gusakov 		goto err;
5847caff0fcSAndrey Gusakov 
5857caff0fcSAndrey Gusakov 	/* Setup AUX link */
5867caff0fcSAndrey Gusakov 	tc_write(DP0_AUXCFG1, AUX_RX_FILTER_EN |
5877caff0fcSAndrey Gusakov 		 (0x06 << 8) |	/* Aux Bit Period Calculator Threshold */
5887caff0fcSAndrey Gusakov 		 (0x3f << 0));	/* Aux Response Timeout Timer */
5897caff0fcSAndrey Gusakov 
5907caff0fcSAndrey Gusakov 	return 0;
5917caff0fcSAndrey Gusakov err:
5927caff0fcSAndrey Gusakov 	dev_err(tc->dev, "tc_aux_link_setup failed: %d\n", ret);
5937caff0fcSAndrey Gusakov 	return ret;
5947caff0fcSAndrey Gusakov }
5957caff0fcSAndrey Gusakov 
5967caff0fcSAndrey Gusakov static int tc_get_display_props(struct tc_data *tc)
5977caff0fcSAndrey Gusakov {
5987caff0fcSAndrey Gusakov 	int ret;
5997caff0fcSAndrey Gusakov 	/* temp buffer */
6007caff0fcSAndrey Gusakov 	u8 tmp[8];
6017caff0fcSAndrey Gusakov 
6027caff0fcSAndrey Gusakov 	/* Read DP Rx Link Capability */
6037caff0fcSAndrey Gusakov 	ret = drm_dp_link_probe(&tc->aux, &tc->link.base);
6047caff0fcSAndrey Gusakov 	if (ret < 0)
6057caff0fcSAndrey Gusakov 		goto err_dpcd_read;
606cffd2b16SAndrey Gusakov 	if (tc->link.base.rate != 162000 && tc->link.base.rate != 270000) {
607cffd2b16SAndrey Gusakov 		dev_dbg(tc->dev, "Falling to 2.7 Gbps rate\n");
608cffd2b16SAndrey Gusakov 		tc->link.base.rate = 270000;
609cffd2b16SAndrey Gusakov 	}
610cffd2b16SAndrey Gusakov 
611cffd2b16SAndrey Gusakov 	if (tc->link.base.num_lanes > 2) {
612cffd2b16SAndrey Gusakov 		dev_dbg(tc->dev, "Falling to 2 lanes\n");
613cffd2b16SAndrey Gusakov 		tc->link.base.num_lanes = 2;
614cffd2b16SAndrey Gusakov 	}
6157caff0fcSAndrey Gusakov 
6167caff0fcSAndrey Gusakov 	ret = drm_dp_dpcd_readb(&tc->aux, DP_MAX_DOWNSPREAD, tmp);
6177caff0fcSAndrey Gusakov 	if (ret < 0)
6187caff0fcSAndrey Gusakov 		goto err_dpcd_read;
6197caff0fcSAndrey Gusakov 	tc->link.spread = tmp[0] & BIT(0); /* 0.5% down spread */
6207caff0fcSAndrey Gusakov 
6217caff0fcSAndrey Gusakov 	ret = drm_dp_dpcd_readb(&tc->aux, DP_MAIN_LINK_CHANNEL_CODING, tmp);
6227caff0fcSAndrey Gusakov 	if (ret < 0)
6237caff0fcSAndrey Gusakov 		goto err_dpcd_read;
6247caff0fcSAndrey Gusakov 	tc->link.coding8b10b = tmp[0] & BIT(0);
6257caff0fcSAndrey Gusakov 	tc->link.scrambler_dis = 0;
6267caff0fcSAndrey Gusakov 	/* read assr */
6277caff0fcSAndrey Gusakov 	ret = drm_dp_dpcd_readb(&tc->aux, DP_EDP_CONFIGURATION_SET, tmp);
6287caff0fcSAndrey Gusakov 	if (ret < 0)
6297caff0fcSAndrey Gusakov 		goto err_dpcd_read;
6307caff0fcSAndrey Gusakov 	tc->link.assr = tmp[0] & DP_ALTERNATE_SCRAMBLER_RESET_ENABLE;
6317caff0fcSAndrey Gusakov 
6327caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "DPCD rev: %d.%d, rate: %s, lanes: %d, framing: %s\n",
6337caff0fcSAndrey Gusakov 		tc->link.base.revision >> 4, tc->link.base.revision & 0x0f,
6347caff0fcSAndrey Gusakov 		(tc->link.base.rate == 162000) ? "1.62Gbps" : "2.7Gbps",
6357caff0fcSAndrey Gusakov 		tc->link.base.num_lanes,
6367caff0fcSAndrey Gusakov 		(tc->link.base.capabilities & DP_LINK_CAP_ENHANCED_FRAMING) ?
6377caff0fcSAndrey Gusakov 		"enhanced" : "non-enhanced");
6387caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "ANSI 8B/10B: %d\n", tc->link.coding8b10b);
6397caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "Display ASSR: %d, TC358767 ASSR: %d\n",
6407caff0fcSAndrey Gusakov 		tc->link.assr, tc->assr);
6417caff0fcSAndrey Gusakov 
6427caff0fcSAndrey Gusakov 	return 0;
6437caff0fcSAndrey Gusakov 
6447caff0fcSAndrey Gusakov err_dpcd_read:
6457caff0fcSAndrey Gusakov 	dev_err(tc->dev, "failed to read DPCD: %d\n", ret);
6467caff0fcSAndrey Gusakov 	return ret;
6477caff0fcSAndrey Gusakov }
6487caff0fcSAndrey Gusakov 
6497caff0fcSAndrey Gusakov static int tc_set_video_mode(struct tc_data *tc, struct drm_display_mode *mode)
6507caff0fcSAndrey Gusakov {
6517caff0fcSAndrey Gusakov 	int ret;
6527caff0fcSAndrey Gusakov 	int vid_sync_dly;
6537caff0fcSAndrey Gusakov 	int max_tu_symbol;
6547caff0fcSAndrey Gusakov 
6557caff0fcSAndrey Gusakov 	int left_margin = mode->htotal - mode->hsync_end;
6567caff0fcSAndrey Gusakov 	int right_margin = mode->hsync_start - mode->hdisplay;
6577caff0fcSAndrey Gusakov 	int hsync_len = mode->hsync_end - mode->hsync_start;
6587caff0fcSAndrey Gusakov 	int upper_margin = mode->vtotal - mode->vsync_end;
6597caff0fcSAndrey Gusakov 	int lower_margin = mode->vsync_start - mode->vdisplay;
6607caff0fcSAndrey Gusakov 	int vsync_len = mode->vsync_end - mode->vsync_start;
6617caff0fcSAndrey Gusakov 
6627caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "set mode %dx%d\n",
6637caff0fcSAndrey Gusakov 		mode->hdisplay, mode->vdisplay);
6647caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "H margin %d,%d sync %d\n",
6657caff0fcSAndrey Gusakov 		left_margin, right_margin, hsync_len);
6667caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "V margin %d,%d sync %d\n",
6677caff0fcSAndrey Gusakov 		upper_margin, lower_margin, vsync_len);
6687caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "total: %dx%d\n", mode->htotal, mode->vtotal);
6697caff0fcSAndrey Gusakov 
6707caff0fcSAndrey Gusakov 
6717caff0fcSAndrey Gusakov 	/* LCD Ctl Frame Size */
6727caff0fcSAndrey Gusakov 	tc_write(VPCTRL0, (0x40 << 20) /* VSDELAY */ |
6737caff0fcSAndrey Gusakov 		 OPXLFMT_RGB888 | FRMSYNC_DISABLED | MSF_DISABLED);
6747caff0fcSAndrey Gusakov 	tc_write(HTIM01, (left_margin << 16) |		/* H back porch */
6757caff0fcSAndrey Gusakov 			 (hsync_len << 0));		/* Hsync */
6767caff0fcSAndrey Gusakov 	tc_write(HTIM02, (right_margin << 16) |		/* H front porch */
6777caff0fcSAndrey Gusakov 			 (mode->hdisplay << 0));	/* width */
6787caff0fcSAndrey Gusakov 	tc_write(VTIM01, (upper_margin << 16) |		/* V back porch */
6797caff0fcSAndrey Gusakov 			 (vsync_len << 0));		/* Vsync */
6807caff0fcSAndrey Gusakov 	tc_write(VTIM02, (lower_margin << 16) |		/* V front porch */
6817caff0fcSAndrey Gusakov 			 (mode->vdisplay << 0));	/* height */
6827caff0fcSAndrey Gusakov 	tc_write(VFUEN0, VFUEN);		/* update settings */
6837caff0fcSAndrey Gusakov 
6847caff0fcSAndrey Gusakov 	/* Test pattern settings */
6857caff0fcSAndrey Gusakov 	tc_write(TSTCTL,
6867caff0fcSAndrey Gusakov 		 (120 << 24) |	/* Red Color component value */
6877caff0fcSAndrey Gusakov 		 (20 << 16) |	/* Green Color component value */
6887caff0fcSAndrey Gusakov 		 (99 << 8) |	/* Blue Color component value */
6897caff0fcSAndrey Gusakov 		 (1 << 4) |	/* Enable I2C Filter */
6907caff0fcSAndrey Gusakov 		 (2 << 0) |	/* Color bar Mode */
6917caff0fcSAndrey Gusakov 		 0);
6927caff0fcSAndrey Gusakov 
6937caff0fcSAndrey Gusakov 	/* DP Main Stream Attributes */
6947caff0fcSAndrey Gusakov 	vid_sync_dly = hsync_len + left_margin + mode->hdisplay;
6957caff0fcSAndrey Gusakov 	tc_write(DP0_VIDSYNCDELAY,
6967caff0fcSAndrey Gusakov 		 (0x003e << 16) |	/* thresh_dly */
6977caff0fcSAndrey Gusakov 		 (vid_sync_dly << 0));
6987caff0fcSAndrey Gusakov 
6997caff0fcSAndrey Gusakov 	tc_write(DP0_TOTALVAL, (mode->vtotal << 16) | (mode->htotal));
7007caff0fcSAndrey Gusakov 
7017caff0fcSAndrey Gusakov 	tc_write(DP0_STARTVAL,
7027caff0fcSAndrey Gusakov 		 ((upper_margin + vsync_len) << 16) |
7037caff0fcSAndrey Gusakov 		 ((left_margin + hsync_len) << 0));
7047caff0fcSAndrey Gusakov 
7057caff0fcSAndrey Gusakov 	tc_write(DP0_ACTIVEVAL, (mode->vdisplay << 16) | (mode->hdisplay));
7067caff0fcSAndrey Gusakov 
7077caff0fcSAndrey Gusakov 	tc_write(DP0_SYNCVAL, (vsync_len << 16) | (hsync_len << 0));
7087caff0fcSAndrey Gusakov 
7097caff0fcSAndrey Gusakov 	tc_write(DPIPXLFMT, VS_POL_ACTIVE_LOW | HS_POL_ACTIVE_LOW |
7107caff0fcSAndrey Gusakov 		 DE_POL_ACTIVE_HIGH | SUB_CFG_TYPE_CONFIG1 | DPI_BPP_RGB888);
7117caff0fcSAndrey Gusakov 
7127caff0fcSAndrey Gusakov 	/*
7137caff0fcSAndrey Gusakov 	 * Recommended maximum number of symbols transferred in a transfer unit:
7147caff0fcSAndrey Gusakov 	 * DIV_ROUND_UP((input active video bandwidth in bytes) * tu_size,
7157caff0fcSAndrey Gusakov 	 *              (output active video bandwidth in bytes))
7167caff0fcSAndrey Gusakov 	 * Must be less than tu_size.
7177caff0fcSAndrey Gusakov 	 */
7187caff0fcSAndrey Gusakov 	max_tu_symbol = TU_SIZE_RECOMMENDED - 1;
7197caff0fcSAndrey Gusakov 	tc_write(DP0_MISC, (max_tu_symbol << 23) | TU_SIZE_RECOMMENDED | BPC_8);
7207caff0fcSAndrey Gusakov 
7217caff0fcSAndrey Gusakov 	return 0;
7227caff0fcSAndrey Gusakov err:
7237caff0fcSAndrey Gusakov 	return ret;
7247caff0fcSAndrey Gusakov }
7257caff0fcSAndrey Gusakov 
7267caff0fcSAndrey Gusakov static int tc_link_training(struct tc_data *tc, int pattern)
7277caff0fcSAndrey Gusakov {
7287caff0fcSAndrey Gusakov 	const char * const *errors;
7297caff0fcSAndrey Gusakov 	u32 srcctrl = tc_srcctrl(tc) | DP0_SRCCTRL_SCRMBLDIS |
7307caff0fcSAndrey Gusakov 		      DP0_SRCCTRL_AUTOCORRECT;
7317caff0fcSAndrey Gusakov 	int timeout;
7327caff0fcSAndrey Gusakov 	int retry;
7337caff0fcSAndrey Gusakov 	u32 value;
7347caff0fcSAndrey Gusakov 	int ret;
7357caff0fcSAndrey Gusakov 
7367caff0fcSAndrey Gusakov 	if (pattern == DP_TRAINING_PATTERN_1) {
7377caff0fcSAndrey Gusakov 		srcctrl |= DP0_SRCCTRL_TP1;
7387caff0fcSAndrey Gusakov 		errors = training_pattern1_errors;
7397caff0fcSAndrey Gusakov 	} else {
7407caff0fcSAndrey Gusakov 		srcctrl |= DP0_SRCCTRL_TP2;
7417caff0fcSAndrey Gusakov 		errors = training_pattern2_errors;
7427caff0fcSAndrey Gusakov 	}
7437caff0fcSAndrey Gusakov 
7447caff0fcSAndrey Gusakov 	/* Set DPCD 0x102 for Training Part 1 or 2 */
7457caff0fcSAndrey Gusakov 	tc_write(DP0_SNKLTCTRL, DP_LINK_SCRAMBLING_DISABLE | pattern);
7467caff0fcSAndrey Gusakov 
7477caff0fcSAndrey Gusakov 	tc_write(DP0_LTLOOPCTRL,
7487caff0fcSAndrey Gusakov 		 (0x0f << 28) |	/* Defer Iteration Count */
7497caff0fcSAndrey Gusakov 		 (0x0f << 24) |	/* Loop Iteration Count */
7507caff0fcSAndrey Gusakov 		 (0x0d << 0));	/* Loop Timer Delay */
7517caff0fcSAndrey Gusakov 
7527caff0fcSAndrey Gusakov 	retry = 5;
7537caff0fcSAndrey Gusakov 	do {
7547caff0fcSAndrey Gusakov 		/* Set DP0 Training Pattern */
7557caff0fcSAndrey Gusakov 		tc_write(DP0_SRCCTRL, srcctrl);
7567caff0fcSAndrey Gusakov 
7577caff0fcSAndrey Gusakov 		/* Enable DP0 to start Link Training */
7587caff0fcSAndrey Gusakov 		tc_write(DP0CTL, DP_EN);
7597caff0fcSAndrey Gusakov 
7607caff0fcSAndrey Gusakov 		/* wait */
7617caff0fcSAndrey Gusakov 		timeout = 1000;
7627caff0fcSAndrey Gusakov 		do {
7637caff0fcSAndrey Gusakov 			tc_read(DP0_LTSTAT, &value);
7647caff0fcSAndrey Gusakov 			udelay(1);
7657caff0fcSAndrey Gusakov 		} while ((!(value & LT_LOOPDONE)) && (--timeout));
7667caff0fcSAndrey Gusakov 		if (timeout == 0) {
7677caff0fcSAndrey Gusakov 			dev_err(tc->dev, "Link training timeout!\n");
7687caff0fcSAndrey Gusakov 		} else {
7697caff0fcSAndrey Gusakov 			int pattern = (value >> 11) & 0x3;
7707caff0fcSAndrey Gusakov 			int error = (value >> 8) & 0x7;
7717caff0fcSAndrey Gusakov 
7727caff0fcSAndrey Gusakov 			dev_dbg(tc->dev,
7737caff0fcSAndrey Gusakov 				"Link training phase %d done after %d uS: %s\n",
7747caff0fcSAndrey Gusakov 				pattern, 1000 - timeout, errors[error]);
7757caff0fcSAndrey Gusakov 			if (pattern == DP_TRAINING_PATTERN_1 && error == 0)
7767caff0fcSAndrey Gusakov 				break;
7777caff0fcSAndrey Gusakov 			if (pattern == DP_TRAINING_PATTERN_2) {
7787caff0fcSAndrey Gusakov 				value &= LT_CHANNEL1_EQ_BITS |
7797caff0fcSAndrey Gusakov 					 LT_INTERLANE_ALIGN_DONE |
7807caff0fcSAndrey Gusakov 					 LT_CHANNEL0_EQ_BITS;
7817caff0fcSAndrey Gusakov 				/* in case of two lanes */
7827caff0fcSAndrey Gusakov 				if ((tc->link.base.num_lanes == 2) &&
7837caff0fcSAndrey Gusakov 				    (value == (LT_CHANNEL1_EQ_BITS |
7847caff0fcSAndrey Gusakov 					       LT_INTERLANE_ALIGN_DONE |
7857caff0fcSAndrey Gusakov 					       LT_CHANNEL0_EQ_BITS)))
7867caff0fcSAndrey Gusakov 					break;
7877caff0fcSAndrey Gusakov 				/* in case of one line */
7887caff0fcSAndrey Gusakov 				if ((tc->link.base.num_lanes == 1) &&
7897caff0fcSAndrey Gusakov 				    (value == (LT_INTERLANE_ALIGN_DONE |
7907caff0fcSAndrey Gusakov 					       LT_CHANNEL0_EQ_BITS)))
7917caff0fcSAndrey Gusakov 					break;
7927caff0fcSAndrey Gusakov 			}
7937caff0fcSAndrey Gusakov 		}
7947caff0fcSAndrey Gusakov 		/* restart */
7957caff0fcSAndrey Gusakov 		tc_write(DP0CTL, 0);
7967caff0fcSAndrey Gusakov 		usleep_range(10, 20);
7977caff0fcSAndrey Gusakov 	} while (--retry);
7987caff0fcSAndrey Gusakov 	if (retry == 0) {
7997caff0fcSAndrey Gusakov 		dev_err(tc->dev, "Failed to finish training phase %d\n",
8007caff0fcSAndrey Gusakov 			pattern);
8017caff0fcSAndrey Gusakov 	}
8027caff0fcSAndrey Gusakov 
8037caff0fcSAndrey Gusakov 	return 0;
8047caff0fcSAndrey Gusakov err:
8057caff0fcSAndrey Gusakov 	return ret;
8067caff0fcSAndrey Gusakov }
8077caff0fcSAndrey Gusakov 
8087caff0fcSAndrey Gusakov static int tc_main_link_setup(struct tc_data *tc)
8097caff0fcSAndrey Gusakov {
8107caff0fcSAndrey Gusakov 	struct drm_dp_aux *aux = &tc->aux;
8117caff0fcSAndrey Gusakov 	struct device *dev = tc->dev;
8127caff0fcSAndrey Gusakov 	unsigned int rate;
8137caff0fcSAndrey Gusakov 	u32 dp_phy_ctrl;
8147caff0fcSAndrey Gusakov 	int timeout;
8157caff0fcSAndrey Gusakov 	bool aligned;
8167caff0fcSAndrey Gusakov 	bool ready;
8177caff0fcSAndrey Gusakov 	u32 value;
8187caff0fcSAndrey Gusakov 	int ret;
8197caff0fcSAndrey Gusakov 	u8 tmp[8];
8207caff0fcSAndrey Gusakov 
8217caff0fcSAndrey Gusakov 	/* display mode should be set at this point */
8227caff0fcSAndrey Gusakov 	if (!tc->mode)
8237caff0fcSAndrey Gusakov 		return -EINVAL;
8247caff0fcSAndrey Gusakov 
8257caff0fcSAndrey Gusakov 	/* from excel file - DP0_SrcCtrl */
8267caff0fcSAndrey Gusakov 	tc_write(DP0_SRCCTRL, DP0_SRCCTRL_SCRMBLDIS | DP0_SRCCTRL_EN810B |
8277caff0fcSAndrey Gusakov 		 DP0_SRCCTRL_LANESKEW | DP0_SRCCTRL_LANES_2 |
8287caff0fcSAndrey Gusakov 		 DP0_SRCCTRL_BW27 | DP0_SRCCTRL_AUTOCORRECT);
8297caff0fcSAndrey Gusakov 	/* from excel file - DP1_SrcCtrl */
8307caff0fcSAndrey Gusakov 	tc_write(0x07a0, 0x00003083);
8317caff0fcSAndrey Gusakov 
8327caff0fcSAndrey Gusakov 	rate = clk_get_rate(tc->refclk);
8337caff0fcSAndrey Gusakov 	switch (rate) {
8347caff0fcSAndrey Gusakov 	case 38400000:
8357caff0fcSAndrey Gusakov 		value = REF_FREQ_38M4;
8367caff0fcSAndrey Gusakov 		break;
8377caff0fcSAndrey Gusakov 	case 26000000:
8387caff0fcSAndrey Gusakov 		value = REF_FREQ_26M;
8397caff0fcSAndrey Gusakov 		break;
8407caff0fcSAndrey Gusakov 	case 19200000:
8417caff0fcSAndrey Gusakov 		value = REF_FREQ_19M2;
8427caff0fcSAndrey Gusakov 		break;
8437caff0fcSAndrey Gusakov 	case 13000000:
8447caff0fcSAndrey Gusakov 		value = REF_FREQ_13M;
8457caff0fcSAndrey Gusakov 		break;
8467caff0fcSAndrey Gusakov 	default:
8477caff0fcSAndrey Gusakov 		return -EINVAL;
8487caff0fcSAndrey Gusakov 	}
8497caff0fcSAndrey Gusakov 	value |= SYSCLK_SEL_LSCLK | LSCLK_DIV_2;
8507caff0fcSAndrey Gusakov 	tc_write(SYS_PLLPARAM, value);
8517caff0fcSAndrey Gusakov 	/* Setup Main Link */
8527caff0fcSAndrey Gusakov 	dp_phy_ctrl = BGREN | PWR_SW_EN | BIT(2) | PHY_A0_EN |  PHY_M0_EN;
8537caff0fcSAndrey Gusakov 	tc_write(DP_PHY_CTRL, dp_phy_ctrl);
8547caff0fcSAndrey Gusakov 	msleep(100);
8557caff0fcSAndrey Gusakov 
8567caff0fcSAndrey Gusakov 	/* PLL setup */
8577caff0fcSAndrey Gusakov 	tc_write(DP0_PLLCTRL, PLLUPDATE | PLLEN);
8587caff0fcSAndrey Gusakov 	tc_wait_pll_lock(tc);
8597caff0fcSAndrey Gusakov 
8607caff0fcSAndrey Gusakov 	tc_write(DP1_PLLCTRL, PLLUPDATE | PLLEN);
8617caff0fcSAndrey Gusakov 	tc_wait_pll_lock(tc);
8627caff0fcSAndrey Gusakov 
8637caff0fcSAndrey Gusakov 	/* PXL PLL setup */
8647caff0fcSAndrey Gusakov 	if (tc_test_pattern) {
8657caff0fcSAndrey Gusakov 		ret = tc_pxl_pll_en(tc, clk_get_rate(tc->refclk),
8667caff0fcSAndrey Gusakov 				    1000 * tc->mode->clock);
8677caff0fcSAndrey Gusakov 		if (ret)
8687caff0fcSAndrey Gusakov 			goto err;
8697caff0fcSAndrey Gusakov 	}
8707caff0fcSAndrey Gusakov 
8717caff0fcSAndrey Gusakov 	/* Reset/Enable Main Links */
8727caff0fcSAndrey Gusakov 	dp_phy_ctrl |= DP_PHY_RST | PHY_M1_RST | PHY_M0_RST;
8737caff0fcSAndrey Gusakov 	tc_write(DP_PHY_CTRL, dp_phy_ctrl);
8747caff0fcSAndrey Gusakov 	usleep_range(100, 200);
8757caff0fcSAndrey Gusakov 	dp_phy_ctrl &= ~(DP_PHY_RST | PHY_M1_RST | PHY_M0_RST);
8767caff0fcSAndrey Gusakov 	tc_write(DP_PHY_CTRL, dp_phy_ctrl);
8777caff0fcSAndrey Gusakov 
8787caff0fcSAndrey Gusakov 	timeout = 1000;
8797caff0fcSAndrey Gusakov 	do {
8807caff0fcSAndrey Gusakov 		tc_read(DP_PHY_CTRL, &value);
8817caff0fcSAndrey Gusakov 		udelay(1);
8827caff0fcSAndrey Gusakov 	} while ((!(value & PHY_RDY)) && (--timeout));
8837caff0fcSAndrey Gusakov 
8847caff0fcSAndrey Gusakov 	if (timeout == 0) {
8857caff0fcSAndrey Gusakov 		dev_err(dev, "timeout waiting for phy become ready");
8867caff0fcSAndrey Gusakov 		return -ETIMEDOUT;
8877caff0fcSAndrey Gusakov 	}
8887caff0fcSAndrey Gusakov 
8897caff0fcSAndrey Gusakov 	/* Set misc: 8 bits per color */
8907caff0fcSAndrey Gusakov 	ret = regmap_update_bits(tc->regmap, DP0_MISC, BPC_8, BPC_8);
8917caff0fcSAndrey Gusakov 	if (ret)
8927caff0fcSAndrey Gusakov 		goto err;
8937caff0fcSAndrey Gusakov 
8947caff0fcSAndrey Gusakov 	/*
8957caff0fcSAndrey Gusakov 	 * ASSR mode
8967caff0fcSAndrey Gusakov 	 * on TC358767 side ASSR configured through strap pin
8977caff0fcSAndrey Gusakov 	 * seems there is no way to change this setting from SW
8987caff0fcSAndrey Gusakov 	 *
8997caff0fcSAndrey Gusakov 	 * check is tc configured for same mode
9007caff0fcSAndrey Gusakov 	 */
9017caff0fcSAndrey Gusakov 	if (tc->assr != tc->link.assr) {
9027caff0fcSAndrey Gusakov 		dev_dbg(dev, "Trying to set display to ASSR: %d\n",
9037caff0fcSAndrey Gusakov 			tc->assr);
9047caff0fcSAndrey Gusakov 		/* try to set ASSR on display side */
9057caff0fcSAndrey Gusakov 		tmp[0] = tc->assr;
9067caff0fcSAndrey Gusakov 		ret = drm_dp_dpcd_writeb(aux, DP_EDP_CONFIGURATION_SET, tmp[0]);
9077caff0fcSAndrey Gusakov 		if (ret < 0)
9087caff0fcSAndrey Gusakov 			goto err_dpcd_read;
9097caff0fcSAndrey Gusakov 		/* read back */
9107caff0fcSAndrey Gusakov 		ret = drm_dp_dpcd_readb(aux, DP_EDP_CONFIGURATION_SET, tmp);
9117caff0fcSAndrey Gusakov 		if (ret < 0)
9127caff0fcSAndrey Gusakov 			goto err_dpcd_read;
9137caff0fcSAndrey Gusakov 
9147caff0fcSAndrey Gusakov 		if (tmp[0] != tc->assr) {
91587291e5dSLucas Stach 			dev_dbg(dev, "Failed to switch display ASSR to %d, falling back to unscrambled mode\n",
9167caff0fcSAndrey Gusakov 				 tc->assr);
9177caff0fcSAndrey Gusakov 			/* trying with disabled scrambler */
9187caff0fcSAndrey Gusakov 			tc->link.scrambler_dis = 1;
9197caff0fcSAndrey Gusakov 		}
9207caff0fcSAndrey Gusakov 	}
9217caff0fcSAndrey Gusakov 
9227caff0fcSAndrey Gusakov 	/* Setup Link & DPRx Config for Training */
9237caff0fcSAndrey Gusakov 	ret = drm_dp_link_configure(aux, &tc->link.base);
9247caff0fcSAndrey Gusakov 	if (ret < 0)
9257caff0fcSAndrey Gusakov 		goto err_dpcd_write;
9267caff0fcSAndrey Gusakov 
9277caff0fcSAndrey Gusakov 	/* DOWNSPREAD_CTRL */
9287caff0fcSAndrey Gusakov 	tmp[0] = tc->link.spread ? DP_SPREAD_AMP_0_5 : 0x00;
9297caff0fcSAndrey Gusakov 	/* MAIN_LINK_CHANNEL_CODING_SET */
9307caff0fcSAndrey Gusakov 	tmp[1] =  tc->link.coding8b10b ? DP_SET_ANSI_8B10B : 0x00;
9317caff0fcSAndrey Gusakov 	ret = drm_dp_dpcd_write(aux, DP_DOWNSPREAD_CTRL, tmp, 2);
9327caff0fcSAndrey Gusakov 	if (ret < 0)
9337caff0fcSAndrey Gusakov 		goto err_dpcd_write;
9347caff0fcSAndrey Gusakov 
9357caff0fcSAndrey Gusakov 	ret = tc_link_training(tc, DP_TRAINING_PATTERN_1);
9367caff0fcSAndrey Gusakov 	if (ret)
9377caff0fcSAndrey Gusakov 		goto err;
9387caff0fcSAndrey Gusakov 
9397caff0fcSAndrey Gusakov 	ret = tc_link_training(tc, DP_TRAINING_PATTERN_2);
9407caff0fcSAndrey Gusakov 	if (ret)
9417caff0fcSAndrey Gusakov 		goto err;
9427caff0fcSAndrey Gusakov 
9437caff0fcSAndrey Gusakov 	/* Clear DPCD 0x102 */
9447caff0fcSAndrey Gusakov 	/* Note: Can Not use DP0_SNKLTCTRL (0x06E4) short cut */
9457caff0fcSAndrey Gusakov 	tmp[0] = tc->link.scrambler_dis ? DP_LINK_SCRAMBLING_DISABLE : 0x00;
9467caff0fcSAndrey Gusakov 	ret = drm_dp_dpcd_writeb(aux, DP_TRAINING_PATTERN_SET, tmp[0]);
9477caff0fcSAndrey Gusakov 	if (ret < 0)
9487caff0fcSAndrey Gusakov 		goto err_dpcd_write;
9497caff0fcSAndrey Gusakov 
9507caff0fcSAndrey Gusakov 	/* Clear Training Pattern, set AutoCorrect Mode = 1 */
9517caff0fcSAndrey Gusakov 	tc_write(DP0_SRCCTRL, tc_srcctrl(tc) | DP0_SRCCTRL_AUTOCORRECT);
9527caff0fcSAndrey Gusakov 
9537caff0fcSAndrey Gusakov 	/* Wait */
9547caff0fcSAndrey Gusakov 	timeout = 100;
9557caff0fcSAndrey Gusakov 	do {
9567caff0fcSAndrey Gusakov 		udelay(1);
9577caff0fcSAndrey Gusakov 		/* Read DPCD 0x202-0x207 */
9587caff0fcSAndrey Gusakov 		ret = drm_dp_dpcd_read_link_status(aux, tmp + 2);
9597caff0fcSAndrey Gusakov 		if (ret < 0)
9607caff0fcSAndrey Gusakov 			goto err_dpcd_read;
9617caff0fcSAndrey Gusakov 		ready = (tmp[2] == ((DP_CHANNEL_EQ_BITS << 4) | /* Lane1 */
9627caff0fcSAndrey Gusakov 				     DP_CHANNEL_EQ_BITS));      /* Lane0 */
9637caff0fcSAndrey Gusakov 		aligned = tmp[4] & DP_INTERLANE_ALIGN_DONE;
9647caff0fcSAndrey Gusakov 	} while ((--timeout) && !(ready && aligned));
9657caff0fcSAndrey Gusakov 
9667caff0fcSAndrey Gusakov 	if (timeout == 0) {
9677caff0fcSAndrey Gusakov 		/* Read DPCD 0x200-0x201 */
9687caff0fcSAndrey Gusakov 		ret = drm_dp_dpcd_read(aux, DP_SINK_COUNT, tmp, 2);
9697caff0fcSAndrey Gusakov 		if (ret < 0)
9707caff0fcSAndrey Gusakov 			goto err_dpcd_read;
9717caff0fcSAndrey Gusakov 		dev_info(dev, "0x0200 SINK_COUNT: 0x%02x\n", tmp[0]);
9727caff0fcSAndrey Gusakov 		dev_info(dev, "0x0201 DEVICE_SERVICE_IRQ_VECTOR: 0x%02x\n",
9737caff0fcSAndrey Gusakov 			 tmp[1]);
9747caff0fcSAndrey Gusakov 		dev_info(dev, "0x0202 LANE0_1_STATUS: 0x%02x\n", tmp[2]);
9757caff0fcSAndrey Gusakov 		dev_info(dev, "0x0204 LANE_ALIGN_STATUS_UPDATED: 0x%02x\n",
9767caff0fcSAndrey Gusakov 			 tmp[4]);
9777caff0fcSAndrey Gusakov 		dev_info(dev, "0x0205 SINK_STATUS: 0x%02x\n", tmp[5]);
9787caff0fcSAndrey Gusakov 		dev_info(dev, "0x0206 ADJUST_REQUEST_LANE0_1: 0x%02x\n",
9797caff0fcSAndrey Gusakov 			 tmp[6]);
9807caff0fcSAndrey Gusakov 
9817caff0fcSAndrey Gusakov 		if (!ready)
9827caff0fcSAndrey Gusakov 			dev_err(dev, "Lane0/1 not ready\n");
9837caff0fcSAndrey Gusakov 		if (!aligned)
9847caff0fcSAndrey Gusakov 			dev_err(dev, "Lane0/1 not aligned\n");
9857caff0fcSAndrey Gusakov 		return -EAGAIN;
9867caff0fcSAndrey Gusakov 	}
9877caff0fcSAndrey Gusakov 
9887caff0fcSAndrey Gusakov 	ret = tc_set_video_mode(tc, tc->mode);
9897caff0fcSAndrey Gusakov 	if (ret)
9907caff0fcSAndrey Gusakov 		goto err;
9917caff0fcSAndrey Gusakov 
9927caff0fcSAndrey Gusakov 	/* Set M/N */
9937caff0fcSAndrey Gusakov 	ret = tc_stream_clock_calc(tc);
9947caff0fcSAndrey Gusakov 	if (ret)
9957caff0fcSAndrey Gusakov 		goto err;
9967caff0fcSAndrey Gusakov 
9977caff0fcSAndrey Gusakov 	return 0;
9987caff0fcSAndrey Gusakov err_dpcd_read:
9997caff0fcSAndrey Gusakov 	dev_err(tc->dev, "Failed to read DPCD: %d\n", ret);
10007caff0fcSAndrey Gusakov 	return ret;
10017caff0fcSAndrey Gusakov err_dpcd_write:
10027caff0fcSAndrey Gusakov 	dev_err(tc->dev, "Failed to write DPCD: %d\n", ret);
10037caff0fcSAndrey Gusakov err:
10047caff0fcSAndrey Gusakov 	return ret;
10057caff0fcSAndrey Gusakov }
10067caff0fcSAndrey Gusakov 
10077caff0fcSAndrey Gusakov static int tc_main_link_stream(struct tc_data *tc, int state)
10087caff0fcSAndrey Gusakov {
10097caff0fcSAndrey Gusakov 	int ret;
10107caff0fcSAndrey Gusakov 	u32 value;
10117caff0fcSAndrey Gusakov 
10127caff0fcSAndrey Gusakov 	dev_dbg(tc->dev, "stream: %d\n", state);
10137caff0fcSAndrey Gusakov 
10147caff0fcSAndrey Gusakov 	if (state) {
10157caff0fcSAndrey Gusakov 		value = VID_MN_GEN | DP_EN;
10167caff0fcSAndrey Gusakov 		if (tc->link.base.capabilities & DP_LINK_CAP_ENHANCED_FRAMING)
10177caff0fcSAndrey Gusakov 			value |= EF_EN;
10187caff0fcSAndrey Gusakov 		tc_write(DP0CTL, value);
10197caff0fcSAndrey Gusakov 		/*
10207caff0fcSAndrey Gusakov 		 * VID_EN assertion should be delayed by at least N * LSCLK
10217caff0fcSAndrey Gusakov 		 * cycles from the time VID_MN_GEN is enabled in order to
10227caff0fcSAndrey Gusakov 		 * generate stable values for VID_M. LSCLK is 270 MHz or
10237caff0fcSAndrey Gusakov 		 * 162 MHz, VID_N is set to 32768 in  tc_stream_clock_calc(),
10247caff0fcSAndrey Gusakov 		 * so a delay of at least 203 us should suffice.
10257caff0fcSAndrey Gusakov 		 */
10267caff0fcSAndrey Gusakov 		usleep_range(500, 1000);
10277caff0fcSAndrey Gusakov 		value |= VID_EN;
10287caff0fcSAndrey Gusakov 		tc_write(DP0CTL, value);
10297caff0fcSAndrey Gusakov 		/* Set input interface */
10307caff0fcSAndrey Gusakov 		value = DP0_AUDSRC_NO_INPUT;
10317caff0fcSAndrey Gusakov 		if (tc_test_pattern)
10327caff0fcSAndrey Gusakov 			value |= DP0_VIDSRC_COLOR_BAR;
10337caff0fcSAndrey Gusakov 		else
10347caff0fcSAndrey Gusakov 			value |= DP0_VIDSRC_DPI_RX;
10357caff0fcSAndrey Gusakov 		tc_write(SYSCTRL, value);
10367caff0fcSAndrey Gusakov 	} else {
10377caff0fcSAndrey Gusakov 		tc_write(DP0CTL, 0);
10387caff0fcSAndrey Gusakov 	}
10397caff0fcSAndrey Gusakov 
10407caff0fcSAndrey Gusakov 	return 0;
10417caff0fcSAndrey Gusakov err:
10427caff0fcSAndrey Gusakov 	return ret;
10437caff0fcSAndrey Gusakov }
10447caff0fcSAndrey Gusakov 
10457caff0fcSAndrey Gusakov static void tc_bridge_pre_enable(struct drm_bridge *bridge)
10467caff0fcSAndrey Gusakov {
10477caff0fcSAndrey Gusakov 	struct tc_data *tc = bridge_to_tc(bridge);
10487caff0fcSAndrey Gusakov 
10497caff0fcSAndrey Gusakov 	drm_panel_prepare(tc->panel);
10507caff0fcSAndrey Gusakov }
10517caff0fcSAndrey Gusakov 
10527caff0fcSAndrey Gusakov static void tc_bridge_enable(struct drm_bridge *bridge)
10537caff0fcSAndrey Gusakov {
10547caff0fcSAndrey Gusakov 	struct tc_data *tc = bridge_to_tc(bridge);
10557caff0fcSAndrey Gusakov 	int ret;
10567caff0fcSAndrey Gusakov 
10577caff0fcSAndrey Gusakov 	ret = tc_main_link_setup(tc);
10587caff0fcSAndrey Gusakov 	if (ret < 0) {
10597caff0fcSAndrey Gusakov 		dev_err(tc->dev, "main link setup error: %d\n", ret);
10607caff0fcSAndrey Gusakov 		return;
10617caff0fcSAndrey Gusakov 	}
10627caff0fcSAndrey Gusakov 
10637caff0fcSAndrey Gusakov 	ret = tc_main_link_stream(tc, 1);
10647caff0fcSAndrey Gusakov 	if (ret < 0) {
10657caff0fcSAndrey Gusakov 		dev_err(tc->dev, "main link stream start error: %d\n", ret);
10667caff0fcSAndrey Gusakov 		return;
10677caff0fcSAndrey Gusakov 	}
10687caff0fcSAndrey Gusakov 
10697caff0fcSAndrey Gusakov 	drm_panel_enable(tc->panel);
10707caff0fcSAndrey Gusakov }
10717caff0fcSAndrey Gusakov 
10727caff0fcSAndrey Gusakov static void tc_bridge_disable(struct drm_bridge *bridge)
10737caff0fcSAndrey Gusakov {
10747caff0fcSAndrey Gusakov 	struct tc_data *tc = bridge_to_tc(bridge);
10757caff0fcSAndrey Gusakov 	int ret;
10767caff0fcSAndrey Gusakov 
10777caff0fcSAndrey Gusakov 	drm_panel_disable(tc->panel);
10787caff0fcSAndrey Gusakov 
10797caff0fcSAndrey Gusakov 	ret = tc_main_link_stream(tc, 0);
10807caff0fcSAndrey Gusakov 	if (ret < 0)
10817caff0fcSAndrey Gusakov 		dev_err(tc->dev, "main link stream stop error: %d\n", ret);
10827caff0fcSAndrey Gusakov }
10837caff0fcSAndrey Gusakov 
10847caff0fcSAndrey Gusakov static void tc_bridge_post_disable(struct drm_bridge *bridge)
10857caff0fcSAndrey Gusakov {
10867caff0fcSAndrey Gusakov 	struct tc_data *tc = bridge_to_tc(bridge);
10877caff0fcSAndrey Gusakov 
10887caff0fcSAndrey Gusakov 	drm_panel_unprepare(tc->panel);
10897caff0fcSAndrey Gusakov }
10907caff0fcSAndrey Gusakov 
10917caff0fcSAndrey Gusakov static bool tc_bridge_mode_fixup(struct drm_bridge *bridge,
10927caff0fcSAndrey Gusakov 				 const struct drm_display_mode *mode,
10937caff0fcSAndrey Gusakov 				 struct drm_display_mode *adj)
10947caff0fcSAndrey Gusakov {
10957caff0fcSAndrey Gusakov 	/* Fixup sync polarities, both hsync and vsync are active low */
10967caff0fcSAndrey Gusakov 	adj->flags = mode->flags;
10977caff0fcSAndrey Gusakov 	adj->flags |= (DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC);
10987caff0fcSAndrey Gusakov 	adj->flags &= ~(DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC);
10997caff0fcSAndrey Gusakov 
11007caff0fcSAndrey Gusakov 	return true;
11017caff0fcSAndrey Gusakov }
11027caff0fcSAndrey Gusakov 
11037caff0fcSAndrey Gusakov static int tc_connector_mode_valid(struct drm_connector *connector,
11047caff0fcSAndrey Gusakov 				   struct drm_display_mode *mode)
11057caff0fcSAndrey Gusakov {
1106*99fc8e96SAndrey Gusakov 	/* DPI interface clock limitation: upto 154 MHz */
1107*99fc8e96SAndrey Gusakov 	if (mode->clock > 154000)
1108*99fc8e96SAndrey Gusakov 		return MODE_CLOCK_HIGH;
1109*99fc8e96SAndrey Gusakov 
11107caff0fcSAndrey Gusakov 	return MODE_OK;
11117caff0fcSAndrey Gusakov }
11127caff0fcSAndrey Gusakov 
11137caff0fcSAndrey Gusakov static void tc_bridge_mode_set(struct drm_bridge *bridge,
11147caff0fcSAndrey Gusakov 			       struct drm_display_mode *mode,
11157caff0fcSAndrey Gusakov 			       struct drm_display_mode *adj)
11167caff0fcSAndrey Gusakov {
11177caff0fcSAndrey Gusakov 	struct tc_data *tc = bridge_to_tc(bridge);
11187caff0fcSAndrey Gusakov 
11197caff0fcSAndrey Gusakov 	tc->mode = mode;
11207caff0fcSAndrey Gusakov }
11217caff0fcSAndrey Gusakov 
11227caff0fcSAndrey Gusakov static int tc_connector_get_modes(struct drm_connector *connector)
11237caff0fcSAndrey Gusakov {
11247caff0fcSAndrey Gusakov 	struct tc_data *tc = connector_to_tc(connector);
11257caff0fcSAndrey Gusakov 	struct edid *edid;
11267caff0fcSAndrey Gusakov 	unsigned int count;
11277caff0fcSAndrey Gusakov 
11287caff0fcSAndrey Gusakov 	if (tc->panel && tc->panel->funcs && tc->panel->funcs->get_modes) {
11297caff0fcSAndrey Gusakov 		count = tc->panel->funcs->get_modes(tc->panel);
11307caff0fcSAndrey Gusakov 		if (count > 0)
11317caff0fcSAndrey Gusakov 			return count;
11327caff0fcSAndrey Gusakov 	}
11337caff0fcSAndrey Gusakov 
11347caff0fcSAndrey Gusakov 	edid = drm_get_edid(connector, &tc->aux.ddc);
11357caff0fcSAndrey Gusakov 
11367caff0fcSAndrey Gusakov 	kfree(tc->edid);
11377caff0fcSAndrey Gusakov 	tc->edid = edid;
11387caff0fcSAndrey Gusakov 	if (!edid)
11397caff0fcSAndrey Gusakov 		return 0;
11407caff0fcSAndrey Gusakov 
11417caff0fcSAndrey Gusakov 	drm_mode_connector_update_edid_property(connector, edid);
11427caff0fcSAndrey Gusakov 	count = drm_add_edid_modes(connector, edid);
11437caff0fcSAndrey Gusakov 
11447caff0fcSAndrey Gusakov 	return count;
11457caff0fcSAndrey Gusakov }
11467caff0fcSAndrey Gusakov 
11477caff0fcSAndrey Gusakov static void tc_connector_set_polling(struct tc_data *tc,
11487caff0fcSAndrey Gusakov 				     struct drm_connector *connector)
11497caff0fcSAndrey Gusakov {
11507caff0fcSAndrey Gusakov 	/* TODO: add support for HPD */
11517caff0fcSAndrey Gusakov 	connector->polled = DRM_CONNECTOR_POLL_CONNECT |
11527caff0fcSAndrey Gusakov 			    DRM_CONNECTOR_POLL_DISCONNECT;
11537caff0fcSAndrey Gusakov }
11547caff0fcSAndrey Gusakov 
11557caff0fcSAndrey Gusakov static struct drm_encoder *
11567caff0fcSAndrey Gusakov tc_connector_best_encoder(struct drm_connector *connector)
11577caff0fcSAndrey Gusakov {
11587caff0fcSAndrey Gusakov 	struct tc_data *tc = connector_to_tc(connector);
11597caff0fcSAndrey Gusakov 
11607caff0fcSAndrey Gusakov 	return tc->bridge.encoder;
11617caff0fcSAndrey Gusakov }
11627caff0fcSAndrey Gusakov 
11637caff0fcSAndrey Gusakov static const struct drm_connector_helper_funcs tc_connector_helper_funcs = {
11647caff0fcSAndrey Gusakov 	.get_modes = tc_connector_get_modes,
11657caff0fcSAndrey Gusakov 	.mode_valid = tc_connector_mode_valid,
11667caff0fcSAndrey Gusakov 	.best_encoder = tc_connector_best_encoder,
11677caff0fcSAndrey Gusakov };
11687caff0fcSAndrey Gusakov 
11697caff0fcSAndrey Gusakov static const struct drm_connector_funcs tc_connector_funcs = {
11707caff0fcSAndrey Gusakov 	.fill_modes = drm_helper_probe_single_connector_modes,
1171fdd8326aSMarek Vasut 	.destroy = drm_connector_cleanup,
11727caff0fcSAndrey Gusakov 	.reset = drm_atomic_helper_connector_reset,
11737caff0fcSAndrey Gusakov 	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
11747caff0fcSAndrey Gusakov 	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
11757caff0fcSAndrey Gusakov };
11767caff0fcSAndrey Gusakov 
11777caff0fcSAndrey Gusakov static int tc_bridge_attach(struct drm_bridge *bridge)
11787caff0fcSAndrey Gusakov {
11797caff0fcSAndrey Gusakov 	u32 bus_format = MEDIA_BUS_FMT_RGB888_1X24;
11807caff0fcSAndrey Gusakov 	struct tc_data *tc = bridge_to_tc(bridge);
11817caff0fcSAndrey Gusakov 	struct drm_device *drm = bridge->dev;
11827caff0fcSAndrey Gusakov 	int ret;
11837caff0fcSAndrey Gusakov 
11847caff0fcSAndrey Gusakov 	/* Create eDP connector */
11857caff0fcSAndrey Gusakov 	drm_connector_helper_add(&tc->connector, &tc_connector_helper_funcs);
11867caff0fcSAndrey Gusakov 	ret = drm_connector_init(drm, &tc->connector, &tc_connector_funcs,
11877caff0fcSAndrey Gusakov 				 DRM_MODE_CONNECTOR_eDP);
11887caff0fcSAndrey Gusakov 	if (ret)
11897caff0fcSAndrey Gusakov 		return ret;
11907caff0fcSAndrey Gusakov 
11917caff0fcSAndrey Gusakov 	if (tc->panel)
11927caff0fcSAndrey Gusakov 		drm_panel_attach(tc->panel, &tc->connector);
11937caff0fcSAndrey Gusakov 
11947caff0fcSAndrey Gusakov 	drm_display_info_set_bus_formats(&tc->connector.display_info,
11957caff0fcSAndrey Gusakov 					 &bus_format, 1);
11967caff0fcSAndrey Gusakov 	drm_mode_connector_attach_encoder(&tc->connector, tc->bridge.encoder);
11977caff0fcSAndrey Gusakov 
11987caff0fcSAndrey Gusakov 	return 0;
11997caff0fcSAndrey Gusakov }
12007caff0fcSAndrey Gusakov 
12017caff0fcSAndrey Gusakov static const struct drm_bridge_funcs tc_bridge_funcs = {
12027caff0fcSAndrey Gusakov 	.attach = tc_bridge_attach,
12037caff0fcSAndrey Gusakov 	.mode_set = tc_bridge_mode_set,
12047caff0fcSAndrey Gusakov 	.pre_enable = tc_bridge_pre_enable,
12057caff0fcSAndrey Gusakov 	.enable = tc_bridge_enable,
12067caff0fcSAndrey Gusakov 	.disable = tc_bridge_disable,
12077caff0fcSAndrey Gusakov 	.post_disable = tc_bridge_post_disable,
12087caff0fcSAndrey Gusakov 	.mode_fixup = tc_bridge_mode_fixup,
12097caff0fcSAndrey Gusakov };
12107caff0fcSAndrey Gusakov 
12117caff0fcSAndrey Gusakov static bool tc_readable_reg(struct device *dev, unsigned int reg)
12127caff0fcSAndrey Gusakov {
12137caff0fcSAndrey Gusakov 	return reg != SYSCTRL;
12147caff0fcSAndrey Gusakov }
12157caff0fcSAndrey Gusakov 
12167caff0fcSAndrey Gusakov static const struct regmap_range tc_volatile_ranges[] = {
12177caff0fcSAndrey Gusakov 	regmap_reg_range(DP0_AUXWDATA(0), DP0_AUXSTATUS),
12187caff0fcSAndrey Gusakov 	regmap_reg_range(DP0_LTSTAT, DP0_SNKLTCHGREQ),
12197caff0fcSAndrey Gusakov 	regmap_reg_range(DP_PHY_CTRL, DP_PHY_CTRL),
12207caff0fcSAndrey Gusakov 	regmap_reg_range(DP0_PLLCTRL, PXL_PLLCTRL),
12217caff0fcSAndrey Gusakov 	regmap_reg_range(VFUEN0, VFUEN0),
12227caff0fcSAndrey Gusakov };
12237caff0fcSAndrey Gusakov 
12247caff0fcSAndrey Gusakov static const struct regmap_access_table tc_volatile_table = {
12257caff0fcSAndrey Gusakov 	.yes_ranges = tc_volatile_ranges,
12267caff0fcSAndrey Gusakov 	.n_yes_ranges = ARRAY_SIZE(tc_volatile_ranges),
12277caff0fcSAndrey Gusakov };
12287caff0fcSAndrey Gusakov 
12297caff0fcSAndrey Gusakov static bool tc_writeable_reg(struct device *dev, unsigned int reg)
12307caff0fcSAndrey Gusakov {
12317caff0fcSAndrey Gusakov 	return (reg != TC_IDREG) &&
12327caff0fcSAndrey Gusakov 	       (reg != DP0_LTSTAT) &&
12337caff0fcSAndrey Gusakov 	       (reg != DP0_SNKLTCHGREQ);
12347caff0fcSAndrey Gusakov }
12357caff0fcSAndrey Gusakov 
12367caff0fcSAndrey Gusakov static const struct regmap_config tc_regmap_config = {
12377caff0fcSAndrey Gusakov 	.name = "tc358767",
12387caff0fcSAndrey Gusakov 	.reg_bits = 16,
12397caff0fcSAndrey Gusakov 	.val_bits = 32,
12407caff0fcSAndrey Gusakov 	.reg_stride = 4,
12417caff0fcSAndrey Gusakov 	.max_register = PLL_DBG,
12427caff0fcSAndrey Gusakov 	.cache_type = REGCACHE_RBTREE,
12437caff0fcSAndrey Gusakov 	.readable_reg = tc_readable_reg,
12447caff0fcSAndrey Gusakov 	.volatile_table = &tc_volatile_table,
12457caff0fcSAndrey Gusakov 	.writeable_reg = tc_writeable_reg,
12467caff0fcSAndrey Gusakov 	.reg_format_endian = REGMAP_ENDIAN_BIG,
12477caff0fcSAndrey Gusakov 	.val_format_endian = REGMAP_ENDIAN_LITTLE,
12487caff0fcSAndrey Gusakov };
12497caff0fcSAndrey Gusakov 
12507caff0fcSAndrey Gusakov static int tc_probe(struct i2c_client *client, const struct i2c_device_id *id)
12517caff0fcSAndrey Gusakov {
12527caff0fcSAndrey Gusakov 	struct device *dev = &client->dev;
12537caff0fcSAndrey Gusakov 	struct tc_data *tc;
12547caff0fcSAndrey Gusakov 	int ret;
12557caff0fcSAndrey Gusakov 
12567caff0fcSAndrey Gusakov 	tc = devm_kzalloc(dev, sizeof(*tc), GFP_KERNEL);
12577caff0fcSAndrey Gusakov 	if (!tc)
12587caff0fcSAndrey Gusakov 		return -ENOMEM;
12597caff0fcSAndrey Gusakov 
12607caff0fcSAndrey Gusakov 	tc->dev = dev;
12617caff0fcSAndrey Gusakov 
12627caff0fcSAndrey Gusakov 	/* port@2 is the output port */
1263ebc94461SRob Herring 	ret = drm_of_find_panel_or_bridge(dev->of_node, 2, 0, &tc->panel, NULL);
1264d630213fSLucas Stach 	if (ret && ret != -ENODEV)
1265ebc94461SRob Herring 		return ret;
12667caff0fcSAndrey Gusakov 
12677caff0fcSAndrey Gusakov 	/* Shut down GPIO is optional */
12687caff0fcSAndrey Gusakov 	tc->sd_gpio = devm_gpiod_get_optional(dev, "shutdown", GPIOD_OUT_HIGH);
12697caff0fcSAndrey Gusakov 	if (IS_ERR(tc->sd_gpio))
12707caff0fcSAndrey Gusakov 		return PTR_ERR(tc->sd_gpio);
12717caff0fcSAndrey Gusakov 
12727caff0fcSAndrey Gusakov 	if (tc->sd_gpio) {
12737caff0fcSAndrey Gusakov 		gpiod_set_value_cansleep(tc->sd_gpio, 0);
12747caff0fcSAndrey Gusakov 		usleep_range(5000, 10000);
12757caff0fcSAndrey Gusakov 	}
12767caff0fcSAndrey Gusakov 
12777caff0fcSAndrey Gusakov 	/* Reset GPIO is optional */
12787caff0fcSAndrey Gusakov 	tc->reset_gpio = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
12797caff0fcSAndrey Gusakov 	if (IS_ERR(tc->reset_gpio))
12807caff0fcSAndrey Gusakov 		return PTR_ERR(tc->reset_gpio);
12817caff0fcSAndrey Gusakov 
12827caff0fcSAndrey Gusakov 	if (tc->reset_gpio) {
12837caff0fcSAndrey Gusakov 		gpiod_set_value_cansleep(tc->reset_gpio, 1);
12847caff0fcSAndrey Gusakov 		usleep_range(5000, 10000);
12857caff0fcSAndrey Gusakov 	}
12867caff0fcSAndrey Gusakov 
12877caff0fcSAndrey Gusakov 	tc->refclk = devm_clk_get(dev, "ref");
12887caff0fcSAndrey Gusakov 	if (IS_ERR(tc->refclk)) {
12897caff0fcSAndrey Gusakov 		ret = PTR_ERR(tc->refclk);
12907caff0fcSAndrey Gusakov 		dev_err(dev, "Failed to get refclk: %d\n", ret);
12917caff0fcSAndrey Gusakov 		return ret;
12927caff0fcSAndrey Gusakov 	}
12937caff0fcSAndrey Gusakov 
12947caff0fcSAndrey Gusakov 	tc->regmap = devm_regmap_init_i2c(client, &tc_regmap_config);
12957caff0fcSAndrey Gusakov 	if (IS_ERR(tc->regmap)) {
12967caff0fcSAndrey Gusakov 		ret = PTR_ERR(tc->regmap);
12977caff0fcSAndrey Gusakov 		dev_err(dev, "Failed to initialize regmap: %d\n", ret);
12987caff0fcSAndrey Gusakov 		return ret;
12997caff0fcSAndrey Gusakov 	}
13007caff0fcSAndrey Gusakov 
13017caff0fcSAndrey Gusakov 	ret = regmap_read(tc->regmap, TC_IDREG, &tc->rev);
13027caff0fcSAndrey Gusakov 	if (ret) {
13037caff0fcSAndrey Gusakov 		dev_err(tc->dev, "can not read device ID: %d\n", ret);
13047caff0fcSAndrey Gusakov 		return ret;
13057caff0fcSAndrey Gusakov 	}
13067caff0fcSAndrey Gusakov 
13077caff0fcSAndrey Gusakov 	if ((tc->rev != 0x6601) && (tc->rev != 0x6603)) {
13087caff0fcSAndrey Gusakov 		dev_err(tc->dev, "invalid device ID: 0x%08x\n", tc->rev);
13097caff0fcSAndrey Gusakov 		return -EINVAL;
13107caff0fcSAndrey Gusakov 	}
13117caff0fcSAndrey Gusakov 
13127caff0fcSAndrey Gusakov 	tc->assr = (tc->rev == 0x6601); /* Enable ASSR for eDP panels */
13137caff0fcSAndrey Gusakov 
13147caff0fcSAndrey Gusakov 	ret = tc_aux_link_setup(tc);
13157caff0fcSAndrey Gusakov 	if (ret)
13167caff0fcSAndrey Gusakov 		return ret;
13177caff0fcSAndrey Gusakov 
13187caff0fcSAndrey Gusakov 	/* Register DP AUX channel */
13197caff0fcSAndrey Gusakov 	tc->aux.name = "TC358767 AUX i2c adapter";
13207caff0fcSAndrey Gusakov 	tc->aux.dev = tc->dev;
13217caff0fcSAndrey Gusakov 	tc->aux.transfer = tc_aux_transfer;
13227caff0fcSAndrey Gusakov 	ret = drm_dp_aux_register(&tc->aux);
13237caff0fcSAndrey Gusakov 	if (ret)
13247caff0fcSAndrey Gusakov 		return ret;
13257caff0fcSAndrey Gusakov 
13267caff0fcSAndrey Gusakov 	ret = tc_get_display_props(tc);
13277caff0fcSAndrey Gusakov 	if (ret)
13287caff0fcSAndrey Gusakov 		goto err_unregister_aux;
13297caff0fcSAndrey Gusakov 
13307caff0fcSAndrey Gusakov 	tc_connector_set_polling(tc, &tc->connector);
13317caff0fcSAndrey Gusakov 
13327caff0fcSAndrey Gusakov 	tc->bridge.funcs = &tc_bridge_funcs;
13337caff0fcSAndrey Gusakov 	tc->bridge.of_node = dev->of_node;
1334dc01732eSInki Dae 	drm_bridge_add(&tc->bridge);
13357caff0fcSAndrey Gusakov 
13367caff0fcSAndrey Gusakov 	i2c_set_clientdata(client, tc);
13377caff0fcSAndrey Gusakov 
13387caff0fcSAndrey Gusakov 	return 0;
13397caff0fcSAndrey Gusakov err_unregister_aux:
13407caff0fcSAndrey Gusakov 	drm_dp_aux_unregister(&tc->aux);
13417caff0fcSAndrey Gusakov 	return ret;
13427caff0fcSAndrey Gusakov }
13437caff0fcSAndrey Gusakov 
13447caff0fcSAndrey Gusakov static int tc_remove(struct i2c_client *client)
13457caff0fcSAndrey Gusakov {
13467caff0fcSAndrey Gusakov 	struct tc_data *tc = i2c_get_clientdata(client);
13477caff0fcSAndrey Gusakov 
13487caff0fcSAndrey Gusakov 	drm_bridge_remove(&tc->bridge);
13497caff0fcSAndrey Gusakov 	drm_dp_aux_unregister(&tc->aux);
13507caff0fcSAndrey Gusakov 
13517caff0fcSAndrey Gusakov 	tc_pxl_pll_dis(tc);
13527caff0fcSAndrey Gusakov 
13537caff0fcSAndrey Gusakov 	return 0;
13547caff0fcSAndrey Gusakov }
13557caff0fcSAndrey Gusakov 
13567caff0fcSAndrey Gusakov static const struct i2c_device_id tc358767_i2c_ids[] = {
13577caff0fcSAndrey Gusakov 	{ "tc358767", 0 },
13587caff0fcSAndrey Gusakov 	{ }
13597caff0fcSAndrey Gusakov };
13607caff0fcSAndrey Gusakov MODULE_DEVICE_TABLE(i2c, tc358767_i2c_ids);
13617caff0fcSAndrey Gusakov 
13627caff0fcSAndrey Gusakov static const struct of_device_id tc358767_of_ids[] = {
13637caff0fcSAndrey Gusakov 	{ .compatible = "toshiba,tc358767", },
13647caff0fcSAndrey Gusakov 	{ }
13657caff0fcSAndrey Gusakov };
13667caff0fcSAndrey Gusakov MODULE_DEVICE_TABLE(of, tc358767_of_ids);
13677caff0fcSAndrey Gusakov 
13687caff0fcSAndrey Gusakov static struct i2c_driver tc358767_driver = {
13697caff0fcSAndrey Gusakov 	.driver = {
13707caff0fcSAndrey Gusakov 		.name = "tc358767",
13717caff0fcSAndrey Gusakov 		.of_match_table = tc358767_of_ids,
13727caff0fcSAndrey Gusakov 	},
13737caff0fcSAndrey Gusakov 	.id_table = tc358767_i2c_ids,
13747caff0fcSAndrey Gusakov 	.probe = tc_probe,
13757caff0fcSAndrey Gusakov 	.remove	= tc_remove,
13767caff0fcSAndrey Gusakov };
13777caff0fcSAndrey Gusakov module_i2c_driver(tc358767_driver);
13787caff0fcSAndrey Gusakov 
13797caff0fcSAndrey Gusakov MODULE_AUTHOR("Andrey Gusakov <andrey.gusakov@cogentembedded.com>");
13807caff0fcSAndrey Gusakov MODULE_DESCRIPTION("tc358767 eDP encoder driver");
13817caff0fcSAndrey Gusakov MODULE_LICENSE("GPL");
1382