1 /*
2 * Copyright (C) 2013 Red Hat
3 * Author: Rob Clark <robdclark@gmail.com>
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License version 2 as published by
7 * the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program. If not, see <http://www.gnu.org/licenses/>.
16 */
17
18 #include "hdmi.h"
19
20 struct hdmi_phy_8x74 {
21 struct hdmi_phy base;
22 void __iomem *mmio;
23 };
24 #define to_hdmi_phy_8x74(x) container_of(x, struct hdmi_phy_8x74, base)
25
26
phy_write(struct hdmi_phy_8x74 * phy,u32 reg,u32 data)27 static void phy_write(struct hdmi_phy_8x74 *phy, u32 reg, u32 data)
28 {
29 msm_writel(data, phy->mmio + reg);
30 }
31
32 //static u32 phy_read(struct hdmi_phy_8x74 *phy, u32 reg)
33 //{
34 // return msm_readl(phy->mmio + reg);
35 //}
36
hdmi_phy_8x74_destroy(struct hdmi_phy * phy)37 static void hdmi_phy_8x74_destroy(struct hdmi_phy *phy)
38 {
39 struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
40 kfree(phy_8x74);
41 }
42
hdmi_phy_8x74_powerup(struct hdmi_phy * phy,unsigned long int pixclock)43 static void hdmi_phy_8x74_powerup(struct hdmi_phy *phy,
44 unsigned long int pixclock)
45 {
46 struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
47
48 phy_write(phy_8x74, REG_HDMI_8x74_ANA_CFG0, 0x1b);
49 phy_write(phy_8x74, REG_HDMI_8x74_ANA_CFG1, 0xf2);
50 phy_write(phy_8x74, REG_HDMI_8x74_BIST_CFG0, 0x0);
51 phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN0, 0x0);
52 phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN1, 0x0);
53 phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN2, 0x0);
54 phy_write(phy_8x74, REG_HDMI_8x74_BIST_PATN3, 0x0);
55 phy_write(phy_8x74, REG_HDMI_8x74_PD_CTRL1, 0x20);
56 }
57
hdmi_phy_8x74_powerdown(struct hdmi_phy * phy)58 static void hdmi_phy_8x74_powerdown(struct hdmi_phy *phy)
59 {
60 struct hdmi_phy_8x74 *phy_8x74 = to_hdmi_phy_8x74(phy);
61 phy_write(phy_8x74, REG_HDMI_8x74_PD_CTRL0, 0x7f);
62 }
63
64 static const struct hdmi_phy_funcs hdmi_phy_8x74_funcs = {
65 .destroy = hdmi_phy_8x74_destroy,
66 .powerup = hdmi_phy_8x74_powerup,
67 .powerdown = hdmi_phy_8x74_powerdown,
68 };
69
hdmi_phy_8x74_init(struct hdmi * hdmi)70 struct hdmi_phy *hdmi_phy_8x74_init(struct hdmi *hdmi)
71 {
72 struct hdmi_phy_8x74 *phy_8x74;
73 struct hdmi_phy *phy = NULL;
74 int ret;
75
76 phy_8x74 = kzalloc(sizeof(*phy_8x74), GFP_KERNEL);
77 if (!phy_8x74) {
78 ret = -ENOMEM;
79 goto fail;
80 }
81
82 phy = &phy_8x74->base;
83
84 phy->funcs = &hdmi_phy_8x74_funcs;
85
86 /* for 8x74, the phy mmio is mapped separately: */
87 phy_8x74->mmio = msm_ioremap(hdmi->pdev,
88 "phy_physical", "HDMI_8x74");
89 if (IS_ERR(phy_8x74->mmio)) {
90 ret = PTR_ERR(phy_8x74->mmio);
91 goto fail;
92 }
93
94 return phy;
95
96 fail:
97 if (phy)
98 hdmi_phy_8x74_destroy(phy);
99 return ERR_PTR(ret);
100 }
101