Kernel  |  4.1

下载     查看原文件
C++程序  |  158行  |  3.94 KB
/*
 * Copyright (C) 2013 Red Hat
 * Author: Rob Clark <robdclark@gmail.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/>.
 */

#include "hdmi.h"

struct hdmi_phy_8x74 {
	struct hdmi_phy base;
	struct hdmi *hdmi;
	void __iomem *mmio;
};
#define to_hdmi_phy_8x74(x) container_of(x, struct hdmi_phy_8x74, base)


static void phy_write(struct hdmi_phy_8x74 *phy, u32 reg, u32 data)
{
	msm_writel(data, phy->mmio + reg);
}

//static u32 phy_read(struct hdmi_phy_8x74 *phy, u32 reg)
//{
//	return msm_readl(phy->mmio + reg);
//}

static void hdmi_phy_8x74_destroy(struct hdmi_phy *phy)
{
	struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
	kfree(phy_8x74);
}

static void hdmi_phy_8x74_reset(struct hdmi_phy *phy)
{
	struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
	struct hdmi *hdmi = phy_8x74->hdmi;
	unsigned int val;

	/* NOTE that HDMI_PHY_CTL is in core mmio, not phy mmio: */

	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 void hdmi_phy_8x74_powerup(struct hdmi_phy *phy,
		unsigned long int pixclock)
{
	struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);

	phy_write(phy_8x74, REG_HDMI_8x74_ANA_CFG0,   0x1b);
	phy_write(phy_8x74, REG_HDMI_8x74_ANA_CFG1,   0xf2);
	phy_write(phy_8x74, REG_HDMI_8x74_BIST_CFG0,  0x0);
	phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN0, 0x0);
	phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN1, 0x0);
	phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN2, 0x0);
	phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN3, 0x0);
	phy_write(phy_8x74, REG_HDMI_8x74_PD_CTRL1,   0x20);
}

static void hdmi_phy_8x74_powerdown(struct hdmi_phy *phy)
{
	struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
	phy_write(phy_8x74, REG_HDMI_8x74_PD_CTRL0, 0x7f);
}

static const struct hdmi_phy_funcs hdmi_phy_8x74_funcs = {
		.destroy = hdmi_phy_8x74_destroy,
		.reset = hdmi_phy_8x74_reset,
		.powerup = hdmi_phy_8x74_powerup,
		.powerdown = hdmi_phy_8x74_powerdown,
};

struct hdmi_phy *hdmi_phy_8x74_init(struct hdmi *hdmi)
{
	struct hdmi_phy_8x74 *phy_8x74;
	struct hdmi_phy *phy = NULL;
	int ret;

	phy_8x74 = kzalloc(sizeof(*phy_8x74), GFP_KERNEL);
	if (!phy_8x74) {
		ret = -ENOMEM;
		goto fail;
	}

	phy = &phy_8x74->base;

	phy->funcs = &hdmi_phy_8x74_funcs;

	phy_8x74->hdmi = hdmi;

	/* for 8x74, the phy mmio is mapped separately: */
	phy_8x74->mmio = msm_ioremap(hdmi->pdev,
			"phy_physical", "HDMI_8x74");
	if (IS_ERR(phy_8x74->mmio)) {
		ret = PTR_ERR(phy_8x74->mmio);
		goto fail;
	}

	return phy;

fail:
	if (phy)
		hdmi_phy_8x74_destroy(phy);
	return ERR_PTR(ret);
}