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