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 
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 
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 
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 
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 
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