[mirror_ubuntu-jammy-kernel.git] / drivers / video / fbdev / omap2 / dss / hdmi5.c

/*
 * HDMI driver for OMAP5
 *
 * Copyright (C) 2014 Texas Instruments Incorporated
 *
 * Authors:
 *	Yong Zhi
 *	Mythri pk
 *	Archit Taneja <archit@ti.com>
 *	Tomi Valkeinen <tomi.valkeinen@ti.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#define DSS_SUBSYS_NAME "HDMI"

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/err.h>
#include <linux/io.h>
#include <linux/interrupt.h>
#include <linux/mutex.h>
#include <linux/delay.h>
#include <linux/string.h>
#include <linux/platform_device.h>
#include <linux/pm_runtime.h>
#include <linux/clk.h>
#include <linux/gpio.h>
#include <linux/regulator/consumer.h>
#include <video/omapdss.h>

#include "hdmi5_core.h"
#include "dss.h"
#include "dss_features.h"

static struct omap_hdmi hdmi;

static int hdmi_runtime_get(void)
{
	int r;

	DSSDBG("hdmi_runtime_get\n");

	r = pm_runtime_get_sync(&hdmi.pdev->dev);
	WARN_ON(r < 0);
	if (r < 0)
		return r;

	return 0;
}

static void hdmi_runtime_put(void)
{
	int r;

	DSSDBG("hdmi_runtime_put\n");

	r = pm_runtime_put_sync(&hdmi.pdev->dev);
	WARN_ON(r < 0 && r != -ENOSYS);
}

static irqreturn_t hdmi_irq_handler(int irq, void *data)
{
	struct hdmi_wp_data *wp = data;
	u32 irqstatus;

	irqstatus = hdmi_wp_get_irqstatus(wp);
	hdmi_wp_set_irqstatus(wp, irqstatus);

	if ((irqstatus & HDMI_IRQ_LINK_CONNECT) &&
			irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
		u32 v;
		/*
		 * If we get both connect and disconnect interrupts at the same
		 * time, turn off the PHY, clear interrupts, and restart, which
		 * raises connect interrupt if a cable is connected, or nothing
		 * if cable is not connected.
		 */

		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF);

		/*
		 * We always get bogus CONNECT & DISCONNECT interrupts when
		 * setting the PHY to LDOON. To ignore those, we force the RXDET
		 * line to 0 until the PHY power state has been changed.
		 */
		v = hdmi_read_reg(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL);
		v = FLD_MOD(v, 1, 15, 15); /* FORCE_RXDET_HIGH */
		v = FLD_MOD(v, 0, 14, 7); /* RXDET_LINE */
		hdmi_write_reg(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL, v);

		hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT |
				HDMI_IRQ_LINK_DISCONNECT);

		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);

		REG_FLD_MOD(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL, 0, 15, 15);

	} else if (irqstatus & HDMI_IRQ_LINK_CONNECT) {
		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON);
	} else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
		hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
	}

	return IRQ_HANDLED;
}

static int hdmi_init_regulator(void)
{
	int r;
	struct regulator *reg;

	if (hdmi.vdda_reg != NULL)
		return 0;

	reg = devm_regulator_get(&hdmi.pdev->dev, "vdda");
	if (IS_ERR(reg)) {
		DSSERR("can't get VDDA regulator\n");
		return PTR_ERR(reg);
	}

	if (regulator_can_change_voltage(reg)) {
		r = regulator_set_voltage(reg, 1800000, 1800000);
		if (r) {
			devm_regulator_put(reg);
			DSSWARN("can't set the regulator voltage\n");
			return r;
		}
	}

	hdmi.vdda_reg = reg;

	return 0;
}

static int hdmi_power_on_core(struct omap_dss_device *dssdev)
{
	int r;

	r = regulator_enable(hdmi.vdda_reg);
	if (r)
		return r;

	r = hdmi_runtime_get();
	if (r)
		goto err_runtime_get;

	/* Make selection of HDMI in DSS */
	dss_select_hdmi_venc_clk_source(DSS_HDMI_M_PCLK);

	hdmi.core_enabled = true;

	return 0;

err_runtime_get:
	regulator_disable(hdmi.vdda_reg);

	return r;
}

static void hdmi_power_off_core(struct omap_dss_device *dssdev)
{
	hdmi.core_enabled = false;

	hdmi_runtime_put();
	regulator_disable(hdmi.vdda_reg);
}

static int hdmi_power_on_full(struct omap_dss_device *dssdev)
{
	int r;
	struct omap_video_timings *p;
	struct omap_overlay_manager *mgr = hdmi.output.manager;
	struct dss_pll_clock_info hdmi_cinfo = { 0 };

	r = hdmi_power_on_core(dssdev);
	if (r)
		return r;

	p = &hdmi.cfg.timings;

	DSSDBG("hdmi_power_on x_res= %d y_res = %d\n", p->x_res, p->y_res);

	hdmi_pll_compute(&hdmi.pll, p->pixelclock, &hdmi_cinfo);

	/* disable and clear irqs */
	hdmi_wp_clear_irqenable(&hdmi.wp, 0xffffffff);
	hdmi_wp_set_irqstatus(&hdmi.wp,
			hdmi_wp_get_irqstatus(&hdmi.wp));

	r = dss_pll_enable(&hdmi.pll.pll);
	if (r) {
		DSSERR("Failed to enable PLL\n");
		goto err_pll_enable;
	}

	r = dss_pll_set_config(&hdmi.pll.pll, &hdmi_cinfo);
	if (r) {
		DSSERR("Failed to configure PLL\n");
		goto err_pll_cfg;
	}

	r = hdmi_phy_configure(&hdmi.phy, hdmi_cinfo.clkdco,
		hdmi_cinfo.clkout[0]);
	if (r) {
		DSSDBG("Failed to start PHY\n");
		goto err_phy_cfg;
	}

	r = hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_LDOON);
	if (r)
		goto err_phy_pwr;

	hdmi5_configure(&hdmi.core, &hdmi.wp, &hdmi.cfg);

	/* bypass TV gamma table */
	dispc_enable_gamma_table(0);

	/* tv size */
	dss_mgr_set_timings(mgr, p);

	r = hdmi_wp_video_start(&hdmi.wp);
	if (r)
		goto err_vid_enable;

	r = dss_mgr_enable(mgr);
	if (r)
		goto err_mgr_enable;

	hdmi_wp_set_irqenable(&hdmi.wp,
			HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);

	return 0;

err_mgr_enable:
	hdmi_wp_video_stop(&hdmi.wp);
err_vid_enable:
	hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);
err_phy_pwr:
err_phy_cfg:
err_pll_cfg:
	dss_pll_disable(&hdmi.pll.pll);
err_pll_enable:
	hdmi_power_off_core(dssdev);
	return -EIO;
}

static void hdmi_power_off_full(struct omap_dss_device *dssdev)
{
	struct omap_overlay_manager *mgr = hdmi.output.manager;

	hdmi_wp_clear_irqenable(&hdmi.wp, 0xffffffff);

	dss_mgr_disable(mgr);

	hdmi_wp_video_stop(&hdmi.wp);

	hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);

	dss_pll_disable(&hdmi.pll.pll);

	hdmi_power_off_core(dssdev);
}

static int hdmi_display_check_timing(struct omap_dss_device *dssdev,
					struct omap_video_timings *timings)
{
	struct omap_dss_device *out = &hdmi.output;

	/* TODO: proper interlace support */
	if (timings->interlace)
		return -EINVAL;

	if (!dispc_mgr_timings_ok(out->dispc_channel, timings))
		return -EINVAL;

	return 0;
}

static void hdmi_display_set_timing(struct omap_dss_device *dssdev,
		struct omap_video_timings *timings)
{
	mutex_lock(&hdmi.lock);

	hdmi.cfg.timings = *timings;

	dispc_set_tv_pclk(timings->pixelclock);

	mutex_unlock(&hdmi.lock);
}

static void hdmi_display_get_timings(struct omap_dss_device *dssdev,
		struct omap_video_timings *timings)
{
	*timings = hdmi.cfg.timings;
}

static void hdmi_dump_regs(struct seq_file *s)
{
	mutex_lock(&hdmi.lock);

	if (hdmi_runtime_get()) {
		mutex_unlock(&hdmi.lock);
		return;
	}

	hdmi_wp_dump(&hdmi.wp, s);
	hdmi_pll_dump(&hdmi.pll, s);
	hdmi_phy_dump(&hdmi.phy, s);
	hdmi5_core_dump(&hdmi.core, s);

	hdmi_runtime_put();
	mutex_unlock(&hdmi.lock);
}

static int read_edid(u8 *buf, int len)
{
	int r;
	int idlemode;

	mutex_lock(&hdmi.lock);

	r = hdmi_runtime_get();
	BUG_ON(r);

	idlemode = REG_GET(hdmi.wp.base, HDMI_WP_SYSCONFIG, 3, 2);
	/* No-idle mode */
	REG_FLD_MOD(hdmi.wp.base, HDMI_WP_SYSCONFIG, 1, 3, 2);

	r = hdmi5_read_edid(&hdmi.core,  buf, len);

	REG_FLD_MOD(hdmi.wp.base, HDMI_WP_SYSCONFIG, idlemode, 3, 2);

	hdmi_runtime_put();
	mutex_unlock(&hdmi.lock);

	return r;
}

static int hdmi_display_enable(struct omap_dss_device *dssdev)
{
	struct omap_dss_device *out = &hdmi.output;
	int r = 0;

	DSSDBG("ENTER hdmi_display_enable\n");

	mutex_lock(&hdmi.lock);

	if (out == NULL || out->manager == NULL) {
		DSSERR("failed to enable display: no output/manager\n");
		r = -ENODEV;
		goto err0;
	}

	r = hdmi_power_on_full(dssdev);
	if (r) {
		DSSERR("failed to power on device\n");
		goto err0;
	}

	mutex_unlock(&hdmi.lock);
	return 0;

err0:
	mutex_unlock(&hdmi.lock);
	return r;
}

static void hdmi_display_disable(struct omap_dss_device *dssdev)
{
	DSSDBG("Enter hdmi_display_disable\n");

	mutex_lock(&hdmi.lock);

	hdmi_power_off_full(dssdev);

	mutex_unlock(&hdmi.lock);
}

static int hdmi_core_enable(struct omap_dss_device *dssdev)
{
	int r = 0;

	DSSDBG("ENTER omapdss_hdmi_core_enable\n");

	mutex_lock(&hdmi.lock);

	r = hdmi_power_on_core(dssdev);
	if (r) {
		DSSERR("failed to power on device\n");
		goto err0;
	}

	mutex_unlock(&hdmi.lock);
	return 0;

err0:
	mutex_unlock(&hdmi.lock);
	return r;
}

static void hdmi_core_disable(struct omap_dss_device *dssdev)
{
	DSSDBG("Enter omapdss_hdmi_core_disable\n");

	mutex_lock(&hdmi.lock);

	hdmi_power_off_core(dssdev);

	mutex_unlock(&hdmi.lock);
}

static int hdmi_connect(struct omap_dss_device *dssdev,
		struct omap_dss_device *dst)
{
	struct omap_overlay_manager *mgr;
	int r;

	r = hdmi_init_regulator();
	if (r)
		return r;

	mgr = omap_dss_get_overlay_manager(dssdev->dispc_channel);
	if (!mgr)
		return -ENODEV;

	r = dss_mgr_connect(mgr, dssdev);
	if (r)
		return r;

	r = omapdss_output_set_device(dssdev, dst);
	if (r) {
		DSSERR("failed to connect output to new device: %s\n",
				dst->name);
		dss_mgr_disconnect(mgr, dssdev);
		return r;
	}

	return 0;
}

static void hdmi_disconnect(struct omap_dss_device *dssdev,
		struct omap_dss_device *dst)
{
	WARN_ON(dst != dssdev->dst);

	if (dst != dssdev->dst)
		return;

	omapdss_output_unset_device(dssdev);

	if (dssdev->manager)
		dss_mgr_disconnect(dssdev->manager, dssdev);
}

static int hdmi_read_edid(struct omap_dss_device *dssdev,
		u8 *edid, int len)
{
	bool need_enable;
	int r;

	need_enable = hdmi.core_enabled == false;

	if (need_enable) {
		r = hdmi_core_enable(dssdev);
		if (r)
			return r;
	}

	r = read_edid(edid, len);

	if (need_enable)
		hdmi_core_disable(dssdev);

	return r;
}

#if defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
static int hdmi_audio_enable(struct omap_dss_device *dssdev)
{
	int r;

	mutex_lock(&hdmi.lock);

	if (!hdmi_mode_has_audio(hdmi.cfg.hdmi_dvi_mode)) {
		r = -EPERM;
		goto err;
	}

	r = hdmi_wp_audio_enable(&hdmi.wp, true);
	if (r)
		goto err;

	mutex_unlock(&hdmi.lock);
	return 0;

err:
	mutex_unlock(&hdmi.lock);
	return r;
}

static void hdmi_audio_disable(struct omap_dss_device *dssdev)
{
	hdmi_wp_audio_enable(&hdmi.wp, false);
}

static int hdmi_audio_start(struct omap_dss_device *dssdev)
{
	return hdmi_wp_audio_core_req_enable(&hdmi.wp, true);
}

static void hdmi_audio_stop(struct omap_dss_device *dssdev)
{
	hdmi_wp_audio_core_req_enable(&hdmi.wp, false);
}

static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
{
	bool r;

	mutex_lock(&hdmi.lock);

	r = hdmi_mode_has_audio(hdmi.cfg.hdmi_dvi_mode);

	mutex_unlock(&hdmi.lock);
	return r;
}

static int hdmi_audio_config(struct omap_dss_device *dssdev,
		struct omap_dss_audio *audio)
{
	int r;
	u32 pclk = hdmi.cfg.timings.pixelclock;

	mutex_lock(&hdmi.lock);

	if (!hdmi_mode_has_audio(hdmi.cfg.hdmi_dvi_mode)) {
		r = -EPERM;
		goto err;
	}

	r = hdmi5_audio_config(&hdmi.core, &hdmi.wp, audio, pclk);
	if (r)
		goto err;

	mutex_unlock(&hdmi.lock);
	return 0;

err:
	mutex_unlock(&hdmi.lock);
	return r;
}
#else
static int hdmi_audio_enable(struct omap_dss_device *dssdev)
{
	return -EPERM;
}

static void hdmi_audio_disable(struct omap_dss_device *dssdev)
{
}

static int hdmi_audio_start(struct omap_dss_device *dssdev)
{
	return -EPERM;
}

static void hdmi_audio_stop(struct omap_dss_device *dssdev)
{
}

static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
{
	return false;
}

static int hdmi_audio_config(struct omap_dss_device *dssdev,
		struct omap_dss_audio *audio)
{
	return -EPERM;
}
#endif

static int hdmi_set_infoframe(struct omap_dss_device *dssdev,
		const struct hdmi_avi_infoframe *avi)
{
	hdmi.cfg.infoframe = *avi;
	return 0;
}

static int hdmi_set_hdmi_mode(struct omap_dss_device *dssdev,
		bool hdmi_mode)
{
	hdmi.cfg.hdmi_dvi_mode = hdmi_mode ? HDMI_HDMI : HDMI_DVI;
	return 0;
}

static const struct omapdss_hdmi_ops hdmi_ops = {
	.connect		= hdmi_connect,
	.disconnect		= hdmi_disconnect,

	.enable			= hdmi_display_enable,
	.disable		= hdmi_display_disable,

	.check_timings		= hdmi_display_check_timing,
	.set_timings		= hdmi_display_set_timing,
	.get_timings		= hdmi_display_get_timings,

	.read_edid		= hdmi_read_edid,
	.set_infoframe		= hdmi_set_infoframe,
	.set_hdmi_mode		= hdmi_set_hdmi_mode,

	.audio_enable		= hdmi_audio_enable,
	.audio_disable		= hdmi_audio_disable,
	.audio_start		= hdmi_audio_start,
	.audio_stop		= hdmi_audio_stop,
	.audio_supported	= hdmi_audio_supported,
	.audio_config		= hdmi_audio_config,
};

static void hdmi_init_output(struct platform_device *pdev)
{
	struct omap_dss_device *out = &hdmi.output;

	out->dev = &pdev->dev;
	out->id = OMAP_DSS_OUTPUT_HDMI;
	out->output_type = OMAP_DISPLAY_TYPE_HDMI;
	out->name = "hdmi.0";
	out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
	out->ops.hdmi = &hdmi_ops;
	out->owner = THIS_MODULE;

	omapdss_register_output(out);
}

static void __exit hdmi_uninit_output(struct platform_device *pdev)
{
	struct omap_dss_device *out = &hdmi.output;

	omapdss_unregister_output(out);
}

static int hdmi_probe_of(struct platform_device *pdev)
{
	struct device_node *node = pdev->dev.of_node;
	struct device_node *ep;
	int r;

	ep = omapdss_of_get_first_endpoint(node);
	if (!ep)
		return 0;

	r = hdmi_parse_lanes_of(pdev, ep, &hdmi.phy);
	if (r)
		goto err;

	of_node_put(ep);
	return 0;

err:
	of_node_put(ep);
	return r;
}

/* HDMI HW IP initialisation */
static int omapdss_hdmihw_probe(struct platform_device *pdev)
{
	int r;
	int irq;

	hdmi.pdev = pdev;
	dev_set_drvdata(&pdev->dev, &hdmi);

	mutex_init(&hdmi.lock);

	if (pdev->dev.of_node) {
		r = hdmi_probe_of(pdev);
		if (r)
			return r;
	}

	r = hdmi_wp_init(pdev, &hdmi.wp);
	if (r)
		return r;

	r = hdmi_pll_init(pdev, &hdmi.pll, &hdmi.wp);
	if (r)
		return r;

	r = hdmi_phy_init(pdev, &hdmi.phy);
	if (r)
		goto err;

	r = hdmi5_core_init(pdev, &hdmi.core);
	if (r)
		goto err;

	irq = platform_get_irq(pdev, 0);
	if (irq < 0) {
		DSSERR("platform_get_irq failed\n");
		r = -ENODEV;
		goto err;
	}

	r = devm_request_threaded_irq(&pdev->dev, irq,
			NULL, hdmi_irq_handler,
			IRQF_ONESHOT, "OMAP HDMI", &hdmi.wp);
	if (r) {
		DSSERR("HDMI IRQ request failed\n");
		goto err;
	}

	pm_runtime_enable(&pdev->dev);

	hdmi_init_output(pdev);

	dss_debugfs_create_file("hdmi", hdmi_dump_regs);

	return 0;
err:
	hdmi_pll_uninit(&hdmi.pll);
	return r;
}

static int __exit omapdss_hdmihw_remove(struct platform_device *pdev)
{
	hdmi_uninit_output(pdev);

	hdmi_pll_uninit(&hdmi.pll);

	pm_runtime_disable(&pdev->dev);

	return 0;
}

static int hdmi_runtime_suspend(struct device *dev)
{
	dispc_runtime_put();

	return 0;
}

static int hdmi_runtime_resume(struct device *dev)
{
	int r;

	r = dispc_runtime_get();
	if (r < 0)
		return r;

	return 0;
}

static const struct dev_pm_ops hdmi_pm_ops = {
	.runtime_suspend = hdmi_runtime_suspend,
	.runtime_resume = hdmi_runtime_resume,
};

static const struct of_device_id hdmi_of_match[] = {
	{ .compatible = "ti,omap5-hdmi", },
	{},
};

static struct platform_driver omapdss_hdmihw_driver = {
	.probe		= omapdss_hdmihw_probe,
	.remove         = __exit_p(omapdss_hdmihw_remove),
	.driver         = {
		.name   = "omapdss_hdmi5",
		.owner  = THIS_MODULE,
		.pm	= &hdmi_pm_ops,
		.of_match_table = hdmi_of_match,
		.suppress_bind_attrs = true,
	},
};

int __init hdmi5_init_platform_driver(void)
{
	return platform_driver_register(&omapdss_hdmihw_driver);
}

void __exit hdmi5_uninit_platform_driver(void)
{
	platform_driver_unregister(&omapdss_hdmihw_driver);
}
Commit	Line	Data
f5bab222 TV	1	/*
	2	* HDMI driver for OMAP5
	3	*
	4	* Copyright (C) 2014 Texas Instruments Incorporated
	5	*
	6	* Authors:
	7	* Yong Zhi
	8	* Mythri pk
	9	* Archit Taneja <archit@ti.com>
	10	* Tomi Valkeinen <tomi.valkeinen@ti.com>
	11	*
	12	* This program is free software; you can redistribute it and/or modify it
	13	* under the terms of the GNU General Public License version 2 as published by
	14	* the Free Software Foundation.
	15	*
	16	* This program is distributed in the hope that it will be useful, but WITHOUT
	17	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	18	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	19	* more details.
	20	*
	21	* You should have received a copy of the GNU General Public License along with
	22	* this program. If not, see <http://www.gnu.org/licenses/>.
	23	*/
	24
	25	#define DSS_SUBSYS_NAME "HDMI"
	26
	27	#include <linux/kernel.h>
	28	#include <linux/module.h>
	29	#include <linux/err.h>
	30	#include <linux/io.h>
	31	#include <linux/interrupt.h>
	32	#include <linux/mutex.h>
	33	#include <linux/delay.h>
	34	#include <linux/string.h>
	35	#include <linux/platform_device.h>
	36	#include <linux/pm_runtime.h>
	37	#include <linux/clk.h>
	38	#include <linux/gpio.h>
	39	#include <linux/regulator/consumer.h>
	40	#include <video/omapdss.h>
	41
	42	#include "hdmi5_core.h"
	43	#include "dss.h"
	44	#include "dss_features.h"
	45
945514b5	46	static struct omap_hdmi hdmi;
f5bab222 TV	47
	48	static int hdmi_runtime_get(void)
	49	{
	50	int r;
	51
	52	DSSDBG("hdmi_runtime_get\n");
	53
	54	r = pm_runtime_get_sync(&hdmi.pdev->dev);
	55	WARN_ON(r < 0);
	56	if (r < 0)
	57	return r;
	58
	59	return 0;
	60	}
	61
	62	static void hdmi_runtime_put(void)
	63	{
	64	int r;
	65
	66	DSSDBG("hdmi_runtime_put\n");
	67
	68	r = pm_runtime_put_sync(&hdmi.pdev->dev);
	69	WARN_ON(r < 0 && r != -ENOSYS);
	70	}
	71
	72	static irqreturn_t hdmi_irq_handler(int irq, void *data)
	73	{
	74	struct hdmi_wp_data *wp = data;
	75	u32 irqstatus;
	76
	77	irqstatus = hdmi_wp_get_irqstatus(wp);
	78	hdmi_wp_set_irqstatus(wp, irqstatus);
	79
	80	if ((irqstatus & HDMI_IRQ_LINK_CONNECT) &&
	81	irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
	82	u32 v;
	83	/*
	84	* If we get both connect and disconnect interrupts at the same
	85	* time, turn off the PHY, clear interrupts, and restart, which
	86	* raises connect interrupt if a cable is connected, or nothing
	87	* if cable is not connected.
	88	*/
	89
	90	hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF);
	91
	92	/*
	93	* We always get bogus CONNECT & DISCONNECT interrupts when
	94	* setting the PHY to LDOON. To ignore those, we force the RXDET
	95	* line to 0 until the PHY power state has been changed.
	96	*/
	97	v = hdmi_read_reg(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL);
	98	v = FLD_MOD(v, 1, 15, 15); /* FORCE_RXDET_HIGH */
	99	v = FLD_MOD(v, 0, 14, 7); /* RXDET_LINE */
	100	hdmi_write_reg(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL, v);
	101
	102	hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT \|
	103	HDMI_IRQ_LINK_DISCONNECT);
	104
	105	hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
	106
	107	REG_FLD_MOD(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL, 0, 15, 15);
	108
	109	} else if (irqstatus & HDMI_IRQ_LINK_CONNECT) {
	110	hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON);
111	} else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
112	hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
113	}
114
115	return IRQ_HANDLED;
116	}
117
118	static int hdmi_init_regulator(void)
119	{
120	int r;
121	struct regulator *reg;
122
123	if (hdmi.vdda_reg != NULL)
124	return 0;
125
126	reg = devm_regulator_get(&hdmi.pdev->dev, "vdda");
127	if (IS_ERR(reg)) {
128	DSSERR("can't get VDDA regulator\n");
129	return PTR_ERR(reg);
130	}
131
132	if (regulator_can_change_voltage(reg)) {
133	r = regulator_set_voltage(reg, 1800000, 1800000);
134	if (r) {
135	devm_regulator_put(reg);
136	DSSWARN("can't set the regulator voltage\n");
137	return r;
138	}
139	}
140
141	hdmi.vdda_reg = reg;
142
143	return 0;
144	}
145
146	static int hdmi_power_on_core(struct omap_dss_device *dssdev)
147	{
148	int r;
149
150	r = regulator_enable(hdmi.vdda_reg);
151	if (r)
152	return r;
153
154	r = hdmi_runtime_get();
155	if (r)
156	goto err_runtime_get;
157
158	/* Make selection of HDMI in DSS */
159	dss_select_hdmi_venc_clk_source(DSS_HDMI_M_PCLK);
160
161	hdmi.core_enabled = true;
162
163	return 0;
164
165	err_runtime_get:
166	regulator_disable(hdmi.vdda_reg);
167
168	return r;
169	}
170
171	static void hdmi_power_off_core(struct omap_dss_device *dssdev)
172	{
173	hdmi.core_enabled = false;
174
175	hdmi_runtime_put();
176	regulator_disable(hdmi.vdda_reg);
177	}
178
179	static int hdmi_power_on_full(struct omap_dss_device *dssdev)
180	{
181	int r;
182	struct omap_video_timings *p;
183	struct omap_overlay_manager *mgr = hdmi.output.manager;
c84c3a5b	184	struct dss_pll_clock_info hdmi_cinfo = { 0 };
f5bab222 TV	185
	186	r = hdmi_power_on_core(dssdev);
	187	if (r)
	188	return r;
	189
	190	p = &hdmi.cfg.timings;
	191
	192	DSSDBG("hdmi_power_on x_res= %d y_res = %d\n", p->x_res, p->y_res);
	193
c84c3a5b	194	hdmi_pll_compute(&hdmi.pll, p->pixelclock, &hdmi_cinfo);
f5bab222 TV	195
	196	/* disable and clear irqs */
	197	hdmi_wp_clear_irqenable(&hdmi.wp, 0xffffffff);
	198	hdmi_wp_set_irqstatus(&hdmi.wp,
	199	hdmi_wp_get_irqstatus(&hdmi.wp));
	200
c84c3a5b	201	r = dss_pll_enable(&hdmi.pll.pll);
f5bab222	202	if (r) {
c2fbd061	203	DSSERR("Failed to enable PLL\n");
f5bab222 TV	204	goto err_pll_enable;
	205	}
	206
c84c3a5b	207	r = dss_pll_set_config(&hdmi.pll.pll, &hdmi_cinfo);
c2fbd061 TV	208	if (r) {
	209	DSSERR("Failed to configure PLL\n");
	210	goto err_pll_cfg;
	211	}
	212
c84c3a5b TV	213	r = hdmi_phy_configure(&hdmi.phy, hdmi_cinfo.clkdco,
c84c3a5b TV	214	hdmi_cinfo.clkout[0]);
f5bab222 TV	215	if (r) {
	216	DSSDBG("Failed to start PHY\n");
	217	goto err_phy_cfg;
	218	}
	219
	220	r = hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_LDOON);
	221	if (r)
	222	goto err_phy_pwr;
	223
	224	hdmi5_configure(&hdmi.core, &hdmi.wp, &hdmi.cfg);
	225
	226	/* bypass TV gamma table */
	227	dispc_enable_gamma_table(0);
	228
	229	/* tv size */
	230	dss_mgr_set_timings(mgr, p);
	231
	232	r = hdmi_wp_video_start(&hdmi.wp);
	233	if (r)
	234	goto err_vid_enable;
	235
	236	r = dss_mgr_enable(mgr);
	237	if (r)
	238	goto err_mgr_enable;
	239
	240	hdmi_wp_set_irqenable(&hdmi.wp,
	241	HDMI_IRQ_LINK_CONNECT \| HDMI_IRQ_LINK_DISCONNECT);
	242
	243	return 0;
	244
	245	err_mgr_enable:
	246	hdmi_wp_video_stop(&hdmi.wp);
	247	err_vid_enable:
	248	hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);
	249	err_phy_pwr:
	250	err_phy_cfg:
c2fbd061	251	err_pll_cfg:
c84c3a5b	252	dss_pll_disable(&hdmi.pll.pll);
f5bab222 TV	253	err_pll_enable:
	254	hdmi_power_off_core(dssdev);
	255	return -EIO;
	256	}
	257
	258	static void hdmi_power_off_full(struct omap_dss_device *dssdev)
	259	{
	260	struct omap_overlay_manager *mgr = hdmi.output.manager;
	261
	262	hdmi_wp_clear_irqenable(&hdmi.wp, 0xffffffff);
	263
	264	dss_mgr_disable(mgr);
	265
	266	hdmi_wp_video_stop(&hdmi.wp);
	267
	268	hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);
	269
c84c3a5b	270	dss_pll_disable(&hdmi.pll.pll);
f5bab222 TV	271
	272	hdmi_power_off_core(dssdev);
	273	}
	274
	275	static int hdmi_display_check_timing(struct omap_dss_device *dssdev,
	276	struct omap_video_timings *timings)
	277	{
	278	struct omap_dss_device *out = &hdmi.output;
	279
31dd0f4b TV	280	/* TODO: proper interlace support */
	281	if (timings->interlace)
	282	return -EINVAL;
	283
f5bab222 TV	284	if (!dispc_mgr_timings_ok(out->dispc_channel, timings))
	285	return -EINVAL;
	286
	287	return 0;
	288	}
	289
	290	static void hdmi_display_set_timing(struct omap_dss_device *dssdev,
	291	struct omap_video_timings *timings)
	292	{
f5bab222 TV	293	mutex_lock(&hdmi.lock);
f5bab222 TV	294
769dcb11	295	hdmi.cfg.timings = *timings;
f5bab222	296
769dcb11	297	dispc_set_tv_pclk(timings->pixelclock);
f5bab222 TV	298
	299	mutex_unlock(&hdmi.lock);
	300	}
	301
	302	static void hdmi_display_get_timings(struct omap_dss_device *dssdev,
	303	struct omap_video_timings *timings)
	304	{
769dcb11	305	*timings = hdmi.cfg.timings;
f5bab222 TV	306	}
	307
	308	static void hdmi_dump_regs(struct seq_file *s)
	309	{
	310	mutex_lock(&hdmi.lock);
	311
	312	if (hdmi_runtime_get()) {
	313	mutex_unlock(&hdmi.lock);
	314	return;
	315	}
	316
	317	hdmi_wp_dump(&hdmi.wp, s);
	318	hdmi_pll_dump(&hdmi.pll, s);
	319	hdmi_phy_dump(&hdmi.phy, s);
	320	hdmi5_core_dump(&hdmi.core, s);
	321
	322	hdmi_runtime_put();
	323	mutex_unlock(&hdmi.lock);
	324	}
	325
	326	static int read_edid(u8 *buf, int len)
	327	{
	328	int r;
	329	int idlemode;
	330
	331	mutex_lock(&hdmi.lock);
	332
	333	r = hdmi_runtime_get();
	334	BUG_ON(r);
	335
	336	idlemode = REG_GET(hdmi.wp.base, HDMI_WP_SYSCONFIG, 3, 2);
	337	/* No-idle mode */
	338	REG_FLD_MOD(hdmi.wp.base, HDMI_WP_SYSCONFIG, 1, 3, 2);
	339
	340	r = hdmi5_read_edid(&hdmi.core, buf, len);
	341
	342	REG_FLD_MOD(hdmi.wp.base, HDMI_WP_SYSCONFIG, idlemode, 3, 2);
	343
	344	hdmi_runtime_put();
	345	mutex_unlock(&hdmi.lock);
	346
	347	return r;
	348	}
	349
	350	static int hdmi_display_enable(struct omap_dss_device *dssdev)
	351	{
	352	struct omap_dss_device *out = &hdmi.output;
	353	int r = 0;
	354
	355	DSSDBG("ENTER hdmi_display_enable\n");
	356
	357	mutex_lock(&hdmi.lock);
	358
	359	if (out == NULL \|\| out->manager == NULL) {
	360	DSSERR("failed to enable display: no output/manager\n");
	361	r = -ENODEV;
	362	goto err0;
	363	}
	364
	365	r = hdmi_power_on_full(dssdev);
	366	if (r) {
	367	DSSERR("failed to power on device\n");
	368	goto err0;
	369	}
370
371	mutex_unlock(&hdmi.lock);
372	return 0;
373
374	err0:
375	mutex_unlock(&hdmi.lock);
376	return r;
377	}
378
379	static void hdmi_display_disable(struct omap_dss_device *dssdev)
380	{
381	DSSDBG("Enter hdmi_display_disable\n");
382
383	mutex_lock(&hdmi.lock);
384
385	hdmi_power_off_full(dssdev);
386
387	mutex_unlock(&hdmi.lock);
388	}
389
390	static int hdmi_core_enable(struct omap_dss_device *dssdev)
391	{
392	int r = 0;
393
394	DSSDBG("ENTER omapdss_hdmi_core_enable\n");
395
396	mutex_lock(&hdmi.lock);
397
398	r = hdmi_power_on_core(dssdev);
399	if (r) {
400	DSSERR("failed to power on device\n");
401	goto err0;
402	}
403
404	mutex_unlock(&hdmi.lock);
405	return 0;
406
407	err0:
408	mutex_unlock(&hdmi.lock);
409	return r;
410	}
411
412	static void hdmi_core_disable(struct omap_dss_device *dssdev)
413	{
414	DSSDBG("Enter omapdss_hdmi_core_disable\n");
415
416	mutex_lock(&hdmi.lock);
417
418	hdmi_power_off_core(dssdev);
419
420	mutex_unlock(&hdmi.lock);
421	}
422
f5bab222 TV	423	static int hdmi_connect(struct omap_dss_device *dssdev,
	424	struct omap_dss_device *dst)
	425	{
	426	struct omap_overlay_manager *mgr;
	427	int r;
	428
	429	r = hdmi_init_regulator();
	430	if (r)
	431	return r;
	432
	433	mgr = omap_dss_get_overlay_manager(dssdev->dispc_channel);
	434	if (!mgr)
	435	return -ENODEV;
	436
	437	r = dss_mgr_connect(mgr, dssdev);
	438	if (r)
	439	return r;
	440
	441	r = omapdss_output_set_device(dssdev, dst);
	442	if (r) {
	443	DSSERR("failed to connect output to new device: %s\n",
	444	dst->name);
	445	dss_mgr_disconnect(mgr, dssdev);
	446	return r;
	447	}
	448
	449	return 0;
	450	}
	451
	452	static void hdmi_disconnect(struct omap_dss_device *dssdev,
	453	struct omap_dss_device *dst)
	454	{
	455	WARN_ON(dst != dssdev->dst);
	456
	457	if (dst != dssdev->dst)
	458	return;
	459
	460	omapdss_output_unset_device(dssdev);
	461
	462	if (dssdev->manager)
	463	dss_mgr_disconnect(dssdev->manager, dssdev);
	464	}
	465
	466	static int hdmi_read_edid(struct omap_dss_device *dssdev,
	467	u8 *edid, int len)
	468	{
	469	bool need_enable;
	470	int r;
	471
	472	need_enable = hdmi.core_enabled == false;
	473
	474	if (need_enable) {
	475	r = hdmi_core_enable(dssdev);
	476	if (r)
	477	return r;
	478	}
	479
	480	r = read_edid(edid, len);
	481
	482	if (need_enable)
	483	hdmi_core_disable(dssdev);
	484
	485	return r;
	486	}
487
488	#if defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
489	static int hdmi_audio_enable(struct omap_dss_device *dssdev)
490	{
491	int r;
492
493	mutex_lock(&hdmi.lock);
494
769dcb11	495	if (!hdmi_mode_has_audio(hdmi.cfg.hdmi_dvi_mode)) {
f5bab222 TV	496	r = -EPERM;
	497	goto err;
	498	}
	499
	500	r = hdmi_wp_audio_enable(&hdmi.wp, true);
	501	if (r)
	502	goto err;
	503
	504	mutex_unlock(&hdmi.lock);
	505	return 0;
	506
	507	err:
	508	mutex_unlock(&hdmi.lock);
	509	return r;
	510	}
	511
	512	static void hdmi_audio_disable(struct omap_dss_device *dssdev)
	513	{
	514	hdmi_wp_audio_enable(&hdmi.wp, false);
	515	}
	516
	517	static int hdmi_audio_start(struct omap_dss_device *dssdev)
	518	{
	519	return hdmi_wp_audio_core_req_enable(&hdmi.wp, true);
	520	}
	521
	522	static void hdmi_audio_stop(struct omap_dss_device *dssdev)
	523	{
	524	hdmi_wp_audio_core_req_enable(&hdmi.wp, false);
	525	}
	526
	527	static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
	528	{
	529	bool r;
	530
	531	mutex_lock(&hdmi.lock);
	532
769dcb11	533	r = hdmi_mode_has_audio(hdmi.cfg.hdmi_dvi_mode);
f5bab222 TV	534
	535	mutex_unlock(&hdmi.lock);
	536	return r;
	537	}
	538
	539	static int hdmi_audio_config(struct omap_dss_device *dssdev,
	540	struct omap_dss_audio *audio)
	541	{
	542	int r;
	543	u32 pclk = hdmi.cfg.timings.pixelclock;
	544
	545	mutex_lock(&hdmi.lock);
	546
769dcb11	547	if (!hdmi_mode_has_audio(hdmi.cfg.hdmi_dvi_mode)) {
f5bab222 TV	548	r = -EPERM;
	549	goto err;
	550	}
	551
	552	r = hdmi5_audio_config(&hdmi.core, &hdmi.wp, audio, pclk);
	553	if (r)
	554	goto err;
	555
	556	mutex_unlock(&hdmi.lock);
	557	return 0;
	558
	559	err:
	560	mutex_unlock(&hdmi.lock);
	561	return r;
	562	}
	563	#else
	564	static int hdmi_audio_enable(struct omap_dss_device *dssdev)
	565	{
	566	return -EPERM;
	567	}
	568
	569	static void hdmi_audio_disable(struct omap_dss_device *dssdev)
	570	{
	571	}
	572
	573	static int hdmi_audio_start(struct omap_dss_device *dssdev)
	574	{
	575	return -EPERM;
	576	}
	577
	578	static void hdmi_audio_stop(struct omap_dss_device *dssdev)
	579	{
	580	}
	581
	582	static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
	583	{
	584	return false;
	585	}
	586
	587	static int hdmi_audio_config(struct omap_dss_device *dssdev,
	588	struct omap_dss_audio *audio)
	589	{
	590	return -EPERM;
	591	}
	592	#endif
	593
769dcb11 TV	594	static int hdmi_set_infoframe(struct omap_dss_device *dssdev,
	595	const struct hdmi_avi_infoframe *avi)
	596	{
	597	hdmi.cfg.infoframe = *avi;
	598	return 0;
	599	}
	600
	601	static int hdmi_set_hdmi_mode(struct omap_dss_device *dssdev,
	602	bool hdmi_mode)
	603	{
	604	hdmi.cfg.hdmi_dvi_mode = hdmi_mode ? HDMI_HDMI : HDMI_DVI;
	605	return 0;
	606	}
	607
f5bab222 TV	608	static const struct omapdss_hdmi_ops hdmi_ops = {
	609	.connect = hdmi_connect,
	610	.disconnect = hdmi_disconnect,
	611
	612	.enable = hdmi_display_enable,
	613	.disable = hdmi_display_disable,
	614
	615	.check_timings = hdmi_display_check_timing,
	616	.set_timings = hdmi_display_set_timing,
	617	.get_timings = hdmi_display_get_timings,
	618
	619	.read_edid = hdmi_read_edid,
769dcb11 TV	620	.set_infoframe = hdmi_set_infoframe,
769dcb11 TV	621	.set_hdmi_mode = hdmi_set_hdmi_mode,
f5bab222 TV	622
	623	.audio_enable = hdmi_audio_enable,
	624	.audio_disable = hdmi_audio_disable,
	625	.audio_start = hdmi_audio_start,
	626	.audio_stop = hdmi_audio_stop,
	627	.audio_supported = hdmi_audio_supported,
	628	.audio_config = hdmi_audio_config,
	629	};
	630
	631	static void hdmi_init_output(struct platform_device *pdev)
	632	{
	633	struct omap_dss_device *out = &hdmi.output;
	634
	635	out->dev = &pdev->dev;
	636	out->id = OMAP_DSS_OUTPUT_HDMI;
	637	out->output_type = OMAP_DISPLAY_TYPE_HDMI;
	638	out->name = "hdmi.0";
	639	out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
	640	out->ops.hdmi = &hdmi_ops;
	641	out->owner = THIS_MODULE;
	642
	643	omapdss_register_output(out);
	644	}
	645
	646	static void __exit hdmi_uninit_output(struct platform_device *pdev)
	647	{
	648	struct omap_dss_device *out = &hdmi.output;
	649
	650	omapdss_unregister_output(out);
	651	}
	652
	653	static int hdmi_probe_of(struct platform_device *pdev)
	654	{
	655	struct device_node *node = pdev->dev.of_node;
	656	struct device_node *ep;
	657	int r;
	658
	659	ep = omapdss_of_get_first_endpoint(node);
	660	if (!ep)
	661	return 0;
	662
	663	r = hdmi_parse_lanes_of(pdev, ep, &hdmi.phy);
	664	if (r)
	665	goto err;
	666
	667	of_node_put(ep);
	668	return 0;
	669
	670	err:
	671	of_node_put(ep);
	672	return r;
	673	}
	674
	675	/* HDMI HW IP initialisation */
	676	static int omapdss_hdmihw_probe(struct platform_device *pdev)
	677	{
	678	int r;
	679	int irq;
	680
	681	hdmi.pdev = pdev;
945514b5	682	dev_set_drvdata(&pdev->dev, &hdmi);
f5bab222 TV	683
	684	mutex_init(&hdmi.lock);
	685
	686	if (pdev->dev.of_node) {
	687	r = hdmi_probe_of(pdev);
	688	if (r)
	689	return r;
	690	}
	691
	692	r = hdmi_wp_init(pdev, &hdmi.wp);
	693	if (r)
	694	return r;
	695
03aafa2c	696	r = hdmi_pll_init(pdev, &hdmi.pll, &hdmi.wp);
f5bab222 TV	697	if (r)
	698	return r;
	699
	700	r = hdmi_phy_init(pdev, &hdmi.phy);
	701	if (r)
c84c3a5b	702	goto err;
f5bab222 TV	703
	704	r = hdmi5_core_init(pdev, &hdmi.core);
	705	if (r)
c84c3a5b	706	goto err;
f5bab222 TV	707
	708	irq = platform_get_irq(pdev, 0);
	709	if (irq < 0) {
	710	DSSERR("platform_get_irq failed\n");
c84c3a5b TV	711	r = -ENODEV;
c84c3a5b TV	712	goto err;
f5bab222 TV	713	}
	714
	715	r = devm_request_threaded_irq(&pdev->dev, irq,
	716	NULL, hdmi_irq_handler,
	717	IRQF_ONESHOT, "OMAP HDMI", &hdmi.wp);
	718	if (r) {
	719	DSSERR("HDMI IRQ request failed\n");
c84c3a5b	720	goto err;
f5bab222 TV	721	}
	722
	723	pm_runtime_enable(&pdev->dev);
	724
	725	hdmi_init_output(pdev);
	726
	727	dss_debugfs_create_file("hdmi", hdmi_dump_regs);
	728
	729	return 0;
c84c3a5b TV	730	err:
	731	hdmi_pll_uninit(&hdmi.pll);
	732	return r;
f5bab222 TV	733	}
	734
	735	static int __exit omapdss_hdmihw_remove(struct platform_device *pdev)
	736	{
	737	hdmi_uninit_output(pdev);
	738
c84c3a5b TV	739	hdmi_pll_uninit(&hdmi.pll);
c84c3a5b TV	740
f5bab222 TV	741	pm_runtime_disable(&pdev->dev);
	742
	743	return 0;
	744	}
	745
	746	static int hdmi_runtime_suspend(struct device *dev)
	747	{
f5bab222 TV	748	dispc_runtime_put();
	749
	750	return 0;
	751	}
	752
	753	static int hdmi_runtime_resume(struct device *dev)
	754	{
	755	int r;
	756
	757	r = dispc_runtime_get();
	758	if (r < 0)
	759	return r;
	760
f5bab222 TV	761	return 0;
	762	}
	763
	764	static const struct dev_pm_ops hdmi_pm_ops = {
	765	.runtime_suspend = hdmi_runtime_suspend,
	766	.runtime_resume = hdmi_runtime_resume,
	767	};
	768
	769	static const struct of_device_id hdmi_of_match[] = {
	770	{ .compatible = "ti,omap5-hdmi", },
	771	{},
	772	};
	773
	774	static struct platform_driver omapdss_hdmihw_driver = {
	775	.probe = omapdss_hdmihw_probe,
	776	.remove = __exit_p(omapdss_hdmihw_remove),
	777	.driver = {
	778	.name = "omapdss_hdmi5",
	779	.owner = THIS_MODULE,
	780	.pm = &hdmi_pm_ops,
	781	.of_match_table = hdmi_of_match,
422ccbd5	782	.suppress_bind_attrs = true,
f5bab222 TV	783	},
	784	};
	785
	786	int __init hdmi5_init_platform_driver(void)
	787	{
	788	return platform_driver_register(&omapdss_hdmihw_driver);
	789	}
	790
	791	void __exit hdmi5_uninit_platform_driver(void)
	792	{
	793	platform_driver_unregister(&omapdss_hdmihw_driver);
	794	}