radeon/audio: consolidate write_sad_regs() functions
[linux-2.6-block.git] / drivers / gpu / drm / radeon / dce6_afmt.c
CommitLineData
b530602f
AD
1/*
2 * Copyright 2013 Advanced Micro Devices, Inc.
3 *
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
10 *
11 * The above copyright notice and this permission notice shall be included in
12 * all copies or substantial portions of the Software.
13 *
14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20 * OTHER DEALINGS IN THE SOFTWARE.
21 *
22 */
23#include <linux/hdmi.h>
24#include <drm/drmP.h>
25#include "radeon.h"
1a626b68 26#include "radeon_audio.h"
b530602f
AD
27#include "sid.h"
28
1a626b68 29u32 dce6_endpoint_rreg(struct radeon_device *rdev,
b530602f
AD
30 u32 block_offset, u32 reg)
31{
0a5b7b0b 32 unsigned long flags;
b530602f
AD
33 u32 r;
34
0a5b7b0b 35 spin_lock_irqsave(&rdev->end_idx_lock, flags);
b530602f
AD
36 WREG32(AZ_F0_CODEC_ENDPOINT_INDEX + block_offset, reg);
37 r = RREG32(AZ_F0_CODEC_ENDPOINT_DATA + block_offset);
0a5b7b0b
AD
38 spin_unlock_irqrestore(&rdev->end_idx_lock, flags);
39
b530602f
AD
40 return r;
41}
42
1a626b68 43void dce6_endpoint_wreg(struct radeon_device *rdev,
b530602f
AD
44 u32 block_offset, u32 reg, u32 v)
45{
0a5b7b0b
AD
46 unsigned long flags;
47
48 spin_lock_irqsave(&rdev->end_idx_lock, flags);
b530602f
AD
49 if (ASIC_IS_DCE8(rdev))
50 WREG32(AZ_F0_CODEC_ENDPOINT_INDEX + block_offset, reg);
51 else
52 WREG32(AZ_F0_CODEC_ENDPOINT_INDEX + block_offset,
53 AZ_ENDPOINT_REG_WRITE_EN | AZ_ENDPOINT_REG_INDEX(reg));
54 WREG32(AZ_F0_CODEC_ENDPOINT_DATA + block_offset, v);
0a5b7b0b 55 spin_unlock_irqrestore(&rdev->end_idx_lock, flags);
b530602f
AD
56}
57
b530602f
AD
58static void dce6_afmt_get_connected_pins(struct radeon_device *rdev)
59{
60 int i;
61 u32 offset, tmp;
62
63 for (i = 0; i < rdev->audio.num_pins; i++) {
64 offset = rdev->audio.pin[i].offset;
65 tmp = RREG32_ENDPOINT(offset,
66 AZ_F0_CODEC_PIN_CONTROL_RESPONSE_CONFIGURATION_DEFAULT);
67 if (((tmp & PORT_CONNECTIVITY_MASK) >> PORT_CONNECTIVITY_SHIFT) == 1)
68 rdev->audio.pin[i].connected = false;
69 else
70 rdev->audio.pin[i].connected = true;
71 }
72}
73
74struct r600_audio_pin *dce6_audio_get_pin(struct radeon_device *rdev)
75{
76 int i;
77
78 dce6_afmt_get_connected_pins(rdev);
79
80 for (i = 0; i < rdev->audio.num_pins; i++) {
81 if (rdev->audio.pin[i].connected)
82 return &rdev->audio.pin[i];
83 }
84 DRM_ERROR("No connected audio pins found!\n");
85 return NULL;
86}
87
88void dce6_afmt_select_pin(struct drm_encoder *encoder)
89{
90 struct radeon_device *rdev = encoder->dev->dev_private;
91 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
92 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
53dc0b0c 93 u32 offset;
b530602f 94
53dc0b0c 95 if (!dig || !dig->afmt || !dig->afmt->pin)
b530602f
AD
96 return;
97
53dc0b0c
AD
98 offset = dig->afmt->offset;
99
7cc0a3d8
AD
100 WREG32(AFMT_AUDIO_SRC_CONTROL + offset,
101 AFMT_AUDIO_SRC_SELECT(dig->afmt->pin->id));
b530602f
AD
102}
103
b1880258
AD
104void dce6_afmt_write_latency_fields(struct drm_encoder *encoder,
105 struct drm_display_mode *mode)
106{
107 struct radeon_device *rdev = encoder->dev->dev_private;
108 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
109 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
110 struct drm_connector *connector;
111 struct radeon_connector *radeon_connector = NULL;
112 u32 tmp = 0, offset;
113
53dc0b0c 114 if (!dig || !dig->afmt || !dig->afmt->pin)
b1880258
AD
115 return;
116
117 offset = dig->afmt->pin->offset;
118
119 list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
120 if (connector->encoder == encoder) {
121 radeon_connector = to_radeon_connector(connector);
122 break;
123 }
124 }
125
126 if (!radeon_connector) {
127 DRM_ERROR("Couldn't find encoder's connector\n");
128 return;
129 }
130
131 if (mode->flags & DRM_MODE_FLAG_INTERLACE) {
132 if (connector->latency_present[1])
133 tmp = VIDEO_LIPSYNC(connector->video_latency[1]) |
134 AUDIO_LIPSYNC(connector->audio_latency[1]);
135 else
c748990b 136 tmp = VIDEO_LIPSYNC(0) | AUDIO_LIPSYNC(0);
b1880258
AD
137 } else {
138 if (connector->latency_present[0])
139 tmp = VIDEO_LIPSYNC(connector->video_latency[0]) |
140 AUDIO_LIPSYNC(connector->audio_latency[0]);
141 else
c748990b 142 tmp = VIDEO_LIPSYNC(0) | AUDIO_LIPSYNC(0);
b1880258
AD
143 }
144 WREG32_ENDPOINT(offset, AZ_F0_CODEC_PIN_CONTROL_RESPONSE_LIPSYNC, tmp);
145}
146
6159b65a 147void dce6_afmt_write_speaker_allocation(struct drm_encoder *encoder)
b530602f
AD
148{
149 struct radeon_device *rdev = encoder->dev->dev_private;
150 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
151 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
6159b65a
RM
152 struct drm_connector *connector;
153 struct radeon_connector *radeon_connector = NULL;
b530602f 154 u32 offset, tmp;
83d04c39 155 u8 *sadb = NULL;
6159b65a
RM
156 int sad_count;
157
53dc0b0c 158 if (!dig || !dig->afmt || !dig->afmt->pin)
6159b65a
RM
159 return;
160
161 offset = dig->afmt->pin->offset;
162
163 list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
88fd4789 164 if (connector->encoder == encoder) {
6159b65a 165 radeon_connector = to_radeon_connector(connector);
88fd4789
SB
166 break;
167 }
6159b65a
RM
168 }
169
170 if (!radeon_connector) {
171 DRM_ERROR("Couldn't find encoder's connector\n");
172 return;
173 }
174
377bd8a9 175 sad_count = drm_edid_to_speaker_allocation(radeon_connector_edid(connector), &sadb);
49104038
AD
176 if (sad_count < 0) {
177 DRM_DEBUG("Couldn't read Speaker Allocation Data Block: %d\n", sad_count);
178 sad_count = 0;
6159b65a
RM
179 }
180
181 /* program the speaker allocation */
182 tmp = RREG32_ENDPOINT(offset, AZ_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER);
183 tmp &= ~(DP_CONNECTION | SPEAKER_ALLOCATION_MASK);
184 /* set HDMI mode */
185 tmp |= HDMI_CONNECTION;
186 if (sad_count)
187 tmp |= SPEAKER_ALLOCATION(sadb[0]);
188 else
189 tmp |= SPEAKER_ALLOCATION(5); /* stereo */
190 WREG32_ENDPOINT(offset, AZ_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER, tmp);
191
192 kfree(sadb);
193}
194
070a2e63
AD
195void dce6_afmt_write_sad_regs(struct drm_encoder *encoder,
196 struct cea_sad *sads, int sad_count)
6159b65a 197{
070a2e63
AD
198 u32 offset;
199 int i;
6159b65a
RM
200 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
201 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
070a2e63 202 struct radeon_device *rdev = encoder->dev->dev_private;
b530602f
AD
203 static const u16 eld_reg_to_type[][2] = {
204 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR0, HDMI_AUDIO_CODING_TYPE_PCM },
205 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR1, HDMI_AUDIO_CODING_TYPE_AC3 },
206 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR2, HDMI_AUDIO_CODING_TYPE_MPEG1 },
207 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR3, HDMI_AUDIO_CODING_TYPE_MP3 },
208 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR4, HDMI_AUDIO_CODING_TYPE_MPEG2 },
209 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR5, HDMI_AUDIO_CODING_TYPE_AAC_LC },
210 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR6, HDMI_AUDIO_CODING_TYPE_DTS },
211 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR7, HDMI_AUDIO_CODING_TYPE_ATRAC },
212 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR9, HDMI_AUDIO_CODING_TYPE_EAC3 },
213 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR10, HDMI_AUDIO_CODING_TYPE_DTS_HD },
214 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR11, HDMI_AUDIO_CODING_TYPE_MLP },
215 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR13, HDMI_AUDIO_CODING_TYPE_WMA_PRO },
216 };
217
53dc0b0c 218 if (!dig || !dig->afmt || !dig->afmt->pin)
b530602f
AD
219 return;
220
221 offset = dig->afmt->pin->offset;
222
b530602f
AD
223 for (i = 0; i < ARRAY_SIZE(eld_reg_to_type); i++) {
224 u32 value = 0;
0f57bca9
AH
225 u8 stereo_freqs = 0;
226 int max_channels = -1;
b530602f
AD
227 int j;
228
229 for (j = 0; j < sad_count; j++) {
230 struct cea_sad *sad = &sads[j];
231
232 if (sad->format == eld_reg_to_type[i][1]) {
0f57bca9
AH
233 if (sad->channels > max_channels) {
234 value = MAX_CHANNELS(sad->channels) |
235 DESCRIPTOR_BYTE_2(sad->byte2) |
236 SUPPORTED_FREQUENCIES(sad->freq);
237 max_channels = sad->channels;
238 }
239
b530602f 240 if (sad->format == HDMI_AUDIO_CODING_TYPE_PCM)
0f57bca9
AH
241 stereo_freqs |= sad->freq;
242 else
243 break;
b530602f
AD
244 }
245 }
0f57bca9
AH
246
247 value |= SUPPORTED_FREQUENCIES_STEREO(stereo_freqs);
248
b530602f
AD
249 WREG32_ENDPOINT(offset, eld_reg_to_type[i][0], value);
250 }
b530602f
AD
251}
252
832eafaf
AD
253void dce6_audio_enable(struct radeon_device *rdev,
254 struct r600_audio_pin *pin,
d3d8c141 255 u8 enable_mask)
b530602f 256{
832eafaf
AD
257 if (!pin)
258 return;
259
f68fdbe4 260 WREG32_ENDPOINT(pin->offset, AZ_F0_CODEC_PIN_CONTROL_HOT_PLUG_CONTROL,
d3d8c141 261 enable_mask ? AUDIO_ENABLED : 0);
b530602f
AD
262}
263
b530602f
AD
264void dce6_audio_fini(struct radeon_device *rdev)
265{
266 int i;
267
268 if (!rdev->audio.enabled)
269 return;
270
271 for (i = 0; i < rdev->audio.num_pins; i++)
272 dce6_audio_enable(rdev, &rdev->audio.pin[i], false);
273
274 rdev->audio.enabled = false;
275}