158 lines
3.9 KiB
C
158 lines
3.9 KiB
C
/*
|
|
* 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);
|
|
}
|