16aa19269SIcenowy Zheng /* SPDX-License-Identifier: GPL-2.0-only */ 26aa19269SIcenowy Zheng /* 36aa19269SIcenowy Zheng * Copyright(c) 2016, Analogix Semiconductor. 46aa19269SIcenowy Zheng * Copyright(c) 2017, Icenowy Zheng <icenowy@aosc.io> 56aa19269SIcenowy Zheng * 66aa19269SIcenowy Zheng * Based on anx7808 driver obtained from chromeos with copyright: 76aa19269SIcenowy Zheng * Copyright(c) 2013, Google Inc. 86aa19269SIcenowy Zheng */ 96aa19269SIcenowy Zheng #include <linux/delay.h> 106aa19269SIcenowy Zheng #include <linux/err.h> 116aa19269SIcenowy Zheng #include <linux/gpio/consumer.h> 126aa19269SIcenowy Zheng #include <linux/i2c.h> 136aa19269SIcenowy Zheng #include <linux/interrupt.h> 146aa19269SIcenowy Zheng #include <linux/kernel.h> 156aa19269SIcenowy Zheng #include <linux/module.h> 166aa19269SIcenowy Zheng #include <linux/of_platform.h> 176aa19269SIcenowy Zheng #include <linux/regmap.h> 186aa19269SIcenowy Zheng #include <linux/regulator/consumer.h> 196aa19269SIcenowy Zheng #include <linux/types.h> 206aa19269SIcenowy Zheng 216aa19269SIcenowy Zheng #include <drm/drm_atomic_helper.h> 22e1cff82cSTorsten Duwe #include <drm/drm_bridge.h> 236aa19269SIcenowy Zheng #include <drm/drm_crtc.h> 246aa19269SIcenowy Zheng #include <drm/drm_crtc_helper.h> 256aa19269SIcenowy Zheng #include <drm/drm_dp_helper.h> 266aa19269SIcenowy Zheng #include <drm/drm_edid.h> 276aa19269SIcenowy Zheng #include <drm/drm_of.h> 286aa19269SIcenowy Zheng #include <drm/drm_panel.h> 296aa19269SIcenowy Zheng #include <drm/drm_print.h> 306aa19269SIcenowy Zheng #include <drm/drm_probe_helper.h> 316aa19269SIcenowy Zheng 326aa19269SIcenowy Zheng #include "analogix-i2c-dptx.h" 336aa19269SIcenowy Zheng #include "analogix-i2c-txcommon.h" 346aa19269SIcenowy Zheng 356aa19269SIcenowy Zheng #define POLL_DELAY 50000 /* us */ 366aa19269SIcenowy Zheng #define POLL_TIMEOUT 5000000 /* us */ 376aa19269SIcenowy Zheng 386aa19269SIcenowy Zheng #define I2C_IDX_DPTX 0 396aa19269SIcenowy Zheng #define I2C_IDX_TXCOM 1 406aa19269SIcenowy Zheng 416aa19269SIcenowy Zheng static const u8 anx6345_i2c_addresses[] = { 426aa19269SIcenowy Zheng [I2C_IDX_DPTX] = 0x70, 436aa19269SIcenowy Zheng [I2C_IDX_TXCOM] = 0x72, 446aa19269SIcenowy Zheng }; 456aa19269SIcenowy Zheng #define I2C_NUM_ADDRESSES ARRAY_SIZE(anx6345_i2c_addresses) 466aa19269SIcenowy Zheng 476aa19269SIcenowy Zheng struct anx6345 { 486aa19269SIcenowy Zheng struct drm_dp_aux aux; 496aa19269SIcenowy Zheng struct drm_bridge bridge; 506aa19269SIcenowy Zheng struct i2c_client *client; 516aa19269SIcenowy Zheng struct edid *edid; 526aa19269SIcenowy Zheng struct drm_connector connector; 536aa19269SIcenowy Zheng struct drm_panel *panel; 546aa19269SIcenowy Zheng struct regulator *dvdd12; 556aa19269SIcenowy Zheng struct regulator *dvdd25; 566aa19269SIcenowy Zheng struct gpio_desc *gpiod_reset; 576aa19269SIcenowy Zheng struct mutex lock; /* protect EDID access */ 586aa19269SIcenowy Zheng 596aa19269SIcenowy Zheng /* I2C Slave addresses of ANX6345 are mapped as DPTX and SYS */ 606aa19269SIcenowy Zheng struct i2c_client *i2c_clients[I2C_NUM_ADDRESSES]; 616aa19269SIcenowy Zheng struct regmap *map[I2C_NUM_ADDRESSES]; 626aa19269SIcenowy Zheng 636aa19269SIcenowy Zheng u16 chipid; 646aa19269SIcenowy Zheng u8 dpcd[DP_RECEIVER_CAP_SIZE]; 656aa19269SIcenowy Zheng 666aa19269SIcenowy Zheng bool powered; 676aa19269SIcenowy Zheng }; 686aa19269SIcenowy Zheng 696aa19269SIcenowy Zheng static inline struct anx6345 *connector_to_anx6345(struct drm_connector *c) 706aa19269SIcenowy Zheng { 716aa19269SIcenowy Zheng return container_of(c, struct anx6345, connector); 726aa19269SIcenowy Zheng } 736aa19269SIcenowy Zheng 746aa19269SIcenowy Zheng static inline struct anx6345 *bridge_to_anx6345(struct drm_bridge *bridge) 756aa19269SIcenowy Zheng { 766aa19269SIcenowy Zheng return container_of(bridge, struct anx6345, bridge); 776aa19269SIcenowy Zheng } 786aa19269SIcenowy Zheng 796aa19269SIcenowy Zheng static int anx6345_set_bits(struct regmap *map, u8 reg, u8 mask) 806aa19269SIcenowy Zheng { 816aa19269SIcenowy Zheng return regmap_update_bits(map, reg, mask, mask); 826aa19269SIcenowy Zheng } 836aa19269SIcenowy Zheng 846aa19269SIcenowy Zheng static int anx6345_clear_bits(struct regmap *map, u8 reg, u8 mask) 856aa19269SIcenowy Zheng { 866aa19269SIcenowy Zheng return regmap_update_bits(map, reg, mask, 0); 876aa19269SIcenowy Zheng } 886aa19269SIcenowy Zheng 896aa19269SIcenowy Zheng static ssize_t anx6345_aux_transfer(struct drm_dp_aux *aux, 906aa19269SIcenowy Zheng struct drm_dp_aux_msg *msg) 916aa19269SIcenowy Zheng { 926aa19269SIcenowy Zheng struct anx6345 *anx6345 = container_of(aux, struct anx6345, aux); 936aa19269SIcenowy Zheng 946aa19269SIcenowy Zheng return anx_dp_aux_transfer(anx6345->map[I2C_IDX_DPTX], msg); 956aa19269SIcenowy Zheng } 966aa19269SIcenowy Zheng 976aa19269SIcenowy Zheng static int anx6345_dp_link_training(struct anx6345 *anx6345) 986aa19269SIcenowy Zheng { 996aa19269SIcenowy Zheng unsigned int value; 100e1cff82cSTorsten Duwe u8 dp_bw, dpcd[2]; 1016aa19269SIcenowy Zheng int err; 1026aa19269SIcenowy Zheng 1036aa19269SIcenowy Zheng err = anx6345_clear_bits(anx6345->map[I2C_IDX_TXCOM], 1046aa19269SIcenowy Zheng SP_POWERDOWN_CTRL_REG, 1056aa19269SIcenowy Zheng SP_TOTAL_PD); 1066aa19269SIcenowy Zheng if (err) 1076aa19269SIcenowy Zheng return err; 1086aa19269SIcenowy Zheng 1096aa19269SIcenowy Zheng err = drm_dp_dpcd_readb(&anx6345->aux, DP_MAX_LINK_RATE, &dp_bw); 1106aa19269SIcenowy Zheng if (err < 0) 1116aa19269SIcenowy Zheng return err; 1126aa19269SIcenowy Zheng 1136aa19269SIcenowy Zheng switch (dp_bw) { 1146aa19269SIcenowy Zheng case DP_LINK_BW_1_62: 1156aa19269SIcenowy Zheng case DP_LINK_BW_2_7: 1166aa19269SIcenowy Zheng break; 1176aa19269SIcenowy Zheng 1186aa19269SIcenowy Zheng default: 1196aa19269SIcenowy Zheng DRM_DEBUG_KMS("DP bandwidth (%#02x) not supported\n", dp_bw); 1206aa19269SIcenowy Zheng return -EINVAL; 1216aa19269SIcenowy Zheng } 1226aa19269SIcenowy Zheng 1236aa19269SIcenowy Zheng err = anx6345_set_bits(anx6345->map[I2C_IDX_TXCOM], SP_VID_CTRL1_REG, 1246aa19269SIcenowy Zheng SP_VIDEO_MUTE); 1256aa19269SIcenowy Zheng if (err) 1266aa19269SIcenowy Zheng return err; 1276aa19269SIcenowy Zheng 1286aa19269SIcenowy Zheng err = anx6345_clear_bits(anx6345->map[I2C_IDX_TXCOM], 1296aa19269SIcenowy Zheng SP_VID_CTRL1_REG, SP_VIDEO_EN); 1306aa19269SIcenowy Zheng if (err) 1316aa19269SIcenowy Zheng return err; 1326aa19269SIcenowy Zheng 1336aa19269SIcenowy Zheng /* Get DPCD info */ 1346aa19269SIcenowy Zheng err = drm_dp_dpcd_read(&anx6345->aux, DP_DPCD_REV, 1356aa19269SIcenowy Zheng &anx6345->dpcd, DP_RECEIVER_CAP_SIZE); 1366aa19269SIcenowy Zheng if (err < 0) { 1376aa19269SIcenowy Zheng DRM_ERROR("Failed to read DPCD: %d\n", err); 1386aa19269SIcenowy Zheng return err; 1396aa19269SIcenowy Zheng } 1406aa19269SIcenowy Zheng 1416aa19269SIcenowy Zheng /* Clear channel x SERDES power down */ 1426aa19269SIcenowy Zheng err = anx6345_clear_bits(anx6345->map[I2C_IDX_DPTX], 1436aa19269SIcenowy Zheng SP_DP_ANALOG_POWER_DOWN_REG, SP_CH0_PD); 1446aa19269SIcenowy Zheng if (err) 1456aa19269SIcenowy Zheng return err; 1466aa19269SIcenowy Zheng 147e1cff82cSTorsten Duwe /* 148e1cff82cSTorsten Duwe * Power up the sink (DP_SET_POWER register is only available on DPCD 149e1cff82cSTorsten Duwe * v1.1 and later). 150e1cff82cSTorsten Duwe */ 151e1cff82cSTorsten Duwe if (anx6345->dpcd[DP_DPCD_REV] >= 0x11) { 152e1cff82cSTorsten Duwe err = drm_dp_dpcd_readb(&anx6345->aux, DP_SET_POWER, &dpcd[0]); 1536aa19269SIcenowy Zheng if (err < 0) { 154e1cff82cSTorsten Duwe DRM_ERROR("Failed to read DP_SET_POWER register: %d\n", 155e1cff82cSTorsten Duwe err); 1566aa19269SIcenowy Zheng return err; 1576aa19269SIcenowy Zheng } 1586aa19269SIcenowy Zheng 159e1cff82cSTorsten Duwe dpcd[0] &= ~DP_SET_POWER_MASK; 160e1cff82cSTorsten Duwe dpcd[0] |= DP_SET_POWER_D0; 161e1cff82cSTorsten Duwe 162e1cff82cSTorsten Duwe err = drm_dp_dpcd_writeb(&anx6345->aux, DP_SET_POWER, dpcd[0]); 1636aa19269SIcenowy Zheng if (err < 0) { 164e1cff82cSTorsten Duwe DRM_ERROR("Failed to power up DisplayPort link: %d\n", 165e1cff82cSTorsten Duwe err); 1666aa19269SIcenowy Zheng return err; 1676aa19269SIcenowy Zheng } 1686aa19269SIcenowy Zheng 169e1cff82cSTorsten Duwe /* 170e1cff82cSTorsten Duwe * According to the DP 1.1 specification, a "Sink Device must 171e1cff82cSTorsten Duwe * exit the power saving state within 1 ms" (Section 2.5.3.1, 172e1cff82cSTorsten Duwe * Table 5-52, "Sink Control Field" (register 0x600). 173e1cff82cSTorsten Duwe */ 174e1cff82cSTorsten Duwe usleep_range(1000, 2000); 175e1cff82cSTorsten Duwe } 176e1cff82cSTorsten Duwe 1776aa19269SIcenowy Zheng /* Possibly enable downspread on the sink */ 1786aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], 1796aa19269SIcenowy Zheng SP_DP_DOWNSPREAD_CTRL1_REG, 0); 1806aa19269SIcenowy Zheng if (err) 1816aa19269SIcenowy Zheng return err; 1826aa19269SIcenowy Zheng 1836aa19269SIcenowy Zheng if (anx6345->dpcd[DP_MAX_DOWNSPREAD] & DP_MAX_DOWNSPREAD_0_5) { 1846aa19269SIcenowy Zheng DRM_DEBUG("Enable downspread on the sink\n"); 1856aa19269SIcenowy Zheng /* 4000PPM */ 1866aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], 1876aa19269SIcenowy Zheng SP_DP_DOWNSPREAD_CTRL1_REG, 8); 1886aa19269SIcenowy Zheng if (err) 1896aa19269SIcenowy Zheng return err; 1906aa19269SIcenowy Zheng 1916aa19269SIcenowy Zheng err = drm_dp_dpcd_writeb(&anx6345->aux, DP_DOWNSPREAD_CTRL, 1926aa19269SIcenowy Zheng DP_SPREAD_AMP_0_5); 1936aa19269SIcenowy Zheng if (err < 0) 1946aa19269SIcenowy Zheng return err; 1956aa19269SIcenowy Zheng } else { 1966aa19269SIcenowy Zheng err = drm_dp_dpcd_writeb(&anx6345->aux, DP_DOWNSPREAD_CTRL, 0); 1976aa19269SIcenowy Zheng if (err < 0) 1986aa19269SIcenowy Zheng return err; 1996aa19269SIcenowy Zheng } 2006aa19269SIcenowy Zheng 2016aa19269SIcenowy Zheng /* Set the lane count and the link rate on the sink */ 2026aa19269SIcenowy Zheng if (drm_dp_enhanced_frame_cap(anx6345->dpcd)) 2036aa19269SIcenowy Zheng err = anx6345_set_bits(anx6345->map[I2C_IDX_DPTX], 2046aa19269SIcenowy Zheng SP_DP_SYSTEM_CTRL_BASE + 4, 2056aa19269SIcenowy Zheng SP_ENHANCED_MODE); 2066aa19269SIcenowy Zheng else 2076aa19269SIcenowy Zheng err = anx6345_clear_bits(anx6345->map[I2C_IDX_DPTX], 2086aa19269SIcenowy Zheng SP_DP_SYSTEM_CTRL_BASE + 4, 2096aa19269SIcenowy Zheng SP_ENHANCED_MODE); 2106aa19269SIcenowy Zheng if (err) 2116aa19269SIcenowy Zheng return err; 2126aa19269SIcenowy Zheng 213e1cff82cSTorsten Duwe dpcd[0] = drm_dp_max_link_rate(anx6345->dpcd); 214e1cff82cSTorsten Duwe dpcd[0] = drm_dp_link_rate_to_bw_code(dpcd[0]); 2156aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], 216e1cff82cSTorsten Duwe SP_DP_MAIN_LINK_BW_SET_REG, dpcd[0]); 2176aa19269SIcenowy Zheng if (err) 2186aa19269SIcenowy Zheng return err; 2196aa19269SIcenowy Zheng 220e1cff82cSTorsten Duwe dpcd[1] = drm_dp_max_lane_count(anx6345->dpcd); 221e1cff82cSTorsten Duwe 2226aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], 223e1cff82cSTorsten Duwe SP_DP_LANE_COUNT_SET_REG, dpcd[1]); 2246aa19269SIcenowy Zheng if (err) 2256aa19269SIcenowy Zheng return err; 2266aa19269SIcenowy Zheng 227e1cff82cSTorsten Duwe if (drm_dp_enhanced_frame_cap(anx6345->dpcd)) 228e1cff82cSTorsten Duwe dpcd[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN; 229e1cff82cSTorsten Duwe 230e1cff82cSTorsten Duwe err = drm_dp_dpcd_write(&anx6345->aux, DP_LINK_BW_SET, dpcd, 231e1cff82cSTorsten Duwe sizeof(dpcd)); 232e1cff82cSTorsten Duwe 2336aa19269SIcenowy Zheng if (err < 0) { 234e1cff82cSTorsten Duwe DRM_ERROR("Failed to configure link: %d\n", err); 2356aa19269SIcenowy Zheng return err; 2366aa19269SIcenowy Zheng } 2376aa19269SIcenowy Zheng 2386aa19269SIcenowy Zheng /* Start training on the source */ 2396aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], SP_DP_LT_CTRL_REG, 2406aa19269SIcenowy Zheng SP_LT_EN); 2416aa19269SIcenowy Zheng if (err) 2426aa19269SIcenowy Zheng return err; 2436aa19269SIcenowy Zheng 2446aa19269SIcenowy Zheng return regmap_read_poll_timeout(anx6345->map[I2C_IDX_DPTX], 2456aa19269SIcenowy Zheng SP_DP_LT_CTRL_REG, 2466aa19269SIcenowy Zheng value, !(value & SP_DP_LT_INPROGRESS), 2476aa19269SIcenowy Zheng POLL_DELAY, POLL_TIMEOUT); 2486aa19269SIcenowy Zheng } 2496aa19269SIcenowy Zheng 2506aa19269SIcenowy Zheng static int anx6345_tx_initialization(struct anx6345 *anx6345) 2516aa19269SIcenowy Zheng { 2526aa19269SIcenowy Zheng int err, i; 2536aa19269SIcenowy Zheng 2546aa19269SIcenowy Zheng /* FIXME: colordepth is hardcoded for now */ 2556aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_TXCOM], SP_VID_CTRL2_REG, 2566aa19269SIcenowy Zheng SP_IN_BPC_6BIT << SP_IN_BPC_SHIFT); 2576aa19269SIcenowy Zheng if (err) 2586aa19269SIcenowy Zheng return err; 2596aa19269SIcenowy Zheng 2606aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], SP_DP_PLL_CTRL_REG, 0); 2616aa19269SIcenowy Zheng if (err) 2626aa19269SIcenowy Zheng return err; 2636aa19269SIcenowy Zheng 2646aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_TXCOM], 2656aa19269SIcenowy Zheng SP_ANALOG_DEBUG1_REG, 0); 2666aa19269SIcenowy Zheng if (err) 2676aa19269SIcenowy Zheng return err; 2686aa19269SIcenowy Zheng 2696aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], 2706aa19269SIcenowy Zheng SP_DP_LINK_DEBUG_CTRL_REG, 2716aa19269SIcenowy Zheng SP_NEW_PRBS7 | SP_M_VID_DEBUG); 2726aa19269SIcenowy Zheng if (err) 2736aa19269SIcenowy Zheng return err; 2746aa19269SIcenowy Zheng 2756aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], 2766aa19269SIcenowy Zheng SP_DP_ANALOG_POWER_DOWN_REG, 0); 2776aa19269SIcenowy Zheng if (err) 2786aa19269SIcenowy Zheng return err; 2796aa19269SIcenowy Zheng 2806aa19269SIcenowy Zheng /* Force HPD */ 2816aa19269SIcenowy Zheng err = anx6345_set_bits(anx6345->map[I2C_IDX_DPTX], 2826aa19269SIcenowy Zheng SP_DP_SYSTEM_CTRL_BASE + 3, 2836aa19269SIcenowy Zheng SP_HPD_FORCE | SP_HPD_CTRL); 2846aa19269SIcenowy Zheng if (err) 2856aa19269SIcenowy Zheng return err; 2866aa19269SIcenowy Zheng 2876aa19269SIcenowy Zheng for (i = 0; i < 4; i++) { 2886aa19269SIcenowy Zheng /* 4 lanes */ 2896aa19269SIcenowy Zheng err = regmap_write(anx6345->map[I2C_IDX_DPTX], 2906aa19269SIcenowy Zheng SP_DP_LANE0_LT_CTRL_REG + i, 0); 2916aa19269SIcenowy Zheng if (err) 2926aa19269SIcenowy Zheng return err; 2936aa19269SIcenowy Zheng } 2946aa19269SIcenowy Zheng 2956aa19269SIcenowy Zheng /* Reset AUX */ 2966aa19269SIcenowy Zheng err = anx6345_set_bits(anx6345->map[I2C_IDX_TXCOM], 2976aa19269SIcenowy Zheng SP_RESET_CTRL2_REG, SP_AUX_RST); 2986aa19269SIcenowy Zheng if (err) 2996aa19269SIcenowy Zheng return err; 3006aa19269SIcenowy Zheng 3016aa19269SIcenowy Zheng return anx6345_clear_bits(anx6345->map[I2C_IDX_TXCOM], 3026aa19269SIcenowy Zheng SP_RESET_CTRL2_REG, SP_AUX_RST); 3036aa19269SIcenowy Zheng } 3046aa19269SIcenowy Zheng 3056aa19269SIcenowy Zheng static void anx6345_poweron(struct anx6345 *anx6345) 3066aa19269SIcenowy Zheng { 3076aa19269SIcenowy Zheng int err; 3086aa19269SIcenowy Zheng 3096aa19269SIcenowy Zheng /* Ensure reset is asserted before starting power on sequence */ 3106aa19269SIcenowy Zheng gpiod_set_value_cansleep(anx6345->gpiod_reset, 1); 3116aa19269SIcenowy Zheng usleep_range(1000, 2000); 3126aa19269SIcenowy Zheng 3136aa19269SIcenowy Zheng err = regulator_enable(anx6345->dvdd12); 3146aa19269SIcenowy Zheng if (err) { 3156aa19269SIcenowy Zheng DRM_ERROR("Failed to enable dvdd12 regulator: %d\n", 3166aa19269SIcenowy Zheng err); 3176aa19269SIcenowy Zheng return; 3186aa19269SIcenowy Zheng } 3196aa19269SIcenowy Zheng 3206aa19269SIcenowy Zheng /* T1 - delay between VDD12 and VDD25 should be 0-2ms */ 3216aa19269SIcenowy Zheng usleep_range(1000, 2000); 3226aa19269SIcenowy Zheng 3236aa19269SIcenowy Zheng err = regulator_enable(anx6345->dvdd25); 3246aa19269SIcenowy Zheng if (err) { 3256aa19269SIcenowy Zheng DRM_ERROR("Failed to enable dvdd25 regulator: %d\n", 3266aa19269SIcenowy Zheng err); 3276aa19269SIcenowy Zheng return; 3286aa19269SIcenowy Zheng } 3296aa19269SIcenowy Zheng 3306aa19269SIcenowy Zheng /* T2 - delay between RESETN and all power rail stable, 3316aa19269SIcenowy Zheng * should be 2-5ms 3326aa19269SIcenowy Zheng */ 3336aa19269SIcenowy Zheng usleep_range(2000, 5000); 3346aa19269SIcenowy Zheng 3356aa19269SIcenowy Zheng gpiod_set_value_cansleep(anx6345->gpiod_reset, 0); 3366aa19269SIcenowy Zheng 3376aa19269SIcenowy Zheng /* Power on registers module */ 3386aa19269SIcenowy Zheng anx6345_set_bits(anx6345->map[I2C_IDX_TXCOM], SP_POWERDOWN_CTRL_REG, 3396aa19269SIcenowy Zheng SP_HDCP_PD | SP_AUDIO_PD | SP_VIDEO_PD | SP_LINK_PD); 3406aa19269SIcenowy Zheng anx6345_clear_bits(anx6345->map[I2C_IDX_TXCOM], SP_POWERDOWN_CTRL_REG, 3416aa19269SIcenowy Zheng SP_REGISTER_PD | SP_TOTAL_PD); 3426aa19269SIcenowy Zheng 3436aa19269SIcenowy Zheng if (anx6345->panel) 3446aa19269SIcenowy Zheng drm_panel_prepare(anx6345->panel); 3456aa19269SIcenowy Zheng 3466aa19269SIcenowy Zheng anx6345->powered = true; 3476aa19269SIcenowy Zheng } 3486aa19269SIcenowy Zheng 3496aa19269SIcenowy Zheng static void anx6345_poweroff(struct anx6345 *anx6345) 3506aa19269SIcenowy Zheng { 3516aa19269SIcenowy Zheng int err; 3526aa19269SIcenowy Zheng 3536aa19269SIcenowy Zheng gpiod_set_value_cansleep(anx6345->gpiod_reset, 1); 3546aa19269SIcenowy Zheng usleep_range(1000, 2000); 3556aa19269SIcenowy Zheng 3566aa19269SIcenowy Zheng if (anx6345->panel) 3576aa19269SIcenowy Zheng drm_panel_unprepare(anx6345->panel); 3586aa19269SIcenowy Zheng 3596aa19269SIcenowy Zheng err = regulator_disable(anx6345->dvdd25); 3606aa19269SIcenowy Zheng if (err) { 3616aa19269SIcenowy Zheng DRM_ERROR("Failed to disable dvdd25 regulator: %d\n", 3626aa19269SIcenowy Zheng err); 3636aa19269SIcenowy Zheng return; 3646aa19269SIcenowy Zheng } 3656aa19269SIcenowy Zheng 3666aa19269SIcenowy Zheng usleep_range(5000, 10000); 3676aa19269SIcenowy Zheng 3686aa19269SIcenowy Zheng err = regulator_disable(anx6345->dvdd12); 3696aa19269SIcenowy Zheng if (err) { 3706aa19269SIcenowy Zheng DRM_ERROR("Failed to disable dvdd12 regulator: %d\n", 3716aa19269SIcenowy Zheng err); 3726aa19269SIcenowy Zheng return; 3736aa19269SIcenowy Zheng } 3746aa19269SIcenowy Zheng 3756aa19269SIcenowy Zheng usleep_range(1000, 2000); 3766aa19269SIcenowy Zheng 3776aa19269SIcenowy Zheng anx6345->powered = false; 3786aa19269SIcenowy Zheng } 3796aa19269SIcenowy Zheng 3806aa19269SIcenowy Zheng static int anx6345_start(struct anx6345 *anx6345) 3816aa19269SIcenowy Zheng { 3826aa19269SIcenowy Zheng int err; 3836aa19269SIcenowy Zheng 3846aa19269SIcenowy Zheng if (!anx6345->powered) 3856aa19269SIcenowy Zheng anx6345_poweron(anx6345); 3866aa19269SIcenowy Zheng 3876aa19269SIcenowy Zheng /* Power on needed modules */ 3886aa19269SIcenowy Zheng err = anx6345_clear_bits(anx6345->map[I2C_IDX_TXCOM], 3896aa19269SIcenowy Zheng SP_POWERDOWN_CTRL_REG, 3906aa19269SIcenowy Zheng SP_VIDEO_PD | SP_LINK_PD); 3916aa19269SIcenowy Zheng 3926aa19269SIcenowy Zheng err = anx6345_tx_initialization(anx6345); 3936aa19269SIcenowy Zheng if (err) { 3946aa19269SIcenowy Zheng DRM_ERROR("Failed eDP transmitter initialization: %d\n", err); 3956aa19269SIcenowy Zheng anx6345_poweroff(anx6345); 3966aa19269SIcenowy Zheng return err; 3976aa19269SIcenowy Zheng } 3986aa19269SIcenowy Zheng 3996aa19269SIcenowy Zheng err = anx6345_dp_link_training(anx6345); 4006aa19269SIcenowy Zheng if (err) { 4016aa19269SIcenowy Zheng DRM_ERROR("Failed link training: %d\n", err); 4026aa19269SIcenowy Zheng anx6345_poweroff(anx6345); 4036aa19269SIcenowy Zheng return err; 4046aa19269SIcenowy Zheng } 4056aa19269SIcenowy Zheng 4066aa19269SIcenowy Zheng /* 4076aa19269SIcenowy Zheng * This delay seems to help keep the hardware in a good state. Without 4086aa19269SIcenowy Zheng * it, there are times where it fails silently. 4096aa19269SIcenowy Zheng */ 4106aa19269SIcenowy Zheng usleep_range(10000, 15000); 4116aa19269SIcenowy Zheng 4126aa19269SIcenowy Zheng return 0; 4136aa19269SIcenowy Zheng } 4146aa19269SIcenowy Zheng 4156aa19269SIcenowy Zheng static int anx6345_config_dp_output(struct anx6345 *anx6345) 4166aa19269SIcenowy Zheng { 4176aa19269SIcenowy Zheng int err; 4186aa19269SIcenowy Zheng 4196aa19269SIcenowy Zheng err = anx6345_clear_bits(anx6345->map[I2C_IDX_TXCOM], SP_VID_CTRL1_REG, 4206aa19269SIcenowy Zheng SP_VIDEO_MUTE); 4216aa19269SIcenowy Zheng if (err) 4226aa19269SIcenowy Zheng return err; 4236aa19269SIcenowy Zheng 4246aa19269SIcenowy Zheng /* Enable DP output */ 4256aa19269SIcenowy Zheng err = anx6345_set_bits(anx6345->map[I2C_IDX_TXCOM], SP_VID_CTRL1_REG, 4266aa19269SIcenowy Zheng SP_VIDEO_EN); 4276aa19269SIcenowy Zheng if (err) 4286aa19269SIcenowy Zheng return err; 4296aa19269SIcenowy Zheng 4306aa19269SIcenowy Zheng /* Force stream valid */ 4316aa19269SIcenowy Zheng return anx6345_set_bits(anx6345->map[I2C_IDX_DPTX], 4326aa19269SIcenowy Zheng SP_DP_SYSTEM_CTRL_BASE + 3, 4336aa19269SIcenowy Zheng SP_STRM_FORCE | SP_STRM_CTRL); 4346aa19269SIcenowy Zheng } 4356aa19269SIcenowy Zheng 4366aa19269SIcenowy Zheng static int anx6345_get_downstream_info(struct anx6345 *anx6345) 4376aa19269SIcenowy Zheng { 4386aa19269SIcenowy Zheng u8 value; 4396aa19269SIcenowy Zheng int err; 4406aa19269SIcenowy Zheng 4416aa19269SIcenowy Zheng err = drm_dp_dpcd_readb(&anx6345->aux, DP_SINK_COUNT, &value); 4426aa19269SIcenowy Zheng if (err < 0) { 4436aa19269SIcenowy Zheng DRM_ERROR("Get sink count failed %d\n", err); 4446aa19269SIcenowy Zheng return err; 4456aa19269SIcenowy Zheng } 4466aa19269SIcenowy Zheng 4476aa19269SIcenowy Zheng if (!DP_GET_SINK_COUNT(value)) { 4486aa19269SIcenowy Zheng DRM_ERROR("Downstream disconnected\n"); 4496aa19269SIcenowy Zheng return -EIO; 4506aa19269SIcenowy Zheng } 4516aa19269SIcenowy Zheng 4526aa19269SIcenowy Zheng return 0; 4536aa19269SIcenowy Zheng } 4546aa19269SIcenowy Zheng 4556aa19269SIcenowy Zheng static int anx6345_get_modes(struct drm_connector *connector) 4566aa19269SIcenowy Zheng { 4576aa19269SIcenowy Zheng struct anx6345 *anx6345 = connector_to_anx6345(connector); 4586aa19269SIcenowy Zheng int err, num_modes = 0; 4596aa19269SIcenowy Zheng bool power_off = false; 4606aa19269SIcenowy Zheng 4616aa19269SIcenowy Zheng mutex_lock(&anx6345->lock); 4626aa19269SIcenowy Zheng 4636aa19269SIcenowy Zheng if (!anx6345->edid) { 4646aa19269SIcenowy Zheng if (!anx6345->powered) { 4656aa19269SIcenowy Zheng anx6345_poweron(anx6345); 4666aa19269SIcenowy Zheng power_off = true; 4676aa19269SIcenowy Zheng } 4686aa19269SIcenowy Zheng 4696aa19269SIcenowy Zheng err = anx6345_get_downstream_info(anx6345); 4706aa19269SIcenowy Zheng if (err) { 4716aa19269SIcenowy Zheng DRM_ERROR("Failed to get downstream info: %d\n", err); 4726aa19269SIcenowy Zheng goto unlock; 4736aa19269SIcenowy Zheng } 4746aa19269SIcenowy Zheng 4756aa19269SIcenowy Zheng anx6345->edid = drm_get_edid(connector, &anx6345->aux.ddc); 4766aa19269SIcenowy Zheng if (!anx6345->edid) 4776aa19269SIcenowy Zheng DRM_ERROR("Failed to read EDID from panel\n"); 4786aa19269SIcenowy Zheng 4796aa19269SIcenowy Zheng err = drm_connector_update_edid_property(connector, 4806aa19269SIcenowy Zheng anx6345->edid); 4816aa19269SIcenowy Zheng if (err) { 4826aa19269SIcenowy Zheng DRM_ERROR("Failed to update EDID property: %d\n", err); 4836aa19269SIcenowy Zheng goto unlock; 4846aa19269SIcenowy Zheng } 4856aa19269SIcenowy Zheng } 4866aa19269SIcenowy Zheng 4876aa19269SIcenowy Zheng num_modes += drm_add_edid_modes(connector, anx6345->edid); 4886aa19269SIcenowy Zheng 4896aa19269SIcenowy Zheng unlock: 4906aa19269SIcenowy Zheng if (power_off) 4916aa19269SIcenowy Zheng anx6345_poweroff(anx6345); 4926aa19269SIcenowy Zheng 4936aa19269SIcenowy Zheng mutex_unlock(&anx6345->lock); 4946aa19269SIcenowy Zheng 4956aa19269SIcenowy Zheng if (!num_modes && anx6345->panel) 49606c4a9c2SSam Ravnborg num_modes += drm_panel_get_modes(anx6345->panel, connector); 4976aa19269SIcenowy Zheng 4986aa19269SIcenowy Zheng return num_modes; 4996aa19269SIcenowy Zheng } 5006aa19269SIcenowy Zheng 5016aa19269SIcenowy Zheng static const struct drm_connector_helper_funcs anx6345_connector_helper_funcs = { 5026aa19269SIcenowy Zheng .get_modes = anx6345_get_modes, 5036aa19269SIcenowy Zheng }; 5046aa19269SIcenowy Zheng 5056aa19269SIcenowy Zheng static void 5066aa19269SIcenowy Zheng anx6345_connector_destroy(struct drm_connector *connector) 5076aa19269SIcenowy Zheng { 5086aa19269SIcenowy Zheng struct anx6345 *anx6345 = connector_to_anx6345(connector); 5096aa19269SIcenowy Zheng 5106aa19269SIcenowy Zheng if (anx6345->panel) 5116aa19269SIcenowy Zheng drm_panel_detach(anx6345->panel); 5126aa19269SIcenowy Zheng drm_connector_cleanup(connector); 5136aa19269SIcenowy Zheng } 5146aa19269SIcenowy Zheng 5156aa19269SIcenowy Zheng static const struct drm_connector_funcs anx6345_connector_funcs = { 5166aa19269SIcenowy Zheng .fill_modes = drm_helper_probe_single_connector_modes, 5176aa19269SIcenowy Zheng .destroy = anx6345_connector_destroy, 5186aa19269SIcenowy Zheng .reset = drm_atomic_helper_connector_reset, 5196aa19269SIcenowy Zheng .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, 5206aa19269SIcenowy Zheng .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, 5216aa19269SIcenowy Zheng }; 5226aa19269SIcenowy Zheng 5236aa19269SIcenowy Zheng static int anx6345_bridge_attach(struct drm_bridge *bridge) 5246aa19269SIcenowy Zheng { 5256aa19269SIcenowy Zheng struct anx6345 *anx6345 = bridge_to_anx6345(bridge); 5266aa19269SIcenowy Zheng int err; 5276aa19269SIcenowy Zheng 5286aa19269SIcenowy Zheng if (!bridge->encoder) { 5296aa19269SIcenowy Zheng DRM_ERROR("Parent encoder object not found"); 5306aa19269SIcenowy Zheng return -ENODEV; 5316aa19269SIcenowy Zheng } 5326aa19269SIcenowy Zheng 5336aa19269SIcenowy Zheng /* Register aux channel */ 5346aa19269SIcenowy Zheng anx6345->aux.name = "DP-AUX"; 5356aa19269SIcenowy Zheng anx6345->aux.dev = &anx6345->client->dev; 5366aa19269SIcenowy Zheng anx6345->aux.transfer = anx6345_aux_transfer; 5376aa19269SIcenowy Zheng 5386aa19269SIcenowy Zheng err = drm_dp_aux_register(&anx6345->aux); 5396aa19269SIcenowy Zheng if (err < 0) { 5406aa19269SIcenowy Zheng DRM_ERROR("Failed to register aux channel: %d\n", err); 5416aa19269SIcenowy Zheng return err; 5426aa19269SIcenowy Zheng } 5436aa19269SIcenowy Zheng 5446aa19269SIcenowy Zheng err = drm_connector_init(bridge->dev, &anx6345->connector, 5456aa19269SIcenowy Zheng &anx6345_connector_funcs, 5466aa19269SIcenowy Zheng DRM_MODE_CONNECTOR_eDP); 5476aa19269SIcenowy Zheng if (err) { 5486aa19269SIcenowy Zheng DRM_ERROR("Failed to initialize connector: %d\n", err); 5496aa19269SIcenowy Zheng return err; 5506aa19269SIcenowy Zheng } 5516aa19269SIcenowy Zheng 5526aa19269SIcenowy Zheng drm_connector_helper_add(&anx6345->connector, 5536aa19269SIcenowy Zheng &anx6345_connector_helper_funcs); 5546aa19269SIcenowy Zheng 5556aa19269SIcenowy Zheng err = drm_connector_register(&anx6345->connector); 5566aa19269SIcenowy Zheng if (err) { 5576aa19269SIcenowy Zheng DRM_ERROR("Failed to register connector: %d\n", err); 5586aa19269SIcenowy Zheng return err; 5596aa19269SIcenowy Zheng } 5606aa19269SIcenowy Zheng 5616aa19269SIcenowy Zheng anx6345->connector.polled = DRM_CONNECTOR_POLL_HPD; 5626aa19269SIcenowy Zheng 5636aa19269SIcenowy Zheng err = drm_connector_attach_encoder(&anx6345->connector, 5646aa19269SIcenowy Zheng bridge->encoder); 5656aa19269SIcenowy Zheng if (err) { 5666aa19269SIcenowy Zheng DRM_ERROR("Failed to link up connector to encoder: %d\n", err); 5676aa19269SIcenowy Zheng return err; 5686aa19269SIcenowy Zheng } 5696aa19269SIcenowy Zheng 5706aa19269SIcenowy Zheng if (anx6345->panel) { 5716aa19269SIcenowy Zheng err = drm_panel_attach(anx6345->panel, &anx6345->connector); 5726aa19269SIcenowy Zheng if (err) { 5736aa19269SIcenowy Zheng DRM_ERROR("Failed to attach panel: %d\n", err); 5746aa19269SIcenowy Zheng return err; 5756aa19269SIcenowy Zheng } 5766aa19269SIcenowy Zheng } 5776aa19269SIcenowy Zheng 5786aa19269SIcenowy Zheng return 0; 5796aa19269SIcenowy Zheng } 5806aa19269SIcenowy Zheng 5816aa19269SIcenowy Zheng static enum drm_mode_status 5826aa19269SIcenowy Zheng anx6345_bridge_mode_valid(struct drm_bridge *bridge, 5836aa19269SIcenowy Zheng const struct drm_display_mode *mode) 5846aa19269SIcenowy Zheng { 5856aa19269SIcenowy Zheng if (mode->flags & DRM_MODE_FLAG_INTERLACE) 5866aa19269SIcenowy Zheng return MODE_NO_INTERLACE; 5876aa19269SIcenowy Zheng 5886aa19269SIcenowy Zheng /* Max 1200p at 5.4 Ghz, one lane */ 5896aa19269SIcenowy Zheng if (mode->clock > 154000) 5906aa19269SIcenowy Zheng return MODE_CLOCK_HIGH; 5916aa19269SIcenowy Zheng 5926aa19269SIcenowy Zheng return MODE_OK; 5936aa19269SIcenowy Zheng } 5946aa19269SIcenowy Zheng 5956aa19269SIcenowy Zheng static void anx6345_bridge_disable(struct drm_bridge *bridge) 5966aa19269SIcenowy Zheng { 5976aa19269SIcenowy Zheng struct anx6345 *anx6345 = bridge_to_anx6345(bridge); 5986aa19269SIcenowy Zheng 5996aa19269SIcenowy Zheng /* Power off all modules except configuration registers access */ 6006aa19269SIcenowy Zheng anx6345_set_bits(anx6345->map[I2C_IDX_TXCOM], SP_POWERDOWN_CTRL_REG, 6016aa19269SIcenowy Zheng SP_HDCP_PD | SP_AUDIO_PD | SP_VIDEO_PD | SP_LINK_PD); 6026aa19269SIcenowy Zheng if (anx6345->panel) 6036aa19269SIcenowy Zheng drm_panel_disable(anx6345->panel); 6046aa19269SIcenowy Zheng 6056aa19269SIcenowy Zheng if (anx6345->powered) 6066aa19269SIcenowy Zheng anx6345_poweroff(anx6345); 6076aa19269SIcenowy Zheng } 6086aa19269SIcenowy Zheng 6096aa19269SIcenowy Zheng static void anx6345_bridge_enable(struct drm_bridge *bridge) 6106aa19269SIcenowy Zheng { 6116aa19269SIcenowy Zheng struct anx6345 *anx6345 = bridge_to_anx6345(bridge); 6126aa19269SIcenowy Zheng int err; 6136aa19269SIcenowy Zheng 6146aa19269SIcenowy Zheng if (anx6345->panel) 6156aa19269SIcenowy Zheng drm_panel_enable(anx6345->panel); 6166aa19269SIcenowy Zheng 6176aa19269SIcenowy Zheng err = anx6345_start(anx6345); 6186aa19269SIcenowy Zheng if (err) { 6196aa19269SIcenowy Zheng DRM_ERROR("Failed to initialize: %d\n", err); 6206aa19269SIcenowy Zheng return; 6216aa19269SIcenowy Zheng } 6226aa19269SIcenowy Zheng 6236aa19269SIcenowy Zheng err = anx6345_config_dp_output(anx6345); 6246aa19269SIcenowy Zheng if (err) 6256aa19269SIcenowy Zheng DRM_ERROR("Failed to enable DP output: %d\n", err); 6266aa19269SIcenowy Zheng } 6276aa19269SIcenowy Zheng 6286aa19269SIcenowy Zheng static const struct drm_bridge_funcs anx6345_bridge_funcs = { 6296aa19269SIcenowy Zheng .attach = anx6345_bridge_attach, 6306aa19269SIcenowy Zheng .mode_valid = anx6345_bridge_mode_valid, 6316aa19269SIcenowy Zheng .disable = anx6345_bridge_disable, 6326aa19269SIcenowy Zheng .enable = anx6345_bridge_enable, 6336aa19269SIcenowy Zheng }; 6346aa19269SIcenowy Zheng 6356aa19269SIcenowy Zheng static void unregister_i2c_dummy_clients(struct anx6345 *anx6345) 6366aa19269SIcenowy Zheng { 6376aa19269SIcenowy Zheng unsigned int i; 6386aa19269SIcenowy Zheng 6396aa19269SIcenowy Zheng for (i = 1; i < ARRAY_SIZE(anx6345->i2c_clients); i++) 6406aa19269SIcenowy Zheng if (anx6345->i2c_clients[i] && 6416aa19269SIcenowy Zheng anx6345->i2c_clients[i]->addr != anx6345->client->addr) 6426aa19269SIcenowy Zheng i2c_unregister_device(anx6345->i2c_clients[i]); 6436aa19269SIcenowy Zheng } 6446aa19269SIcenowy Zheng 6456aa19269SIcenowy Zheng static const struct regmap_config anx6345_regmap_config = { 6466aa19269SIcenowy Zheng .reg_bits = 8, 6476aa19269SIcenowy Zheng .val_bits = 8, 6486aa19269SIcenowy Zheng .max_register = 0xff, 6496aa19269SIcenowy Zheng .cache_type = REGCACHE_NONE, 6506aa19269SIcenowy Zheng }; 6516aa19269SIcenowy Zheng 6526aa19269SIcenowy Zheng static const u16 anx6345_chipid_list[] = { 6536aa19269SIcenowy Zheng 0x6345, 6546aa19269SIcenowy Zheng }; 6556aa19269SIcenowy Zheng 6566aa19269SIcenowy Zheng static bool anx6345_get_chip_id(struct anx6345 *anx6345) 6576aa19269SIcenowy Zheng { 6586aa19269SIcenowy Zheng unsigned int i, idl, idh, version; 6596aa19269SIcenowy Zheng 6606aa19269SIcenowy Zheng if (regmap_read(anx6345->map[I2C_IDX_TXCOM], SP_DEVICE_IDL_REG, &idl)) 6616aa19269SIcenowy Zheng return false; 6626aa19269SIcenowy Zheng 6636aa19269SIcenowy Zheng if (regmap_read(anx6345->map[I2C_IDX_TXCOM], SP_DEVICE_IDH_REG, &idh)) 6646aa19269SIcenowy Zheng return false; 6656aa19269SIcenowy Zheng 6666aa19269SIcenowy Zheng anx6345->chipid = (u8)idl | ((u8)idh << 8); 6676aa19269SIcenowy Zheng 6686aa19269SIcenowy Zheng if (regmap_read(anx6345->map[I2C_IDX_TXCOM], SP_DEVICE_VERSION_REG, 6696aa19269SIcenowy Zheng &version)) 6706aa19269SIcenowy Zheng return false; 6716aa19269SIcenowy Zheng 6726aa19269SIcenowy Zheng for (i = 0; i < ARRAY_SIZE(anx6345_chipid_list); i++) { 6736aa19269SIcenowy Zheng if (anx6345->chipid == anx6345_chipid_list[i]) { 6746aa19269SIcenowy Zheng DRM_INFO("Found ANX%x (ver. %d) eDP Transmitter\n", 6756aa19269SIcenowy Zheng anx6345->chipid, version); 6766aa19269SIcenowy Zheng return true; 6776aa19269SIcenowy Zheng } 6786aa19269SIcenowy Zheng } 6796aa19269SIcenowy Zheng 6806aa19269SIcenowy Zheng DRM_ERROR("ANX%x (ver. %d) not supported by this driver\n", 6816aa19269SIcenowy Zheng anx6345->chipid, version); 6826aa19269SIcenowy Zheng 6836aa19269SIcenowy Zheng return false; 6846aa19269SIcenowy Zheng } 6856aa19269SIcenowy Zheng 6866aa19269SIcenowy Zheng static int anx6345_i2c_probe(struct i2c_client *client, 6876aa19269SIcenowy Zheng const struct i2c_device_id *id) 6886aa19269SIcenowy Zheng { 6896aa19269SIcenowy Zheng struct anx6345 *anx6345; 6906aa19269SIcenowy Zheng struct device *dev; 6916aa19269SIcenowy Zheng int i, err; 6926aa19269SIcenowy Zheng 6936aa19269SIcenowy Zheng anx6345 = devm_kzalloc(&client->dev, sizeof(*anx6345), GFP_KERNEL); 6946aa19269SIcenowy Zheng if (!anx6345) 6956aa19269SIcenowy Zheng return -ENOMEM; 6966aa19269SIcenowy Zheng 6976aa19269SIcenowy Zheng mutex_init(&anx6345->lock); 6986aa19269SIcenowy Zheng 6996aa19269SIcenowy Zheng anx6345->bridge.of_node = client->dev.of_node; 7006aa19269SIcenowy Zheng 7016aa19269SIcenowy Zheng anx6345->client = client; 7026aa19269SIcenowy Zheng i2c_set_clientdata(client, anx6345); 7036aa19269SIcenowy Zheng 7046aa19269SIcenowy Zheng dev = &anx6345->client->dev; 7056aa19269SIcenowy Zheng 7066aa19269SIcenowy Zheng err = drm_of_find_panel_or_bridge(client->dev.of_node, 1, 0, 7076aa19269SIcenowy Zheng &anx6345->panel, NULL); 7086aa19269SIcenowy Zheng if (err == -EPROBE_DEFER) 7096aa19269SIcenowy Zheng return err; 7106aa19269SIcenowy Zheng 7116aa19269SIcenowy Zheng if (err) 7126aa19269SIcenowy Zheng DRM_DEBUG("No panel found\n"); 7136aa19269SIcenowy Zheng 7146aa19269SIcenowy Zheng /* 1.2V digital core power regulator */ 7156aa19269SIcenowy Zheng anx6345->dvdd12 = devm_regulator_get(dev, "dvdd12-supply"); 7166aa19269SIcenowy Zheng if (IS_ERR(anx6345->dvdd12)) { 7176aa19269SIcenowy Zheng DRM_ERROR("dvdd12-supply not found\n"); 7186aa19269SIcenowy Zheng return PTR_ERR(anx6345->dvdd12); 7196aa19269SIcenowy Zheng } 7206aa19269SIcenowy Zheng 7216aa19269SIcenowy Zheng /* 2.5V digital core power regulator */ 7226aa19269SIcenowy Zheng anx6345->dvdd25 = devm_regulator_get(dev, "dvdd25-supply"); 7236aa19269SIcenowy Zheng if (IS_ERR(anx6345->dvdd25)) { 7246aa19269SIcenowy Zheng DRM_ERROR("dvdd25-supply not found\n"); 7256aa19269SIcenowy Zheng return PTR_ERR(anx6345->dvdd25); 7266aa19269SIcenowy Zheng } 7276aa19269SIcenowy Zheng 7286aa19269SIcenowy Zheng /* GPIO for chip reset */ 7296aa19269SIcenowy Zheng anx6345->gpiod_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_LOW); 7306aa19269SIcenowy Zheng if (IS_ERR(anx6345->gpiod_reset)) { 7316aa19269SIcenowy Zheng DRM_ERROR("Reset gpio not found\n"); 7326aa19269SIcenowy Zheng return PTR_ERR(anx6345->gpiod_reset); 7336aa19269SIcenowy Zheng } 7346aa19269SIcenowy Zheng 7356aa19269SIcenowy Zheng /* Map slave addresses of ANX6345 */ 7366aa19269SIcenowy Zheng for (i = 0; i < I2C_NUM_ADDRESSES; i++) { 7376aa19269SIcenowy Zheng if (anx6345_i2c_addresses[i] >> 1 != client->addr) 7386aa19269SIcenowy Zheng anx6345->i2c_clients[i] = i2c_new_dummy(client->adapter, 7396aa19269SIcenowy Zheng anx6345_i2c_addresses[i] >> 1); 7406aa19269SIcenowy Zheng else 7416aa19269SIcenowy Zheng anx6345->i2c_clients[i] = client; 7426aa19269SIcenowy Zheng 7436aa19269SIcenowy Zheng if (!anx6345->i2c_clients[i]) { 7446aa19269SIcenowy Zheng err = -ENOMEM; 7456aa19269SIcenowy Zheng DRM_ERROR("Failed to reserve I2C bus %02x\n", 7466aa19269SIcenowy Zheng anx6345_i2c_addresses[i]); 7476aa19269SIcenowy Zheng goto err_unregister_i2c; 7486aa19269SIcenowy Zheng } 7496aa19269SIcenowy Zheng 7506aa19269SIcenowy Zheng anx6345->map[i] = devm_regmap_init_i2c(anx6345->i2c_clients[i], 7516aa19269SIcenowy Zheng &anx6345_regmap_config); 7526aa19269SIcenowy Zheng if (IS_ERR(anx6345->map[i])) { 7536aa19269SIcenowy Zheng err = PTR_ERR(anx6345->map[i]); 7546aa19269SIcenowy Zheng DRM_ERROR("Failed regmap initialization %02x\n", 7556aa19269SIcenowy Zheng anx6345_i2c_addresses[i]); 7566aa19269SIcenowy Zheng goto err_unregister_i2c; 7576aa19269SIcenowy Zheng } 7586aa19269SIcenowy Zheng } 7596aa19269SIcenowy Zheng 7606aa19269SIcenowy Zheng /* Look for supported chip ID */ 7616aa19269SIcenowy Zheng anx6345_poweron(anx6345); 7626aa19269SIcenowy Zheng if (anx6345_get_chip_id(anx6345)) { 7636aa19269SIcenowy Zheng anx6345->bridge.funcs = &anx6345_bridge_funcs; 7646aa19269SIcenowy Zheng drm_bridge_add(&anx6345->bridge); 7656aa19269SIcenowy Zheng 7666aa19269SIcenowy Zheng return 0; 7676aa19269SIcenowy Zheng } else { 7686aa19269SIcenowy Zheng anx6345_poweroff(anx6345); 7696aa19269SIcenowy Zheng err = -ENODEV; 7706aa19269SIcenowy Zheng } 7716aa19269SIcenowy Zheng 7726aa19269SIcenowy Zheng err_unregister_i2c: 7736aa19269SIcenowy Zheng unregister_i2c_dummy_clients(anx6345); 7746aa19269SIcenowy Zheng return err; 7756aa19269SIcenowy Zheng } 7766aa19269SIcenowy Zheng 7776aa19269SIcenowy Zheng static int anx6345_i2c_remove(struct i2c_client *client) 7786aa19269SIcenowy Zheng { 7796aa19269SIcenowy Zheng struct anx6345 *anx6345 = i2c_get_clientdata(client); 7806aa19269SIcenowy Zheng 7816aa19269SIcenowy Zheng drm_bridge_remove(&anx6345->bridge); 7826aa19269SIcenowy Zheng 7836aa19269SIcenowy Zheng unregister_i2c_dummy_clients(anx6345); 7846aa19269SIcenowy Zheng 7856aa19269SIcenowy Zheng kfree(anx6345->edid); 7866aa19269SIcenowy Zheng 7876aa19269SIcenowy Zheng mutex_destroy(&anx6345->lock); 7886aa19269SIcenowy Zheng 7896aa19269SIcenowy Zheng return 0; 7906aa19269SIcenowy Zheng } 7916aa19269SIcenowy Zheng 7926aa19269SIcenowy Zheng static const struct i2c_device_id anx6345_id[] = { 7936aa19269SIcenowy Zheng { "anx6345", 0 }, 7946aa19269SIcenowy Zheng { /* sentinel */ } 7956aa19269SIcenowy Zheng }; 7966aa19269SIcenowy Zheng MODULE_DEVICE_TABLE(i2c, anx6345_id); 7976aa19269SIcenowy Zheng 7986aa19269SIcenowy Zheng static const struct of_device_id anx6345_match_table[] = { 7996aa19269SIcenowy Zheng { .compatible = "analogix,anx6345", }, 8006aa19269SIcenowy Zheng { /* sentinel */ }, 8016aa19269SIcenowy Zheng }; 8026aa19269SIcenowy Zheng MODULE_DEVICE_TABLE(of, anx6345_match_table); 8036aa19269SIcenowy Zheng 8046aa19269SIcenowy Zheng static struct i2c_driver anx6345_driver = { 8056aa19269SIcenowy Zheng .driver = { 8066aa19269SIcenowy Zheng .name = "anx6345", 8076aa19269SIcenowy Zheng .of_match_table = of_match_ptr(anx6345_match_table), 8086aa19269SIcenowy Zheng }, 8096aa19269SIcenowy Zheng .probe = anx6345_i2c_probe, 8106aa19269SIcenowy Zheng .remove = anx6345_i2c_remove, 8116aa19269SIcenowy Zheng .id_table = anx6345_id, 8126aa19269SIcenowy Zheng }; 8136aa19269SIcenowy Zheng module_i2c_driver(anx6345_driver); 8146aa19269SIcenowy Zheng 8156aa19269SIcenowy Zheng MODULE_DESCRIPTION("ANX6345 eDP Transmitter driver"); 8166aa19269SIcenowy Zheng MODULE_AUTHOR("Icenowy Zheng <icenowy@aosc.io>"); 8176aa19269SIcenowy Zheng MODULE_LICENSE("GPL v2"); 818