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