drivers/gpu/drm/radeon/radeon_audio.c

   1 /*
   2  * Copyright 2014 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  * Authors: Slava Grigorev <slava.grigorev@amd.com>
  23  */
  24
  25 #include <linux/gcd.h>
  26 #include <drm/drmP.h>
  27 #include <drm/drm_crtc.h>
  28 #include "radeon.h"
  29 #include "atom.h"
  30 #include "radeon_audio.h"
  31
  32 void r600_audio_enable(struct radeon_device *rdev, struct r600_audio_pin *pin,
  33                 u8 enable_mask);
  34 void dce4_audio_enable(struct radeon_device *rdev, struct r600_audio_pin *pin,
  35                 u8 enable_mask);
  36 void dce6_audio_enable(struct radeon_device *rdev, struct r600_audio_pin *pin,
  37                 u8 enable_mask);
  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,
  91         u32 offset, int bpc);
  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
  99 static const u32 pin_offsets[7] =
 100 {
 101         (0x5e00 - 0x5e00),
 102         (0x5e18 - 0x5e00),
 103         (0x5e30 - 0x5e00),
 104         (0x5e48 - 0x5e00),
 105         (0x5e60 - 0x5e00),
 106         (0x5e78 - 0x5e00),
 107         (0x5e90 - 0x5e00),
 108 };
 109
 110 static u32 radeon_audio_rreg(struct radeon_device *rdev, u32 offset, u32 reg)
 111 {
 112         return RREG32(reg);
 113 }
 114
 115 static void radeon_audio_wreg(struct radeon_device *rdev, u32 offset,
 116                 u32 reg, u32 v)
 117 {
 118         WREG32(reg, v);
 119 }
 120
 121 static struct radeon_audio_basic_funcs r600_funcs = {
 122         .endpoint_rreg = radeon_audio_rreg,
 123         .endpoint_wreg = radeon_audio_wreg,
 124         .enable = r600_audio_enable,
 125 };
 126
 127 static struct radeon_audio_basic_funcs dce32_funcs = {
 128         .endpoint_rreg = radeon_audio_rreg,
 129         .endpoint_wreg = radeon_audio_wreg,
 130         .enable = r600_audio_enable,
 131 };
 132
 133 static struct radeon_audio_basic_funcs dce4_funcs = {
 134         .endpoint_rreg = radeon_audio_rreg,
 135         .endpoint_wreg = radeon_audio_wreg,
 136         .enable = dce4_audio_enable,
 137 };
 138
 139 static struct radeon_audio_basic_funcs dce6_funcs = {
 140         .endpoint_rreg = dce6_endpoint_rreg,
 141         .endpoint_wreg = dce6_endpoint_wreg,
 142         .enable = dce6_audio_enable,
 143 };
 144
 145 static struct radeon_audio_funcs r600_hdmi_funcs = {
 146         .get_pin = r600_audio_get_pin,
 147         .set_dto = r600_hdmi_audio_set_dto,
 148         .update_acr = r600_hdmi_update_acr,
 149         .set_vbi_packet = r600_set_vbi_packet,
 150         .set_avi_packet = r600_set_avi_packet,
 151         .set_audio_packet = r600_set_audio_packet,
 152         .set_mute = r600_set_mute,
 153 };
 154
 155 static struct radeon_audio_funcs dce32_hdmi_funcs = {
 156         .get_pin = r600_audio_get_pin,
 157         .write_sad_regs = dce3_2_afmt_write_sad_regs,
 158         .write_speaker_allocation = dce3_2_afmt_hdmi_write_speaker_allocation,
 159         .set_dto = dce3_2_audio_set_dto,
 160         .update_acr = dce3_2_hdmi_update_acr,
 161         .set_vbi_packet = r600_set_vbi_packet,
 162         .set_avi_packet = r600_set_avi_packet,
 163         .set_audio_packet = dce3_2_set_audio_packet,
 164         .set_mute = dce3_2_set_mute,
 165 };
 166
 167 static struct radeon_audio_funcs dce32_dp_funcs = {
 168         .get_pin = r600_audio_get_pin,
 169         .write_sad_regs = dce3_2_afmt_write_sad_regs,
 170         .write_speaker_allocation = dce3_2_afmt_dp_write_speaker_allocation,
 171         .set_dto = dce3_2_audio_set_dto,
 172         .set_avi_packet = r600_set_avi_packet,
 173 };
 174
 175 static struct radeon_audio_funcs dce4_hdmi_funcs = {
 176         .get_pin = r600_audio_get_pin,
 177         .write_sad_regs = evergreen_hdmi_write_sad_regs,
 178         .write_speaker_allocation = dce4_afmt_hdmi_write_speaker_allocation,
 179         .write_latency_fields = dce4_afmt_write_latency_fields,
 180         .set_dto = dce4_hdmi_audio_set_dto,
 181         .update_acr = evergreen_hdmi_update_acr,
 182         .set_vbi_packet = dce4_set_vbi_packet,
 183         .set_color_depth = dce4_hdmi_set_color_depth,
 184         .set_avi_packet = evergreen_set_avi_packet,
 185         .set_audio_packet = dce4_set_audio_packet,
 186         .set_mute = dce4_set_mute,
 187 };
 188
 189 static struct radeon_audio_funcs dce4_dp_funcs = {
 190         .get_pin = r600_audio_get_pin,
 191         .write_sad_regs = evergreen_hdmi_write_sad_regs,
 192         .write_speaker_allocation = dce4_afmt_dp_write_speaker_allocation,
 193         .write_latency_fields = dce4_afmt_write_latency_fields,
 194         .set_dto = dce4_dp_audio_set_dto,
 195         .set_avi_packet = evergreen_set_avi_packet,
 196 };
 197
 198 static struct radeon_audio_funcs dce6_hdmi_funcs = {
 199         .select_pin = dce6_afmt_select_pin,
 200         .get_pin = dce6_audio_get_pin,
 201         .write_sad_regs = dce6_afmt_write_sad_regs,
 202         .write_speaker_allocation = dce6_afmt_hdmi_write_speaker_allocation,
 203         .write_latency_fields = dce6_afmt_write_latency_fields,
 204         .set_dto = dce6_hdmi_audio_set_dto,
 205         .update_acr = evergreen_hdmi_update_acr,
 206         .set_vbi_packet = dce4_set_vbi_packet,
 207         .set_color_depth = dce4_hdmi_set_color_depth,
 208         .set_avi_packet = evergreen_set_avi_packet,
 209         .set_audio_packet = dce4_set_audio_packet,
 210         .set_mute = dce4_set_mute,
 211 };
 212
 213 static struct radeon_audio_funcs dce6_dp_funcs = {
 214         .select_pin = dce6_afmt_select_pin,
 215         .get_pin = dce6_audio_get_pin,
 216         .write_sad_regs = dce6_afmt_write_sad_regs,
 217         .write_speaker_allocation = dce6_afmt_dp_write_speaker_allocation,
 218         .write_latency_fields = dce6_afmt_write_latency_fields,
 219         .set_dto = dce6_dp_audio_set_dto,
 220         .set_avi_packet = evergreen_set_avi_packet,
 221 };
 222
 223 static void radeon_audio_interface_init(struct radeon_device *rdev)
 224 {
 225         if (ASIC_IS_DCE6(rdev)) {
 226                 rdev->audio.funcs = &dce6_funcs;
 227                 rdev->audio.hdmi_funcs = &dce6_hdmi_funcs;
 228                 rdev->audio.dp_funcs = &dce6_dp_funcs;
 229         } else if (ASIC_IS_DCE4(rdev)) {
 230                 rdev->audio.funcs = &dce4_funcs;
 231                 rdev->audio.hdmi_funcs = &dce4_hdmi_funcs;
 232                 rdev->audio.dp_funcs = &dce4_dp_funcs;
 233         } else if (ASIC_IS_DCE32(rdev)) {
 234                 rdev->audio.funcs = &dce32_funcs;
 235                 rdev->audio.hdmi_funcs = &dce32_hdmi_funcs;
 236                 rdev->audio.dp_funcs = &dce32_dp_funcs;
 237         } else {
 238                 rdev->audio.funcs = &r600_funcs;
 239                 rdev->audio.hdmi_funcs = &r600_hdmi_funcs;
 240                 rdev->audio.dp_funcs = 0;
 241         }
 242 }
 243
 244 static int radeon_audio_chipset_supported(struct radeon_device *rdev)
 245 {
 246         return ASIC_IS_DCE2(rdev) && !ASIC_IS_NODCE(rdev);
 247 }
 248
 249 int radeon_audio_init(struct radeon_device *rdev)
 250 {
 251         int i;
 252
 253         if (!radeon_audio || !radeon_audio_chipset_supported(rdev))
 254                 return 0;
 255
 256         rdev->audio.enabled = true;
 257
 258         if (ASIC_IS_DCE83(rdev))                /* KB: 2 streams, 3 endpoints */
 259                 rdev->audio.num_pins = 3;
 260         else if (ASIC_IS_DCE81(rdev))   /* KV: 4 streams, 7 endpoints */
 261                 rdev->audio.num_pins = 7;
 262         else if (ASIC_IS_DCE8(rdev))    /* BN/HW: 6 streams, 7 endpoints */
 263                 rdev->audio.num_pins = 7;
 264         else if (ASIC_IS_DCE64(rdev))   /* OL: 2 streams, 2 endpoints */
 265                 rdev->audio.num_pins = 2;
 266         else if (ASIC_IS_DCE61(rdev))   /* TN: 4 streams, 6 endpoints */
 267                 rdev->audio.num_pins = 6;
 268         else if (ASIC_IS_DCE6(rdev))    /* SI: 6 streams, 6 endpoints */
 269                 rdev->audio.num_pins = 6;
 270         else
 271                 rdev->audio.num_pins = 1;
 272
 273         for (i = 0; i < rdev->audio.num_pins; i++) {
 274                 rdev->audio.pin[i].channels = -1;
 275                 rdev->audio.pin[i].rate = -1;
 276                 rdev->audio.pin[i].bits_per_sample = -1;
 277                 rdev->audio.pin[i].status_bits = 0;
 278                 rdev->audio.pin[i].category_code = 0;
 279                 rdev->audio.pin[i].connected = false;
 280                 rdev->audio.pin[i].offset = pin_offsets[i];
 281                 rdev->audio.pin[i].id = i;
 282         }
 283
 284         radeon_audio_interface_init(rdev);
 285
 286         /* disable audio.  it will be set up later */
 287         for (i = 0; i < rdev->audio.num_pins; i++)
 288                 radeon_audio_enable(rdev, &rdev->audio.pin[i], false);
 289
 290         return 0;
 291 }
 292
 293 void radeon_audio_detect(struct drm_connector *connector,
 294         enum drm_connector_status status)
 295 {
 296         if (!connector || !connector->encoder)
 297                 return;
 298
 299         if (status == connector_status_connected) {
 300                 int sink_type;
 301                 struct radeon_device *rdev = connector->encoder->dev->dev_private;
 302                 struct radeon_connector *radeon_connector;
 303                 struct radeon_encoder *radeon_encoder =
 304                         to_radeon_encoder(connector->encoder);
 305
 306                 if (!drm_detect_monitor_audio(radeon_connector_edid(connector))) {
 307                         radeon_encoder->audio = 0;
 308                         return;
 309                 }
 310
 311                 radeon_connector = to_radeon_connector(connector);
 312                 sink_type = radeon_dp_getsinktype(radeon_connector);
 313
 314                 if (connector->connector_type == DRM_MODE_CONNECTOR_DisplayPort &&
 315                         sink_type == CONNECTOR_OBJECT_ID_DISPLAYPORT)
 316                         radeon_encoder->audio = rdev->audio.dp_funcs;
 317                 else
 318                         radeon_encoder->audio = rdev->audio.hdmi_funcs;
 319                 /* TODO: set up the sads, etc. and set the audio enable_mask */
 320         } else {
 321                 /* TODO: reset the audio enable_mask */
 322         }
 323 }
 324
 325 u32 radeon_audio_endpoint_rreg(struct radeon_device *rdev, u32 offset, u32 reg)
 326 {
 327         if (rdev->audio.funcs->endpoint_rreg)
 328                 return rdev->audio.funcs->endpoint_rreg(rdev, offset, reg);
 329
 330         return 0;
 331 }
 332
 333 void radeon_audio_endpoint_wreg(struct radeon_device *rdev, u32 offset,
 334         u32 reg, u32 v)
 335 {
 336         if (rdev->audio.funcs->endpoint_wreg)
 337                 rdev->audio.funcs->endpoint_wreg(rdev, offset, reg, v);
 338 }
 339
 340 void radeon_audio_write_sad_regs(struct drm_encoder *encoder)
 341 {
 342         struct radeon_encoder *radeon_encoder;
 343         struct drm_connector *connector;
 344         struct radeon_connector *radeon_connector = NULL;
 345         struct cea_sad *sads;
 346         int sad_count;
 347
 348         list_for_each_entry(connector,
 349                 &encoder->dev->mode_config.connector_list, head) {
 350                 if (connector->encoder == encoder) {
 351                         radeon_connector = to_radeon_connector(connector);
 352                         break;
 353                 }
 354         }
 355
 356         if (!radeon_connector) {
 357                 DRM_ERROR("Couldn't find encoder's connector\n");
 358                 return;
 359         }
 360
 361         sad_count = drm_edid_to_sad(radeon_connector_edid(connector), &sads);
 362         if (sad_count <= 0) {
 363                 DRM_ERROR("Couldn't read SADs: %d\n", sad_count);
 364                 return;
 365         }
 366         BUG_ON(!sads);
 367
 368         radeon_encoder = to_radeon_encoder(encoder);
 369
 370         if (radeon_encoder->audio && radeon_encoder->audio->write_sad_regs)
 371                 radeon_encoder->audio->write_sad_regs(encoder, sads, sad_count);
 372
 373         kfree(sads);
 374 }
 375
 376 void radeon_audio_write_speaker_allocation(struct drm_encoder *encoder)
 377 {
 378         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 379     struct drm_connector *connector;
 380     struct radeon_connector *radeon_connector = NULL;
 381     u8 *sadb = NULL;
 382     int sad_count;
 383
 384     list_for_each_entry(connector,
 385                 &encoder->dev->mode_config.connector_list, head) {
 386         if (connector->encoder == encoder) {
 387             radeon_connector = to_radeon_connector(connector);
 388             break;
 389         }
 390     }
 391
 392     if (!radeon_connector) {
 393         DRM_ERROR("Couldn't find encoder's connector\n");
 394         return;
 395     }
 396
 397     sad_count = drm_edid_to_speaker_allocation(
 398                 radeon_connector_edid(connector), &sadb);
 399     if (sad_count < 0) {
 400         DRM_DEBUG("Couldn't read Speaker Allocation Data Block: %d\n",
 401                         sad_count);
 402         sad_count = 0;
 403     }
 404
 405         if (radeon_encoder->audio && radeon_encoder->audio->write_speaker_allocation)
 406                 radeon_encoder->audio->write_speaker_allocation(encoder, sadb, sad_count);
 407
 408     kfree(sadb);
 409 }
 410
 411 void radeon_audio_write_latency_fields(struct drm_encoder *encoder,
 412         struct drm_display_mode *mode)
 413 {
 414         struct radeon_encoder *radeon_encoder;
 415         struct drm_connector *connector;
 416         struct radeon_connector *radeon_connector = 0;
 417
 418         list_for_each_entry(connector,
 419                 &encoder->dev->mode_config.connector_list, head) {
 420                 if (connector->encoder == encoder) {
 421                         radeon_connector = to_radeon_connector(connector);
 422                         break;
 423                 }
 424         }
 425
 426         if (!radeon_connector) {
 427                 DRM_ERROR("Couldn't find encoder's connector\n");
 428                 return;
 429         }
 430
 431         radeon_encoder = to_radeon_encoder(encoder);
 432
 433         if (radeon_encoder->audio && radeon_encoder->audio->write_latency_fields)
 434                 radeon_encoder->audio->write_latency_fields(encoder, connector, mode);
 435 }
 436
 437 struct r600_audio_pin* radeon_audio_get_pin(struct drm_encoder *encoder)
 438 {
 439         struct radeon_device *rdev = encoder->dev->dev_private;
 440         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 441
 442         if (radeon_encoder->audio && radeon_encoder->audio->get_pin)
 443                 return radeon_encoder->audio->get_pin(rdev);
 444
 445         return NULL;
 446 }
 447
 448 void radeon_audio_select_pin(struct drm_encoder *encoder)
 449 {
 450         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 451
 452         if (radeon_encoder->audio && radeon_encoder->audio->select_pin)
 453                 radeon_encoder->audio->select_pin(encoder);
 454 }
 455
 456 void radeon_audio_enable(struct radeon_device *rdev,
 457         struct r600_audio_pin *pin, u8 enable_mask)
 458 {
 459         if (rdev->audio.funcs->enable)
 460                 rdev->audio.funcs->enable(rdev, pin, enable_mask);
 461 }
 462
 463 void radeon_audio_fini(struct radeon_device *rdev)
 464 {
 465         int i;
 466
 467         if (!rdev->audio.enabled)
 468                 return;
 469
 470         for (i = 0; i < rdev->audio.num_pins; i++)
 471                 radeon_audio_enable(rdev, &rdev->audio.pin[i], false);
 472
 473         rdev->audio.enabled = false;
 474 }
 475
 476 void radeon_audio_set_dto(struct drm_encoder *encoder, unsigned int clock)
 477 {
 478         struct radeon_device *rdev = encoder->dev->dev_private;
 479         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 480         struct radeon_crtc *crtc = to_radeon_crtc(encoder->crtc);
 481
 482         if (radeon_encoder->audio && radeon_encoder->audio->set_dto)
 483                 radeon_encoder->audio->set_dto(rdev, crtc, clock);
 484 }
 485
 486 int radeon_audio_set_avi_packet(struct drm_encoder *encoder,
 487         struct drm_display_mode *mode)
 488 {
 489     struct radeon_device *rdev = encoder->dev->dev_private;
 490         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 491         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 492         u8 buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AVI_INFOFRAME_SIZE];
 493         struct hdmi_avi_infoframe frame;
 494         int err;
 495
 496         err = drm_hdmi_avi_infoframe_from_display_mode(&frame, mode);
 497         if (err < 0) {
 498                 DRM_ERROR("failed to setup AVI infoframe: %d\n", err);
 499                 return err;
 500         }
 501
 502         err = hdmi_avi_infoframe_pack(&frame, buffer, sizeof(buffer));
 503         if (err < 0) {
 504                 DRM_ERROR("failed to pack AVI infoframe: %d\n", err);
 505                 return err;
 506         }
 507
 508         if (dig && dig->afmt &&
 509                 radeon_encoder->audio && radeon_encoder->audio->set_avi_packet)
 510                 radeon_encoder->audio->set_avi_packet(rdev, dig->afmt->offset,
 511                         buffer, sizeof(buffer));
 512
 513         return 0;
 514 }
 515
 516 /*
 517  * calculate CTS and N values if they are not found in the table
 518  */
 519 static void radeon_audio_calc_cts(unsigned int clock, int *CTS, int *N, int freq)
 520 {
 521         int n, cts;
 522         unsigned long div, mul;
 523
 524         /* Safe, but overly large values */
 525         n = 128 * freq;
 526         cts = clock * 1000;
 527
 528         /* Smallest valid fraction */
 529         div = gcd(n, cts);
 530
 531         n /= div;
 532         cts /= div;
 533
 534         /*
 535          * The optimal N is 128*freq/1000. Calculate the closest larger
 536          * value that doesn't truncate any bits.
 537          */
 538         mul = ((128*freq/1000) + (n-1))/n;
 539
 540         n *= mul;
 541         cts *= mul;
 542
 543         /* Check that we are in spec (not always possible) */
 544         if (n < (128*freq/1500))
 545                 printk(KERN_WARNING "Calculated ACR N value is too small. You may experience audio problems.\n");
 546         if (n > (128*freq/300))
 547                 printk(KERN_WARNING "Calculated ACR N value is too large. You may experience audio problems.\n");
 548
 549         *N = n;
 550         *CTS = cts;
 551
 552         DRM_DEBUG("Calculated ACR timing N=%d CTS=%d for frequency %d\n",
 553                 *N, *CTS, freq);
 554 }
 555
 556 static const struct radeon_hdmi_acr* radeon_audio_acr(unsigned int clock)
 557 {
 558         static struct radeon_hdmi_acr res;
 559         u8 i;
 560
 561         static const struct radeon_hdmi_acr hdmi_predefined_acr[] = {
 562                 /*       32kHz    44.1kHz   48kHz    */
 563                 /* Clock      N     CTS      N     CTS      N     CTS */
 564                 {  25175,  4096,  25175, 28224, 125875,  6144,  25175 }, /*  25,20/1.001 MHz */
 565                 {  25200,  4096,  25200,  6272,  28000,  6144,  25200 }, /*  25.20       MHz */
 566                 {  27000,  4096,  27000,  6272,  30000,  6144,  27000 }, /*  27.00       MHz */
 567                 {  27027,  4096,  27027,  6272,  30030,  6144,  27027 }, /*  27.00*1.001 MHz */
 568                 {  54000,  4096,  54000,  6272,  60000,  6144,  54000 }, /*  54.00       MHz */
 569                 {  54054,  4096,  54054,  6272,  60060,  6144,  54054 }, /*  54.00*1.001 MHz */
 570                 {  74176,  4096,  74176,  5733,  75335,  6144,  74176 }, /*  74.25/1.001 MHz */
 571                 {  74250,  4096,  74250,  6272,  82500,  6144,  74250 }, /*  74.25       MHz */
 572                 { 148352,  4096, 148352,  5733, 150670,  6144, 148352 }, /* 148.50/1.001 MHz */
 573                 { 148500,  4096, 148500,  6272, 165000,  6144, 148500 }, /* 148.50       MHz */
 574         };
 575
 576         /* Precalculated values for common clocks */
 577         for (i = 0; i < ARRAY_SIZE(hdmi_predefined_acr); i++)
 578                 if (hdmi_predefined_acr[i].clock == clock)
 579                         return &hdmi_predefined_acr[i];
 580
 581         /* And odd clocks get manually calculated */
 582         radeon_audio_calc_cts(clock, &res.cts_32khz, &res.n_32khz, 32000);
 583         radeon_audio_calc_cts(clock, &res.cts_44_1khz, &res.n_44_1khz, 44100);
 584         radeon_audio_calc_cts(clock, &res.cts_48khz, &res.n_48khz, 48000);
 585
 586         return &res;
 587 }
 588
 589 /*
 590  * update the N and CTS parameters for a given pixel clock rate
 591  */
 592 void radeon_audio_update_acr(struct drm_encoder *encoder, unsigned int clock)
 593 {
 594     const struct radeon_hdmi_acr *acr = radeon_audio_acr(clock);
 595     struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 596     struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 597
 598         if (!dig || !dig->afmt)
 599                 return;
 600
 601         if (radeon_encoder->audio && radeon_encoder->audio->update_acr)
 602                 radeon_encoder->audio->update_acr(encoder, dig->afmt->offset, acr);
 603 }
 604
 605 void radeon_audio_set_vbi_packet(struct drm_encoder *encoder)
 606 {
 607     struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 608     struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 609
 610         if (!dig || !dig->afmt)
 611                 return;
 612
 613         if (radeon_encoder->audio && radeon_encoder->audio->set_vbi_packet)
 614                 radeon_encoder->audio->set_vbi_packet(encoder, dig->afmt->offset);
 615 }
 616
 617 void radeon_hdmi_set_color_depth(struct drm_encoder *encoder)
 618 {
 619         int bpc = 8;
 620         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 621         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 622
 623         if (!dig || !dig->afmt)
 624                 return;
 625
 626         if (encoder->crtc) {
 627                 struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
 628                 bpc = radeon_crtc->bpc;
 629         }
 630
 631         if (radeon_encoder->audio && radeon_encoder->audio->set_color_depth)
 632                 radeon_encoder->audio->set_color_depth(encoder, dig->afmt->offset, bpc);
 633 }
 634
 635 void radeon_audio_set_audio_packet(struct drm_encoder *encoder)
 636 {
 637     struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 638     struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 639
 640         if (!dig || !dig->afmt)
 641                 return;
 642
 643         if (radeon_encoder->audio && radeon_encoder->audio->set_audio_packet)
 644                 radeon_encoder->audio->set_audio_packet(encoder, dig->afmt->offset);
 645 }
 646
 647 void radeon_audio_set_mute(struct drm_encoder *encoder, bool mute)
 648 {
 649     struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 650     struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 651
 652         if (!dig || !dig->afmt)
 653                 return;
 654
 655         if (radeon_encoder->audio && radeon_encoder->audio->set_mute)
 656                 radeon_encoder->audio->set_mute(encoder, dig->afmt->offset, mute);
 657 }