2 * Copyright (C) 2013 Red Hat
3 * Author: Rob Clark <robdclark@gmail.com>
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.
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
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/>.
21 struct drm_bridge base
;
24 #define to_hdmi_bridge(x) container_of(x, struct hdmi_bridge, base)
26 void hdmi_bridge_destroy(struct drm_bridge
*bridge
)
28 struct hdmi_bridge
*hdmi_bridge
= to_hdmi_bridge(bridge
);
32 static void power_on(struct drm_bridge
*bridge
)
34 struct drm_device
*dev
= bridge
->dev
;
35 struct hdmi_bridge
*hdmi_bridge
= to_hdmi_bridge(bridge
);
36 struct hdmi
*hdmi
= hdmi_bridge
->hdmi
;
37 const struct hdmi_platform_config
*config
= hdmi
->config
;
40 for (i
= 0; i
< config
->pwr_reg_cnt
; i
++) {
41 ret
= regulator_enable(hdmi
->pwr_regs
[i
]);
43 dev_err(dev
->dev
, "failed to enable pwr regulator: %s (%d)\n",
44 config
->pwr_reg_names
[i
], ret
);
48 if (config
->pwr_clk_cnt
> 0) {
49 DBG("pixclock: %lu", hdmi
->pixclock
);
50 ret
= clk_set_rate(hdmi
->pwr_clks
[0], hdmi
->pixclock
);
52 dev_err(dev
->dev
, "failed to set pixel clk: %s (%d)\n",
53 config
->pwr_clk_names
[0], ret
);
57 for (i
= 0; i
< config
->pwr_clk_cnt
; i
++) {
58 ret
= clk_prepare_enable(hdmi
->pwr_clks
[i
]);
60 dev_err(dev
->dev
, "failed to enable pwr clk: %s (%d)\n",
61 config
->pwr_clk_names
[i
], ret
);
66 static void power_off(struct drm_bridge
*bridge
)
68 struct drm_device
*dev
= bridge
->dev
;
69 struct hdmi_bridge
*hdmi_bridge
= to_hdmi_bridge(bridge
);
70 struct hdmi
*hdmi
= hdmi_bridge
->hdmi
;
71 const struct hdmi_platform_config
*config
= hdmi
->config
;
74 /* TODO do we need to wait for final vblank somewhere before
79 for (i
= 0; i
< config
->pwr_clk_cnt
; i
++)
80 clk_disable_unprepare(hdmi
->pwr_clks
[i
]);
82 for (i
= 0; i
< config
->pwr_reg_cnt
; i
++) {
83 ret
= regulator_disable(hdmi
->pwr_regs
[i
]);
85 dev_err(dev
->dev
, "failed to disable pwr regulator: %s (%d)\n",
86 config
->pwr_reg_names
[i
], ret
);
91 static void hdmi_bridge_pre_enable(struct drm_bridge
*bridge
)
93 struct hdmi_bridge
*hdmi_bridge
= to_hdmi_bridge(bridge
);
94 struct hdmi
*hdmi
= hdmi_bridge
->hdmi
;
95 struct hdmi_phy
*phy
= hdmi
->phy
;
99 if (!hdmi
->power_on
) {
101 hdmi
->power_on
= true;
102 hdmi_audio_update(hdmi
);
105 phy
->funcs
->powerup(phy
, hdmi
->pixclock
);
106 hdmi_set_mode(hdmi
, true);
109 static void hdmi_bridge_enable(struct drm_bridge
*bridge
)
113 static void hdmi_bridge_disable(struct drm_bridge
*bridge
)
117 static void hdmi_bridge_post_disable(struct drm_bridge
*bridge
)
119 struct hdmi_bridge
*hdmi_bridge
= to_hdmi_bridge(bridge
);
120 struct hdmi
*hdmi
= hdmi_bridge
->hdmi
;
121 struct hdmi_phy
*phy
= hdmi
->phy
;
124 hdmi_set_mode(hdmi
, false);
125 phy
->funcs
->powerdown(phy
);
127 if (hdmi
->power_on
) {
129 hdmi
->power_on
= false;
130 hdmi_audio_update(hdmi
);
134 static void hdmi_bridge_mode_set(struct drm_bridge
*bridge
,
135 struct drm_display_mode
*mode
,
136 struct drm_display_mode
*adjusted_mode
)
138 struct hdmi_bridge
*hdmi_bridge
= to_hdmi_bridge(bridge
);
139 struct hdmi
*hdmi
= hdmi_bridge
->hdmi
;
140 int hstart
, hend
, vstart
, vend
;
143 mode
= adjusted_mode
;
145 hdmi
->pixclock
= mode
->clock
* 1000;
147 hdmi
->hdmi_mode
= drm_match_cea_mode(mode
) > 1;
149 hstart
= mode
->htotal
- mode
->hsync_start
;
150 hend
= mode
->htotal
- mode
->hsync_start
+ mode
->hdisplay
;
152 vstart
= mode
->vtotal
- mode
->vsync_start
- 1;
153 vend
= mode
->vtotal
- mode
->vsync_start
+ mode
->vdisplay
- 1;
155 DBG("htotal=%d, vtotal=%d, hstart=%d, hend=%d, vstart=%d, vend=%d",
156 mode
->htotal
, mode
->vtotal
, hstart
, hend
, vstart
, vend
);
158 hdmi_write(hdmi
, REG_HDMI_TOTAL
,
159 HDMI_TOTAL_H_TOTAL(mode
->htotal
- 1) |
160 HDMI_TOTAL_V_TOTAL(mode
->vtotal
- 1));
162 hdmi_write(hdmi
, REG_HDMI_ACTIVE_HSYNC
,
163 HDMI_ACTIVE_HSYNC_START(hstart
) |
164 HDMI_ACTIVE_HSYNC_END(hend
));
165 hdmi_write(hdmi
, REG_HDMI_ACTIVE_VSYNC
,
166 HDMI_ACTIVE_VSYNC_START(vstart
) |
167 HDMI_ACTIVE_VSYNC_END(vend
));
169 if (mode
->flags
& DRM_MODE_FLAG_INTERLACE
) {
170 hdmi_write(hdmi
, REG_HDMI_VSYNC_TOTAL_F2
,
171 HDMI_VSYNC_TOTAL_F2_V_TOTAL(mode
->vtotal
));
172 hdmi_write(hdmi
, REG_HDMI_VSYNC_ACTIVE_F2
,
173 HDMI_VSYNC_ACTIVE_F2_START(vstart
+ 1) |
174 HDMI_VSYNC_ACTIVE_F2_END(vend
+ 1));
176 hdmi_write(hdmi
, REG_HDMI_VSYNC_TOTAL_F2
,
177 HDMI_VSYNC_TOTAL_F2_V_TOTAL(0));
178 hdmi_write(hdmi
, REG_HDMI_VSYNC_ACTIVE_F2
,
179 HDMI_VSYNC_ACTIVE_F2_START(0) |
180 HDMI_VSYNC_ACTIVE_F2_END(0));
184 if (mode
->flags
& DRM_MODE_FLAG_NHSYNC
)
185 frame_ctrl
|= HDMI_FRAME_CTRL_HSYNC_LOW
;
186 if (mode
->flags
& DRM_MODE_FLAG_NVSYNC
)
187 frame_ctrl
|= HDMI_FRAME_CTRL_VSYNC_LOW
;
188 if (mode
->flags
& DRM_MODE_FLAG_INTERLACE
)
189 frame_ctrl
|= HDMI_FRAME_CTRL_INTERLACED_EN
;
190 DBG("frame_ctrl=%08x", frame_ctrl
);
191 hdmi_write(hdmi
, REG_HDMI_FRAME_CTRL
, frame_ctrl
);
193 hdmi_audio_update(hdmi
);
196 static const struct drm_bridge_funcs hdmi_bridge_funcs
= {
197 .pre_enable
= hdmi_bridge_pre_enable
,
198 .enable
= hdmi_bridge_enable
,
199 .disable
= hdmi_bridge_disable
,
200 .post_disable
= hdmi_bridge_post_disable
,
201 .mode_set
= hdmi_bridge_mode_set
,
205 /* initialize bridge */
206 struct drm_bridge
*hdmi_bridge_init(struct hdmi
*hdmi
)
208 struct drm_bridge
*bridge
= NULL
;
209 struct hdmi_bridge
*hdmi_bridge
;
212 hdmi_bridge
= kzalloc(sizeof(*hdmi_bridge
), GFP_KERNEL
);
218 hdmi_bridge
->hdmi
= hdmi
;
220 bridge
= &hdmi_bridge
->base
;
221 bridge
->funcs
= &hdmi_bridge_funcs
;
223 drm_bridge_attach(hdmi
->dev
, bridge
);
229 hdmi_bridge_destroy(bridge
);