xref: /openbmc/linux/drivers/gpu/drm/omapdrm/dss/hdmi4.c (revision d17eb4537a7eb16da9eafbfd5717e12b45b77251)
19960aa7cSTomi Valkeinen /*
29960aa7cSTomi Valkeinen  * HDMI interface DSS driver for TI's OMAP4 family of SoCs.
3bb5cdf8dSAndrew F. Davis  *
49960aa7cSTomi Valkeinen  * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
59960aa7cSTomi Valkeinen  * Authors: Yong Zhi
69960aa7cSTomi Valkeinen  *	Mythri pk <mythripk@ti.com>
79960aa7cSTomi Valkeinen  *
89960aa7cSTomi Valkeinen  * This program is free software; you can redistribute it and/or modify it
99960aa7cSTomi Valkeinen  * under the terms of the GNU General Public License version 2 as published by
109960aa7cSTomi Valkeinen  * the Free Software Foundation.
119960aa7cSTomi Valkeinen  *
129960aa7cSTomi Valkeinen  * This program is distributed in the hope that it will be useful, but WITHOUT
139960aa7cSTomi Valkeinen  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
149960aa7cSTomi Valkeinen  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
159960aa7cSTomi Valkeinen  * more details.
169960aa7cSTomi Valkeinen  *
179960aa7cSTomi Valkeinen  * You should have received a copy of the GNU General Public License along with
189960aa7cSTomi Valkeinen  * this program.  If not, see <http://www.gnu.org/licenses/>.
199960aa7cSTomi Valkeinen  */
209960aa7cSTomi Valkeinen 
219960aa7cSTomi Valkeinen #define DSS_SUBSYS_NAME "HDMI"
229960aa7cSTomi Valkeinen 
239960aa7cSTomi Valkeinen #include <linux/kernel.h>
249960aa7cSTomi Valkeinen #include <linux/module.h>
259960aa7cSTomi Valkeinen #include <linux/err.h>
269960aa7cSTomi Valkeinen #include <linux/io.h>
279960aa7cSTomi Valkeinen #include <linux/interrupt.h>
289960aa7cSTomi Valkeinen #include <linux/mutex.h>
299960aa7cSTomi Valkeinen #include <linux/delay.h>
309960aa7cSTomi Valkeinen #include <linux/string.h>
319960aa7cSTomi Valkeinen #include <linux/platform_device.h>
329960aa7cSTomi Valkeinen #include <linux/pm_runtime.h>
339960aa7cSTomi Valkeinen #include <linux/clk.h>
349960aa7cSTomi Valkeinen #include <linux/gpio.h>
359960aa7cSTomi Valkeinen #include <linux/regulator/consumer.h>
369960aa7cSTomi Valkeinen #include <linux/component.h>
37d9e32ecdSTomi Valkeinen #include <linux/of.h>
3809bffa6eSRob Herring #include <linux/of_graph.h>
399960aa7cSTomi Valkeinen #include <sound/omap-hdmi-audio.h>
401897e1a3SHans Verkuil #include <media/cec.h>
419960aa7cSTomi Valkeinen 
4232043da7SPeter Ujfalusi #include "omapdss.h"
439960aa7cSTomi Valkeinen #include "hdmi4_core.h"
441897e1a3SHans Verkuil #include "hdmi4_cec.h"
459960aa7cSTomi Valkeinen #include "dss.h"
469960aa7cSTomi Valkeinen #include "hdmi.h"
479960aa7cSTomi Valkeinen 
48ac767456SLaurent Pinchart static int hdmi_runtime_get(struct omap_hdmi *hdmi)
499960aa7cSTomi Valkeinen {
509960aa7cSTomi Valkeinen 	int r;
519960aa7cSTomi Valkeinen 
529960aa7cSTomi Valkeinen 	DSSDBG("hdmi_runtime_get\n");
539960aa7cSTomi Valkeinen 
54ac767456SLaurent Pinchart 	r = pm_runtime_get_sync(&hdmi->pdev->dev);
559960aa7cSTomi Valkeinen 	WARN_ON(r < 0);
569960aa7cSTomi Valkeinen 	if (r < 0)
579960aa7cSTomi Valkeinen 		return r;
589960aa7cSTomi Valkeinen 
599960aa7cSTomi Valkeinen 	return 0;
609960aa7cSTomi Valkeinen }
619960aa7cSTomi Valkeinen 
62ac767456SLaurent Pinchart static void hdmi_runtime_put(struct omap_hdmi *hdmi)
639960aa7cSTomi Valkeinen {
649960aa7cSTomi Valkeinen 	int r;
659960aa7cSTomi Valkeinen 
669960aa7cSTomi Valkeinen 	DSSDBG("hdmi_runtime_put\n");
679960aa7cSTomi Valkeinen 
68ac767456SLaurent Pinchart 	r = pm_runtime_put_sync(&hdmi->pdev->dev);
699960aa7cSTomi Valkeinen 	WARN_ON(r < 0 && r != -ENOSYS);
709960aa7cSTomi Valkeinen }
719960aa7cSTomi Valkeinen 
729960aa7cSTomi Valkeinen static irqreturn_t hdmi_irq_handler(int irq, void *data)
739960aa7cSTomi Valkeinen {
74f3096a4aSHans Verkuil 	struct omap_hdmi *hdmi = data;
75f3096a4aSHans Verkuil 	struct hdmi_wp_data *wp = &hdmi->wp;
769960aa7cSTomi Valkeinen 	u32 irqstatus;
779960aa7cSTomi Valkeinen 
789960aa7cSTomi Valkeinen 	irqstatus = hdmi_wp_get_irqstatus(wp);
799960aa7cSTomi Valkeinen 	hdmi_wp_set_irqstatus(wp, irqstatus);
809960aa7cSTomi Valkeinen 
819960aa7cSTomi Valkeinen 	if ((irqstatus & HDMI_IRQ_LINK_CONNECT) &&
829960aa7cSTomi Valkeinen 			irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
839960aa7cSTomi Valkeinen 		/*
849960aa7cSTomi Valkeinen 		 * If we get both connect and disconnect interrupts at the same
859960aa7cSTomi Valkeinen 		 * time, turn off the PHY, clear interrupts, and restart, which
869960aa7cSTomi Valkeinen 		 * raises connect interrupt if a cable is connected, or nothing
879960aa7cSTomi Valkeinen 		 * if cable is not connected.
889960aa7cSTomi Valkeinen 		 */
899960aa7cSTomi Valkeinen 		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF);
909960aa7cSTomi Valkeinen 
919960aa7cSTomi Valkeinen 		hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT |
929960aa7cSTomi Valkeinen 				HDMI_IRQ_LINK_DISCONNECT);
939960aa7cSTomi Valkeinen 
949960aa7cSTomi Valkeinen 		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
959960aa7cSTomi Valkeinen 	} else if (irqstatus & HDMI_IRQ_LINK_CONNECT) {
969960aa7cSTomi Valkeinen 		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON);
979960aa7cSTomi Valkeinen 	} else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
989960aa7cSTomi Valkeinen 		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
999960aa7cSTomi Valkeinen 	}
1001897e1a3SHans Verkuil 	if (irqstatus & HDMI_IRQ_CORE) {
1011897e1a3SHans Verkuil 		u32 intr4 = hdmi_read_reg(hdmi->core.base, HDMI_CORE_SYS_INTR4);
1021897e1a3SHans Verkuil 
1031897e1a3SHans Verkuil 		hdmi_write_reg(hdmi->core.base, HDMI_CORE_SYS_INTR4, intr4);
1041897e1a3SHans Verkuil 		if (intr4 & 8)
1051897e1a3SHans Verkuil 			hdmi4_cec_irq(&hdmi->core);
1061897e1a3SHans Verkuil 	}
1079960aa7cSTomi Valkeinen 
1089960aa7cSTomi Valkeinen 	return IRQ_HANDLED;
1099960aa7cSTomi Valkeinen }
1109960aa7cSTomi Valkeinen 
111ac767456SLaurent Pinchart static int hdmi_power_on_core(struct omap_hdmi *hdmi)
1129960aa7cSTomi Valkeinen {
1139960aa7cSTomi Valkeinen 	int r;
1149960aa7cSTomi Valkeinen 
115ac767456SLaurent Pinchart 	if (hdmi->core.core_pwr_cnt++)
116a141a296SHans Verkuil 		return 0;
117a141a296SHans Verkuil 
118ac767456SLaurent Pinchart 	r = regulator_enable(hdmi->vdda_reg);
1199960aa7cSTomi Valkeinen 	if (r)
120a141a296SHans Verkuil 		goto err_reg_enable;
1219960aa7cSTomi Valkeinen 
122ac767456SLaurent Pinchart 	r = hdmi_runtime_get(hdmi);
1239960aa7cSTomi Valkeinen 	if (r)
1249960aa7cSTomi Valkeinen 		goto err_runtime_get;
1259960aa7cSTomi Valkeinen 
126ac767456SLaurent Pinchart 	hdmi4_core_powerdown_disable(&hdmi->core);
1271d54ecf2SHans Verkuil 
1289960aa7cSTomi Valkeinen 	/* Make selection of HDMI in DSS */
129ac767456SLaurent Pinchart 	dss_select_hdmi_venc_clk_source(hdmi->dss, DSS_HDMI_M_PCLK);
1309960aa7cSTomi Valkeinen 
131ac767456SLaurent Pinchart 	hdmi->core_enabled = true;
1329960aa7cSTomi Valkeinen 
1339960aa7cSTomi Valkeinen 	return 0;
1349960aa7cSTomi Valkeinen 
1359960aa7cSTomi Valkeinen err_runtime_get:
136ac767456SLaurent Pinchart 	regulator_disable(hdmi->vdda_reg);
137a141a296SHans Verkuil err_reg_enable:
138ac767456SLaurent Pinchart 	hdmi->core.core_pwr_cnt--;
1399960aa7cSTomi Valkeinen 
1409960aa7cSTomi Valkeinen 	return r;
1419960aa7cSTomi Valkeinen }
1429960aa7cSTomi Valkeinen 
143ac767456SLaurent Pinchart static void hdmi_power_off_core(struct omap_hdmi *hdmi)
1449960aa7cSTomi Valkeinen {
145ac767456SLaurent Pinchart 	if (--hdmi->core.core_pwr_cnt)
146a141a296SHans Verkuil 		return;
147a141a296SHans Verkuil 
148ac767456SLaurent Pinchart 	hdmi->core_enabled = false;
1499960aa7cSTomi Valkeinen 
150ac767456SLaurent Pinchart 	hdmi_runtime_put(hdmi);
151ac767456SLaurent Pinchart 	regulator_disable(hdmi->vdda_reg);
1529960aa7cSTomi Valkeinen }
1539960aa7cSTomi Valkeinen 
154ac767456SLaurent Pinchart static int hdmi_power_on_full(struct omap_hdmi *hdmi)
1559960aa7cSTomi Valkeinen {
1569960aa7cSTomi Valkeinen 	int r;
15795e472daSLaurent Pinchart 	const struct videomode *vm;
158ac767456SLaurent Pinchart 	struct hdmi_wp_data *wp = &hdmi->wp;
1599960aa7cSTomi Valkeinen 	struct dss_pll_clock_info hdmi_cinfo = { 0 };
160d11e5c82SLaurent Pinchart 	unsigned int pc;
1619960aa7cSTomi Valkeinen 
162ac767456SLaurent Pinchart 	r = hdmi_power_on_core(hdmi);
1639960aa7cSTomi Valkeinen 	if (r)
1649960aa7cSTomi Valkeinen 		return r;
1659960aa7cSTomi Valkeinen 
1669960aa7cSTomi Valkeinen 	/* disable and clear irqs */
167f3096a4aSHans Verkuil 	hdmi_wp_clear_irqenable(wp, ~HDMI_IRQ_CORE);
168f3096a4aSHans Verkuil 	hdmi_wp_set_irqstatus(wp, ~HDMI_IRQ_CORE);
1699960aa7cSTomi Valkeinen 
170ac767456SLaurent Pinchart 	vm = &hdmi->cfg.vm;
1719960aa7cSTomi Valkeinen 
172da11bbbbSPeter Ujfalusi 	DSSDBG("hdmi_power_on hactive= %d vactive = %d\n", vm->hactive,
173da11bbbbSPeter Ujfalusi 	       vm->vactive);
1749960aa7cSTomi Valkeinen 
175da11bbbbSPeter Ujfalusi 	pc = vm->pixelclock;
176da11bbbbSPeter Ujfalusi 	if (vm->flags & DISPLAY_FLAGS_DOUBLECLK)
17767d8ffddSTomi Valkeinen 		pc *= 2;
17867d8ffddSTomi Valkeinen 
179c107751dSTomi Valkeinen 	/* DSS_HDMI_TCLK is bitclk / 10 */
180c107751dSTomi Valkeinen 	pc *= 10;
181c107751dSTomi Valkeinen 
182ac767456SLaurent Pinchart 	dss_pll_calc_b(&hdmi->pll.pll, clk_get_rate(hdmi->pll.pll.clkin),
183c17dc0e3STomi Valkeinen 		pc, &hdmi_cinfo);
1849960aa7cSTomi Valkeinen 
185ac767456SLaurent Pinchart 	r = dss_pll_enable(&hdmi->pll.pll);
1869960aa7cSTomi Valkeinen 	if (r) {
1879960aa7cSTomi Valkeinen 		DSSERR("Failed to enable PLL\n");
1889960aa7cSTomi Valkeinen 		goto err_pll_enable;
1899960aa7cSTomi Valkeinen 	}
1909960aa7cSTomi Valkeinen 
191ac767456SLaurent Pinchart 	r = dss_pll_set_config(&hdmi->pll.pll, &hdmi_cinfo);
1929960aa7cSTomi Valkeinen 	if (r) {
1939960aa7cSTomi Valkeinen 		DSSERR("Failed to configure PLL\n");
1949960aa7cSTomi Valkeinen 		goto err_pll_cfg;
1959960aa7cSTomi Valkeinen 	}
1969960aa7cSTomi Valkeinen 
197ac767456SLaurent Pinchart 	r = hdmi_phy_configure(&hdmi->phy, hdmi_cinfo.clkdco,
1989960aa7cSTomi Valkeinen 		hdmi_cinfo.clkout[0]);
1999960aa7cSTomi Valkeinen 	if (r) {
2009960aa7cSTomi Valkeinen 		DSSDBG("Failed to configure PHY\n");
2019960aa7cSTomi Valkeinen 		goto err_phy_cfg;
2029960aa7cSTomi Valkeinen 	}
2039960aa7cSTomi Valkeinen 
2049960aa7cSTomi Valkeinen 	r = hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
2059960aa7cSTomi Valkeinen 	if (r)
2069960aa7cSTomi Valkeinen 		goto err_phy_pwr;
2079960aa7cSTomi Valkeinen 
208ac767456SLaurent Pinchart 	hdmi4_configure(&hdmi->core, &hdmi->wp, &hdmi->cfg);
2099960aa7cSTomi Valkeinen 
210ac767456SLaurent Pinchart 	r = dss_mgr_enable(&hdmi->output);
2119960aa7cSTomi Valkeinen 	if (r)
2129960aa7cSTomi Valkeinen 		goto err_mgr_enable;
2139960aa7cSTomi Valkeinen 
214ac767456SLaurent Pinchart 	r = hdmi_wp_video_start(&hdmi->wp);
2154e4b53ceSTomi Valkeinen 	if (r)
2164e4b53ceSTomi Valkeinen 		goto err_vid_enable;
2174e4b53ceSTomi Valkeinen 
2189960aa7cSTomi Valkeinen 	hdmi_wp_set_irqenable(wp,
2199960aa7cSTomi Valkeinen 		HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);
2209960aa7cSTomi Valkeinen 
2219960aa7cSTomi Valkeinen 	return 0;
2229960aa7cSTomi Valkeinen 
2239960aa7cSTomi Valkeinen err_vid_enable:
224ac767456SLaurent Pinchart 	dss_mgr_disable(&hdmi->output);
2254e4b53ceSTomi Valkeinen err_mgr_enable:
226ac767456SLaurent Pinchart 	hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF);
2279960aa7cSTomi Valkeinen err_phy_pwr:
2289960aa7cSTomi Valkeinen err_phy_cfg:
2299960aa7cSTomi Valkeinen err_pll_cfg:
230ac767456SLaurent Pinchart 	dss_pll_disable(&hdmi->pll.pll);
2319960aa7cSTomi Valkeinen err_pll_enable:
232ac767456SLaurent Pinchart 	hdmi_power_off_core(hdmi);
2339960aa7cSTomi Valkeinen 	return -EIO;
2349960aa7cSTomi Valkeinen }
2359960aa7cSTomi Valkeinen 
236ac767456SLaurent Pinchart static void hdmi_power_off_full(struct omap_hdmi *hdmi)
2379960aa7cSTomi Valkeinen {
238ac767456SLaurent Pinchart 	hdmi_wp_clear_irqenable(&hdmi->wp, ~HDMI_IRQ_CORE);
2399960aa7cSTomi Valkeinen 
240ac767456SLaurent Pinchart 	hdmi_wp_video_stop(&hdmi->wp);
2419960aa7cSTomi Valkeinen 
242ac767456SLaurent Pinchart 	dss_mgr_disable(&hdmi->output);
2434e4b53ceSTomi Valkeinen 
244ac767456SLaurent Pinchart 	hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF);
2459960aa7cSTomi Valkeinen 
246ac767456SLaurent Pinchart 	dss_pll_disable(&hdmi->pll.pll);
2479960aa7cSTomi Valkeinen 
248ac767456SLaurent Pinchart 	hdmi_power_off_core(hdmi);
2499960aa7cSTomi Valkeinen }
2509960aa7cSTomi Valkeinen 
251ec68cd5aSLaurent Pinchart static void hdmi_display_set_timings(struct omap_dss_device *dssdev,
2528fe1d361SLaurent Pinchart 				     const struct videomode *vm)
2539960aa7cSTomi Valkeinen {
254ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
2559960aa7cSTomi Valkeinen 
256ac767456SLaurent Pinchart 	mutex_lock(&hdmi->lock);
2579960aa7cSTomi Valkeinen 
258ac767456SLaurent Pinchart 	hdmi->cfg.vm = *vm;
2599960aa7cSTomi Valkeinen 
260ac767456SLaurent Pinchart 	dispc_set_tv_pclk(hdmi->dss->dispc, vm->pixelclock);
261ac767456SLaurent Pinchart 
262ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
2639960aa7cSTomi Valkeinen }
2649960aa7cSTomi Valkeinen 
265f33656e1SLaurent Pinchart static int hdmi_dump_regs(struct seq_file *s, void *p)
2669960aa7cSTomi Valkeinen {
267ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = s->private;
2689960aa7cSTomi Valkeinen 
269ac767456SLaurent Pinchart 	mutex_lock(&hdmi->lock);
270ac767456SLaurent Pinchart 
271ac767456SLaurent Pinchart 	if (hdmi_runtime_get(hdmi)) {
272ac767456SLaurent Pinchart 		mutex_unlock(&hdmi->lock);
273f33656e1SLaurent Pinchart 		return 0;
2749960aa7cSTomi Valkeinen 	}
2759960aa7cSTomi Valkeinen 
276ac767456SLaurent Pinchart 	hdmi_wp_dump(&hdmi->wp, s);
277ac767456SLaurent Pinchart 	hdmi_pll_dump(&hdmi->pll, s);
278ac767456SLaurent Pinchart 	hdmi_phy_dump(&hdmi->phy, s);
279ac767456SLaurent Pinchart 	hdmi4_core_dump(&hdmi->core, s);
2809960aa7cSTomi Valkeinen 
281ac767456SLaurent Pinchart 	hdmi_runtime_put(hdmi);
282ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
283f33656e1SLaurent Pinchart 	return 0;
2849960aa7cSTomi Valkeinen }
2859960aa7cSTomi Valkeinen 
286ac767456SLaurent Pinchart static int read_edid(struct omap_hdmi *hdmi, u8 *buf, int len)
2879960aa7cSTomi Valkeinen {
2889960aa7cSTomi Valkeinen 	int r;
2899960aa7cSTomi Valkeinen 
290ac767456SLaurent Pinchart 	mutex_lock(&hdmi->lock);
2919960aa7cSTomi Valkeinen 
292ac767456SLaurent Pinchart 	r = hdmi_runtime_get(hdmi);
2939960aa7cSTomi Valkeinen 	BUG_ON(r);
2949960aa7cSTomi Valkeinen 
295ac767456SLaurent Pinchart 	r = hdmi4_read_edid(&hdmi->core,  buf, len);
2969960aa7cSTomi Valkeinen 
297ac767456SLaurent Pinchart 	hdmi_runtime_put(hdmi);
298ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
2999960aa7cSTomi Valkeinen 
3009960aa7cSTomi Valkeinen 	return r;
3019960aa7cSTomi Valkeinen }
3029960aa7cSTomi Valkeinen 
3039960aa7cSTomi Valkeinen static void hdmi_start_audio_stream(struct omap_hdmi *hd)
3049960aa7cSTomi Valkeinen {
3059960aa7cSTomi Valkeinen 	hdmi_wp_audio_enable(&hd->wp, true);
3069960aa7cSTomi Valkeinen 	hdmi4_audio_start(&hd->core, &hd->wp);
3079960aa7cSTomi Valkeinen }
3089960aa7cSTomi Valkeinen 
3099960aa7cSTomi Valkeinen static void hdmi_stop_audio_stream(struct omap_hdmi *hd)
3109960aa7cSTomi Valkeinen {
3119960aa7cSTomi Valkeinen 	hdmi4_audio_stop(&hd->core, &hd->wp);
3129960aa7cSTomi Valkeinen 	hdmi_wp_audio_enable(&hd->wp, false);
3139960aa7cSTomi Valkeinen }
3149960aa7cSTomi Valkeinen 
31519b4200dSLaurent Pinchart static void hdmi_display_enable(struct omap_dss_device *dssdev)
3169960aa7cSTomi Valkeinen {
317ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
3189960aa7cSTomi Valkeinen 	unsigned long flags;
31919b4200dSLaurent Pinchart 	int r;
3209960aa7cSTomi Valkeinen 
3219960aa7cSTomi Valkeinen 	DSSDBG("ENTER hdmi_display_enable\n");
3229960aa7cSTomi Valkeinen 
323ac767456SLaurent Pinchart 	mutex_lock(&hdmi->lock);
3249960aa7cSTomi Valkeinen 
325ac767456SLaurent Pinchart 	r = hdmi_power_on_full(hdmi);
3269960aa7cSTomi Valkeinen 	if (r) {
3279960aa7cSTomi Valkeinen 		DSSERR("failed to power on device\n");
32819b4200dSLaurent Pinchart 		goto done;
3299960aa7cSTomi Valkeinen 	}
3309960aa7cSTomi Valkeinen 
331ac767456SLaurent Pinchart 	if (hdmi->audio_configured) {
332ac767456SLaurent Pinchart 		r = hdmi4_audio_config(&hdmi->core, &hdmi->wp,
333ac767456SLaurent Pinchart 				       &hdmi->audio_config,
334ac767456SLaurent Pinchart 				       hdmi->cfg.vm.pixelclock);
3359960aa7cSTomi Valkeinen 		if (r) {
3369960aa7cSTomi Valkeinen 			DSSERR("Error restoring audio configuration: %d", r);
337ac767456SLaurent Pinchart 			hdmi->audio_abort_cb(&hdmi->pdev->dev);
338ac767456SLaurent Pinchart 			hdmi->audio_configured = false;
3399960aa7cSTomi Valkeinen 		}
3409960aa7cSTomi Valkeinen 	}
3419960aa7cSTomi Valkeinen 
342ac767456SLaurent Pinchart 	spin_lock_irqsave(&hdmi->audio_playing_lock, flags);
343ac767456SLaurent Pinchart 	if (hdmi->audio_configured && hdmi->audio_playing)
344ac767456SLaurent Pinchart 		hdmi_start_audio_stream(hdmi);
345ac767456SLaurent Pinchart 	hdmi->display_enabled = true;
346ac767456SLaurent Pinchart 	spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags);
3479960aa7cSTomi Valkeinen 
34819b4200dSLaurent Pinchart done:
349ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
3509960aa7cSTomi Valkeinen }
3519960aa7cSTomi Valkeinen 
3529960aa7cSTomi Valkeinen static void hdmi_display_disable(struct omap_dss_device *dssdev)
3539960aa7cSTomi Valkeinen {
354ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
3559960aa7cSTomi Valkeinen 	unsigned long flags;
3569960aa7cSTomi Valkeinen 
3579960aa7cSTomi Valkeinen 	DSSDBG("Enter hdmi_display_disable\n");
3589960aa7cSTomi Valkeinen 
359ac767456SLaurent Pinchart 	mutex_lock(&hdmi->lock);
3609960aa7cSTomi Valkeinen 
361ac767456SLaurent Pinchart 	spin_lock_irqsave(&hdmi->audio_playing_lock, flags);
362ac767456SLaurent Pinchart 	hdmi_stop_audio_stream(hdmi);
363ac767456SLaurent Pinchart 	hdmi->display_enabled = false;
364ac767456SLaurent Pinchart 	spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags);
3659960aa7cSTomi Valkeinen 
366ac767456SLaurent Pinchart 	hdmi_power_off_full(hdmi);
3679960aa7cSTomi Valkeinen 
368ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
3699960aa7cSTomi Valkeinen }
3709960aa7cSTomi Valkeinen 
371ac767456SLaurent Pinchart int hdmi4_core_enable(struct hdmi_core_data *core)
3729960aa7cSTomi Valkeinen {
373ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = container_of(core, struct omap_hdmi, core);
3749960aa7cSTomi Valkeinen 	int r = 0;
3759960aa7cSTomi Valkeinen 
3765bebbbfeSHans Verkuil 	DSSDBG("ENTER omapdss_hdmi4_core_enable\n");
3779960aa7cSTomi Valkeinen 
378ac767456SLaurent Pinchart 	mutex_lock(&hdmi->lock);
3799960aa7cSTomi Valkeinen 
380ac767456SLaurent Pinchart 	r = hdmi_power_on_core(hdmi);
3819960aa7cSTomi Valkeinen 	if (r) {
3829960aa7cSTomi Valkeinen 		DSSERR("failed to power on device\n");
3839960aa7cSTomi Valkeinen 		goto err0;
3849960aa7cSTomi Valkeinen 	}
3859960aa7cSTomi Valkeinen 
386ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
3879960aa7cSTomi Valkeinen 	return 0;
3889960aa7cSTomi Valkeinen 
3899960aa7cSTomi Valkeinen err0:
390ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
3919960aa7cSTomi Valkeinen 	return r;
3929960aa7cSTomi Valkeinen }
3939960aa7cSTomi Valkeinen 
394ac767456SLaurent Pinchart void hdmi4_core_disable(struct hdmi_core_data *core)
3959960aa7cSTomi Valkeinen {
396ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = container_of(core, struct omap_hdmi, core);
397ac767456SLaurent Pinchart 
3985bebbbfeSHans Verkuil 	DSSDBG("Enter omapdss_hdmi4_core_disable\n");
3999960aa7cSTomi Valkeinen 
400ac767456SLaurent Pinchart 	mutex_lock(&hdmi->lock);
4019960aa7cSTomi Valkeinen 
402ac767456SLaurent Pinchart 	hdmi_power_off_core(hdmi);
4039960aa7cSTomi Valkeinen 
404ac767456SLaurent Pinchart 	mutex_unlock(&hdmi->lock);
4059960aa7cSTomi Valkeinen }
4069960aa7cSTomi Valkeinen 
407511afb44SLaurent Pinchart static int hdmi_connect(struct omap_dss_device *src,
4089960aa7cSTomi Valkeinen 			struct omap_dss_device *dst)
4099960aa7cSTomi Valkeinen {
410f8a8eabbSLaurent Pinchart 	return omapdss_device_connect(dst->dss, dst, dst->next);
41171316556SLaurent Pinchart }
41271316556SLaurent Pinchart 
413511afb44SLaurent Pinchart static void hdmi_disconnect(struct omap_dss_device *src,
4149960aa7cSTomi Valkeinen 			    struct omap_dss_device *dst)
4159960aa7cSTomi Valkeinen {
416511afb44SLaurent Pinchart 	omapdss_device_disconnect(dst, dst->next);
4179960aa7cSTomi Valkeinen }
4189960aa7cSTomi Valkeinen 
4199960aa7cSTomi Valkeinen static int hdmi_read_edid(struct omap_dss_device *dssdev,
4209960aa7cSTomi Valkeinen 		u8 *edid, int len)
4219960aa7cSTomi Valkeinen {
422ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
4239960aa7cSTomi Valkeinen 	bool need_enable;
4249960aa7cSTomi Valkeinen 	int r;
4259960aa7cSTomi Valkeinen 
426ac767456SLaurent Pinchart 	need_enable = hdmi->core_enabled == false;
4279960aa7cSTomi Valkeinen 
4289960aa7cSTomi Valkeinen 	if (need_enable) {
429ac767456SLaurent Pinchart 		r = hdmi4_core_enable(&hdmi->core);
4309960aa7cSTomi Valkeinen 		if (r)
4319960aa7cSTomi Valkeinen 			return r;
4329960aa7cSTomi Valkeinen 	}
4339960aa7cSTomi Valkeinen 
434ac767456SLaurent Pinchart 	r = read_edid(hdmi, edid, len);
4351897e1a3SHans Verkuil 	if (r >= 256)
436ac767456SLaurent Pinchart 		hdmi4_cec_set_phys_addr(&hdmi->core,
4371897e1a3SHans Verkuil 					cec_get_edid_phys_addr(edid, r, NULL));
4381897e1a3SHans Verkuil 	else
439ac767456SLaurent Pinchart 		hdmi4_cec_set_phys_addr(&hdmi->core, CEC_PHYS_ADDR_INVALID);
4409960aa7cSTomi Valkeinen 	if (need_enable)
441ac767456SLaurent Pinchart 		hdmi4_core_disable(&hdmi->core);
4429960aa7cSTomi Valkeinen 
4439960aa7cSTomi Valkeinen 	return r;
4449960aa7cSTomi Valkeinen }
4459960aa7cSTomi Valkeinen 
446019114efSHans Verkuil static void hdmi_lost_hotplug(struct omap_dss_device *dssdev)
447019114efSHans Verkuil {
448ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
449ac767456SLaurent Pinchart 
450ac767456SLaurent Pinchart 	hdmi4_cec_set_phys_addr(&hdmi->core, CEC_PHYS_ADDR_INVALID);
451019114efSHans Verkuil }
452019114efSHans Verkuil 
4539960aa7cSTomi Valkeinen static int hdmi_set_infoframe(struct omap_dss_device *dssdev,
4549960aa7cSTomi Valkeinen 		const struct hdmi_avi_infoframe *avi)
4559960aa7cSTomi Valkeinen {
456ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
457ac767456SLaurent Pinchart 
458ac767456SLaurent Pinchart 	hdmi->cfg.infoframe = *avi;
4599960aa7cSTomi Valkeinen 	return 0;
4609960aa7cSTomi Valkeinen }
4619960aa7cSTomi Valkeinen 
4629960aa7cSTomi Valkeinen static int hdmi_set_hdmi_mode(struct omap_dss_device *dssdev,
4639960aa7cSTomi Valkeinen 		bool hdmi_mode)
4649960aa7cSTomi Valkeinen {
465ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
466ac767456SLaurent Pinchart 
467ac767456SLaurent Pinchart 	hdmi->cfg.hdmi_dvi_mode = hdmi_mode ? HDMI_HDMI : HDMI_DVI;
4689960aa7cSTomi Valkeinen 	return 0;
4699960aa7cSTomi Valkeinen }
4709960aa7cSTomi Valkeinen 
471b93109d7SLaurent Pinchart static const struct omap_dss_device_ops hdmi_ops = {
4729960aa7cSTomi Valkeinen 	.connect		= hdmi_connect,
4739960aa7cSTomi Valkeinen 	.disconnect		= hdmi_disconnect,
4749960aa7cSTomi Valkeinen 
4759960aa7cSTomi Valkeinen 	.enable			= hdmi_display_enable,
4769960aa7cSTomi Valkeinen 	.disable		= hdmi_display_disable,
4779960aa7cSTomi Valkeinen 
478ec68cd5aSLaurent Pinchart 	.set_timings		= hdmi_display_set_timings,
4799960aa7cSTomi Valkeinen 
4809960aa7cSTomi Valkeinen 	.read_edid		= hdmi_read_edid,
48183910ad3SLaurent Pinchart 
48283910ad3SLaurent Pinchart 	.hdmi = {
483019114efSHans Verkuil 		.lost_hotplug		= hdmi_lost_hotplug,
4849960aa7cSTomi Valkeinen 		.set_infoframe		= hdmi_set_infoframe,
4859960aa7cSTomi Valkeinen 		.set_hdmi_mode		= hdmi_set_hdmi_mode,
486b93109d7SLaurent Pinchart 	},
4879960aa7cSTomi Valkeinen };
4889960aa7cSTomi Valkeinen 
4895fc15d98SLaurent Pinchart /* -----------------------------------------------------------------------------
4905fc15d98SLaurent Pinchart  * Audio Callbacks
4915fc15d98SLaurent Pinchart  */
4929960aa7cSTomi Valkeinen 
4939960aa7cSTomi Valkeinen static int hdmi_audio_startup(struct device *dev,
4949960aa7cSTomi Valkeinen 			      void (*abort_cb)(struct device *dev))
4959960aa7cSTomi Valkeinen {
4969960aa7cSTomi Valkeinen 	struct omap_hdmi *hd = dev_get_drvdata(dev);
4979960aa7cSTomi Valkeinen 
4989960aa7cSTomi Valkeinen 	mutex_lock(&hd->lock);
4999960aa7cSTomi Valkeinen 
500c1899cb3SJyri Sarha 	WARN_ON(hd->audio_abort_cb != NULL);
5019960aa7cSTomi Valkeinen 
5029960aa7cSTomi Valkeinen 	hd->audio_abort_cb = abort_cb;
5039960aa7cSTomi Valkeinen 
5049960aa7cSTomi Valkeinen 	mutex_unlock(&hd->lock);
5059960aa7cSTomi Valkeinen 
506c1899cb3SJyri Sarha 	return 0;
5079960aa7cSTomi Valkeinen }
5089960aa7cSTomi Valkeinen 
5099960aa7cSTomi Valkeinen static int hdmi_audio_shutdown(struct device *dev)
5109960aa7cSTomi Valkeinen {
5119960aa7cSTomi Valkeinen 	struct omap_hdmi *hd = dev_get_drvdata(dev);
5129960aa7cSTomi Valkeinen 
5139960aa7cSTomi Valkeinen 	mutex_lock(&hd->lock);
5149960aa7cSTomi Valkeinen 	hd->audio_abort_cb = NULL;
5159960aa7cSTomi Valkeinen 	hd->audio_configured = false;
5169960aa7cSTomi Valkeinen 	hd->audio_playing = false;
5179960aa7cSTomi Valkeinen 	mutex_unlock(&hd->lock);
5189960aa7cSTomi Valkeinen 
5199960aa7cSTomi Valkeinen 	return 0;
5209960aa7cSTomi Valkeinen }
5219960aa7cSTomi Valkeinen 
5229960aa7cSTomi Valkeinen static int hdmi_audio_start(struct device *dev)
5239960aa7cSTomi Valkeinen {
5249960aa7cSTomi Valkeinen 	struct omap_hdmi *hd = dev_get_drvdata(dev);
5259960aa7cSTomi Valkeinen 	unsigned long flags;
5269960aa7cSTomi Valkeinen 
5279960aa7cSTomi Valkeinen 	spin_lock_irqsave(&hd->audio_playing_lock, flags);
5289960aa7cSTomi Valkeinen 
529c1899cb3SJyri Sarha 	if (hd->display_enabled) {
530c1899cb3SJyri Sarha 		if (!hdmi_mode_has_audio(&hd->cfg))
531c1899cb3SJyri Sarha 			DSSERR("%s: Video mode does not support audio\n",
532c1899cb3SJyri Sarha 			       __func__);
5339960aa7cSTomi Valkeinen 		hdmi_start_audio_stream(hd);
534c1899cb3SJyri Sarha 	}
5359960aa7cSTomi Valkeinen 	hd->audio_playing = true;
5369960aa7cSTomi Valkeinen 
5379960aa7cSTomi Valkeinen 	spin_unlock_irqrestore(&hd->audio_playing_lock, flags);
5389960aa7cSTomi Valkeinen 	return 0;
5399960aa7cSTomi Valkeinen }
5409960aa7cSTomi Valkeinen 
5419960aa7cSTomi Valkeinen static void hdmi_audio_stop(struct device *dev)
5429960aa7cSTomi Valkeinen {
5439960aa7cSTomi Valkeinen 	struct omap_hdmi *hd = dev_get_drvdata(dev);
5449960aa7cSTomi Valkeinen 	unsigned long flags;
5459960aa7cSTomi Valkeinen 
5469960aa7cSTomi Valkeinen 	WARN_ON(!hdmi_mode_has_audio(&hd->cfg));
5479960aa7cSTomi Valkeinen 
5489960aa7cSTomi Valkeinen 	spin_lock_irqsave(&hd->audio_playing_lock, flags);
5499960aa7cSTomi Valkeinen 
5509960aa7cSTomi Valkeinen 	if (hd->display_enabled)
5519960aa7cSTomi Valkeinen 		hdmi_stop_audio_stream(hd);
5529960aa7cSTomi Valkeinen 	hd->audio_playing = false;
5539960aa7cSTomi Valkeinen 
5549960aa7cSTomi Valkeinen 	spin_unlock_irqrestore(&hd->audio_playing_lock, flags);
5559960aa7cSTomi Valkeinen }
5569960aa7cSTomi Valkeinen 
5579960aa7cSTomi Valkeinen static int hdmi_audio_config(struct device *dev,
5589960aa7cSTomi Valkeinen 			     struct omap_dss_audio *dss_audio)
5599960aa7cSTomi Valkeinen {
5609960aa7cSTomi Valkeinen 	struct omap_hdmi *hd = dev_get_drvdata(dev);
56177eeac24STomi Valkeinen 	int ret = 0;
5629960aa7cSTomi Valkeinen 
5639960aa7cSTomi Valkeinen 	mutex_lock(&hd->lock);
5649960aa7cSTomi Valkeinen 
565c1899cb3SJyri Sarha 	if (hd->display_enabled) {
566c1899cb3SJyri Sarha 		ret = hdmi4_audio_config(&hd->core, &hd->wp, dss_audio,
567c1899cb3SJyri Sarha 					 hd->cfg.vm.pixelclock);
568c1899cb3SJyri Sarha 		if (ret)
5699960aa7cSTomi Valkeinen 			goto out;
5709960aa7cSTomi Valkeinen 	}
5719960aa7cSTomi Valkeinen 
5729960aa7cSTomi Valkeinen 	hd->audio_configured = true;
5739960aa7cSTomi Valkeinen 	hd->audio_config = *dss_audio;
5749960aa7cSTomi Valkeinen out:
5759960aa7cSTomi Valkeinen 	mutex_unlock(&hd->lock);
5769960aa7cSTomi Valkeinen 
5779960aa7cSTomi Valkeinen 	return ret;
5789960aa7cSTomi Valkeinen }
5799960aa7cSTomi Valkeinen 
5809960aa7cSTomi Valkeinen static const struct omap_hdmi_audio_ops hdmi_audio_ops = {
5819960aa7cSTomi Valkeinen 	.audio_startup = hdmi_audio_startup,
5829960aa7cSTomi Valkeinen 	.audio_shutdown = hdmi_audio_shutdown,
5839960aa7cSTomi Valkeinen 	.audio_start = hdmi_audio_start,
5849960aa7cSTomi Valkeinen 	.audio_stop = hdmi_audio_stop,
5859960aa7cSTomi Valkeinen 	.audio_config = hdmi_audio_config,
5869960aa7cSTomi Valkeinen };
5879960aa7cSTomi Valkeinen 
588ac767456SLaurent Pinchart static int hdmi_audio_register(struct omap_hdmi *hdmi)
5899960aa7cSTomi Valkeinen {
5909960aa7cSTomi Valkeinen 	struct omap_hdmi_audio_pdata pdata = {
591ac767456SLaurent Pinchart 		.dev = &hdmi->pdev->dev,
592d20fa5a0SLaurent Pinchart 		.version = 4,
593ac767456SLaurent Pinchart 		.audio_dma_addr = hdmi_wp_get_audio_dma_addr(&hdmi->wp),
5949960aa7cSTomi Valkeinen 		.ops = &hdmi_audio_ops,
5959960aa7cSTomi Valkeinen 	};
5969960aa7cSTomi Valkeinen 
597ac767456SLaurent Pinchart 	hdmi->audio_pdev = platform_device_register_data(
598ac767456SLaurent Pinchart 		&hdmi->pdev->dev, "omap-hdmi-audio", PLATFORM_DEVID_AUTO,
5999960aa7cSTomi Valkeinen 		&pdata, sizeof(pdata));
6009960aa7cSTomi Valkeinen 
601ac767456SLaurent Pinchart 	if (IS_ERR(hdmi->audio_pdev))
602ac767456SLaurent Pinchart 		return PTR_ERR(hdmi->audio_pdev);
6039960aa7cSTomi Valkeinen 
6049960aa7cSTomi Valkeinen 	return 0;
6059960aa7cSTomi Valkeinen }
6069960aa7cSTomi Valkeinen 
6075fc15d98SLaurent Pinchart /* -----------------------------------------------------------------------------
6085fc15d98SLaurent Pinchart  * Component Bind & Unbind
6095fc15d98SLaurent Pinchart  */
6105fc15d98SLaurent Pinchart 
6119960aa7cSTomi Valkeinen static int hdmi4_bind(struct device *dev, struct device *master, void *data)
6129960aa7cSTomi Valkeinen {
6137b295257SLaurent Pinchart 	struct dss_device *dss = dss_get_device(master);
6145fc15d98SLaurent Pinchart 	struct omap_hdmi *hdmi = dev_get_drvdata(dev);
6159960aa7cSTomi Valkeinen 	int r;
6169960aa7cSTomi Valkeinen 
617ac767456SLaurent Pinchart 	hdmi->dss = dss;
6189960aa7cSTomi Valkeinen 
619f8523b64SLaurent Pinchart 	r = hdmi_runtime_get(hdmi);
6209960aa7cSTomi Valkeinen 	if (r)
6215fc15d98SLaurent Pinchart 		return r;
6229960aa7cSTomi Valkeinen 
623f8523b64SLaurent Pinchart 	r = hdmi_pll_init(dss, hdmi->pdev, &hdmi->pll, &hdmi->wp);
624f8523b64SLaurent Pinchart 	if (r)
625f8523b64SLaurent Pinchart 		goto err_runtime_put;
626f8523b64SLaurent Pinchart 
6275fc15d98SLaurent Pinchart 	r = hdmi4_cec_init(hdmi->pdev, &hdmi->core, &hdmi->wp);
6289960aa7cSTomi Valkeinen 	if (r)
6295fc15d98SLaurent Pinchart 		goto err_pll_uninit;
6309960aa7cSTomi Valkeinen 
631ac767456SLaurent Pinchart 	r = hdmi_audio_register(hdmi);
6329960aa7cSTomi Valkeinen 	if (r) {
6339960aa7cSTomi Valkeinen 		DSSERR("Registering HDMI audio failed\n");
6345fc15d98SLaurent Pinchart 		goto err_cec_uninit;
6359960aa7cSTomi Valkeinen 	}
6369960aa7cSTomi Valkeinen 
637ac767456SLaurent Pinchart 	hdmi->debugfs = dss_debugfs_create_file(dss, "hdmi", hdmi_dump_regs,
638ac767456SLaurent Pinchart 					       hdmi);
6399960aa7cSTomi Valkeinen 
640f8523b64SLaurent Pinchart 	hdmi_runtime_put(hdmi);
641f8523b64SLaurent Pinchart 
6429960aa7cSTomi Valkeinen 	return 0;
643ac767456SLaurent Pinchart 
6445fc15d98SLaurent Pinchart err_cec_uninit:
6455fc15d98SLaurent Pinchart 	hdmi4_cec_uninit(&hdmi->core);
6465fc15d98SLaurent Pinchart err_pll_uninit:
647ac767456SLaurent Pinchart 	hdmi_pll_uninit(&hdmi->pll);
648f8523b64SLaurent Pinchart err_runtime_put:
649f8523b64SLaurent Pinchart 	hdmi_runtime_put(hdmi);
6509960aa7cSTomi Valkeinen 	return r;
6519960aa7cSTomi Valkeinen }
6529960aa7cSTomi Valkeinen 
6539960aa7cSTomi Valkeinen static void hdmi4_unbind(struct device *dev, struct device *master, void *data)
6549960aa7cSTomi Valkeinen {
655ac767456SLaurent Pinchart 	struct omap_hdmi *hdmi = dev_get_drvdata(dev);
6569960aa7cSTomi Valkeinen 
657ac767456SLaurent Pinchart 	dss_debugfs_remove_file(hdmi->debugfs);
658f33656e1SLaurent Pinchart 
659ac767456SLaurent Pinchart 	if (hdmi->audio_pdev)
660ac767456SLaurent Pinchart 		platform_device_unregister(hdmi->audio_pdev);
6619960aa7cSTomi Valkeinen 
662ac767456SLaurent Pinchart 	hdmi4_cec_uninit(&hdmi->core);
663ac767456SLaurent Pinchart 	hdmi_pll_uninit(&hdmi->pll);
6649960aa7cSTomi Valkeinen }
6659960aa7cSTomi Valkeinen 
6669960aa7cSTomi Valkeinen static const struct component_ops hdmi4_component_ops = {
6679960aa7cSTomi Valkeinen 	.bind	= hdmi4_bind,
6689960aa7cSTomi Valkeinen 	.unbind	= hdmi4_unbind,
6699960aa7cSTomi Valkeinen };
6709960aa7cSTomi Valkeinen 
6715fc15d98SLaurent Pinchart /* -----------------------------------------------------------------------------
6725fc15d98SLaurent Pinchart  * Probe & Remove, Suspend & Resume
6735fc15d98SLaurent Pinchart  */
6745fc15d98SLaurent Pinchart 
67527d62452SLaurent Pinchart static int hdmi4_init_output(struct omap_hdmi *hdmi)
6765fc15d98SLaurent Pinchart {
6775fc15d98SLaurent Pinchart 	struct omap_dss_device *out = &hdmi->output;
67871316556SLaurent Pinchart 	int r;
6795fc15d98SLaurent Pinchart 
6805fc15d98SLaurent Pinchart 	out->dev = &hdmi->pdev->dev;
6815fc15d98SLaurent Pinchart 	out->id = OMAP_DSS_OUTPUT_HDMI;
6825fc15d98SLaurent Pinchart 	out->output_type = OMAP_DISPLAY_TYPE_HDMI;
6835fc15d98SLaurent Pinchart 	out->name = "hdmi.0";
6845fc15d98SLaurent Pinchart 	out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
6855fc15d98SLaurent Pinchart 	out->ops = &hdmi_ops;
6865fc15d98SLaurent Pinchart 	out->owner = THIS_MODULE;
6875fc15d98SLaurent Pinchart 	out->of_ports = BIT(0);
68890279e95SLaurent Pinchart 	out->ops_flags = OMAP_DSS_DEVICE_OP_EDID;
6895fc15d98SLaurent Pinchart 
690*d17eb453SLaurent Pinchart 	r = omapdss_device_init_output(out);
691*d17eb453SLaurent Pinchart 	if (r < 0)
69271316556SLaurent Pinchart 		return r;
69371316556SLaurent Pinchart 
6945fc15d98SLaurent Pinchart 	omapdss_device_register(out);
69527d62452SLaurent Pinchart 
69627d62452SLaurent Pinchart 	return 0;
6975fc15d98SLaurent Pinchart }
6985fc15d98SLaurent Pinchart 
6995fc15d98SLaurent Pinchart static void hdmi4_uninit_output(struct omap_hdmi *hdmi)
7005fc15d98SLaurent Pinchart {
7015fc15d98SLaurent Pinchart 	struct omap_dss_device *out = &hdmi->output;
7025fc15d98SLaurent Pinchart 
7035fc15d98SLaurent Pinchart 	omapdss_device_unregister(out);
704*d17eb453SLaurent Pinchart 	omapdss_device_cleanup_output(out);
7055fc15d98SLaurent Pinchart }
7065fc15d98SLaurent Pinchart 
7075fc15d98SLaurent Pinchart static int hdmi4_probe_of(struct omap_hdmi *hdmi)
7085fc15d98SLaurent Pinchart {
7095fc15d98SLaurent Pinchart 	struct platform_device *pdev = hdmi->pdev;
7105fc15d98SLaurent Pinchart 	struct device_node *node = pdev->dev.of_node;
7115fc15d98SLaurent Pinchart 	struct device_node *ep;
7125fc15d98SLaurent Pinchart 	int r;
7135fc15d98SLaurent Pinchart 
7145fc15d98SLaurent Pinchart 	ep = of_graph_get_endpoint_by_regs(node, 0, 0);
7155fc15d98SLaurent Pinchart 	if (!ep)
7165fc15d98SLaurent Pinchart 		return 0;
7175fc15d98SLaurent Pinchart 
7185fc15d98SLaurent Pinchart 	r = hdmi_parse_lanes_of(pdev, ep, &hdmi->phy);
7195fc15d98SLaurent Pinchart 	of_node_put(ep);
7205fc15d98SLaurent Pinchart 	return r;
7215fc15d98SLaurent Pinchart }
7225fc15d98SLaurent Pinchart 
7239960aa7cSTomi Valkeinen static int hdmi4_probe(struct platform_device *pdev)
7249960aa7cSTomi Valkeinen {
7255fc15d98SLaurent Pinchart 	struct omap_hdmi *hdmi;
7265fc15d98SLaurent Pinchart 	int irq;
7275fc15d98SLaurent Pinchart 	int r;
7285fc15d98SLaurent Pinchart 
7295fc15d98SLaurent Pinchart 	hdmi = kzalloc(sizeof(*hdmi), GFP_KERNEL);
7305fc15d98SLaurent Pinchart 	if (!hdmi)
7315fc15d98SLaurent Pinchart 		return -ENOMEM;
7325fc15d98SLaurent Pinchart 
7335fc15d98SLaurent Pinchart 	hdmi->pdev = pdev;
7345fc15d98SLaurent Pinchart 
7355fc15d98SLaurent Pinchart 	dev_set_drvdata(&pdev->dev, hdmi);
7365fc15d98SLaurent Pinchart 
7375fc15d98SLaurent Pinchart 	mutex_init(&hdmi->lock);
7385fc15d98SLaurent Pinchart 	spin_lock_init(&hdmi->audio_playing_lock);
7395fc15d98SLaurent Pinchart 
7405fc15d98SLaurent Pinchart 	r = hdmi4_probe_of(hdmi);
7415fc15d98SLaurent Pinchart 	if (r)
7425fc15d98SLaurent Pinchart 		goto err_free;
7435fc15d98SLaurent Pinchart 
7445fc15d98SLaurent Pinchart 	r = hdmi_wp_init(pdev, &hdmi->wp, 4);
7455fc15d98SLaurent Pinchart 	if (r)
7465fc15d98SLaurent Pinchart 		goto err_free;
7475fc15d98SLaurent Pinchart 
7485fc15d98SLaurent Pinchart 	r = hdmi_phy_init(pdev, &hdmi->phy, 4);
7495fc15d98SLaurent Pinchart 	if (r)
7505fc15d98SLaurent Pinchart 		goto err_free;
7515fc15d98SLaurent Pinchart 
7525fc15d98SLaurent Pinchart 	r = hdmi4_core_init(pdev, &hdmi->core);
7535fc15d98SLaurent Pinchart 	if (r)
7545fc15d98SLaurent Pinchart 		goto err_free;
7555fc15d98SLaurent Pinchart 
7565fc15d98SLaurent Pinchart 	irq = platform_get_irq(pdev, 0);
7575fc15d98SLaurent Pinchart 	if (irq < 0) {
7585fc15d98SLaurent Pinchart 		DSSERR("platform_get_irq failed\n");
7595fc15d98SLaurent Pinchart 		r = -ENODEV;
7605fc15d98SLaurent Pinchart 		goto err_free;
7615fc15d98SLaurent Pinchart 	}
7625fc15d98SLaurent Pinchart 
7635fc15d98SLaurent Pinchart 	r = devm_request_threaded_irq(&pdev->dev, irq,
7645fc15d98SLaurent Pinchart 			NULL, hdmi_irq_handler,
7655fc15d98SLaurent Pinchart 			IRQF_ONESHOT, "OMAP HDMI", hdmi);
7665fc15d98SLaurent Pinchart 	if (r) {
7675fc15d98SLaurent Pinchart 		DSSERR("HDMI IRQ request failed\n");
7685fc15d98SLaurent Pinchart 		goto err_free;
7695fc15d98SLaurent Pinchart 	}
7705fc15d98SLaurent Pinchart 
7718a36357aSLaurent Pinchart 	hdmi->vdda_reg = devm_regulator_get(&pdev->dev, "vdda");
7728a36357aSLaurent Pinchart 	if (IS_ERR(hdmi->vdda_reg)) {
7738a36357aSLaurent Pinchart 		r = PTR_ERR(hdmi->vdda_reg);
7748a36357aSLaurent Pinchart 		if (r != -EPROBE_DEFER)
7758a36357aSLaurent Pinchart 			DSSERR("can't get VDDA regulator\n");
7768a36357aSLaurent Pinchart 		goto err_free;
7778a36357aSLaurent Pinchart 	}
7788a36357aSLaurent Pinchart 
7795fc15d98SLaurent Pinchart 	pm_runtime_enable(&pdev->dev);
7805fc15d98SLaurent Pinchart 
78127d62452SLaurent Pinchart 	r = hdmi4_init_output(hdmi);
78227d62452SLaurent Pinchart 	if (r)
78327d62452SLaurent Pinchart 		goto err_pm_disable;
7845fc15d98SLaurent Pinchart 
7855fc15d98SLaurent Pinchart 	r = component_add(&pdev->dev, &hdmi4_component_ops);
7865fc15d98SLaurent Pinchart 	if (r)
7875fc15d98SLaurent Pinchart 		goto err_uninit_output;
7885fc15d98SLaurent Pinchart 
7895fc15d98SLaurent Pinchart 	return 0;
7905fc15d98SLaurent Pinchart 
7915fc15d98SLaurent Pinchart err_uninit_output:
7925fc15d98SLaurent Pinchart 	hdmi4_uninit_output(hdmi);
79327d62452SLaurent Pinchart err_pm_disable:
7945fc15d98SLaurent Pinchart 	pm_runtime_disable(&pdev->dev);
7955fc15d98SLaurent Pinchart err_free:
7965fc15d98SLaurent Pinchart 	kfree(hdmi);
7975fc15d98SLaurent Pinchart 	return r;
7989960aa7cSTomi Valkeinen }
7999960aa7cSTomi Valkeinen 
8009960aa7cSTomi Valkeinen static int hdmi4_remove(struct platform_device *pdev)
8019960aa7cSTomi Valkeinen {
8025fc15d98SLaurent Pinchart 	struct omap_hdmi *hdmi = platform_get_drvdata(pdev);
8035fc15d98SLaurent Pinchart 
8049960aa7cSTomi Valkeinen 	component_del(&pdev->dev, &hdmi4_component_ops);
8055fc15d98SLaurent Pinchart 
8065fc15d98SLaurent Pinchart 	hdmi4_uninit_output(hdmi);
8075fc15d98SLaurent Pinchart 
8085fc15d98SLaurent Pinchart 	pm_runtime_disable(&pdev->dev);
8095fc15d98SLaurent Pinchart 
8105fc15d98SLaurent Pinchart 	kfree(hdmi);
8119960aa7cSTomi Valkeinen 	return 0;
8129960aa7cSTomi Valkeinen }
8139960aa7cSTomi Valkeinen 
8149960aa7cSTomi Valkeinen static const struct of_device_id hdmi_of_match[] = {
8159960aa7cSTomi Valkeinen 	{ .compatible = "ti,omap4-hdmi", },
8169960aa7cSTomi Valkeinen 	{},
8179960aa7cSTomi Valkeinen };
8189960aa7cSTomi Valkeinen 
819d66c36a3SAndrew F. Davis struct platform_driver omapdss_hdmi4hw_driver = {
8209960aa7cSTomi Valkeinen 	.probe		= hdmi4_probe,
8219960aa7cSTomi Valkeinen 	.remove		= hdmi4_remove,
8229960aa7cSTomi Valkeinen 	.driver         = {
8239960aa7cSTomi Valkeinen 		.name   = "omapdss_hdmi",
8249960aa7cSTomi Valkeinen 		.of_match_table = hdmi_of_match,
8259960aa7cSTomi Valkeinen 		.suppress_bind_attrs = true,
8269960aa7cSTomi Valkeinen 	},
8279960aa7cSTomi Valkeinen };
828