radeon/audio: consolidate write_speaker_allocation() 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
00a9d4bc
SG
147void dce6_afmt_hdmi_write_speaker_allocation(struct drm_encoder *encoder,
148 u8 *sadb, int sad_count)
b530602f
AD
149{
150 struct radeon_device *rdev = encoder->dev->dev_private;
151 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
152 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
153 u32 offset, tmp;
6159b65a 154
53dc0b0c 155 if (!dig || !dig->afmt || !dig->afmt->pin)
6159b65a
RM
156 return;
157
158 offset = dig->afmt->pin->offset;
159
6159b65a
RM
160 /* program the speaker allocation */
161 tmp = RREG32_ENDPOINT(offset, AZ_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER);
162 tmp &= ~(DP_CONNECTION | SPEAKER_ALLOCATION_MASK);
163 /* set HDMI mode */
164 tmp |= HDMI_CONNECTION;
165 if (sad_count)
166 tmp |= SPEAKER_ALLOCATION(sadb[0]);
167 else
168 tmp |= SPEAKER_ALLOCATION(5); /* stereo */
169 WREG32_ENDPOINT(offset, AZ_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER, tmp);
00a9d4bc 170}
6159b65a 171
00a9d4bc
SG
172void dce6_afmt_dp_write_speaker_allocation(struct drm_encoder *encoder,
173 u8 *sadb, int sad_count)
174{
175 struct radeon_device *rdev = encoder->dev->dev_private;
176 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
177 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
178 u32 offset, tmp;
179
180 if (!dig || !dig->afmt || !dig->afmt->pin)
181 return;
182
183 offset = dig->afmt->pin->offset;
184
185 /* program the speaker allocation */
186 tmp = RREG32_ENDPOINT(offset, AZ_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER);
187 tmp &= ~(HDMI_CONNECTION | SPEAKER_ALLOCATION_MASK);
188 /* set DP mode */
189 tmp |= DP_CONNECTION;
190 if (sad_count)
191 tmp |= SPEAKER_ALLOCATION(sadb[0]);
192 else
193 tmp |= SPEAKER_ALLOCATION(5); /* stereo */
194 WREG32_ENDPOINT(offset, AZ_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER, tmp);
6159b65a
RM
195}
196
070a2e63
AD
197void dce6_afmt_write_sad_regs(struct drm_encoder *encoder,
198 struct cea_sad *sads, int sad_count)
6159b65a 199{
070a2e63
AD
200 u32 offset;
201 int i;
6159b65a
RM
202 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
203 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
070a2e63 204 struct radeon_device *rdev = encoder->dev->dev_private;
b530602f
AD
205 static const u16 eld_reg_to_type[][2] = {
206 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR0, HDMI_AUDIO_CODING_TYPE_PCM },
207 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR1, HDMI_AUDIO_CODING_TYPE_AC3 },
208 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR2, HDMI_AUDIO_CODING_TYPE_MPEG1 },
209 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR3, HDMI_AUDIO_CODING_TYPE_MP3 },
210 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR4, HDMI_AUDIO_CODING_TYPE_MPEG2 },
211 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR5, HDMI_AUDIO_CODING_TYPE_AAC_LC },
212 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR6, HDMI_AUDIO_CODING_TYPE_DTS },
213 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR7, HDMI_AUDIO_CODING_TYPE_ATRAC },
214 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR9, HDMI_AUDIO_CODING_TYPE_EAC3 },
215 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR10, HDMI_AUDIO_CODING_TYPE_DTS_HD },
216 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR11, HDMI_AUDIO_CODING_TYPE_MLP },
217 { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR13, HDMI_AUDIO_CODING_TYPE_WMA_PRO },
218 };
219
53dc0b0c 220 if (!dig || !dig->afmt || !dig->afmt->pin)
b530602f
AD
221 return;
222
223 offset = dig->afmt->pin->offset;
224
b530602f
AD
225 for (i = 0; i < ARRAY_SIZE(eld_reg_to_type); i++) {
226 u32 value = 0;
0f57bca9
AH
227 u8 stereo_freqs = 0;
228 int max_channels = -1;
b530602f
AD
229 int j;
230
231 for (j = 0; j < sad_count; j++) {
232 struct cea_sad *sad = &sads[j];
233
234 if (sad->format == eld_reg_to_type[i][1]) {
0f57bca9
AH
235 if (sad->channels > max_channels) {
236 value = MAX_CHANNELS(sad->channels) |
237 DESCRIPTOR_BYTE_2(sad->byte2) |
238 SUPPORTED_FREQUENCIES(sad->freq);
239 max_channels = sad->channels;
240 }
241
b530602f 242 if (sad->format == HDMI_AUDIO_CODING_TYPE_PCM)
0f57bca9
AH
243 stereo_freqs |= sad->freq;
244 else
245 break;
b530602f
AD
246 }
247 }
0f57bca9
AH
248
249 value |= SUPPORTED_FREQUENCIES_STEREO(stereo_freqs);
250
b530602f
AD
251 WREG32_ENDPOINT(offset, eld_reg_to_type[i][0], value);
252 }
b530602f
AD
253}
254
832eafaf
AD
255void dce6_audio_enable(struct radeon_device *rdev,
256 struct r600_audio_pin *pin,
d3d8c141 257 u8 enable_mask)
b530602f 258{
832eafaf
AD
259 if (!pin)
260 return;
261
f68fdbe4 262 WREG32_ENDPOINT(pin->offset, AZ_F0_CODEC_PIN_CONTROL_HOT_PLUG_CONTROL,
d3d8c141 263 enable_mask ? AUDIO_ENABLED : 0);
b530602f
AD
264}
265
b530602f
AD
266void dce6_audio_fini(struct radeon_device *rdev)
267{
268 int i;
269
270 if (!rdev->audio.enabled)
271 return;
272
273 for (i = 0; i < rdev->audio.num_pins; i++)
274 dce6_audio_enable(rdev, &rdev->audio.pin[i], false);
275
276 rdev->audio.enabled = false;
277}