2 * Copyright 2014 Advanced Micro Devices, Inc.
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:
11 * The above copyright notice and this permission notice shall be included in
12 * all copies or substantial portions of the Software.
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.
22 * Authors: Slava Grigorev <slava.grigorev@amd.com>
25 #include <linux/gcd.h>
27 #include <drm/drm_crtc.h>
30 #include "radeon_audio.h"
32 void r600_audio_enable(struct radeon_device
*rdev
, struct r600_audio_pin
*pin
,
34 void dce4_audio_enable(struct radeon_device
*rdev
, struct r600_audio_pin
*pin
,
36 void dce6_audio_enable(struct radeon_device
*rdev
, struct r600_audio_pin
*pin
,
38 u32
dce6_endpoint_rreg(struct radeon_device
*rdev
, u32 offset
, u32 reg
);
39 void dce6_endpoint_wreg(struct radeon_device
*rdev
,
40 u32 offset
, u32 reg
, u32 v
);
41 void dce3_2_afmt_write_sad_regs(struct drm_encoder
*encoder
,
42 struct cea_sad
*sads
, int sad_count
);
43 void evergreen_hdmi_write_sad_regs(struct drm_encoder
*encoder
,
44 struct cea_sad
*sads
, int sad_count
);
45 void dce6_afmt_write_sad_regs(struct drm_encoder
*encoder
,
46 struct cea_sad
*sads
, int sad_count
);
47 void dce3_2_afmt_hdmi_write_speaker_allocation(struct drm_encoder
*encoder
,
48 u8
*sadb
, int sad_count
);
49 void dce3_2_afmt_dp_write_speaker_allocation(struct drm_encoder
*encoder
,
50 u8
*sadb
, int sad_count
);
51 void dce4_afmt_hdmi_write_speaker_allocation(struct drm_encoder
*encoder
,
52 u8
*sadb
, int sad_count
);
53 void dce4_afmt_dp_write_speaker_allocation(struct drm_encoder
*encoder
,
54 u8
*sadb
, int sad_count
);
55 void dce6_afmt_hdmi_write_speaker_allocation(struct drm_encoder
*encoder
,
56 u8
*sadb
, int sad_count
);
57 void dce6_afmt_dp_write_speaker_allocation(struct drm_encoder
*encoder
,
58 u8
*sadb
, int sad_count
);
59 void dce4_afmt_write_latency_fields(struct drm_encoder
*encoder
,
60 struct drm_connector
*connector
, struct drm_display_mode
*mode
);
61 void dce6_afmt_write_latency_fields(struct drm_encoder
*encoder
,
62 struct drm_connector
*connector
, struct drm_display_mode
*mode
);
63 struct r600_audio_pin
* r600_audio_get_pin(struct radeon_device
*rdev
);
64 struct r600_audio_pin
* dce6_audio_get_pin(struct radeon_device
*rdev
);
65 void dce6_afmt_select_pin(struct drm_encoder
*encoder
);
66 void r600_hdmi_audio_set_dto(struct radeon_device
*rdev
,
67 struct radeon_crtc
*crtc
, unsigned int clock
);
68 void dce3_2_audio_set_dto(struct radeon_device
*rdev
,
69 struct radeon_crtc
*crtc
, unsigned int clock
);
70 void dce4_hdmi_audio_set_dto(struct radeon_device
*rdev
,
71 struct radeon_crtc
*crtc
, unsigned int clock
);
72 void dce4_dp_audio_set_dto(struct radeon_device
*rdev
,
73 struct radeon_crtc
*crtc
, unsigned int clock
);
74 void dce6_hdmi_audio_set_dto(struct radeon_device
*rdev
,
75 struct radeon_crtc
*crtc
, unsigned int clock
);
76 void dce6_dp_audio_set_dto(struct radeon_device
*rdev
,
77 struct radeon_crtc
*crtc
, unsigned int clock
);
78 void r600_set_avi_packet(struct radeon_device
*rdev
, u32 offset
,
79 unsigned char *buffer
, size_t size
);
80 void evergreen_set_avi_packet(struct radeon_device
*rdev
, u32 offset
,
81 unsigned char *buffer
, size_t size
);
82 void r600_hdmi_update_acr(struct drm_encoder
*encoder
, long offset
,
83 const struct radeon_hdmi_acr
*acr
);
84 void dce3_2_hdmi_update_acr(struct drm_encoder
*encoder
, long offset
,
85 const struct radeon_hdmi_acr
*acr
);
86 void evergreen_hdmi_update_acr(struct drm_encoder
*encoder
, long offset
,
87 const struct radeon_hdmi_acr
*acr
);
88 void r600_set_vbi_packet(struct drm_encoder
*encoder
, u32 offset
);
89 void dce4_set_vbi_packet(struct drm_encoder
*encoder
, u32 offset
);
90 void dce4_hdmi_set_color_depth(struct drm_encoder
*encoder
,
92 void r600_set_audio_packet(struct drm_encoder
*encoder
, u32 offset
);
93 void dce3_2_set_audio_packet(struct drm_encoder
*encoder
, u32 offset
);
94 void dce4_set_audio_packet(struct drm_encoder
*encoder
, u32 offset
);
95 void r600_set_mute(struct drm_encoder
*encoder
, u32 offset
, bool mute
);
96 void dce3_2_set_mute(struct drm_encoder
*encoder
, u32 offset
, bool mute
);
97 void dce4_set_mute(struct drm_encoder
*encoder
, u32 offset
, bool mute
);
98 static void radeon_audio_hdmi_mode_set(struct drm_encoder
*encoder
,
99 struct drm_display_mode
*mode
);
100 static void radeon_audio_dp_mode_set(struct drm_encoder
*encoder
,
101 struct drm_display_mode
*mode
);
102 void r600_hdmi_enable(struct drm_encoder
*encoder
, bool enable
);
103 void evergreen_hdmi_enable(struct drm_encoder
*encoder
, bool enable
);
104 void evergreen_enable_dp_audio_packets(struct drm_encoder
*encoder
, bool enable
);
105 void dce6_enable_dp_audio_packets(struct drm_encoder
*encoder
, bool enable
);
107 static const u32 pin_offsets
[7] =
118 static u32
radeon_audio_rreg(struct radeon_device
*rdev
, u32 offset
, u32 reg
)
123 static void radeon_audio_wreg(struct radeon_device
*rdev
, u32 offset
,
129 static struct radeon_audio_basic_funcs r600_funcs
= {
130 .endpoint_rreg
= radeon_audio_rreg
,
131 .endpoint_wreg
= radeon_audio_wreg
,
132 .enable
= r600_audio_enable
,
135 static struct radeon_audio_basic_funcs dce32_funcs
= {
136 .endpoint_rreg
= radeon_audio_rreg
,
137 .endpoint_wreg
= radeon_audio_wreg
,
138 .enable
= r600_audio_enable
,
141 static struct radeon_audio_basic_funcs dce4_funcs
= {
142 .endpoint_rreg
= radeon_audio_rreg
,
143 .endpoint_wreg
= radeon_audio_wreg
,
144 .enable
= dce4_audio_enable
,
147 static struct radeon_audio_basic_funcs dce6_funcs
= {
148 .endpoint_rreg
= dce6_endpoint_rreg
,
149 .endpoint_wreg
= dce6_endpoint_wreg
,
150 .enable
= dce6_audio_enable
,
153 static struct radeon_audio_funcs r600_hdmi_funcs
= {
154 .get_pin
= r600_audio_get_pin
,
155 .set_dto
= r600_hdmi_audio_set_dto
,
156 .update_acr
= r600_hdmi_update_acr
,
157 .set_vbi_packet
= r600_set_vbi_packet
,
158 .set_avi_packet
= r600_set_avi_packet
,
159 .set_audio_packet
= r600_set_audio_packet
,
160 .set_mute
= r600_set_mute
,
161 .mode_set
= radeon_audio_hdmi_mode_set
,
162 .dpms
= r600_hdmi_enable
,
165 static struct radeon_audio_funcs dce32_hdmi_funcs
= {
166 .get_pin
= r600_audio_get_pin
,
167 .write_sad_regs
= dce3_2_afmt_write_sad_regs
,
168 .write_speaker_allocation
= dce3_2_afmt_hdmi_write_speaker_allocation
,
169 .set_dto
= dce3_2_audio_set_dto
,
170 .update_acr
= dce3_2_hdmi_update_acr
,
171 .set_vbi_packet
= r600_set_vbi_packet
,
172 .set_avi_packet
= r600_set_avi_packet
,
173 .set_audio_packet
= dce3_2_set_audio_packet
,
174 .set_mute
= dce3_2_set_mute
,
175 .mode_set
= radeon_audio_hdmi_mode_set
,
176 .dpms
= r600_hdmi_enable
,
179 static struct radeon_audio_funcs dce32_dp_funcs
= {
180 .get_pin
= r600_audio_get_pin
,
181 .write_sad_regs
= dce3_2_afmt_write_sad_regs
,
182 .write_speaker_allocation
= dce3_2_afmt_dp_write_speaker_allocation
,
183 .set_dto
= dce3_2_audio_set_dto
,
184 .set_avi_packet
= r600_set_avi_packet
,
185 .set_audio_packet
= dce3_2_set_audio_packet
,
188 static struct radeon_audio_funcs dce4_hdmi_funcs
= {
189 .get_pin
= r600_audio_get_pin
,
190 .write_sad_regs
= evergreen_hdmi_write_sad_regs
,
191 .write_speaker_allocation
= dce4_afmt_hdmi_write_speaker_allocation
,
192 .write_latency_fields
= dce4_afmt_write_latency_fields
,
193 .set_dto
= dce4_hdmi_audio_set_dto
,
194 .update_acr
= evergreen_hdmi_update_acr
,
195 .set_vbi_packet
= dce4_set_vbi_packet
,
196 .set_color_depth
= dce4_hdmi_set_color_depth
,
197 .set_avi_packet
= evergreen_set_avi_packet
,
198 .set_audio_packet
= dce4_set_audio_packet
,
199 .set_mute
= dce4_set_mute
,
200 .mode_set
= radeon_audio_hdmi_mode_set
,
201 .dpms
= evergreen_hdmi_enable
,
204 static struct radeon_audio_funcs dce4_dp_funcs
= {
205 .get_pin
= r600_audio_get_pin
,
206 .write_sad_regs
= evergreen_hdmi_write_sad_regs
,
207 .write_speaker_allocation
= dce4_afmt_dp_write_speaker_allocation
,
208 .write_latency_fields
= dce4_afmt_write_latency_fields
,
209 .set_dto
= dce4_dp_audio_set_dto
,
210 .set_avi_packet
= evergreen_set_avi_packet
,
211 .set_audio_packet
= dce4_set_audio_packet
,
212 .mode_set
= radeon_audio_dp_mode_set
,
213 .dpms
= evergreen_enable_dp_audio_packets
,
216 static struct radeon_audio_funcs dce6_hdmi_funcs
= {
217 .select_pin
= dce6_afmt_select_pin
,
218 .get_pin
= dce6_audio_get_pin
,
219 .write_sad_regs
= dce6_afmt_write_sad_regs
,
220 .write_speaker_allocation
= dce6_afmt_hdmi_write_speaker_allocation
,
221 .write_latency_fields
= dce6_afmt_write_latency_fields
,
222 .set_dto
= dce6_hdmi_audio_set_dto
,
223 .update_acr
= evergreen_hdmi_update_acr
,
224 .set_vbi_packet
= dce4_set_vbi_packet
,
225 .set_color_depth
= dce4_hdmi_set_color_depth
,
226 .set_avi_packet
= evergreen_set_avi_packet
,
227 .set_audio_packet
= dce4_set_audio_packet
,
228 .set_mute
= dce4_set_mute
,
229 .mode_set
= radeon_audio_hdmi_mode_set
,
230 .dpms
= evergreen_hdmi_enable
,
233 static struct radeon_audio_funcs dce6_dp_funcs
= {
234 .select_pin
= dce6_afmt_select_pin
,
235 .get_pin
= dce6_audio_get_pin
,
236 .write_sad_regs
= dce6_afmt_write_sad_regs
,
237 .write_speaker_allocation
= dce6_afmt_dp_write_speaker_allocation
,
238 .write_latency_fields
= dce6_afmt_write_latency_fields
,
239 .set_dto
= dce6_dp_audio_set_dto
,
240 .set_avi_packet
= evergreen_set_avi_packet
,
241 .set_audio_packet
= dce4_set_audio_packet
,
242 .mode_set
= radeon_audio_dp_mode_set
,
243 .dpms
= dce6_enable_dp_audio_packets
,
246 static void radeon_audio_interface_init(struct radeon_device
*rdev
)
248 if (ASIC_IS_DCE6(rdev
)) {
249 rdev
->audio
.funcs
= &dce6_funcs
;
250 rdev
->audio
.hdmi_funcs
= &dce6_hdmi_funcs
;
251 rdev
->audio
.dp_funcs
= &dce6_dp_funcs
;
252 } else if (ASIC_IS_DCE4(rdev
)) {
253 rdev
->audio
.funcs
= &dce4_funcs
;
254 rdev
->audio
.hdmi_funcs
= &dce4_hdmi_funcs
;
255 rdev
->audio
.dp_funcs
= &dce4_dp_funcs
;
256 } else if (ASIC_IS_DCE32(rdev
)) {
257 rdev
->audio
.funcs
= &dce32_funcs
;
258 rdev
->audio
.hdmi_funcs
= &dce32_hdmi_funcs
;
259 rdev
->audio
.dp_funcs
= &dce32_dp_funcs
;
261 rdev
->audio
.funcs
= &r600_funcs
;
262 rdev
->audio
.hdmi_funcs
= &r600_hdmi_funcs
;
263 rdev
->audio
.dp_funcs
= 0;
267 static int radeon_audio_chipset_supported(struct radeon_device
*rdev
)
269 return ASIC_IS_DCE2(rdev
) && !ASIC_IS_NODCE(rdev
);
272 int radeon_audio_init(struct radeon_device
*rdev
)
276 if (!radeon_audio
|| !radeon_audio_chipset_supported(rdev
))
279 rdev
->audio
.enabled
= true;
281 if (ASIC_IS_DCE83(rdev
)) /* KB: 2 streams, 3 endpoints */
282 rdev
->audio
.num_pins
= 3;
283 else if (ASIC_IS_DCE81(rdev
)) /* KV: 4 streams, 7 endpoints */
284 rdev
->audio
.num_pins
= 7;
285 else if (ASIC_IS_DCE8(rdev
)) /* BN/HW: 6 streams, 7 endpoints */
286 rdev
->audio
.num_pins
= 7;
287 else if (ASIC_IS_DCE64(rdev
)) /* OL: 2 streams, 2 endpoints */
288 rdev
->audio
.num_pins
= 2;
289 else if (ASIC_IS_DCE61(rdev
)) /* TN: 4 streams, 6 endpoints */
290 rdev
->audio
.num_pins
= 6;
291 else if (ASIC_IS_DCE6(rdev
)) /* SI: 6 streams, 6 endpoints */
292 rdev
->audio
.num_pins
= 6;
294 rdev
->audio
.num_pins
= 1;
296 for (i
= 0; i
< rdev
->audio
.num_pins
; i
++) {
297 rdev
->audio
.pin
[i
].channels
= -1;
298 rdev
->audio
.pin
[i
].rate
= -1;
299 rdev
->audio
.pin
[i
].bits_per_sample
= -1;
300 rdev
->audio
.pin
[i
].status_bits
= 0;
301 rdev
->audio
.pin
[i
].category_code
= 0;
302 rdev
->audio
.pin
[i
].connected
= false;
303 rdev
->audio
.pin
[i
].offset
= pin_offsets
[i
];
304 rdev
->audio
.pin
[i
].id
= i
;
307 radeon_audio_interface_init(rdev
);
309 /* disable audio. it will be set up later */
310 for (i
= 0; i
< rdev
->audio
.num_pins
; i
++)
311 radeon_audio_enable(rdev
, &rdev
->audio
.pin
[i
], false);
316 u32
radeon_audio_endpoint_rreg(struct radeon_device
*rdev
, u32 offset
, u32 reg
)
318 if (rdev
->audio
.funcs
->endpoint_rreg
)
319 return rdev
->audio
.funcs
->endpoint_rreg(rdev
, offset
, reg
);
324 void radeon_audio_endpoint_wreg(struct radeon_device
*rdev
, u32 offset
,
327 if (rdev
->audio
.funcs
->endpoint_wreg
)
328 rdev
->audio
.funcs
->endpoint_wreg(rdev
, offset
, reg
, v
);
331 static void radeon_audio_write_sad_regs(struct drm_encoder
*encoder
)
333 struct radeon_encoder
*radeon_encoder
;
334 struct drm_connector
*connector
;
335 struct radeon_connector
*radeon_connector
= NULL
;
336 struct cea_sad
*sads
;
339 list_for_each_entry(connector
,
340 &encoder
->dev
->mode_config
.connector_list
, head
) {
341 if (connector
->encoder
== encoder
) {
342 radeon_connector
= to_radeon_connector(connector
);
347 if (!radeon_connector
) {
348 DRM_ERROR("Couldn't find encoder's connector\n");
352 sad_count
= drm_edid_to_sad(radeon_connector_edid(connector
), &sads
);
353 if (sad_count
<= 0) {
354 DRM_ERROR("Couldn't read SADs: %d\n", sad_count
);
359 radeon_encoder
= to_radeon_encoder(encoder
);
361 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->write_sad_regs
)
362 radeon_encoder
->audio
->write_sad_regs(encoder
, sads
, sad_count
);
367 static void radeon_audio_write_speaker_allocation(struct drm_encoder
*encoder
)
369 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
370 struct drm_connector
*connector
;
371 struct radeon_connector
*radeon_connector
= NULL
;
375 list_for_each_entry(connector
,
376 &encoder
->dev
->mode_config
.connector_list
, head
) {
377 if (connector
->encoder
== encoder
) {
378 radeon_connector
= to_radeon_connector(connector
);
383 if (!radeon_connector
) {
384 DRM_ERROR("Couldn't find encoder's connector\n");
388 sad_count
= drm_edid_to_speaker_allocation(
389 radeon_connector_edid(connector
), &sadb
);
391 DRM_DEBUG("Couldn't read Speaker Allocation Data Block: %d\n",
396 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->write_speaker_allocation
)
397 radeon_encoder
->audio
->write_speaker_allocation(encoder
, sadb
, sad_count
);
402 static void radeon_audio_write_latency_fields(struct drm_encoder
*encoder
,
403 struct drm_display_mode
*mode
)
405 struct radeon_encoder
*radeon_encoder
;
406 struct drm_connector
*connector
;
407 struct radeon_connector
*radeon_connector
= 0;
409 list_for_each_entry(connector
,
410 &encoder
->dev
->mode_config
.connector_list
, head
) {
411 if (connector
->encoder
== encoder
) {
412 radeon_connector
= to_radeon_connector(connector
);
417 if (!radeon_connector
) {
418 DRM_ERROR("Couldn't find encoder's connector\n");
422 radeon_encoder
= to_radeon_encoder(encoder
);
424 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->write_latency_fields
)
425 radeon_encoder
->audio
->write_latency_fields(encoder
, connector
, mode
);
428 struct r600_audio_pin
* radeon_audio_get_pin(struct drm_encoder
*encoder
)
430 struct radeon_device
*rdev
= encoder
->dev
->dev_private
;
431 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
433 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->get_pin
)
434 return radeon_encoder
->audio
->get_pin(rdev
);
439 static void radeon_audio_select_pin(struct drm_encoder
*encoder
)
441 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
443 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->select_pin
)
444 radeon_encoder
->audio
->select_pin(encoder
);
447 void radeon_audio_enable(struct radeon_device
*rdev
,
448 struct r600_audio_pin
*pin
, u8 enable_mask
)
450 if (rdev
->audio
.funcs
->enable
)
451 rdev
->audio
.funcs
->enable(rdev
, pin
, enable_mask
);
454 void radeon_audio_detect(struct drm_connector
*connector
,
455 enum drm_connector_status status
)
457 struct radeon_device
*rdev
;
458 struct radeon_encoder
*radeon_encoder
;
459 struct radeon_encoder_atom_dig
*dig
;
461 if (!connector
|| !connector
->encoder
)
464 rdev
= connector
->encoder
->dev
->dev_private
;
465 radeon_encoder
= to_radeon_encoder(connector
->encoder
);
466 dig
= radeon_encoder
->enc_priv
;
468 if (status
== connector_status_connected
) {
469 struct radeon_connector
*radeon_connector
;
472 if (!drm_detect_monitor_audio(radeon_connector_edid(connector
))) {
473 radeon_encoder
->audio
= NULL
;
477 radeon_connector
= to_radeon_connector(connector
);
478 sink_type
= radeon_dp_getsinktype(radeon_connector
);
480 if (connector
->connector_type
== DRM_MODE_CONNECTOR_DisplayPort
&&
481 sink_type
== CONNECTOR_OBJECT_ID_DISPLAYPORT
)
482 radeon_encoder
->audio
= rdev
->audio
.dp_funcs
;
484 radeon_encoder
->audio
= rdev
->audio
.hdmi_funcs
;
486 radeon_audio_write_speaker_allocation(connector
->encoder
);
487 radeon_audio_write_sad_regs(connector
->encoder
);
488 if (connector
->encoder
->crtc
)
489 radeon_audio_write_latency_fields(connector
->encoder
,
490 &connector
->encoder
->crtc
->mode
);
491 radeon_audio_enable(rdev
, dig
->afmt
->pin
, 0xf);
493 radeon_audio_enable(rdev
, dig
->afmt
->pin
, 0);
497 void radeon_audio_fini(struct radeon_device
*rdev
)
501 if (!rdev
->audio
.enabled
)
504 for (i
= 0; i
< rdev
->audio
.num_pins
; i
++)
505 radeon_audio_enable(rdev
, &rdev
->audio
.pin
[i
], false);
507 rdev
->audio
.enabled
= false;
510 static void radeon_audio_set_dto(struct drm_encoder
*encoder
, unsigned int clock
)
512 struct radeon_device
*rdev
= encoder
->dev
->dev_private
;
513 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
514 struct radeon_crtc
*crtc
= to_radeon_crtc(encoder
->crtc
);
516 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->set_dto
)
517 radeon_encoder
->audio
->set_dto(rdev
, crtc
, clock
);
520 static int radeon_audio_set_avi_packet(struct drm_encoder
*encoder
,
521 struct drm_display_mode
*mode
)
523 struct radeon_device
*rdev
= encoder
->dev
->dev_private
;
524 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
525 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
526 u8 buffer
[HDMI_INFOFRAME_HEADER_SIZE
+ HDMI_AVI_INFOFRAME_SIZE
];
527 struct hdmi_avi_infoframe frame
;
530 err
= drm_hdmi_avi_infoframe_from_display_mode(&frame
, mode
);
532 DRM_ERROR("failed to setup AVI infoframe: %d\n", err
);
536 err
= hdmi_avi_infoframe_pack(&frame
, buffer
, sizeof(buffer
));
538 DRM_ERROR("failed to pack AVI infoframe: %d\n", err
);
542 if (dig
&& dig
->afmt
&&
543 radeon_encoder
->audio
&& radeon_encoder
->audio
->set_avi_packet
)
544 radeon_encoder
->audio
->set_avi_packet(rdev
, dig
->afmt
->offset
,
545 buffer
, sizeof(buffer
));
551 * calculate CTS and N values if they are not found in the table
553 static void radeon_audio_calc_cts(unsigned int clock
, int *CTS
, int *N
, int freq
)
556 unsigned long div
, mul
;
558 /* Safe, but overly large values */
562 /* Smallest valid fraction */
569 * The optimal N is 128*freq/1000. Calculate the closest larger
570 * value that doesn't truncate any bits.
572 mul
= ((128*freq
/1000) + (n
-1))/n
;
577 /* Check that we are in spec (not always possible) */
578 if (n
< (128*freq
/1500))
579 printk(KERN_WARNING
"Calculated ACR N value is too small. You may experience audio problems.\n");
580 if (n
> (128*freq
/300))
581 printk(KERN_WARNING
"Calculated ACR N value is too large. You may experience audio problems.\n");
586 DRM_DEBUG("Calculated ACR timing N=%d CTS=%d for frequency %d\n",
590 static const struct radeon_hdmi_acr
* radeon_audio_acr(unsigned int clock
)
592 static struct radeon_hdmi_acr res
;
595 static const struct radeon_hdmi_acr hdmi_predefined_acr
[] = {
596 /* 32kHz 44.1kHz 48kHz */
597 /* Clock N CTS N CTS N CTS */
598 { 25175, 4096, 25175, 28224, 125875, 6144, 25175 }, /* 25,20/1.001 MHz */
599 { 25200, 4096, 25200, 6272, 28000, 6144, 25200 }, /* 25.20 MHz */
600 { 27000, 4096, 27000, 6272, 30000, 6144, 27000 }, /* 27.00 MHz */
601 { 27027, 4096, 27027, 6272, 30030, 6144, 27027 }, /* 27.00*1.001 MHz */
602 { 54000, 4096, 54000, 6272, 60000, 6144, 54000 }, /* 54.00 MHz */
603 { 54054, 4096, 54054, 6272, 60060, 6144, 54054 }, /* 54.00*1.001 MHz */
604 { 74176, 4096, 74176, 5733, 75335, 6144, 74176 }, /* 74.25/1.001 MHz */
605 { 74250, 4096, 74250, 6272, 82500, 6144, 74250 }, /* 74.25 MHz */
606 { 148352, 4096, 148352, 5733, 150670, 6144, 148352 }, /* 148.50/1.001 MHz */
607 { 148500, 4096, 148500, 6272, 165000, 6144, 148500 }, /* 148.50 MHz */
610 /* Precalculated values for common clocks */
611 for (i
= 0; i
< ARRAY_SIZE(hdmi_predefined_acr
); i
++)
612 if (hdmi_predefined_acr
[i
].clock
== clock
)
613 return &hdmi_predefined_acr
[i
];
615 /* And odd clocks get manually calculated */
616 radeon_audio_calc_cts(clock
, &res
.cts_32khz
, &res
.n_32khz
, 32000);
617 radeon_audio_calc_cts(clock
, &res
.cts_44_1khz
, &res
.n_44_1khz
, 44100);
618 radeon_audio_calc_cts(clock
, &res
.cts_48khz
, &res
.n_48khz
, 48000);
624 * update the N and CTS parameters for a given pixel clock rate
626 static void radeon_audio_update_acr(struct drm_encoder
*encoder
, unsigned int clock
)
628 const struct radeon_hdmi_acr
*acr
= radeon_audio_acr(clock
);
629 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
630 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
632 if (!dig
|| !dig
->afmt
)
635 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->update_acr
)
636 radeon_encoder
->audio
->update_acr(encoder
, dig
->afmt
->offset
, acr
);
639 static void radeon_audio_set_vbi_packet(struct drm_encoder
*encoder
)
641 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
642 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
644 if (!dig
|| !dig
->afmt
)
647 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->set_vbi_packet
)
648 radeon_encoder
->audio
->set_vbi_packet(encoder
, dig
->afmt
->offset
);
651 static void radeon_hdmi_set_color_depth(struct drm_encoder
*encoder
)
654 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
655 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
657 if (!dig
|| !dig
->afmt
)
661 struct radeon_crtc
*radeon_crtc
= to_radeon_crtc(encoder
->crtc
);
662 bpc
= radeon_crtc
->bpc
;
665 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->set_color_depth
)
666 radeon_encoder
->audio
->set_color_depth(encoder
, dig
->afmt
->offset
, bpc
);
669 static void radeon_audio_set_audio_packet(struct drm_encoder
*encoder
)
671 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
672 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
674 if (!dig
|| !dig
->afmt
)
677 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->set_audio_packet
)
678 radeon_encoder
->audio
->set_audio_packet(encoder
, dig
->afmt
->offset
);
681 static void radeon_audio_set_mute(struct drm_encoder
*encoder
, bool mute
)
683 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
684 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
686 if (!dig
|| !dig
->afmt
)
689 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->set_mute
)
690 radeon_encoder
->audio
->set_mute(encoder
, dig
->afmt
->offset
, mute
);
694 * update the info frames with the data from the current display mode
696 static void radeon_audio_hdmi_mode_set(struct drm_encoder
*encoder
,
697 struct drm_display_mode
*mode
)
699 struct radeon_device
*rdev
= encoder
->dev
->dev_private
;
700 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
701 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
703 if (!dig
|| !dig
->afmt
)
706 /* disable audio prior to setting up hw */
707 dig
->afmt
->pin
= radeon_audio_get_pin(encoder
);
708 radeon_audio_enable(rdev
, dig
->afmt
->pin
, 0);
710 radeon_audio_set_dto(encoder
, mode
->clock
);
711 radeon_audio_set_vbi_packet(encoder
);
712 radeon_hdmi_set_color_depth(encoder
);
713 radeon_audio_set_mute(encoder
, false);
714 radeon_audio_update_acr(encoder
, mode
->clock
);
715 radeon_audio_set_audio_packet(encoder
);
716 radeon_audio_select_pin(encoder
);
718 if (radeon_audio_set_avi_packet(encoder
, mode
) < 0)
721 /* enable audio after to setting up hw */
722 radeon_audio_enable(rdev
, dig
->afmt
->pin
, 0xf);
725 static void radeon_audio_dp_mode_set(struct drm_encoder
*encoder
,
726 struct drm_display_mode
*mode
)
728 struct drm_device
*dev
= encoder
->dev
;
729 struct radeon_device
*rdev
= dev
->dev_private
;
730 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
731 struct radeon_encoder_atom_dig
*dig
= radeon_encoder
->enc_priv
;
733 if (!dig
|| !dig
->afmt
)
736 /* disable audio prior to setting up hw */
737 dig
->afmt
->pin
= radeon_audio_get_pin(encoder
);
738 radeon_audio_enable(rdev
, dig
->afmt
->pin
, 0);
740 radeon_audio_set_dto(encoder
, rdev
->clock
.default_dispclk
* 10);
741 radeon_audio_set_audio_packet(encoder
);
742 radeon_audio_select_pin(encoder
);
744 if (radeon_audio_set_avi_packet(encoder
, mode
) < 0)
747 /* enable audio after to setting up hw */
748 radeon_audio_enable(rdev
, dig
->afmt
->pin
, 0xf);
751 void radeon_audio_mode_set(struct drm_encoder
*encoder
,
752 struct drm_display_mode
*mode
)
754 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
756 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->mode_set
)
757 radeon_encoder
->audio
->mode_set(encoder
, mode
);
760 void radeon_audio_dpms(struct drm_encoder
*encoder
, int mode
)
762 struct radeon_encoder
*radeon_encoder
= to_radeon_encoder(encoder
);
764 if (radeon_encoder
->audio
&& radeon_encoder
->audio
->dpms
)
765 radeon_encoder
->audio
->dpms(encoder
, mode
== DRM_MODE_DPMS_ON
);