Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 * Copyright (C) 2016 BayLibre, SAS
   4 * Author: Neil Armstrong <narmstrong@baylibre.com>
   5 * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
   6 */
   7
   8#include <linux/clk.h>
   9#include <linux/component.h>
  10#include <linux/kernel.h>
  11#include <linux/module.h>
  12#include <linux/of_device.h>
  13#include <linux/of_graph.h>
  14#include <linux/regulator/consumer.h>
  15#include <linux/reset.h>
  16
  17#include <drm/bridge/dw_hdmi.h>
  18#include <drm/drm_atomic_helper.h>
  19#include <drm/drm_bridge.h>
  20#include <drm/drm_device.h>
  21#include <drm/drm_edid.h>
  22#include <drm/drm_probe_helper.h>
  23#include <drm/drm_print.h>
  24
  25#include <linux/media-bus-format.h>
  26#include <linux/videodev2.h>
  27
  28#include "meson_drv.h"
  29#include "meson_dw_hdmi.h"
  30#include "meson_registers.h"
  31#include "meson_vclk.h"
  32#include "meson_venc.h"
  33
  34#define DRIVER_NAME "meson-dw-hdmi"
  35#define DRIVER_DESC "Amlogic Meson HDMI-TX DRM driver"
  36
  37/**
  38 * DOC: HDMI Output
  39 *
  40 * HDMI Output is composed of :
  41 *
  42 * - A Synopsys DesignWare HDMI Controller IP
  43 * - A TOP control block controlling the Clocks and PHY
  44 * - A custom HDMI PHY in order convert video to TMDS signal
  45 *
  46 * .. code::
  47 *
  48 *    ___________________________________
  49 *   |            HDMI TOP               |<= HPD
  50 *   |___________________________________|
  51 *   |                  |                |
  52 *   |  Synopsys HDMI   |   HDMI PHY     |=> TMDS
  53 *   |    Controller    |________________|
  54 *   |___________________________________|<=> DDC
  55 *
  56 *
  57 * The HDMI TOP block only supports HPD sensing.
  58 * The Synopsys HDMI Controller interrupt is routed
  59 * through the TOP Block interrupt.
  60 * Communication to the TOP Block and the Synopsys
  61 * HDMI Controller is done a pair of addr+read/write
  62 * registers.
  63 * The HDMI PHY is configured by registers in the
  64 * HHI register block.
  65 *
  66 * Pixel data arrives in 4:4:4 format from the VENC
  67 * block and the VPU HDMI mux selects either the ENCI
  68 * encoder for the 576i or 480i formats or the ENCP
  69 * encoder for all the other formats including
  70 * interlaced HD formats.
  71 * The VENC uses a DVI encoder on top of the ENCI
  72 * or ENCP encoders to generate DVI timings for the
  73 * HDMI controller.
  74 *
  75 * GXBB, GXL and GXM embeds the Synopsys DesignWare
  76 * HDMI TX IP version 2.01a with HDCP and I2C & S/PDIF
  77 * audio source interfaces.
  78 *
  79 * We handle the following features :
  80 *
  81 * - HPD Rise & Fall interrupt
  82 * - HDMI Controller Interrupt
  83 * - HDMI PHY Init for 480i to 1080p60
  84 * - VENC & HDMI Clock setup for 480i to 1080p60
  85 * - VENC Mode setup for 480i to 1080p60
  86 *
  87 * What is missing :
  88 *
  89 * - PHY, Clock and Mode setup for 2k && 4k modes
  90 * - SDDC Scrambling mode for HDMI 2.0a
  91 * - HDCP Setup
  92 * - CEC Management
  93 */
  94
  95/* TOP Block Communication Channel */
  96#define HDMITX_TOP_ADDR_REG	0x0
  97#define HDMITX_TOP_DATA_REG	0x4
  98#define HDMITX_TOP_CTRL_REG	0x8
  99#define HDMITX_TOP_G12A_OFFSET	0x8000
 100
 101/* Controller Communication Channel */
 102#define HDMITX_DWC_ADDR_REG	0x10
 103#define HDMITX_DWC_DATA_REG	0x14
 104#define HDMITX_DWC_CTRL_REG	0x18
 105
 106/* HHI Registers */
 107#define HHI_MEM_PD_REG0		0x100 /* 0x40 */
 108#define HHI_HDMI_CLK_CNTL	0x1cc /* 0x73 */
 109#define HHI_HDMI_PHY_CNTL0	0x3a0 /* 0xe8 */
 110#define HHI_HDMI_PHY_CNTL1	0x3a4 /* 0xe9 */
 111#define HHI_HDMI_PHY_CNTL2	0x3a8 /* 0xea */
 112#define HHI_HDMI_PHY_CNTL3	0x3ac /* 0xeb */
 113#define HHI_HDMI_PHY_CNTL4	0x3b0 /* 0xec */
 114#define HHI_HDMI_PHY_CNTL5	0x3b4 /* 0xed */
 115
 116static DEFINE_SPINLOCK(reg_lock);
 117
 118enum meson_venc_source {
 119	MESON_VENC_SOURCE_NONE = 0,
 120	MESON_VENC_SOURCE_ENCI = 1,
 121	MESON_VENC_SOURCE_ENCP = 2,
 122};
 123
 124struct meson_dw_hdmi;
 125
 126struct meson_dw_hdmi_data {
 127	unsigned int	(*top_read)(struct meson_dw_hdmi *dw_hdmi,
 128				    unsigned int addr);
 129	void		(*top_write)(struct meson_dw_hdmi *dw_hdmi,
 130				     unsigned int addr, unsigned int data);
 131	unsigned int	(*dwc_read)(struct meson_dw_hdmi *dw_hdmi,
 132				    unsigned int addr);
 133	void		(*dwc_write)(struct meson_dw_hdmi *dw_hdmi,
 134				     unsigned int addr, unsigned int data);
 135};
 136
 137struct meson_dw_hdmi {
 138	struct drm_encoder encoder;
 139	struct drm_bridge bridge;
 140	struct dw_hdmi_plat_data dw_plat_data;
 141	struct meson_drm *priv;
 142	struct device *dev;
 143	void __iomem *hdmitx;
 144	const struct meson_dw_hdmi_data *data;
 145	struct reset_control *hdmitx_apb;
 146	struct reset_control *hdmitx_ctrl;
 147	struct reset_control *hdmitx_phy;
 148	struct regulator *hdmi_supply;
 149	u32 irq_stat;
 150	struct dw_hdmi *hdmi;
 151	unsigned long output_bus_fmt;
 152};
 153#define encoder_to_meson_dw_hdmi(x) \
 154	container_of(x, struct meson_dw_hdmi, encoder)
 155#define bridge_to_meson_dw_hdmi(x) \
 156	container_of(x, struct meson_dw_hdmi, bridge)
 157
 158static inline int dw_hdmi_is_compatible(struct meson_dw_hdmi *dw_hdmi,
 159					const char *compat)
 160{
 161	return of_device_is_compatible(dw_hdmi->dev->of_node, compat);
 162}
 163
 164/* PHY (via TOP bridge) and Controller dedicated register interface */
 165
 166static unsigned int dw_hdmi_top_read(struct meson_dw_hdmi *dw_hdmi,
 167				     unsigned int addr)
 168{
 169	unsigned long flags;
 170	unsigned int data;
 171
 172	spin_lock_irqsave(&reg_lock, flags);
 173
 174	/* ADDR must be written twice */
 175	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_TOP_ADDR_REG);
 176	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_TOP_ADDR_REG);
 177
 178	/* Read needs a second DATA read */
 179	data = readl(dw_hdmi->hdmitx + HDMITX_TOP_DATA_REG);
 180	data = readl(dw_hdmi->hdmitx + HDMITX_TOP_DATA_REG);
 181
 182	spin_unlock_irqrestore(&reg_lock, flags);
 183
 184	return data;
 185}
 186
 187static unsigned int dw_hdmi_g12a_top_read(struct meson_dw_hdmi *dw_hdmi,
 188					  unsigned int addr)
 189{
 190	return readl(dw_hdmi->hdmitx + HDMITX_TOP_G12A_OFFSET + (addr << 2));
 191}
 192
 193static inline void dw_hdmi_top_write(struct meson_dw_hdmi *dw_hdmi,
 194				     unsigned int addr, unsigned int data)
 195{
 196	unsigned long flags;
 197
 198	spin_lock_irqsave(&reg_lock, flags);
 199
 200	/* ADDR must be written twice */
 201	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_TOP_ADDR_REG);
 202	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_TOP_ADDR_REG);
 203
 204	/* Write needs single DATA write */
 205	writel(data, dw_hdmi->hdmitx + HDMITX_TOP_DATA_REG);
 206
 207	spin_unlock_irqrestore(&reg_lock, flags);
 208}
 209
 210static inline void dw_hdmi_g12a_top_write(struct meson_dw_hdmi *dw_hdmi,
 211					  unsigned int addr, unsigned int data)
 212{
 213	writel(data, dw_hdmi->hdmitx + HDMITX_TOP_G12A_OFFSET + (addr << 2));
 214}
 215
 216/* Helper to change specific bits in PHY registers */
 217static inline void dw_hdmi_top_write_bits(struct meson_dw_hdmi *dw_hdmi,
 218					  unsigned int addr,
 219					  unsigned int mask,
 220					  unsigned int val)
 221{
 222	unsigned int data = dw_hdmi->data->top_read(dw_hdmi, addr);
 223
 224	data &= ~mask;
 225	data |= val;
 226
 227	dw_hdmi->data->top_write(dw_hdmi, addr, data);
 228}
 229
 230static unsigned int dw_hdmi_dwc_read(struct meson_dw_hdmi *dw_hdmi,
 231				     unsigned int addr)
 232{
 233	unsigned long flags;
 234	unsigned int data;
 235
 236	spin_lock_irqsave(&reg_lock, flags);
 237
 238	/* ADDR must be written twice */
 239	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_DWC_ADDR_REG);
 240	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_DWC_ADDR_REG);
 241
 242	/* Read needs a second DATA read */
 243	data = readl(dw_hdmi->hdmitx + HDMITX_DWC_DATA_REG);
 244	data = readl(dw_hdmi->hdmitx + HDMITX_DWC_DATA_REG);
 245
 246	spin_unlock_irqrestore(&reg_lock, flags);
 247
 248	return data;
 249}
 250
 251static unsigned int dw_hdmi_g12a_dwc_read(struct meson_dw_hdmi *dw_hdmi,
 252					  unsigned int addr)
 253{
 254	return readb(dw_hdmi->hdmitx + addr);
 255}
 256
 257static inline void dw_hdmi_dwc_write(struct meson_dw_hdmi *dw_hdmi,
 258				     unsigned int addr, unsigned int data)
 259{
 260	unsigned long flags;
 261
 262	spin_lock_irqsave(&reg_lock, flags);
 263
 264	/* ADDR must be written twice */
 265	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_DWC_ADDR_REG);
 266	writel(addr & 0xffff, dw_hdmi->hdmitx + HDMITX_DWC_ADDR_REG);
 267
 268	/* Write needs single DATA write */
 269	writel(data, dw_hdmi->hdmitx + HDMITX_DWC_DATA_REG);
 270
 271	spin_unlock_irqrestore(&reg_lock, flags);
 272}
 273
 274static inline void dw_hdmi_g12a_dwc_write(struct meson_dw_hdmi *dw_hdmi,
 275					  unsigned int addr, unsigned int data)
 276{
 277	writeb(data, dw_hdmi->hdmitx + addr);
 278}
 279
 280/* Helper to change specific bits in controller registers */
 281static inline void dw_hdmi_dwc_write_bits(struct meson_dw_hdmi *dw_hdmi,
 282					  unsigned int addr,
 283					  unsigned int mask,
 284					  unsigned int val)
 285{
 286	unsigned int data = dw_hdmi->data->dwc_read(dw_hdmi, addr);
 287
 288	data &= ~mask;
 289	data |= val;
 290
 291	dw_hdmi->data->dwc_write(dw_hdmi, addr, data);
 292}
 293
 294/* Bridge */
 295
 296/* Setup PHY bandwidth modes */
 297static void meson_hdmi_phy_setup_mode(struct meson_dw_hdmi *dw_hdmi,
 298				      const struct drm_display_mode *mode)
 299{
 300	struct meson_drm *priv = dw_hdmi->priv;
 301	unsigned int pixel_clock = mode->clock;
 302
 303	/* For 420, pixel clock is half unlike venc clock */
 304	if (dw_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
 305		pixel_clock /= 2;
 306
 307	if (dw_hdmi_is_compatible(dw_hdmi, "amlogic,meson-gxl-dw-hdmi") ||
 308	    dw_hdmi_is_compatible(dw_hdmi, "amlogic,meson-gxm-dw-hdmi")) {
 309		if (pixel_clock >= 371250) {
 310			/* 5.94Gbps, 3.7125Gbps */
 311			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x333d3282);
 312			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2136315b);
 313		} else if (pixel_clock >= 297000) {
 314			/* 2.97Gbps */
 315			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33303382);
 316			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2036315b);
 317		} else if (pixel_clock >= 148500) {
 318			/* 1.485Gbps */
 319			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33303362);
 320			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2016315b);
 321		} else {
 322			/* 742.5Mbps, and below */
 323			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33604142);
 324			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x0016315b);
 325		}
 326	} else if (dw_hdmi_is_compatible(dw_hdmi,
 327					 "amlogic,meson-gxbb-dw-hdmi")) {
 328		if (pixel_clock >= 371250) {
 329			/* 5.94Gbps, 3.7125Gbps */
 330			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33353245);
 331			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2100115b);
 332		} else if (pixel_clock >= 297000) {
 333			/* 2.97Gbps */
 334			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33634283);
 335			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0xb000115b);
 336		} else {
 337			/* 1.485Gbps, and below */
 338			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33632122);
 339			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2000115b);
 340		}
 341	} else if (dw_hdmi_is_compatible(dw_hdmi,
 342					 "amlogic,meson-g12a-dw-hdmi")) {
 343		if (pixel_clock >= 371250) {
 344			/* 5.94Gbps, 3.7125Gbps */
 345			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x37eb65c4);
 346			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2ab0ff3b);
 347			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL5, 0x0000080b);
 348		} else if (pixel_clock >= 297000) {
 349			/* 2.97Gbps */
 350			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33eb6262);
 351			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2ab0ff3b);
 352			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL5, 0x00000003);
 353		} else {
 354			/* 1.485Gbps, and below */
 355			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0x33eb4242);
 356			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL3, 0x2ab0ff3b);
 357			regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL5, 0x00000003);
 358		}
 359	}
 360}
 361
 362static inline void meson_dw_hdmi_phy_reset(struct meson_dw_hdmi *dw_hdmi)
 363{
 364	struct meson_drm *priv = dw_hdmi->priv;
 365
 366	/* Enable and software reset */
 367	regmap_update_bits(priv->hhi, HHI_HDMI_PHY_CNTL1, 0xf, 0xf);
 368
 369	mdelay(2);
 370
 371	/* Enable and unreset */
 372	regmap_update_bits(priv->hhi, HHI_HDMI_PHY_CNTL1, 0xf, 0xe);
 373
 374	mdelay(2);
 375}
 376
 377static void dw_hdmi_set_vclk(struct meson_dw_hdmi *dw_hdmi,
 378			     const struct drm_display_mode *mode)
 379{
 380	struct meson_drm *priv = dw_hdmi->priv;
 381	int vic = drm_match_cea_mode(mode);
 382	unsigned int phy_freq;
 383	unsigned int vclk_freq;
 384	unsigned int venc_freq;
 385	unsigned int hdmi_freq;
 386
 387	vclk_freq = mode->clock;
 388
 389	/* For 420, pixel clock is half unlike venc clock */
 390	if (dw_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
 391		vclk_freq /= 2;
 392
 393	/* TMDS clock is pixel_clock * 10 */
 394	phy_freq = vclk_freq * 10;
 395
 396	if (!vic) {
 397		meson_vclk_setup(priv, MESON_VCLK_TARGET_DMT, phy_freq,
 398				 vclk_freq, vclk_freq, vclk_freq, false);
 399		return;
 400	}
 401
 402	/* 480i/576i needs global pixel doubling */
 403	if (mode->flags & DRM_MODE_FLAG_DBLCLK)
 404		vclk_freq *= 2;
 405
 406	venc_freq = vclk_freq;
 407	hdmi_freq = vclk_freq;
 408
 409	/* VENC double pixels for 1080i, 720p and YUV420 modes */
 410	if (meson_venc_hdmi_venc_repeat(vic) ||
 411	    dw_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
 412		venc_freq *= 2;
 413
 414	vclk_freq = max(venc_freq, hdmi_freq);
 415
 416	if (mode->flags & DRM_MODE_FLAG_DBLCLK)
 417		venc_freq /= 2;
 418
 419	DRM_DEBUG_DRIVER("vclk:%d phy=%d venc=%d hdmi=%d enci=%d\n",
 420		phy_freq, vclk_freq, venc_freq, hdmi_freq,
 421		priv->venc.hdmi_use_enci);
 422
 423	meson_vclk_setup(priv, MESON_VCLK_TARGET_HDMI, phy_freq, vclk_freq,
 424			 venc_freq, hdmi_freq, priv->venc.hdmi_use_enci);
 425}
 426
 427static int dw_hdmi_phy_init(struct dw_hdmi *hdmi, void *data,
 428			    const struct drm_display_info *display,
 429			    const struct drm_display_mode *mode)
 430{
 431	struct meson_dw_hdmi *dw_hdmi = (struct meson_dw_hdmi *)data;
 432	struct meson_drm *priv = dw_hdmi->priv;
 433	unsigned int wr_clk =
 434		readl_relaxed(priv->io_base + _REG(VPU_HDMI_SETTING));
 435
 436	DRM_DEBUG_DRIVER("\"%s\" div%d\n", mode->name,
 437			 mode->clock > 340000 ? 40 : 10);
 438
 439	/* Enable clocks */
 440	regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, 0xffff, 0x100);
 441
 442	/* Bring HDMITX MEM output of power down */
 443	regmap_update_bits(priv->hhi, HHI_MEM_PD_REG0, 0xff << 8, 0);
 444
 445	/* Bring out of reset */
 446	dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_SW_RESET,  0);
 447
 448	/* Enable internal pixclk, tmds_clk, spdif_clk, i2s_clk, cecclk */
 449	dw_hdmi_top_write_bits(dw_hdmi, HDMITX_TOP_CLK_CNTL,
 450			       0x3, 0x3);
 451
 452	/* Enable cec_clk and hdcp22_tmdsclk_en */
 453	dw_hdmi_top_write_bits(dw_hdmi, HDMITX_TOP_CLK_CNTL,
 454			       0x3 << 4, 0x3 << 4);
 455
 456	/* Enable normal output to PHY */
 457	dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_BIST_CNTL, BIT(12));
 458
 459	/* TMDS pattern setup */
 460	if (mode->clock > 340000 &&
 461	    dw_hdmi->output_bus_fmt == MEDIA_BUS_FMT_YUV8_1X24) {
 462		dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_TMDS_CLK_PTTN_01,
 463				  0);
 464		dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_TMDS_CLK_PTTN_23,
 465				  0x03ff03ff);
 466	} else {
 467		dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_TMDS_CLK_PTTN_01,
 468				  0x001f001f);
 469		dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_TMDS_CLK_PTTN_23,
 470				  0x001f001f);
 471	}
 472
 473	/* Load TMDS pattern */
 474	dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_TMDS_CLK_PTTN_CNTL, 0x1);
 475	msleep(20);
 476	dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_TMDS_CLK_PTTN_CNTL, 0x2);
 477
 478	/* Setup PHY parameters */
 479	meson_hdmi_phy_setup_mode(dw_hdmi, mode);
 480
 481	/* Setup PHY */
 482	regmap_update_bits(priv->hhi, HHI_HDMI_PHY_CNTL1,
 483			   0xffff << 16, 0x0390 << 16);
 484
 485	/* BIT_INVERT */
 486	if (dw_hdmi_is_compatible(dw_hdmi, "amlogic,meson-gxl-dw-hdmi") ||
 487	    dw_hdmi_is_compatible(dw_hdmi, "amlogic,meson-gxm-dw-hdmi") ||
 488	    dw_hdmi_is_compatible(dw_hdmi, "amlogic,meson-g12a-dw-hdmi"))
 489		regmap_update_bits(priv->hhi, HHI_HDMI_PHY_CNTL1,
 490				   BIT(17), 0);
 491	else
 492		regmap_update_bits(priv->hhi, HHI_HDMI_PHY_CNTL1,
 493				   BIT(17), BIT(17));
 494
 495	/* Disable clock, fifo, fifo_wr */
 496	regmap_update_bits(priv->hhi, HHI_HDMI_PHY_CNTL1, 0xf, 0);
 497
 498	dw_hdmi_set_high_tmds_clock_ratio(hdmi, display);
 499
 500	msleep(100);
 501
 502	/* Reset PHY 3 times in a row */
 503	meson_dw_hdmi_phy_reset(dw_hdmi);
 504	meson_dw_hdmi_phy_reset(dw_hdmi);
 505	meson_dw_hdmi_phy_reset(dw_hdmi);
 506
 507	/* Temporary Disable VENC video stream */
 508	if (priv->venc.hdmi_use_enci)
 509		writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
 510	else
 511		writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
 512
 513	/* Temporary Disable HDMI video stream to HDMI-TX */
 514	writel_bits_relaxed(0x3, 0,
 515			    priv->io_base + _REG(VPU_HDMI_SETTING));
 516	writel_bits_relaxed(0xf << 8, 0,
 517			    priv->io_base + _REG(VPU_HDMI_SETTING));
 518
 519	/* Re-Enable VENC video stream */
 520	if (priv->venc.hdmi_use_enci)
 521		writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
 522	else
 523		writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN));
 524
 525	/* Push back HDMI clock settings */
 526	writel_bits_relaxed(0xf << 8, wr_clk & (0xf << 8),
 527			    priv->io_base + _REG(VPU_HDMI_SETTING));
 528
 529	/* Enable and Select HDMI video source for HDMI-TX */
 530	if (priv->venc.hdmi_use_enci)
 531		writel_bits_relaxed(0x3, MESON_VENC_SOURCE_ENCI,
 532				    priv->io_base + _REG(VPU_HDMI_SETTING));
 533	else
 534		writel_bits_relaxed(0x3, MESON_VENC_SOURCE_ENCP,
 535				    priv->io_base + _REG(VPU_HDMI_SETTING));
 536
 537	return 0;
 538}
 539
 540static void dw_hdmi_phy_disable(struct dw_hdmi *hdmi,
 541				void *data)
 542{
 543	struct meson_dw_hdmi *dw_hdmi = (struct meson_dw_hdmi *)data;
 544	struct meson_drm *priv = dw_hdmi->priv;
 545
 546	DRM_DEBUG_DRIVER("\n");
 547
 548	regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0);
 549}
 550
 551static enum drm_connector_status dw_hdmi_read_hpd(struct dw_hdmi *hdmi,
 552			     void *data)
 553{
 554	struct meson_dw_hdmi *dw_hdmi = (struct meson_dw_hdmi *)data;
 555
 556	return !!dw_hdmi->data->top_read(dw_hdmi, HDMITX_TOP_STAT0) ?
 557		connector_status_connected : connector_status_disconnected;
 558}
 559
 560static void dw_hdmi_setup_hpd(struct dw_hdmi *hdmi,
 561			      void *data)
 562{
 563	struct meson_dw_hdmi *dw_hdmi = (struct meson_dw_hdmi *)data;
 564
 565	/* Setup HPD Filter */
 566	dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_HPD_FILTER,
 567			  (0xa << 12) | 0xa0);
 568
 569	/* Clear interrupts */
 570	dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_INTR_STAT_CLR,
 571			  HDMITX_TOP_INTR_HPD_RISE | HDMITX_TOP_INTR_HPD_FALL);
 572
 573	/* Unmask interrupts */
 574	dw_hdmi_top_write_bits(dw_hdmi, HDMITX_TOP_INTR_MASKN,
 575			HDMITX_TOP_INTR_HPD_RISE | HDMITX_TOP_INTR_HPD_FALL,
 576			HDMITX_TOP_INTR_HPD_RISE | HDMITX_TOP_INTR_HPD_FALL);
 577}
 578
 579static const struct dw_hdmi_phy_ops meson_dw_hdmi_phy_ops = {
 580	.init = dw_hdmi_phy_init,
 581	.disable = dw_hdmi_phy_disable,
 582	.read_hpd = dw_hdmi_read_hpd,
 583	.setup_hpd = dw_hdmi_setup_hpd,
 584};
 585
 586static irqreturn_t dw_hdmi_top_irq(int irq, void *dev_id)
 587{
 588	struct meson_dw_hdmi *dw_hdmi = dev_id;
 589	u32 stat;
 590
 591	stat = dw_hdmi->data->top_read(dw_hdmi, HDMITX_TOP_INTR_STAT);
 592	dw_hdmi->data->top_write(dw_hdmi, HDMITX_TOP_INTR_STAT_CLR, stat);
 593
 594	/* HPD Events, handle in the threaded interrupt handler */
 595	if (stat & (HDMITX_TOP_INTR_HPD_RISE | HDMITX_TOP_INTR_HPD_FALL)) {
 596		dw_hdmi->irq_stat = stat;
 597		return IRQ_WAKE_THREAD;
 598	}
 599
 600	/* HDMI Controller Interrupt */
 601	if (stat & 1)
 602		return IRQ_NONE;
 603
 604	/* TOFIX Handle HDCP Interrupts */
 605
 606	return IRQ_HANDLED;
 607}
 608
 609/* Threaded interrupt handler to manage HPD events */
 610static irqreturn_t dw_hdmi_top_thread_irq(int irq, void *dev_id)
 611{
 612	struct meson_dw_hdmi *dw_hdmi = dev_id;
 613	u32 stat = dw_hdmi->irq_stat;
 614
 615	/* HPD Events */
 616	if (stat & (HDMITX_TOP_INTR_HPD_RISE | HDMITX_TOP_INTR_HPD_FALL)) {
 617		bool hpd_connected = false;
 618
 619		if (stat & HDMITX_TOP_INTR_HPD_RISE)
 620			hpd_connected = true;
 621
 622		dw_hdmi_setup_rx_sense(dw_hdmi->hdmi, hpd_connected,
 623				       hpd_connected);
 624
 625		drm_helper_hpd_irq_event(dw_hdmi->encoder.dev);
 626	}
 627
 628	return IRQ_HANDLED;
 629}
 630
 631static enum drm_mode_status
 632dw_hdmi_mode_valid(struct dw_hdmi *hdmi, void *data,
 633		   const struct drm_display_info *display_info,
 634		   const struct drm_display_mode *mode)
 635{
 636	struct meson_dw_hdmi *dw_hdmi = data;
 637	struct meson_drm *priv = dw_hdmi->priv;
 638	bool is_hdmi2_sink = display_info->hdmi.scdc.supported;
 639	unsigned int phy_freq;
 640	unsigned int vclk_freq;
 641	unsigned int venc_freq;
 642	unsigned int hdmi_freq;
 643	int vic = drm_match_cea_mode(mode);
 644	enum drm_mode_status status;
 645
 646	DRM_DEBUG_DRIVER("Modeline " DRM_MODE_FMT "\n", DRM_MODE_ARG(mode));
 647
 648	/* If sink does not support 540MHz, reject the non-420 HDMI2 modes */
 649	if (display_info->max_tmds_clock &&
 650	    mode->clock > display_info->max_tmds_clock &&
 651	    !drm_mode_is_420_only(display_info, mode) &&
 652	    !drm_mode_is_420_also(display_info, mode))
 653		return MODE_BAD;
 654
 655	/* Check against non-VIC supported modes */
 656	if (!vic) {
 657		status = meson_venc_hdmi_supported_mode(mode);
 658		if (status != MODE_OK)
 659			return status;
 660
 661		return meson_vclk_dmt_supported_freq(priv, mode->clock);
 662	/* Check against supported VIC modes */
 663	} else if (!meson_venc_hdmi_supported_vic(vic))
 664		return MODE_BAD;
 665
 666	vclk_freq = mode->clock;
 667
 668	/* For 420, pixel clock is half unlike venc clock */
 669	if (drm_mode_is_420_only(display_info, mode) ||
 670	    (!is_hdmi2_sink &&
 671	     drm_mode_is_420_also(display_info, mode)))
 672		vclk_freq /= 2;
 673
 674	/* TMDS clock is pixel_clock * 10 */
 675	phy_freq = vclk_freq * 10;
 676
 677	/* 480i/576i needs global pixel doubling */
 678	if (mode->flags & DRM_MODE_FLAG_DBLCLK)
 679		vclk_freq *= 2;
 680
 681	venc_freq = vclk_freq;
 682	hdmi_freq = vclk_freq;
 683
 684	/* VENC double pixels for 1080i, 720p and YUV420 modes */
 685	if (meson_venc_hdmi_venc_repeat(vic) ||
 686	    drm_mode_is_420_only(display_info, mode) ||
 687	    (!is_hdmi2_sink &&
 688	     drm_mode_is_420_also(display_info, mode)))
 689		venc_freq *= 2;
 690
 691	vclk_freq = max(venc_freq, hdmi_freq);
 692
 693	if (mode->flags & DRM_MODE_FLAG_DBLCLK)
 694		venc_freq /= 2;
 695
 696	dev_dbg(dw_hdmi->dev, "%s: vclk:%d phy=%d venc=%d hdmi=%d\n",
 697		__func__, phy_freq, vclk_freq, venc_freq, hdmi_freq);
 698
 699	return meson_vclk_vic_supported_freq(priv, phy_freq, vclk_freq);
 700}
 701
 702/* Encoder */
 703
 704static const u32 meson_dw_hdmi_out_bus_fmts[] = {
 705	MEDIA_BUS_FMT_YUV8_1X24,
 706	MEDIA_BUS_FMT_UYYVYY8_0_5X24,
 707};
 708
 709static void meson_venc_hdmi_encoder_destroy(struct drm_encoder *encoder)
 710{
 711	drm_encoder_cleanup(encoder);
 712}
 713
 714static const struct drm_encoder_funcs meson_venc_hdmi_encoder_funcs = {
 715	.destroy        = meson_venc_hdmi_encoder_destroy,
 716};
 717
 718static u32 *
 719meson_venc_hdmi_encoder_get_inp_bus_fmts(struct drm_bridge *bridge,
 720					struct drm_bridge_state *bridge_state,
 721					struct drm_crtc_state *crtc_state,
 722					struct drm_connector_state *conn_state,
 723					u32 output_fmt,
 724					unsigned int *num_input_fmts)
 725{
 726	u32 *input_fmts = NULL;
 727	int i;
 728
 729	*num_input_fmts = 0;
 730
 731	for (i = 0 ; i < ARRAY_SIZE(meson_dw_hdmi_out_bus_fmts) ; ++i) {
 732		if (output_fmt == meson_dw_hdmi_out_bus_fmts[i]) {
 733			*num_input_fmts = 1;
 734			input_fmts = kcalloc(*num_input_fmts,
 735					     sizeof(*input_fmts),
 736					     GFP_KERNEL);
 737			if (!input_fmts)
 738				return NULL;
 739
 740			input_fmts[0] = output_fmt;
 741
 742			break;
 743		}
 744	}
 745
 746	return input_fmts;
 747}
 748
 749static int meson_venc_hdmi_encoder_atomic_check(struct drm_bridge *bridge,
 750					struct drm_bridge_state *bridge_state,
 751					struct drm_crtc_state *crtc_state,
 752					struct drm_connector_state *conn_state)
 753{
 754	struct meson_dw_hdmi *dw_hdmi = bridge_to_meson_dw_hdmi(bridge);
 755
 756	dw_hdmi->output_bus_fmt = bridge_state->output_bus_cfg.format;
 757
 758	DRM_DEBUG_DRIVER("output_bus_fmt %lx\n", dw_hdmi->output_bus_fmt);
 759
 760	return 0;
 761}
 762
 763static void meson_venc_hdmi_encoder_disable(struct drm_bridge *bridge)
 764{
 765	struct meson_dw_hdmi *dw_hdmi = bridge_to_meson_dw_hdmi(bridge);
 766	struct meson_drm *priv = dw_hdmi->priv;
 767
 768	DRM_DEBUG_DRIVER("\n");
 769
 770	writel_bits_relaxed(0x3, 0,
 771			    priv->io_base + _REG(VPU_HDMI_SETTING));
 772
 773	writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
 774	writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
 775}
 776
 777static void meson_venc_hdmi_encoder_enable(struct drm_bridge *bridge)
 778{
 779	struct meson_dw_hdmi *dw_hdmi = bridge_to_meson_dw_hdmi(bridge);
 780	struct meson_drm *priv = dw_hdmi->priv;
 781
 782	DRM_DEBUG_DRIVER("%s\n", priv->venc.hdmi_use_enci ? "VENCI" : "VENCP");
 783
 784	if (priv->venc.hdmi_use_enci)
 785		writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
 786	else
 787		writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN));
 788}
 789
 790static void meson_venc_hdmi_encoder_mode_set(struct drm_bridge *bridge,
 791				   const struct drm_display_mode *mode,
 792				   const struct drm_display_mode *adjusted_mode)
 793{
 794	struct meson_dw_hdmi *dw_hdmi = bridge_to_meson_dw_hdmi(bridge);
 795	struct meson_drm *priv = dw_hdmi->priv;
 796	int vic = drm_match_cea_mode(mode);
 797	unsigned int ycrcb_map = VPU_HDMI_OUTPUT_CBYCR;
 798	bool yuv420_mode = false;
 799
 800	DRM_DEBUG_DRIVER("\"%s\" vic %d\n", mode->name, vic);
 801
 802	if (dw_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24) {
 803		ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
 804		yuv420_mode = true;
 805	}
 806
 807	/* VENC + VENC-DVI Mode setup */
 808	meson_venc_hdmi_mode_set(priv, vic, ycrcb_map, yuv420_mode, mode);
 809
 810	/* VCLK Set clock */
 811	dw_hdmi_set_vclk(dw_hdmi, mode);
 812
 813	if (dw_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
 814		/* Setup YUV420 to HDMI-TX, no 10bit diphering */
 815		writel_relaxed(2 | (2 << 2),
 816			       priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
 817	else
 818		/* Setup YUV444 to HDMI-TX, no 10bit diphering */
 819		writel_relaxed(0, priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
 820}
 821
 822static const struct drm_bridge_funcs meson_venc_hdmi_encoder_bridge_funcs = {
 823	.atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
 824	.atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
 825	.atomic_get_input_bus_fmts = meson_venc_hdmi_encoder_get_inp_bus_fmts,
 826	.atomic_reset = drm_atomic_helper_bridge_reset,
 827	.atomic_check = meson_venc_hdmi_encoder_atomic_check,
 828	.enable	= meson_venc_hdmi_encoder_enable,
 829	.disable = meson_venc_hdmi_encoder_disable,
 830	.mode_set = meson_venc_hdmi_encoder_mode_set,
 831};
 832
 833/* DW HDMI Regmap */
 834
 835static int meson_dw_hdmi_reg_read(void *context, unsigned int reg,
 836				  unsigned int *result)
 837{
 838	struct meson_dw_hdmi *dw_hdmi = context;
 839
 840	*result = dw_hdmi->data->dwc_read(dw_hdmi, reg);
 841
 842	return 0;
 843
 844}
 845
 846static int meson_dw_hdmi_reg_write(void *context, unsigned int reg,
 847				   unsigned int val)
 848{
 849	struct meson_dw_hdmi *dw_hdmi = context;
 850
 851	dw_hdmi->data->dwc_write(dw_hdmi, reg, val);
 852
 853	return 0;
 854}
 855
 856static const struct regmap_config meson_dw_hdmi_regmap_config = {
 857	.reg_bits = 32,
 858	.val_bits = 8,
 859	.reg_read = meson_dw_hdmi_reg_read,
 860	.reg_write = meson_dw_hdmi_reg_write,
 861	.max_register = 0x10000,
 862	.fast_io = true,
 863};
 864
 865static const struct meson_dw_hdmi_data meson_dw_hdmi_gx_data = {
 866	.top_read = dw_hdmi_top_read,
 867	.top_write = dw_hdmi_top_write,
 868	.dwc_read = dw_hdmi_dwc_read,
 869	.dwc_write = dw_hdmi_dwc_write,
 870};
 871
 872static const struct meson_dw_hdmi_data meson_dw_hdmi_g12a_data = {
 873	.top_read = dw_hdmi_g12a_top_read,
 874	.top_write = dw_hdmi_g12a_top_write,
 875	.dwc_read = dw_hdmi_g12a_dwc_read,
 876	.dwc_write = dw_hdmi_g12a_dwc_write,
 877};
 878
 879static bool meson_hdmi_connector_is_available(struct device *dev)
 880{
 881	struct device_node *ep, *remote;
 882
 883	/* HDMI Connector is on the second port, first endpoint */
 884	ep = of_graph_get_endpoint_by_regs(dev->of_node, 1, 0);
 885	if (!ep)
 886		return false;
 887
 888	/* If the endpoint node exists, consider it enabled */
 889	remote = of_graph_get_remote_port(ep);
 890	if (remote) {
 891		of_node_put(ep);
 892		return true;
 893	}
 894
 895	of_node_put(ep);
 896	of_node_put(remote);
 897
 898	return false;
 899}
 900
 901static void meson_dw_hdmi_init(struct meson_dw_hdmi *meson_dw_hdmi)
 902{
 903	struct meson_drm *priv = meson_dw_hdmi->priv;
 904
 905	/* Enable clocks */
 906	regmap_update_bits(priv->hhi, HHI_HDMI_CLK_CNTL, 0xffff, 0x100);
 907
 908	/* Bring HDMITX MEM output of power down */
 909	regmap_update_bits(priv->hhi, HHI_MEM_PD_REG0, 0xff << 8, 0);
 910
 911	/* Reset HDMITX APB & TX & PHY */
 912	reset_control_reset(meson_dw_hdmi->hdmitx_apb);
 913	reset_control_reset(meson_dw_hdmi->hdmitx_ctrl);
 914	reset_control_reset(meson_dw_hdmi->hdmitx_phy);
 915
 916	/* Enable APB3 fail on error */
 917	if (!meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A)) {
 918		writel_bits_relaxed(BIT(15), BIT(15),
 919				    meson_dw_hdmi->hdmitx + HDMITX_TOP_CTRL_REG);
 920		writel_bits_relaxed(BIT(15), BIT(15),
 921				    meson_dw_hdmi->hdmitx + HDMITX_DWC_CTRL_REG);
 922	}
 923
 924	/* Bring out of reset */
 925	meson_dw_hdmi->data->top_write(meson_dw_hdmi,
 926				       HDMITX_TOP_SW_RESET,  0);
 927
 928	msleep(20);
 929
 930	meson_dw_hdmi->data->top_write(meson_dw_hdmi,
 931				       HDMITX_TOP_CLK_CNTL, 0xff);
 932
 933	/* Enable HDMI-TX Interrupt */
 934	meson_dw_hdmi->data->top_write(meson_dw_hdmi, HDMITX_TOP_INTR_STAT_CLR,
 935				       HDMITX_TOP_INTR_CORE);
 936
 937	meson_dw_hdmi->data->top_write(meson_dw_hdmi, HDMITX_TOP_INTR_MASKN,
 938				       HDMITX_TOP_INTR_CORE);
 939
 940}
 941
 942static void meson_disable_regulator(void *data)
 943{
 944	regulator_disable(data);
 945}
 946
 947static void meson_disable_clk(void *data)
 948{
 949	clk_disable_unprepare(data);
 950}
 951
 952static int meson_enable_clk(struct device *dev, char *name)
 953{
 954	struct clk *clk;
 955	int ret;
 956
 957	clk = devm_clk_get(dev, name);
 958	if (IS_ERR(clk)) {
 959		dev_err(dev, "Unable to get %s pclk\n", name);
 960		return PTR_ERR(clk);
 961	}
 962
 963	ret = clk_prepare_enable(clk);
 964	if (!ret)
 965		ret = devm_add_action_or_reset(dev, meson_disable_clk, clk);
 966
 967	return ret;
 968}
 969
 970static int meson_dw_hdmi_bind(struct device *dev, struct device *master,
 971				void *data)
 972{
 973	struct platform_device *pdev = to_platform_device(dev);
 974	const struct meson_dw_hdmi_data *match;
 975	struct meson_dw_hdmi *meson_dw_hdmi;
 976	struct drm_device *drm = data;
 977	struct meson_drm *priv = drm->dev_private;
 978	struct dw_hdmi_plat_data *dw_plat_data;
 979	struct drm_bridge *next_bridge;
 980	struct drm_encoder *encoder;
 981	struct resource *res;
 982	int irq;
 983	int ret;
 984
 985	DRM_DEBUG_DRIVER("\n");
 986
 987	if (!meson_hdmi_connector_is_available(dev)) {
 988		dev_info(drm->dev, "HDMI Output connector not available\n");
 989		return -ENODEV;
 990	}
 991
 992	match = of_device_get_match_data(&pdev->dev);
 993	if (!match) {
 994		dev_err(&pdev->dev, "failed to get match data\n");
 995		return -ENODEV;
 996	}
 997
 998	meson_dw_hdmi = devm_kzalloc(dev, sizeof(*meson_dw_hdmi),
 999				     GFP_KERNEL);
1000	if (!meson_dw_hdmi)
1001		return -ENOMEM;
1002
1003	meson_dw_hdmi->priv = priv;
1004	meson_dw_hdmi->dev = dev;
1005	meson_dw_hdmi->data = match;
1006	dw_plat_data = &meson_dw_hdmi->dw_plat_data;
1007	encoder = &meson_dw_hdmi->encoder;
1008
1009	meson_dw_hdmi->hdmi_supply = devm_regulator_get_optional(dev, "hdmi");
1010	if (IS_ERR(meson_dw_hdmi->hdmi_supply)) {
1011		if (PTR_ERR(meson_dw_hdmi->hdmi_supply) == -EPROBE_DEFER)
1012			return -EPROBE_DEFER;
1013		meson_dw_hdmi->hdmi_supply = NULL;
1014	} else {
1015		ret = regulator_enable(meson_dw_hdmi->hdmi_supply);
1016		if (ret)
1017			return ret;
1018		ret = devm_add_action_or_reset(dev, meson_disable_regulator,
1019					       meson_dw_hdmi->hdmi_supply);
1020		if (ret)
1021			return ret;
1022	}
1023
1024	meson_dw_hdmi->hdmitx_apb = devm_reset_control_get_exclusive(dev,
1025						"hdmitx_apb");
1026	if (IS_ERR(meson_dw_hdmi->hdmitx_apb)) {
1027		dev_err(dev, "Failed to get hdmitx_apb reset\n");
1028		return PTR_ERR(meson_dw_hdmi->hdmitx_apb);
1029	}
1030
1031	meson_dw_hdmi->hdmitx_ctrl = devm_reset_control_get_exclusive(dev,
1032						"hdmitx");
1033	if (IS_ERR(meson_dw_hdmi->hdmitx_ctrl)) {
1034		dev_err(dev, "Failed to get hdmitx reset\n");
1035		return PTR_ERR(meson_dw_hdmi->hdmitx_ctrl);
1036	}
1037
1038	meson_dw_hdmi->hdmitx_phy = devm_reset_control_get_exclusive(dev,
1039						"hdmitx_phy");
1040	if (IS_ERR(meson_dw_hdmi->hdmitx_phy)) {
1041		dev_err(dev, "Failed to get hdmitx_phy reset\n");
1042		return PTR_ERR(meson_dw_hdmi->hdmitx_phy);
1043	}
1044
1045	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1046	meson_dw_hdmi->hdmitx = devm_ioremap_resource(dev, res);
1047	if (IS_ERR(meson_dw_hdmi->hdmitx))
1048		return PTR_ERR(meson_dw_hdmi->hdmitx);
1049
1050	ret = meson_enable_clk(dev, "isfr");
1051	if (ret)
1052		return ret;
1053
1054	ret = meson_enable_clk(dev, "iahb");
1055	if (ret)
1056		return ret;
1057
1058	ret = meson_enable_clk(dev, "venci");
1059	if (ret)
1060		return ret;
1061
1062	dw_plat_data->regm = devm_regmap_init(dev, NULL, meson_dw_hdmi,
1063					      &meson_dw_hdmi_regmap_config);
1064	if (IS_ERR(dw_plat_data->regm))
1065		return PTR_ERR(dw_plat_data->regm);
1066
1067	irq = platform_get_irq(pdev, 0);
1068	if (irq < 0)
1069		return irq;
1070
1071	ret = devm_request_threaded_irq(dev, irq, dw_hdmi_top_irq,
1072					dw_hdmi_top_thread_irq, IRQF_SHARED,
1073					"dw_hdmi_top_irq", meson_dw_hdmi);
1074	if (ret) {
1075		dev_err(dev, "Failed to request hdmi top irq\n");
1076		return ret;
1077	}
1078
1079	/* Encoder */
1080
1081	ret = drm_encoder_init(drm, encoder, &meson_venc_hdmi_encoder_funcs,
1082			       DRM_MODE_ENCODER_TMDS, "meson_hdmi");
1083	if (ret) {
1084		dev_err(priv->dev, "Failed to init HDMI encoder\n");
1085		return ret;
1086	}
1087
1088	meson_dw_hdmi->bridge.funcs = &meson_venc_hdmi_encoder_bridge_funcs;
1089	drm_bridge_attach(encoder, &meson_dw_hdmi->bridge, NULL, 0);
1090
1091	encoder->possible_crtcs = BIT(0);
1092
1093	meson_dw_hdmi_init(meson_dw_hdmi);
1094
1095	DRM_DEBUG_DRIVER("encoder initialized\n");
1096
1097	/* Bridge / Connector */
1098
1099	dw_plat_data->priv_data = meson_dw_hdmi;
1100	dw_plat_data->mode_valid = dw_hdmi_mode_valid;
1101	dw_plat_data->phy_ops = &meson_dw_hdmi_phy_ops;
1102	dw_plat_data->phy_name = "meson_dw_hdmi_phy";
1103	dw_plat_data->phy_data = meson_dw_hdmi;
1104	dw_plat_data->input_bus_encoding = V4L2_YCBCR_ENC_709;
1105	dw_plat_data->ycbcr_420_allowed = true;
1106	dw_plat_data->disable_cec = true;
1107
1108	if (dw_hdmi_is_compatible(meson_dw_hdmi, "amlogic,meson-gxl-dw-hdmi") ||
1109	    dw_hdmi_is_compatible(meson_dw_hdmi, "amlogic,meson-gxm-dw-hdmi") ||
1110	    dw_hdmi_is_compatible(meson_dw_hdmi, "amlogic,meson-g12a-dw-hdmi"))
1111		dw_plat_data->use_drm_infoframe = true;
1112
1113	platform_set_drvdata(pdev, meson_dw_hdmi);
1114
1115	meson_dw_hdmi->hdmi = dw_hdmi_probe(pdev,
1116					    &meson_dw_hdmi->dw_plat_data);
1117	if (IS_ERR(meson_dw_hdmi->hdmi))
1118		return PTR_ERR(meson_dw_hdmi->hdmi);
1119
1120	next_bridge = of_drm_find_bridge(pdev->dev.of_node);
1121	if (next_bridge)
1122		drm_bridge_attach(encoder, next_bridge,
1123				  &meson_dw_hdmi->bridge, 0);
1124
1125	DRM_DEBUG_DRIVER("HDMI controller initialized\n");
1126
1127	return 0;
1128}
1129
1130static void meson_dw_hdmi_unbind(struct device *dev, struct device *master,
1131				   void *data)
1132{
1133	struct meson_dw_hdmi *meson_dw_hdmi = dev_get_drvdata(dev);
1134
1135	dw_hdmi_unbind(meson_dw_hdmi->hdmi);
1136}
1137
1138static const struct component_ops meson_dw_hdmi_ops = {
1139	.bind	= meson_dw_hdmi_bind,
1140	.unbind	= meson_dw_hdmi_unbind,
1141};
1142
1143static int __maybe_unused meson_dw_hdmi_pm_suspend(struct device *dev)
1144{
1145	struct meson_dw_hdmi *meson_dw_hdmi = dev_get_drvdata(dev);
1146
1147	if (!meson_dw_hdmi)
1148		return 0;
1149
1150	/* Reset TOP */
1151	meson_dw_hdmi->data->top_write(meson_dw_hdmi,
1152				       HDMITX_TOP_SW_RESET, 0);
1153
1154	return 0;
1155}
1156
1157static int __maybe_unused meson_dw_hdmi_pm_resume(struct device *dev)
1158{
1159	struct meson_dw_hdmi *meson_dw_hdmi = dev_get_drvdata(dev);
1160
1161	if (!meson_dw_hdmi)
1162		return 0;
1163
1164	meson_dw_hdmi_init(meson_dw_hdmi);
1165
1166	dw_hdmi_resume(meson_dw_hdmi->hdmi);
1167
1168	return 0;
1169}
1170
1171static int meson_dw_hdmi_probe(struct platform_device *pdev)
1172{
1173	return component_add(&pdev->dev, &meson_dw_hdmi_ops);
1174}
1175
1176static int meson_dw_hdmi_remove(struct platform_device *pdev)
1177{
1178	component_del(&pdev->dev, &meson_dw_hdmi_ops);
1179
1180	return 0;
1181}
1182
1183static const struct dev_pm_ops meson_dw_hdmi_pm_ops = {
1184	SET_SYSTEM_SLEEP_PM_OPS(meson_dw_hdmi_pm_suspend,
1185				meson_dw_hdmi_pm_resume)
1186};
1187
1188static const struct of_device_id meson_dw_hdmi_of_table[] = {
1189	{ .compatible = "amlogic,meson-gxbb-dw-hdmi",
1190	  .data = &meson_dw_hdmi_gx_data },
1191	{ .compatible = "amlogic,meson-gxl-dw-hdmi",
1192	  .data = &meson_dw_hdmi_gx_data },
1193	{ .compatible = "amlogic,meson-gxm-dw-hdmi",
1194	  .data = &meson_dw_hdmi_gx_data },
1195	{ .compatible = "amlogic,meson-g12a-dw-hdmi",
1196	  .data = &meson_dw_hdmi_g12a_data },
1197	{ }
1198};
1199MODULE_DEVICE_TABLE(of, meson_dw_hdmi_of_table);
1200
1201static struct platform_driver meson_dw_hdmi_platform_driver = {
1202	.probe		= meson_dw_hdmi_probe,
1203	.remove		= meson_dw_hdmi_remove,
1204	.driver		= {
1205		.name		= DRIVER_NAME,
1206		.of_match_table	= meson_dw_hdmi_of_table,
1207		.pm = &meson_dw_hdmi_pm_ops,
1208	},
1209};
1210module_platform_driver(meson_dw_hdmi_platform_driver);
1211
1212MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");
1213MODULE_DESCRIPTION(DRIVER_DESC);
1214MODULE_LICENSE("GPL");