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 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_dp_enable(struct drm_encoder *encoder, bool enable);
 105 void dce6_dp_enable(struct drm_encoder *encoder, bool enable);
 106
 107 static const u32 pin_offsets[7] =
 108 {
 109         (0x5e00 - 0x5e00),
 110         (0x5e18 - 0x5e00),
 111         (0x5e30 - 0x5e00),
 112         (0x5e48 - 0x5e00),
 113         (0x5e60 - 0x5e00),
 114         (0x5e78 - 0x5e00),
 115         (0x5e90 - 0x5e00),
 116 };
 117
 118 static u32 radeon_audio_rreg(struct radeon_device *rdev, u32 offset, u32 reg)
 119 {
 120         return RREG32(reg);
 121 }
 122
 123 static void radeon_audio_wreg(struct radeon_device *rdev, u32 offset,
 124                 u32 reg, u32 v)
 125 {
 126         WREG32(reg, v);
 127 }
 128
 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,
 133 };
 134
 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,
 139 };
 140
 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,
 145 };
 146
 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,
 151 };
 152
 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,
 163 };
 164
 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,
 177 };
 178
 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,
 186 };
 187
 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,
 202 };
 203
 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_dp_enable,
 214 };
 215
 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,
 231 };
 232
 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_dp_enable,
 244 };
 245
 246 static void radeon_audio_interface_init(struct radeon_device *rdev)
 247 {
 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;
 260         } else {
 261                 rdev->audio.funcs = &r600_funcs;
 262                 rdev->audio.hdmi_funcs = &r600_hdmi_funcs;
 263                 rdev->audio.dp_funcs = 0;
 264         }
 265 }
 266
 267 static int radeon_audio_chipset_supported(struct radeon_device *rdev)
 268 {
 269         return ASIC_IS_DCE2(rdev) && !ASIC_IS_NODCE(rdev);
 270 }
 271
 272 int radeon_audio_init(struct radeon_device *rdev)
 273 {
 274         int i;
 275
 276         if (!radeon_audio || !radeon_audio_chipset_supported(rdev))
 277                 return 0;
 278
 279         rdev->audio.enabled = true;
 280
 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;
 293         else
 294                 rdev->audio.num_pins = 1;
 295
 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;
 305         }
 306
 307         radeon_audio_interface_init(rdev);
 308
 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);
 312
 313         return 0;
 314 }
 315
 316 u32 radeon_audio_endpoint_rreg(struct radeon_device *rdev, u32 offset, u32 reg)
 317 {
 318         if (rdev->audio.funcs->endpoint_rreg)
 319                 return rdev->audio.funcs->endpoint_rreg(rdev, offset, reg);
 320
 321         return 0;
 322 }
 323
 324 void radeon_audio_endpoint_wreg(struct radeon_device *rdev, u32 offset,
 325         u32 reg, u32 v)
 326 {
 327         if (rdev->audio.funcs->endpoint_wreg)
 328                 rdev->audio.funcs->endpoint_wreg(rdev, offset, reg, v);
 329 }
 330
 331 static void radeon_audio_write_sad_regs(struct drm_encoder *encoder)
 332 {
 333         struct radeon_encoder *radeon_encoder;
 334         struct drm_connector *connector;
 335         struct radeon_connector *radeon_connector = NULL;
 336         struct cea_sad *sads;
 337         int sad_count;
 338
 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);
 343                         break;
 344                 }
 345         }
 346
 347         if (!radeon_connector) {
 348                 DRM_ERROR("Couldn't find encoder's connector\n");
 349                 return;
 350         }
 351
 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);
 355                 return;
 356         }
 357         BUG_ON(!sads);
 358
 359         radeon_encoder = to_radeon_encoder(encoder);
 360
 361         if (radeon_encoder->audio && radeon_encoder->audio->write_sad_regs)
 362                 radeon_encoder->audio->write_sad_regs(encoder, sads, sad_count);
 363
 364         kfree(sads);
 365 }
 366
 367 static void radeon_audio_write_speaker_allocation(struct drm_encoder *encoder)
 368 {
 369         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 370         struct drm_connector *connector;
 371         struct radeon_connector *radeon_connector = NULL;
 372         u8 *sadb = NULL;
 373         int sad_count;
 374
 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);
 379                         break;
 380                 }
 381         }
 382
 383         if (!radeon_connector) {
 384                 DRM_ERROR("Couldn't find encoder's connector\n");
 385                 return;
 386         }
 387
 388         sad_count = drm_edid_to_speaker_allocation(
 389                 radeon_connector_edid(connector), &sadb);
 390         if (sad_count < 0) {
 391                 DRM_DEBUG("Couldn't read Speaker Allocation Data Block: %d\n",
 392                           sad_count);
 393                 sad_count = 0;
 394         }
 395
 396         if (radeon_encoder->audio && radeon_encoder->audio->write_speaker_allocation)
 397                 radeon_encoder->audio->write_speaker_allocation(encoder, sadb, sad_count);
 398
 399         kfree(sadb);
 400 }
 401
 402 static void radeon_audio_write_latency_fields(struct drm_encoder *encoder,
 403         struct drm_display_mode *mode)
 404 {
 405         struct radeon_encoder *radeon_encoder;
 406         struct drm_connector *connector;
 407         struct radeon_connector *radeon_connector = 0;
 408
 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);
 413                         break;
 414                 }
 415         }
 416
 417         if (!radeon_connector) {
 418                 DRM_ERROR("Couldn't find encoder's connector\n");
 419                 return;
 420         }
 421
 422         radeon_encoder = to_radeon_encoder(encoder);
 423
 424         if (radeon_encoder->audio && radeon_encoder->audio->write_latency_fields)
 425                 radeon_encoder->audio->write_latency_fields(encoder, connector, mode);
 426 }
 427
 428 struct r600_audio_pin* radeon_audio_get_pin(struct drm_encoder *encoder)
 429 {
 430         struct radeon_device *rdev = encoder->dev->dev_private;
 431         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 432
 433         if (radeon_encoder->audio && radeon_encoder->audio->get_pin)
 434                 return radeon_encoder->audio->get_pin(rdev);
 435
 436         return NULL;
 437 }
 438
 439 static void radeon_audio_select_pin(struct drm_encoder *encoder)
 440 {
 441         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 442
 443         if (radeon_encoder->audio && radeon_encoder->audio->select_pin)
 444                 radeon_encoder->audio->select_pin(encoder);
 445 }
 446
 447 void radeon_audio_enable(struct radeon_device *rdev,
 448         struct r600_audio_pin *pin, u8 enable_mask)
 449 {
 450         if (rdev->audio.funcs->enable)
 451                 rdev->audio.funcs->enable(rdev, pin, enable_mask);
 452 }
 453
 454 void radeon_audio_detect(struct drm_connector *connector,
 455                          enum drm_connector_status status)
 456 {
 457         struct radeon_device *rdev;
 458         struct radeon_encoder *radeon_encoder;
 459         struct radeon_encoder_atom_dig *dig;
 460
 461         if (!connector || !connector->encoder)
 462                 return;
 463
 464         rdev = connector->encoder->dev->dev_private;
 465         radeon_encoder = to_radeon_encoder(connector->encoder);
 466         dig = radeon_encoder->enc_priv;
 467
 468         if (status == connector_status_connected) {
 469                 struct radeon_connector *radeon_connector;
 470                 int sink_type;
 471
 472                 if (!drm_detect_monitor_audio(radeon_connector_edid(connector))) {
 473                         radeon_encoder->audio = NULL;
 474                         return;
 475                 }
 476
 477                 radeon_connector = to_radeon_connector(connector);
 478                 sink_type = radeon_dp_getsinktype(radeon_connector);
 479
 480                 if (connector->connector_type == DRM_MODE_CONNECTOR_DisplayPort &&
 481                         sink_type == CONNECTOR_OBJECT_ID_DISPLAYPORT)
 482                         radeon_encoder->audio = rdev->audio.dp_funcs;
 483                 else
 484                         radeon_encoder->audio = rdev->audio.hdmi_funcs;
 485
 486                 dig->afmt->pin = radeon_audio_get_pin(connector->encoder);
 487                 radeon_audio_enable(rdev, dig->afmt->pin, 0xf);
 488         } else {
 489                 radeon_audio_enable(rdev, dig->afmt->pin, 0);
 490                 dig->afmt->pin = NULL;
 491         }
 492 }
 493
 494 void radeon_audio_fini(struct radeon_device *rdev)
 495 {
 496         int i;
 497
 498         if (!rdev->audio.enabled)
 499                 return;
 500
 501         for (i = 0; i < rdev->audio.num_pins; i++)
 502                 radeon_audio_enable(rdev, &rdev->audio.pin[i], false);
 503
 504         rdev->audio.enabled = false;
 505 }
 506
 507 static void radeon_audio_set_dto(struct drm_encoder *encoder, unsigned int clock)
 508 {
 509         struct radeon_device *rdev = encoder->dev->dev_private;
 510         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 511         struct radeon_crtc *crtc = to_radeon_crtc(encoder->crtc);
 512
 513         if (radeon_encoder->audio && radeon_encoder->audio->set_dto)
 514                 radeon_encoder->audio->set_dto(rdev, crtc, clock);
 515 }
 516
 517 static int radeon_audio_set_avi_packet(struct drm_encoder *encoder,
 518         struct drm_display_mode *mode)
 519 {
 520         struct radeon_device *rdev = encoder->dev->dev_private;
 521         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 522         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 523         struct drm_connector *connector;
 524         struct radeon_connector *radeon_connector = NULL;
 525         u8 buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AVI_INFOFRAME_SIZE];
 526         struct hdmi_avi_infoframe frame;
 527         int err;
 528
 529         list_for_each_entry(connector,
 530                 &encoder->dev->mode_config.connector_list, head) {
 531                 if (connector->encoder == encoder) {
 532                         radeon_connector = to_radeon_connector(connector);
 533                         break;
 534                 }
 535         }
 536
 537         if (!radeon_connector) {
 538                 DRM_ERROR("Couldn't find encoder's connector\n");
 539                 return -ENOENT;
 540         }
 541
 542         err = drm_hdmi_avi_infoframe_from_display_mode(&frame, mode);
 543         if (err < 0) {
 544                 DRM_ERROR("failed to setup AVI infoframe: %d\n", err);
 545                 return err;
 546         }
 547
 548         if (drm_rgb_quant_range_selectable(radeon_connector_edid(connector))) {
 549                 if (radeon_encoder->output_csc == RADEON_OUTPUT_CSC_TVRGB)
 550                         frame.quantization_range = HDMI_QUANTIZATION_RANGE_LIMITED;
 551                 else
 552                         frame.quantization_range = HDMI_QUANTIZATION_RANGE_FULL;
 553         } else {
 554                 frame.quantization_range = HDMI_QUANTIZATION_RANGE_DEFAULT;
 555         }
 556
 557         err = hdmi_avi_infoframe_pack(&frame, buffer, sizeof(buffer));
 558         if (err < 0) {
 559                 DRM_ERROR("failed to pack AVI infoframe: %d\n", err);
 560                 return err;
 561         }
 562
 563         if (dig && dig->afmt &&
 564                 radeon_encoder->audio && radeon_encoder->audio->set_avi_packet)
 565                 radeon_encoder->audio->set_avi_packet(rdev, dig->afmt->offset,
 566                         buffer, sizeof(buffer));
 567
 568         return 0;
 569 }
 570
 571 /*
 572  * calculate CTS and N values if they are not found in the table
 573  */
 574 static void radeon_audio_calc_cts(unsigned int clock, int *CTS, int *N, int freq)
 575 {
 576         int n, cts;
 577         unsigned long div, mul;
 578
 579         /* Safe, but overly large values */
 580         n = 128 * freq;
 581         cts = clock * 1000;
 582
 583         /* Smallest valid fraction */
 584         div = gcd(n, cts);
 585
 586         n /= div;
 587         cts /= div;
 588
 589         /*
 590          * The optimal N is 128*freq/1000. Calculate the closest larger
 591          * value that doesn't truncate any bits.
 592          */
 593         mul = ((128*freq/1000) + (n-1))/n;
 594
 595         n *= mul;
 596         cts *= mul;
 597
 598         /* Check that we are in spec (not always possible) */
 599         if (n < (128*freq/1500))
 600                 printk(KERN_WARNING "Calculated ACR N value is too small. You may experience audio problems.\n");
 601         if (n > (128*freq/300))
 602                 printk(KERN_WARNING "Calculated ACR N value is too large. You may experience audio problems.\n");
 603
 604         *N = n;
 605         *CTS = cts;
 606
 607         DRM_DEBUG("Calculated ACR timing N=%d CTS=%d for frequency %d\n",
 608                 *N, *CTS, freq);
 609 }
 610
 611 static const struct radeon_hdmi_acr* radeon_audio_acr(unsigned int clock)
 612 {
 613         static struct radeon_hdmi_acr res;
 614         u8 i;
 615
 616         static const struct radeon_hdmi_acr hdmi_predefined_acr[] = {
 617                 /*       32kHz    44.1kHz   48kHz    */
 618                 /* Clock      N     CTS      N     CTS      N     CTS */
 619                 {  25175,  4096,  25175, 28224, 125875,  6144,  25175 }, /*  25,20/1.001 MHz */
 620                 {  25200,  4096,  25200,  6272,  28000,  6144,  25200 }, /*  25.20       MHz */
 621                 {  27000,  4096,  27000,  6272,  30000,  6144,  27000 }, /*  27.00       MHz */
 622                 {  27027,  4096,  27027,  6272,  30030,  6144,  27027 }, /*  27.00*1.001 MHz */
 623                 {  54000,  4096,  54000,  6272,  60000,  6144,  54000 }, /*  54.00       MHz */
 624                 {  54054,  4096,  54054,  6272,  60060,  6144,  54054 }, /*  54.00*1.001 MHz */
 625                 {  74176,  4096,  74176,  5733,  75335,  6144,  74176 }, /*  74.25/1.001 MHz */
 626                 {  74250,  4096,  74250,  6272,  82500,  6144,  74250 }, /*  74.25       MHz */
 627                 { 148352,  4096, 148352,  5733, 150670,  6144, 148352 }, /* 148.50/1.001 MHz */
 628                 { 148500,  4096, 148500,  6272, 165000,  6144, 148500 }, /* 148.50       MHz */
 629         };
 630
 631         /* Precalculated values for common clocks */
 632         for (i = 0; i < ARRAY_SIZE(hdmi_predefined_acr); i++)
 633                 if (hdmi_predefined_acr[i].clock == clock)
 634                         return &hdmi_predefined_acr[i];
 635
 636         /* And odd clocks get manually calculated */
 637         radeon_audio_calc_cts(clock, &res.cts_32khz, &res.n_32khz, 32000);
 638         radeon_audio_calc_cts(clock, &res.cts_44_1khz, &res.n_44_1khz, 44100);
 639         radeon_audio_calc_cts(clock, &res.cts_48khz, &res.n_48khz, 48000);
 640
 641         return &res;
 642 }
 643
 644 /*
 645  * update the N and CTS parameters for a given pixel clock rate
 646  */
 647 static void radeon_audio_update_acr(struct drm_encoder *encoder, unsigned int clock)
 648 {
 649         const struct radeon_hdmi_acr *acr = radeon_audio_acr(clock);
 650         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 651         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 652
 653         if (!dig || !dig->afmt)
 654                 return;
 655
 656         if (radeon_encoder->audio && radeon_encoder->audio->update_acr)
 657                 radeon_encoder->audio->update_acr(encoder, dig->afmt->offset, acr);
 658 }
 659
 660 static void radeon_audio_set_vbi_packet(struct drm_encoder *encoder)
 661 {
 662         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 663         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 664
 665         if (!dig || !dig->afmt)
 666                 return;
 667
 668         if (radeon_encoder->audio && radeon_encoder->audio->set_vbi_packet)
 669                 radeon_encoder->audio->set_vbi_packet(encoder, dig->afmt->offset);
 670 }
 671
 672 static void radeon_hdmi_set_color_depth(struct drm_encoder *encoder)
 673 {
 674         int bpc = 8;
 675         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 676         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 677
 678         if (!dig || !dig->afmt)
 679                 return;
 680
 681         if (encoder->crtc) {
 682                 struct radeon_crtc *radeon_crtc = to_radeon_crtc(encoder->crtc);
 683                 bpc = radeon_crtc->bpc;
 684         }
 685
 686         if (radeon_encoder->audio && radeon_encoder->audio->set_color_depth)
 687                 radeon_encoder->audio->set_color_depth(encoder, dig->afmt->offset, bpc);
 688 }
 689
 690 static void radeon_audio_set_audio_packet(struct drm_encoder *encoder)
 691 {
 692         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 693         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 694
 695         if (!dig || !dig->afmt)
 696                 return;
 697
 698         if (radeon_encoder->audio && radeon_encoder->audio->set_audio_packet)
 699                 radeon_encoder->audio->set_audio_packet(encoder, dig->afmt->offset);
 700 }
 701
 702 static void radeon_audio_set_mute(struct drm_encoder *encoder, bool mute)
 703 {
 704         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 705         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 706
 707         if (!dig || !dig->afmt)
 708                 return;
 709
 710         if (radeon_encoder->audio && radeon_encoder->audio->set_mute)
 711                 radeon_encoder->audio->set_mute(encoder, dig->afmt->offset, mute);
 712 }
 713
 714 /*
 715  * update the info frames with the data from the current display mode
 716  */
 717 static void radeon_audio_hdmi_mode_set(struct drm_encoder *encoder,
 718                                        struct drm_display_mode *mode)
 719 {
 720         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 721         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 722
 723         if (!dig || !dig->afmt)
 724                 return;
 725
 726         radeon_audio_set_mute(encoder, true);
 727
 728         radeon_audio_write_speaker_allocation(encoder);
 729         radeon_audio_write_sad_regs(encoder);
 730         radeon_audio_write_latency_fields(encoder, mode);
 731         radeon_audio_set_dto(encoder, mode->clock);
 732         radeon_audio_set_vbi_packet(encoder);
 733         radeon_hdmi_set_color_depth(encoder);
 734         radeon_audio_update_acr(encoder, mode->clock);
 735         radeon_audio_set_audio_packet(encoder);
 736         radeon_audio_select_pin(encoder);
 737
 738         if (radeon_audio_set_avi_packet(encoder, mode) < 0)
 739                 return;
 740
 741         radeon_audio_set_mute(encoder, false);
 742 }
 743
 744 static void radeon_audio_dp_mode_set(struct drm_encoder *encoder,
 745         struct drm_display_mode *mode)
 746 {
 747         struct drm_device *dev = encoder->dev;
 748         struct radeon_device *rdev = dev->dev_private;
 749         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 750         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
 751         struct drm_connector *connector = radeon_get_connector_for_encoder(encoder);
 752         struct radeon_connector *radeon_connector = to_radeon_connector(connector);
 753         struct radeon_connector_atom_dig *dig_connector =
 754                 radeon_connector->con_priv;
 755
 756         if (!dig || !dig->afmt)
 757                 return;
 758
 759         radeon_audio_write_speaker_allocation(encoder);
 760         radeon_audio_write_sad_regs(encoder);
 761         radeon_audio_write_latency_fields(encoder, mode);
 762         if (rdev->clock.dp_extclk || ASIC_IS_DCE5(rdev))
 763                 radeon_audio_set_dto(encoder, rdev->clock.default_dispclk * 10);
 764         else
 765                 radeon_audio_set_dto(encoder, dig_connector->dp_clock);
 766         radeon_audio_set_audio_packet(encoder);
 767         radeon_audio_select_pin(encoder);
 768
 769         if (radeon_audio_set_avi_packet(encoder, mode) < 0)
 770                 return;
 771 }
 772
 773 void radeon_audio_mode_set(struct drm_encoder *encoder,
 774         struct drm_display_mode *mode)
 775 {
 776         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 777
 778         if (radeon_encoder->audio && radeon_encoder->audio->mode_set)
 779                 radeon_encoder->audio->mode_set(encoder, mode);
 780 }
 781
 782 void radeon_audio_dpms(struct drm_encoder *encoder, int mode)
 783 {
 784         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 785
 786         if (radeon_encoder->audio && radeon_encoder->audio->dpms)
 787                 radeon_encoder->audio->dpms(encoder, mode == DRM_MODE_DPMS_ON);
 788 }