1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * HDMI wrapper
4 *
5 * Copyright (C) 2013 Texas Instruments Incorporated
6 */
7
8 #define DSS_SUBSYS_NAME "HDMIWP"
9
10 #include <linux/kernel.h>
11 #include <linux/err.h>
12 #include <linux/io.h>
13 #include <linux/platform_device.h>
14 #include <linux/seq_file.h>
15
16 #include <video/omapfb_dss.h>
17
18 #include "dss.h"
19 #include "hdmi.h"
20
hdmi_wp_dump(struct hdmi_wp_data * wp,struct seq_file * s)21 void hdmi_wp_dump(struct hdmi_wp_data *wp, struct seq_file *s)
22 {
23 #define DUMPREG(r) seq_printf(s, "%-35s %08x\n", #r, hdmi_read_reg(wp->base, r))
24
25 DUMPREG(HDMI_WP_REVISION);
26 DUMPREG(HDMI_WP_SYSCONFIG);
27 DUMPREG(HDMI_WP_IRQSTATUS_RAW);
28 DUMPREG(HDMI_WP_IRQSTATUS);
29 DUMPREG(HDMI_WP_IRQENABLE_SET);
30 DUMPREG(HDMI_WP_IRQENABLE_CLR);
31 DUMPREG(HDMI_WP_IRQWAKEEN);
32 DUMPREG(HDMI_WP_PWR_CTRL);
33 DUMPREG(HDMI_WP_DEBOUNCE);
34 DUMPREG(HDMI_WP_VIDEO_CFG);
35 DUMPREG(HDMI_WP_VIDEO_SIZE);
36 DUMPREG(HDMI_WP_VIDEO_TIMING_H);
37 DUMPREG(HDMI_WP_VIDEO_TIMING_V);
38 DUMPREG(HDMI_WP_CLK);
39 DUMPREG(HDMI_WP_AUDIO_CFG);
40 DUMPREG(HDMI_WP_AUDIO_CFG2);
41 DUMPREG(HDMI_WP_AUDIO_CTRL);
42 DUMPREG(HDMI_WP_AUDIO_DATA);
43 }
44
hdmi_wp_get_irqstatus(struct hdmi_wp_data * wp)45 u32 hdmi_wp_get_irqstatus(struct hdmi_wp_data *wp)
46 {
47 return hdmi_read_reg(wp->base, HDMI_WP_IRQSTATUS);
48 }
49
hdmi_wp_set_irqstatus(struct hdmi_wp_data * wp,u32 irqstatus)50 void hdmi_wp_set_irqstatus(struct hdmi_wp_data *wp, u32 irqstatus)
51 {
52 hdmi_write_reg(wp->base, HDMI_WP_IRQSTATUS, irqstatus);
53 /* flush posted write */
54 hdmi_read_reg(wp->base, HDMI_WP_IRQSTATUS);
55 }
56
hdmi_wp_set_irqenable(struct hdmi_wp_data * wp,u32 mask)57 void hdmi_wp_set_irqenable(struct hdmi_wp_data *wp, u32 mask)
58 {
59 hdmi_write_reg(wp->base, HDMI_WP_IRQENABLE_SET, mask);
60 }
61
hdmi_wp_clear_irqenable(struct hdmi_wp_data * wp,u32 mask)62 void hdmi_wp_clear_irqenable(struct hdmi_wp_data *wp, u32 mask)
63 {
64 hdmi_write_reg(wp->base, HDMI_WP_IRQENABLE_CLR, mask);
65 }
66
67 /* PHY_PWR_CMD */
hdmi_wp_set_phy_pwr(struct hdmi_wp_data * wp,enum hdmi_phy_pwr val)68 int hdmi_wp_set_phy_pwr(struct hdmi_wp_data *wp, enum hdmi_phy_pwr val)
69 {
70 /* Return if already the state */
71 if (REG_GET(wp->base, HDMI_WP_PWR_CTRL, 5, 4) == val)
72 return 0;
73
74 /* Command for power control of HDMI PHY */
75 REG_FLD_MOD(wp->base, HDMI_WP_PWR_CTRL, val, 7, 6);
76
77 /* Status of the power control of HDMI PHY */
78 if (hdmi_wait_for_bit_change(wp->base, HDMI_WP_PWR_CTRL, 5, 4, val)
79 != val) {
80 DSSERR("Failed to set PHY power mode to %d\n", val);
81 return -ETIMEDOUT;
82 }
83
84 return 0;
85 }
86
87 /* PLL_PWR_CMD */
hdmi_wp_set_pll_pwr(struct hdmi_wp_data * wp,enum hdmi_pll_pwr val)88 int hdmi_wp_set_pll_pwr(struct hdmi_wp_data *wp, enum hdmi_pll_pwr val)
89 {
90 /* Command for power control of HDMI PLL */
91 REG_FLD_MOD(wp->base, HDMI_WP_PWR_CTRL, val, 3, 2);
92
93 /* wait till PHY_PWR_STATUS is set */
94 if (hdmi_wait_for_bit_change(wp->base, HDMI_WP_PWR_CTRL, 1, 0, val)
95 != val) {
96 DSSERR("Failed to set PLL_PWR_STATUS\n");
97 return -ETIMEDOUT;
98 }
99
100 return 0;
101 }
102
hdmi_wp_video_start(struct hdmi_wp_data * wp)103 int hdmi_wp_video_start(struct hdmi_wp_data *wp)
104 {
105 REG_FLD_MOD(wp->base, HDMI_WP_VIDEO_CFG, true, 31, 31);
106
107 return 0;
108 }
109
hdmi_wp_video_stop(struct hdmi_wp_data * wp)110 void hdmi_wp_video_stop(struct hdmi_wp_data *wp)
111 {
112 int i;
113
114 hdmi_write_reg(wp->base, HDMI_WP_IRQSTATUS, HDMI_IRQ_VIDEO_FRAME_DONE);
115
116 REG_FLD_MOD(wp->base, HDMI_WP_VIDEO_CFG, false, 31, 31);
117
118 for (i = 0; i < 50; ++i) {
119 u32 v;
120
121 msleep(20);
122
123 v = hdmi_read_reg(wp->base, HDMI_WP_IRQSTATUS_RAW);
124 if (v & HDMI_IRQ_VIDEO_FRAME_DONE)
125 return;
126 }
127
128 DSSERR("no HDMI FRAMEDONE when disabling output\n");
129 }
130
hdmi_wp_video_config_format(struct hdmi_wp_data * wp,struct hdmi_video_format * video_fmt)131 void hdmi_wp_video_config_format(struct hdmi_wp_data *wp,
132 struct hdmi_video_format *video_fmt)
133 {
134 u32 l = 0;
135
136 REG_FLD_MOD(wp->base, HDMI_WP_VIDEO_CFG, video_fmt->packing_mode,
137 10, 8);
138
139 l |= FLD_VAL(video_fmt->y_res, 31, 16);
140 l |= FLD_VAL(video_fmt->x_res, 15, 0);
141 hdmi_write_reg(wp->base, HDMI_WP_VIDEO_SIZE, l);
142 }
143
hdmi_wp_video_config_interface(struct hdmi_wp_data * wp,struct omap_video_timings * timings)144 void hdmi_wp_video_config_interface(struct hdmi_wp_data *wp,
145 struct omap_video_timings *timings)
146 {
147 u32 r;
148 bool vsync_pol, hsync_pol;
149 DSSDBG("Enter hdmi_wp_video_config_interface\n");
150
151 vsync_pol = timings->vsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
152 hsync_pol = timings->hsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
153
154 r = hdmi_read_reg(wp->base, HDMI_WP_VIDEO_CFG);
155 r = FLD_MOD(r, vsync_pol, 7, 7);
156 r = FLD_MOD(r, hsync_pol, 6, 6);
157 r = FLD_MOD(r, timings->interlace, 3, 3);
158 r = FLD_MOD(r, 1, 1, 0); /* HDMI_TIMING_MASTER_24BIT */
159 hdmi_write_reg(wp->base, HDMI_WP_VIDEO_CFG, r);
160 }
161
hdmi_wp_video_config_timing(struct hdmi_wp_data * wp,struct omap_video_timings * timings)162 void hdmi_wp_video_config_timing(struct hdmi_wp_data *wp,
163 struct omap_video_timings *timings)
164 {
165 u32 timing_h = 0;
166 u32 timing_v = 0;
167
168 DSSDBG("Enter hdmi_wp_video_config_timing\n");
169
170 timing_h |= FLD_VAL(timings->hbp, 31, 20);
171 timing_h |= FLD_VAL(timings->hfp, 19, 8);
172 timing_h |= FLD_VAL(timings->hsw, 7, 0);
173 hdmi_write_reg(wp->base, HDMI_WP_VIDEO_TIMING_H, timing_h);
174
175 timing_v |= FLD_VAL(timings->vbp, 31, 20);
176 timing_v |= FLD_VAL(timings->vfp, 19, 8);
177 timing_v |= FLD_VAL(timings->vsw, 7, 0);
178 hdmi_write_reg(wp->base, HDMI_WP_VIDEO_TIMING_V, timing_v);
179 }
180
hdmi_wp_init_vid_fmt_timings(struct hdmi_video_format * video_fmt,struct omap_video_timings * timings,struct hdmi_config * param)181 void hdmi_wp_init_vid_fmt_timings(struct hdmi_video_format *video_fmt,
182 struct omap_video_timings *timings, struct hdmi_config *param)
183 {
184 DSSDBG("Enter hdmi_wp_video_init_format\n");
185
186 video_fmt->packing_mode = HDMI_PACK_10b_RGB_YUV444;
187 video_fmt->y_res = param->timings.y_res;
188 video_fmt->x_res = param->timings.x_res;
189 if (param->timings.interlace)
190 video_fmt->y_res /= 2;
191
192 timings->hbp = param->timings.hbp;
193 timings->hfp = param->timings.hfp;
194 timings->hsw = param->timings.hsw;
195 timings->vbp = param->timings.vbp;
196 timings->vfp = param->timings.vfp;
197 timings->vsw = param->timings.vsw;
198 timings->vsync_level = param->timings.vsync_level;
199 timings->hsync_level = param->timings.hsync_level;
200 timings->interlace = param->timings.interlace;
201 }
202
hdmi_wp_audio_config_format(struct hdmi_wp_data * wp,struct hdmi_audio_format * aud_fmt)203 void hdmi_wp_audio_config_format(struct hdmi_wp_data *wp,
204 struct hdmi_audio_format *aud_fmt)
205 {
206 u32 r;
207
208 DSSDBG("Enter hdmi_wp_audio_config_format\n");
209
210 r = hdmi_read_reg(wp->base, HDMI_WP_AUDIO_CFG);
211 if (omapdss_get_version() == OMAPDSS_VER_OMAP4430_ES1 ||
212 omapdss_get_version() == OMAPDSS_VER_OMAP4430_ES2 ||
213 omapdss_get_version() == OMAPDSS_VER_OMAP4) {
214 r = FLD_MOD(r, aud_fmt->stereo_channels, 26, 24);
215 r = FLD_MOD(r, aud_fmt->active_chnnls_msk, 23, 16);
216 }
217 r = FLD_MOD(r, aud_fmt->en_sig_blk_strt_end, 5, 5);
218 r = FLD_MOD(r, aud_fmt->type, 4, 4);
219 r = FLD_MOD(r, aud_fmt->justification, 3, 3);
220 r = FLD_MOD(r, aud_fmt->sample_order, 2, 2);
221 r = FLD_MOD(r, aud_fmt->samples_per_word, 1, 1);
222 r = FLD_MOD(r, aud_fmt->sample_size, 0, 0);
223 hdmi_write_reg(wp->base, HDMI_WP_AUDIO_CFG, r);
224 }
225
hdmi_wp_audio_config_dma(struct hdmi_wp_data * wp,struct hdmi_audio_dma * aud_dma)226 void hdmi_wp_audio_config_dma(struct hdmi_wp_data *wp,
227 struct hdmi_audio_dma *aud_dma)
228 {
229 u32 r;
230
231 DSSDBG("Enter hdmi_wp_audio_config_dma\n");
232
233 r = hdmi_read_reg(wp->base, HDMI_WP_AUDIO_CFG2);
234 r = FLD_MOD(r, aud_dma->transfer_size, 15, 8);
235 r = FLD_MOD(r, aud_dma->block_size, 7, 0);
236 hdmi_write_reg(wp->base, HDMI_WP_AUDIO_CFG2, r);
237
238 r = hdmi_read_reg(wp->base, HDMI_WP_AUDIO_CTRL);
239 r = FLD_MOD(r, aud_dma->mode, 9, 9);
240 r = FLD_MOD(r, aud_dma->fifo_threshold, 8, 0);
241 hdmi_write_reg(wp->base, HDMI_WP_AUDIO_CTRL, r);
242 }
243
hdmi_wp_audio_enable(struct hdmi_wp_data * wp,bool enable)244 int hdmi_wp_audio_enable(struct hdmi_wp_data *wp, bool enable)
245 {
246 REG_FLD_MOD(wp->base, HDMI_WP_AUDIO_CTRL, enable, 31, 31);
247
248 return 0;
249 }
250
hdmi_wp_audio_core_req_enable(struct hdmi_wp_data * wp,bool enable)251 int hdmi_wp_audio_core_req_enable(struct hdmi_wp_data *wp, bool enable)
252 {
253 REG_FLD_MOD(wp->base, HDMI_WP_AUDIO_CTRL, enable, 30, 30);
254
255 return 0;
256 }
257
hdmi_wp_init(struct platform_device * pdev,struct hdmi_wp_data * wp)258 int hdmi_wp_init(struct platform_device *pdev, struct hdmi_wp_data *wp)
259 {
260 struct resource *res;
261
262 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "wp");
263 if (!res) {
264 DSSERR("can't get WP mem resource\n");
265 return -EINVAL;
266 }
267 wp->phys_base = res->start;
268
269 wp->base = devm_ioremap_resource(&pdev->dev, res);
270 if (IS_ERR(wp->base)) {
271 DSSERR("can't ioremap HDMI WP\n");
272 return PTR_ERR(wp->base);
273 }
274
275 return 0;
276 }
277
hdmi_wp_get_audio_dma_addr(struct hdmi_wp_data * wp)278 phys_addr_t hdmi_wp_get_audio_dma_addr(struct hdmi_wp_data *wp)
279 {
280 return wp->phys_base + HDMI_WP_AUDIO_DATA;
281 }
282