[mirror_ubuntu-focal-kernel.git] / drivers / gpu / drm / msm / hdmi / hdmi_connector.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2013 Red Hat
 * Author: Rob Clark <robdclark@gmail.com>
 */

#include <linux/delay.h>
#include <linux/gpio/consumer.h>
#include <linux/pinctrl/consumer.h>

#include "msm_kms.h"
#include "hdmi.h"

struct hdmi_connector {
	struct drm_connector base;
	struct hdmi *hdmi;
	struct work_struct hpd_work;
};
#define to_hdmi_connector(x) container_of(x, struct hdmi_connector, base)

static void msm_hdmi_phy_reset(struct hdmi *hdmi)
{
	unsigned int val;

	val = hdmi_read(hdmi, REG_HDMI_PHY_CTRL);

	if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
		/* pull low */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val & ~HDMI_PHY_CTRL_SW_RESET);
	} else {
		/* pull high */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val | HDMI_PHY_CTRL_SW_RESET);
	}

	if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
		/* pull low */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
	} else {
		/* pull high */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val | HDMI_PHY_CTRL_SW_RESET_PLL);
	}

	msleep(100);

	if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
		/* pull high */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val | HDMI_PHY_CTRL_SW_RESET);
	} else {
		/* pull low */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val & ~HDMI_PHY_CTRL_SW_RESET);
	}

	if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
		/* pull high */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val | HDMI_PHY_CTRL_SW_RESET_PLL);
	} else {
		/* pull low */
		hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
				val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
	}
}

static int gpio_config(struct hdmi *hdmi, bool on)
{
	const struct hdmi_platform_config *config = hdmi->config;
	int i;

	if (on) {
		for (i = 0; i < HDMI_MAX_NUM_GPIO; i++) {
			struct hdmi_gpio_data gpio = config->gpios[i];

			if (gpio.gpiod) {
				if (gpio.output) {
					gpiod_direction_output(gpio.gpiod,
							       gpio.value);
				} else {
					gpiod_direction_input(gpio.gpiod);
					gpiod_set_value_cansleep(gpio.gpiod,
								 gpio.value);
				}
			}
		}

		DBG("gpio on");
	} else {
		for (i = 0; i < HDMI_MAX_NUM_GPIO; i++) {
			struct hdmi_gpio_data gpio = config->gpios[i];

			if (!gpio.gpiod)
				continue;

			if (gpio.output) {
				int value = gpio.value ? 0 : 1;

				gpiod_set_value_cansleep(gpio.gpiod, value);
			}
		};

		DBG("gpio off");
	}

	return 0;
}

static void enable_hpd_clocks(struct hdmi *hdmi, bool enable)
{
	const struct hdmi_platform_config *config = hdmi->config;
	struct device *dev = &hdmi->pdev->dev;
	int i, ret;

	if (enable) {
		for (i = 0; i < config->hpd_clk_cnt; i++) {
			if (config->hpd_freq && config->hpd_freq[i]) {
				ret = clk_set_rate(hdmi->hpd_clks[i],
						   config->hpd_freq[i]);
				if (ret)
					dev_warn(dev,
						 "failed to set clk %s (%d)\n",
						 config->hpd_clk_names[i], ret);
			}

			ret = clk_prepare_enable(hdmi->hpd_clks[i]);
			if (ret) {
				DRM_DEV_ERROR(dev,
					"failed to enable hpd clk: %s (%d)\n",
					config->hpd_clk_names[i], ret);
			}
		}
	} else {
		for (i = config->hpd_clk_cnt - 1; i >= 0; i--)
			clk_disable_unprepare(hdmi->hpd_clks[i]);
	}
}

int msm_hdmi_hpd_enable(struct drm_connector *connector)
{
	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
	struct hdmi *hdmi = hdmi_connector->hdmi;
	const struct hdmi_platform_config *config = hdmi->config;
	struct device *dev = &hdmi->pdev->dev;
	uint32_t hpd_ctrl;
	int i, ret;
	unsigned long flags;

	for (i = 0; i < config->hpd_reg_cnt; i++) {
		ret = regulator_enable(hdmi->hpd_regs[i]);
		if (ret) {
			DRM_DEV_ERROR(dev, "failed to enable hpd regulator: %s (%d)\n",
					config->hpd_reg_names[i], ret);
			goto fail;
		}
	}

	ret = pinctrl_pm_select_default_state(dev);
	if (ret) {
		DRM_DEV_ERROR(dev, "pinctrl state chg failed: %d\n", ret);
		goto fail;
	}

	ret = gpio_config(hdmi, true);
	if (ret) {
		DRM_DEV_ERROR(dev, "failed to configure GPIOs: %d\n", ret);
		goto fail;
	}

	pm_runtime_get_sync(dev);
	enable_hpd_clocks(hdmi, true);

	msm_hdmi_set_mode(hdmi, false);
	msm_hdmi_phy_reset(hdmi);
	msm_hdmi_set_mode(hdmi, true);

	hdmi_write(hdmi, REG_HDMI_USEC_REFTIMER, 0x0001001b);

	/* enable HPD events: */
	hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
			HDMI_HPD_INT_CTRL_INT_CONNECT |
			HDMI_HPD_INT_CTRL_INT_EN);

	/* set timeout to 4.1ms (max) for hardware debounce */
	spin_lock_irqsave(&hdmi->reg_lock, flags);
	hpd_ctrl = hdmi_read(hdmi, REG_HDMI_HPD_CTRL);
	hpd_ctrl |= HDMI_HPD_CTRL_TIMEOUT(0x1fff);

	/* Toggle HPD circuit to trigger HPD sense */
	hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
			~HDMI_HPD_CTRL_ENABLE & hpd_ctrl);
	hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
			HDMI_HPD_CTRL_ENABLE | hpd_ctrl);
	spin_unlock_irqrestore(&hdmi->reg_lock, flags);

	return 0;

fail:
	return ret;
}

static void hdp_disable(struct hdmi_connector *hdmi_connector)
{
	struct hdmi *hdmi = hdmi_connector->hdmi;
	const struct hdmi_platform_config *config = hdmi->config;
	struct device *dev = &hdmi->pdev->dev;
	int i, ret = 0;

	/* Disable HPD interrupt */
	hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, 0);

	msm_hdmi_set_mode(hdmi, false);

	enable_hpd_clocks(hdmi, false);
	pm_runtime_put_autosuspend(dev);

	ret = gpio_config(hdmi, false);
	if (ret)
		dev_warn(dev, "failed to unconfigure GPIOs: %d\n", ret);

	ret = pinctrl_pm_select_sleep_state(dev);
	if (ret)
		dev_warn(dev, "pinctrl state chg failed: %d\n", ret);

	for (i = 0; i < config->hpd_reg_cnt; i++) {
		ret = regulator_disable(hdmi->hpd_regs[i]);
		if (ret)
			dev_warn(dev, "failed to disable hpd regulator: %s (%d)\n",
					config->hpd_reg_names[i], ret);
	}
}

static void
msm_hdmi_hotplug_work(struct work_struct *work)
{
	struct hdmi_connector *hdmi_connector =
		container_of(work, struct hdmi_connector, hpd_work);
	struct drm_connector *connector = &hdmi_connector->base;
	drm_helper_hpd_irq_event(connector->dev);
}

void msm_hdmi_connector_irq(struct drm_connector *connector)
{
	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
	struct hdmi *hdmi = hdmi_connector->hdmi;
	uint32_t hpd_int_status, hpd_int_ctrl;

	/* Process HPD: */
	hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);
	hpd_int_ctrl   = hdmi_read(hdmi, REG_HDMI_HPD_INT_CTRL);

	if ((hpd_int_ctrl & HDMI_HPD_INT_CTRL_INT_EN) &&
			(hpd_int_status & HDMI_HPD_INT_STATUS_INT)) {
		bool detected = !!(hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED);

		/* ack & disable (temporarily) HPD events: */
		hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
			HDMI_HPD_INT_CTRL_INT_ACK);

		DBG("status=%04x, ctrl=%04x", hpd_int_status, hpd_int_ctrl);

		/* detect disconnect if we are connected or visa versa: */
		hpd_int_ctrl = HDMI_HPD_INT_CTRL_INT_EN;
		if (!detected)
			hpd_int_ctrl |= HDMI_HPD_INT_CTRL_INT_CONNECT;
		hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, hpd_int_ctrl);

		queue_work(hdmi->workq, &hdmi_connector->hpd_work);
	}
}

static enum drm_connector_status detect_reg(struct hdmi *hdmi)
{
	uint32_t hpd_int_status;

	pm_runtime_get_sync(&hdmi->pdev->dev);
	enable_hpd_clocks(hdmi, true);

	hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);

	enable_hpd_clocks(hdmi, false);
	pm_runtime_put_autosuspend(&hdmi->pdev->dev);

	return (hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED) ?
			connector_status_connected : connector_status_disconnected;
}

#define HPD_GPIO_INDEX	2
static enum drm_connector_status detect_gpio(struct hdmi *hdmi)
{
	const struct hdmi_platform_config *config = hdmi->config;
	struct hdmi_gpio_data hpd_gpio = config->gpios[HPD_GPIO_INDEX];

	return gpiod_get_value(hpd_gpio.gpiod) ?
			connector_status_connected :
			connector_status_disconnected;
}

static enum drm_connector_status hdmi_connector_detect(
		struct drm_connector *connector, bool force)
{
	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
	struct hdmi *hdmi = hdmi_connector->hdmi;
	const struct hdmi_platform_config *config = hdmi->config;
	struct hdmi_gpio_data hpd_gpio = config->gpios[HPD_GPIO_INDEX];
	enum drm_connector_status stat_gpio, stat_reg;
	int retry = 20;

	/*
	 * some platforms may not have hpd gpio. Rely only on the status
	 * provided by REG_HDMI_HPD_INT_STATUS in this case.
	 */
	if (!hpd_gpio.gpiod)
		return detect_reg(hdmi);

	do {
		stat_gpio = detect_gpio(hdmi);
		stat_reg  = detect_reg(hdmi);

		if (stat_gpio == stat_reg)
			break;

		mdelay(10);
	} while (--retry);

	/* the status we get from reading gpio seems to be more reliable,
	 * so trust that one the most if we didn't manage to get hdmi and
	 * gpio status to agree:
	 */
	if (stat_gpio != stat_reg) {
		DBG("HDMI_HPD_INT_STATUS tells us: %d", stat_reg);
		DBG("hpd gpio tells us: %d", stat_gpio);
	}

	return stat_gpio;
}

static void hdmi_connector_destroy(struct drm_connector *connector)
{
	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);

	hdp_disable(hdmi_connector);

	drm_connector_cleanup(connector);

	kfree(hdmi_connector);
}

static int msm_hdmi_connector_get_modes(struct drm_connector *connector)
{
	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
	struct hdmi *hdmi = hdmi_connector->hdmi;
	struct edid *edid;
	uint32_t hdmi_ctrl;
	int ret = 0;

	hdmi_ctrl = hdmi_read(hdmi, REG_HDMI_CTRL);
	hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl | HDMI_CTRL_ENABLE);

	edid = drm_get_edid(connector, hdmi->i2c);

	hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl);

	hdmi->hdmi_mode = drm_detect_hdmi_monitor(edid);
	drm_connector_update_edid_property(connector, edid);

	if (edid) {
		ret = drm_add_edid_modes(connector, edid);
		kfree(edid);
	}

	return ret;
}

static int msm_hdmi_connector_mode_valid(struct drm_connector *connector,
				 struct drm_display_mode *mode)
{
	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
	struct hdmi *hdmi = hdmi_connector->hdmi;
	const struct hdmi_platform_config *config = hdmi->config;
	struct msm_drm_private *priv = connector->dev->dev_private;
	struct msm_kms *kms = priv->kms;
	long actual, requested;

	requested = 1000 * mode->clock;
	actual = kms->funcs->round_pixclk(kms,
			requested, hdmi_connector->hdmi->encoder);

	/* for mdp5/apq8074, we manage our own pixel clk (as opposed to
	 * mdp4/dtv stuff where pixel clk is assigned to mdp/encoder
	 * instead):
	 */
	if (config->pwr_clk_cnt > 0)
		actual = clk_round_rate(hdmi->pwr_clks[0], actual);

	DBG("requested=%ld, actual=%ld", requested, actual);

	if (actual != requested)
		return MODE_CLOCK_RANGE;

	return 0;
}

static const struct drm_connector_funcs hdmi_connector_funcs = {
	.detect = hdmi_connector_detect,
	.fill_modes = drm_helper_probe_single_connector_modes,
	.destroy = hdmi_connector_destroy,
	.reset = drm_atomic_helper_connector_reset,
	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
};

static const struct drm_connector_helper_funcs msm_hdmi_connector_helper_funcs = {
	.get_modes = msm_hdmi_connector_get_modes,
	.mode_valid = msm_hdmi_connector_mode_valid,
};

/* initialize connector */
struct drm_connector *msm_hdmi_connector_init(struct hdmi *hdmi)
{
	struct drm_connector *connector = NULL;
	struct hdmi_connector *hdmi_connector;

	hdmi_connector = kzalloc(sizeof(*hdmi_connector), GFP_KERNEL);
	if (!hdmi_connector)
		return ERR_PTR(-ENOMEM);

	hdmi_connector->hdmi = hdmi;
	INIT_WORK(&hdmi_connector->hpd_work, msm_hdmi_hotplug_work);

	connector = &hdmi_connector->base;

	drm_connector_init(hdmi->dev, connector, &hdmi_connector_funcs,
			DRM_MODE_CONNECTOR_HDMIA);
	drm_connector_helper_add(connector, &msm_hdmi_connector_helper_funcs);

	connector->polled = DRM_CONNECTOR_POLL_CONNECT |
			DRM_CONNECTOR_POLL_DISCONNECT;

	connector->interlace_allowed = 0;
	connector->doublescan_allowed = 0;

	drm_connector_attach_encoder(connector, hdmi->encoder);

	return connector;
}
Commit	Line	Data
caab277b	1	// SPDX-License-Identifier: GPL-2.0-only
c8afe684 RC	2	/*
	3	* Copyright (C) 2013 Red Hat
	4	* Author: Rob Clark <robdclark@gmail.com>
c8afe684 RC	5	*/
c8afe684 RC	6
feea39a8	7	#include <linux/delay.h>
a44769b4	8	#include <linux/gpio/consumer.h>
865807d0	9	#include <linux/pinctrl/consumer.h>
c8afe684	10
dd2da6e3	11	#include "msm_kms.h"
c8afe684 RC	12	#include "hdmi.h"
	13
	14	struct hdmi_connector {
a3376e3e RC	15	struct drm_connector base;
a3376e3e RC	16	struct hdmi *hdmi;
dada25bd	17	struct work_struct hpd_work;
c8afe684 RC	18	};
	19	#define to_hdmi_connector(x) container_of(x, struct hdmi_connector, base)
	20
fcda50c8	21	static void msm_hdmi_phy_reset(struct hdmi *hdmi)
da328552 SV	22	{
	23	unsigned int val;
	24
	25	val = hdmi_read(hdmi, REG_HDMI_PHY_CTRL);
	26
	27	if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
	28	/* pull low */
	29	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	30	val & ~HDMI_PHY_CTRL_SW_RESET);
	31	} else {
	32	/* pull high */
	33	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	34	val \| HDMI_PHY_CTRL_SW_RESET);
	35	}
	36
	37	if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
	38	/* pull low */
	39	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	40	val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
	41	} else {
	42	/* pull high */
	43	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	44	val \| HDMI_PHY_CTRL_SW_RESET_PLL);
	45	}
	46
	47	msleep(100);
	48
	49	if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
	50	/* pull high */
	51	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	52	val \| HDMI_PHY_CTRL_SW_RESET);
	53	} else {
	54	/* pull low */
	55	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	56	val & ~HDMI_PHY_CTRL_SW_RESET);
	57	}
	58
	59	if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
	60	/* pull high */
	61	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	62	val \| HDMI_PHY_CTRL_SW_RESET_PLL);
	63	} else {
	64	/* pull low */
	65	hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
	66	val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
	67	}
	68	}
	69
c8afe684 RC	70	static int gpio_config(struct hdmi *hdmi, bool on)
c8afe684 RC	71	{
dada25bd	72	const struct hdmi_platform_config *config = hdmi->config;
a44769b4	73	int i;
c8afe684 RC	74
c8afe684 RC	75	if (on) {
dc50f782 AT	76	for (i = 0; i < HDMI_MAX_NUM_GPIO; i++) {
	77	struct hdmi_gpio_data gpio = config->gpios[i];
	78
a44769b4	79	if (gpio.gpiod) {
dc50f782	80	if (gpio.output) {
a44769b4 LW	81	gpiod_direction_output(gpio.gpiod,
a44769b4 LW	82	gpio.value);
dc50f782	83	} else {
a44769b4 LW	84	gpiod_direction_input(gpio.gpiod);
	85	gpiod_set_value_cansleep(gpio.gpiod,
	86	gpio.value);
dc50f782	87	}
3a84f846	88	}
c8afe684	89	}
dada25bd	90
c8afe684 RC	91	DBG("gpio on");
c8afe684 RC	92	} else {
dc50f782 AT	93	for (i = 0; i < HDMI_MAX_NUM_GPIO; i++) {
dc50f782 AT	94	struct hdmi_gpio_data gpio = config->gpios[i];
3a84f846	95
a44769b4	96	if (!gpio.gpiod)
c899f935 AT	97	continue;
c899f935 AT	98
dc50f782 AT	99	if (gpio.output) {
dc50f782 AT	100	int value = gpio.value ? 0 : 1;
3a84f846	101
a44769b4	102	gpiod_set_value_cansleep(gpio.gpiod, value);
dc50f782	103	}
dc50f782	104	};
1930f38a	105
c8afe684 RC	106	DBG("gpio off");
	107	}
	108
	109	return 0;
c8afe684 RC	110	}
c8afe684 RC	111
6ed9ed48 AT	112	static void enable_hpd_clocks(struct hdmi *hdmi, bool enable)
	113	{
	114	const struct hdmi_platform_config *config = hdmi->config;
	115	struct device *dev = &hdmi->pdev->dev;
	116	int i, ret;
	117
	118	if (enable) {
	119	for (i = 0; i < config->hpd_clk_cnt; i++) {
	120	if (config->hpd_freq && config->hpd_freq[i]) {
	121	ret = clk_set_rate(hdmi->hpd_clks[i],
	122	config->hpd_freq[i]);
	123	if (ret)
	124	dev_warn(dev,
	125	"failed to set clk %s (%d)\n",
	126	config->hpd_clk_names[i], ret);
	127	}
	128
	129	ret = clk_prepare_enable(hdmi->hpd_clks[i]);
	130	if (ret) {
6a41da17	131	DRM_DEV_ERROR(dev,
6ed9ed48 AT	132	"failed to enable hpd clk: %s (%d)\n",
	133	config->hpd_clk_names[i], ret);
	134	}
	135	}
	136	} else {
	137	for (i = config->hpd_clk_cnt - 1; i >= 0; i--)
	138	clk_disable_unprepare(hdmi->hpd_clks[i]);
	139	}
	140	}
	141
ee445635	142	int msm_hdmi_hpd_enable(struct drm_connector *connector)
c8afe684	143	{
ee445635	144	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
a3376e3e	145	struct hdmi *hdmi = hdmi_connector->hdmi;
dada25bd	146	const struct hdmi_platform_config *config = hdmi->config;
5e4eb82f	147	struct device *dev = &hdmi->pdev->dev;
c8afe684	148	uint32_t hpd_ctrl;
dada25bd	149	int i, ret;
c6a57a50	150	unsigned long flags;
c8afe684	151
e6d7a16f JW	152	for (i = 0; i < config->hpd_reg_cnt; i++) {
	153	ret = regulator_enable(hdmi->hpd_regs[i]);
	154	if (ret) {
6a41da17	155	DRM_DEV_ERROR(dev, "failed to enable hpd regulator: %s (%d)\n",
e6d7a16f JW	156	config->hpd_reg_names[i], ret);
	157	goto fail;
	158	}
	159	}
	160
865807d0 SV	161	ret = pinctrl_pm_select_default_state(dev);
865807d0 SV	162	if (ret) {
6a41da17	163	DRM_DEV_ERROR(dev, "pinctrl state chg failed: %d\n", ret);
865807d0 SV	164	goto fail;
	165	}
	166
c8afe684 RC	167	ret = gpio_config(hdmi, true);
c8afe684 RC	168	if (ret) {
6a41da17	169	DRM_DEV_ERROR(dev, "failed to configure GPIOs: %d\n", ret);
c8afe684 RC	170	goto fail;
	171	}
	172
6ed9ed48 AT	173	pm_runtime_get_sync(dev);
6ed9ed48 AT	174	enable_hpd_clocks(hdmi, true);
c8afe684	175
fcda50c8 AB	176	msm_hdmi_set_mode(hdmi, false);
	177	msm_hdmi_phy_reset(hdmi);
	178	msm_hdmi_set_mode(hdmi, true);
c8afe684 RC	179
	180	hdmi_write(hdmi, REG_HDMI_USEC_REFTIMER, 0x0001001b);
	181
	182	/* enable HPD events: */
	183	hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
	184	HDMI_HPD_INT_CTRL_INT_CONNECT \|
	185	HDMI_HPD_INT_CTRL_INT_EN);
	186
	187	/* set timeout to 4.1ms (max) for hardware debounce */
c6a57a50	188	spin_lock_irqsave(&hdmi->reg_lock, flags);
c8afe684 RC	189	hpd_ctrl = hdmi_read(hdmi, REG_HDMI_HPD_CTRL);
	190	hpd_ctrl \|= HDMI_HPD_CTRL_TIMEOUT(0x1fff);
	191
	192	/* Toggle HPD circuit to trigger HPD sense */
	193	hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
	194	~HDMI_HPD_CTRL_ENABLE & hpd_ctrl);
	195	hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
	196	HDMI_HPD_CTRL_ENABLE \| hpd_ctrl);
c6a57a50	197	spin_unlock_irqrestore(&hdmi->reg_lock, flags);
c8afe684 RC	198
	199	return 0;
	200
	201	fail:
	202	return ret;
	203	}
	204
e6d7a16f	205	static void hdp_disable(struct hdmi_connector *hdmi_connector)
c8afe684	206	{
a3376e3e	207	struct hdmi *hdmi = hdmi_connector->hdmi;
dada25bd	208	const struct hdmi_platform_config *config = hdmi->config;
5e4eb82f	209	struct device *dev = &hdmi->pdev->dev;
dada25bd	210	int i, ret = 0;
c8afe684 RC	211
	212	/* Disable HPD interrupt */
	213	hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, 0);
	214
fcda50c8	215	msm_hdmi_set_mode(hdmi, false);
c8afe684	216
6ed9ed48 AT	217	enable_hpd_clocks(hdmi, false);
6ed9ed48 AT	218	pm_runtime_put_autosuspend(dev);
c8afe684 RC	219
c8afe684 RC	220	ret = gpio_config(hdmi, false);
e6d7a16f	221	if (ret)
5e4eb82f	222	dev_warn(dev, "failed to unconfigure GPIOs: %d\n", ret);
c8afe684	223
865807d0 SV	224	ret = pinctrl_pm_select_sleep_state(dev);
	225	if (ret)
	226	dev_warn(dev, "pinctrl state chg failed: %d\n", ret);
	227
e6d7a16f JW	228	for (i = 0; i < config->hpd_reg_cnt; i++) {
	229	ret = regulator_disable(hdmi->hpd_regs[i]);
	230	if (ret)
5e4eb82f	231	dev_warn(dev, "failed to disable hpd regulator: %s (%d)\n",
e6d7a16f JW	232	config->hpd_reg_names[i], ret);
e6d7a16f JW	233	}
c8afe684 RC	234	}
c8afe684 RC	235
dada25bd	236	static void
fcda50c8	237	msm_hdmi_hotplug_work(struct work_struct *work)
dada25bd RC	238	{
	239	struct hdmi_connector *hdmi_connector =
	240	container_of(work, struct hdmi_connector, hpd_work);
	241	struct drm_connector *connector = &hdmi_connector->base;
	242	drm_helper_hpd_irq_event(connector->dev);
	243	}
	244
fcda50c8	245	void msm_hdmi_connector_irq(struct drm_connector *connector)
c8afe684	246	{
a3376e3e RC	247	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
a3376e3e RC	248	struct hdmi *hdmi = hdmi_connector->hdmi;
c8afe684 RC	249	uint32_t hpd_int_status, hpd_int_ctrl;
	250
	251	/* Process HPD: */
	252	hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);
	253	hpd_int_ctrl = hdmi_read(hdmi, REG_HDMI_HPD_INT_CTRL);
	254
	255	if ((hpd_int_ctrl & HDMI_HPD_INT_CTRL_INT_EN) &&
	256	(hpd_int_status & HDMI_HPD_INT_STATUS_INT)) {
	257	bool detected = !!(hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED);
	258
ff2f974e	259	/* ack & disable (temporarily) HPD events: */
c8afe684	260	hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
ff2f974e JW	261	HDMI_HPD_INT_CTRL_INT_ACK);
	262
	263	DBG("status=%04x, ctrl=%04x", hpd_int_status, hpd_int_ctrl);
c8afe684	264
c8afe684 RC	265	/* detect disconnect if we are connected or visa versa: */
	266	hpd_int_ctrl = HDMI_HPD_INT_CTRL_INT_EN;
	267	if (!detected)
	268	hpd_int_ctrl \|= HDMI_HPD_INT_CTRL_INT_CONNECT;
	269	hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, hpd_int_ctrl);
dada25bd	270
c6a57a50	271	queue_work(hdmi->workq, &hdmi_connector->hpd_work);
c8afe684 RC	272	}
	273	}
	274
3189650d RC	275	static enum drm_connector_status detect_reg(struct hdmi *hdmi)
3189650d RC	276	{
6ed9ed48 AT	277	uint32_t hpd_int_status;
	278
	279	pm_runtime_get_sync(&hdmi->pdev->dev);
	280	enable_hpd_clocks(hdmi, true);
	281
	282	hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);
	283
	284	enable_hpd_clocks(hdmi, false);
	285	pm_runtime_put_autosuspend(&hdmi->pdev->dev);
	286
3189650d RC	287	return (hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED) ?
	288	connector_status_connected : connector_status_disconnected;
	289	}
	290
dc50f782	291	#define HPD_GPIO_INDEX 2
3189650d RC	292	static enum drm_connector_status detect_gpio(struct hdmi *hdmi)
	293	{
	294	const struct hdmi_platform_config *config = hdmi->config;
dc50f782 AT	295	struct hdmi_gpio_data hpd_gpio = config->gpios[HPD_GPIO_INDEX];
dc50f782 AT	296
a44769b4	297	return gpiod_get_value(hpd_gpio.gpiod) ?
3189650d RC	298	connector_status_connected :
	299	connector_status_disconnected;
	300	}
	301
c8afe684 RC	302	static enum drm_connector_status hdmi_connector_detect(
	303	struct drm_connector *connector, bool force)
	304	{
a3376e3e RC	305	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
a3376e3e RC	306	struct hdmi *hdmi = hdmi_connector->hdmi;
c95ea162 AT	307	const struct hdmi_platform_config *config = hdmi->config;
c95ea162 AT	308	struct hdmi_gpio_data hpd_gpio = config->gpios[HPD_GPIO_INDEX];
3189650d	309	enum drm_connector_status stat_gpio, stat_reg;
c8afe684 RC	310	int retry = 20;
c8afe684 RC	311
c95ea162 AT	312	/*
	313	* some platforms may not have hpd gpio. Rely only on the status
	314	* provided by REG_HDMI_HPD_INT_STATUS in this case.
	315	*/
a44769b4	316	if (!hpd_gpio.gpiod)
c95ea162 AT	317	return detect_reg(hdmi);
c95ea162 AT	318
3189650d RC	319	do {
	320	stat_gpio = detect_gpio(hdmi);
	321	stat_reg = detect_reg(hdmi);
c8afe684	322
3189650d	323	if (stat_gpio == stat_reg)
dada25bd	324	break;
3189650d	325
c8afe684	326	mdelay(10);
3189650d RC	327	} while (--retry);
	328
	329	/* the status we get from reading gpio seems to be more reliable,
	330	* so trust that one the most if we didn't manage to get hdmi and
	331	* gpio status to agree:
	332	*/
	333	if (stat_gpio != stat_reg) {
	334	DBG("HDMI_HPD_INT_STATUS tells us: %d", stat_reg);
	335	DBG("hpd gpio tells us: %d", stat_gpio);
c8afe684 RC	336	}
c8afe684 RC	337
3189650d	338	return stat_gpio;
c8afe684 RC	339	}
	340
	341	static void hdmi_connector_destroy(struct drm_connector *connector)
	342	{
a3376e3e	343	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
c8afe684 RC	344
	345	hdp_disable(hdmi_connector);
	346
c8afe684 RC	347	drm_connector_cleanup(connector);
c8afe684 RC	348
c8afe684 RC	349	kfree(hdmi_connector);
	350	}
	351
fcda50c8	352	static int msm_hdmi_connector_get_modes(struct drm_connector *connector)
c8afe684	353	{
a3376e3e RC	354	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
a3376e3e RC	355	struct hdmi *hdmi = hdmi_connector->hdmi;
c8afe684 RC	356	struct edid *edid;
	357	uint32_t hdmi_ctrl;
	358	int ret = 0;
	359
	360	hdmi_ctrl = hdmi_read(hdmi, REG_HDMI_CTRL);
	361	hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl \| HDMI_CTRL_ENABLE);
	362
	363	edid = drm_get_edid(connector, hdmi->i2c);
	364
	365	hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl);
	366
c6a57a50	367	hdmi->hdmi_mode = drm_detect_hdmi_monitor(edid);
c555f023	368	drm_connector_update_edid_property(connector, edid);
c8afe684 RC	369
	370	if (edid) {
	371	ret = drm_add_edid_modes(connector, edid);
	372	kfree(edid);
	373	}
	374
	375	return ret;
	376	}
	377
fcda50c8	378	static int msm_hdmi_connector_mode_valid(struct drm_connector *connector,
c8afe684 RC	379	struct drm_display_mode *mode)
c8afe684 RC	380	{
a3376e3e	381	struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
dada25bd RC	382	struct hdmi *hdmi = hdmi_connector->hdmi;
dada25bd RC	383	const struct hdmi_platform_config *config = hdmi->config;
c8afe684 RC	384	struct msm_drm_private *priv = connector->dev->dev_private;
	385	struct msm_kms *kms = priv->kms;
	386	long actual, requested;
	387
	388	requested = 1000 * mode->clock;
	389	actual = kms->funcs->round_pixclk(kms,
a3376e3e	390	requested, hdmi_connector->hdmi->encoder);
c8afe684	391
dada25bd RC	392	/* for mdp5/apq8074, we manage our own pixel clk (as opposed to
	393	* mdp4/dtv stuff where pixel clk is assigned to mdp/encoder
	394	* instead):
	395	*/
	396	if (config->pwr_clk_cnt > 0)
	397	actual = clk_round_rate(hdmi->pwr_clks[0], actual);
	398
c8afe684 RC	399	DBG("requested=%ld, actual=%ld", requested, actual);
	400
	401	if (actual != requested)
	402	return MODE_CLOCK_RANGE;
	403
	404	return 0;
	405	}
	406
	407	static const struct drm_connector_funcs hdmi_connector_funcs = {
c8afe684 RC	408	.detect = hdmi_connector_detect,
	409	.fill_modes = drm_helper_probe_single_connector_modes,
	410	.destroy = hdmi_connector_destroy,
3e7849ef RC	411	.reset = drm_atomic_helper_connector_reset,
	412	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
	413	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
c8afe684 RC	414	};
c8afe684 RC	415
fcda50c8 AB	416	static const struct drm_connector_helper_funcs msm_hdmi_connector_helper_funcs = {
	417	.get_modes = msm_hdmi_connector_get_modes,
	418	.mode_valid = msm_hdmi_connector_mode_valid,
c8afe684 RC	419	};
	420
	421	/* initialize connector */
fcda50c8	422	struct drm_connector msm_hdmi_connector_init(struct hdmi hdmi)
c8afe684 RC	423	{
	424	struct drm_connector *connector = NULL;
	425	struct hdmi_connector *hdmi_connector;
c8afe684 RC	426
c8afe684 RC	427	hdmi_connector = kzalloc(sizeof(*hdmi_connector), GFP_KERNEL);
8208ed93 AT	428	if (!hdmi_connector)
8208ed93 AT	429	return ERR_PTR(-ENOMEM);
c8afe684	430
d1a717bd	431	hdmi_connector->hdmi = hdmi;
fcda50c8	432	INIT_WORK(&hdmi_connector->hpd_work, msm_hdmi_hotplug_work);
a3376e3e RC	433
a3376e3e RC	434	connector = &hdmi_connector->base;
c8afe684	435
a3376e3e	436	drm_connector_init(hdmi->dev, connector, &hdmi_connector_funcs,
c8afe684	437	DRM_MODE_CONNECTOR_HDMIA);
fcda50c8	438	drm_connector_helper_add(connector, &msm_hdmi_connector_helper_funcs);
c8afe684	439
3189650d RC	440	connector->polled = DRM_CONNECTOR_POLL_CONNECT \|
3189650d RC	441	DRM_CONNECTOR_POLL_DISCONNECT;
c8afe684	442
cddfaebd	443	connector->interlace_allowed = 0;
c8afe684 RC	444	connector->doublescan_allowed = 0;
c8afe684 RC	445
cde4c44d	446	drm_connector_attach_encoder(connector, hdmi->encoder);
c8afe684 RC	447
c8afe684 RC	448	return connector;
c8afe684	449	}