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 <drm/drmP.h>
  26 #include <drm/drm_crtc.h>
  27 #include "radeon.h"
  28 #include "atom.h"
  29 #include "radeon_audio.h"
  30
  31 void r600_audio_enable(struct radeon_device *rdev, struct r600_audio_pin *pin,
  32                 u8 enable_mask);
  33 void dce6_audio_enable(struct radeon_device *rdev, struct r600_audio_pin *pin,
  34                 u8 enable_mask);
  35 u32 dce6_endpoint_rreg(struct radeon_device *rdev, u32 offset, u32 reg);
  36 void dce6_endpoint_wreg(struct radeon_device *rdev,
  37                 u32 offset, u32 reg, u32 v);
  38 void dce3_2_afmt_write_sad_regs(struct drm_encoder *encoder,
  39                 struct cea_sad *sads, int sad_count);
  40 void evergreen_hdmi_write_sad_regs(struct drm_encoder *encoder,
  41                 struct cea_sad *sads, int sad_count);
  42 void dce6_afmt_write_sad_regs(struct drm_encoder *encoder,
  43                 struct cea_sad *sads, int sad_count);
  44 void dce3_2_afmt_hdmi_write_speaker_allocation(struct drm_encoder *encoder,
  45                 u8 *sadb, int sad_count);
  46 void dce3_2_afmt_dp_write_speaker_allocation(struct drm_encoder *encoder,
  47                 u8 *sadb, int sad_count);
  48 void dce4_afmt_hdmi_write_speaker_allocation(struct drm_encoder *encoder,
  49                 u8 *sadb, int sad_count);
  50 void dce4_afmt_dp_write_speaker_allocation(struct drm_encoder *encoder,
  51                 u8 *sadb, int sad_count);
  52 void dce6_afmt_hdmi_write_speaker_allocation(struct drm_encoder *encoder,
  53                 u8 *sadb, int sad_count);
  54 void dce6_afmt_dp_write_speaker_allocation(struct drm_encoder *encoder,
  55                 u8 *sadb, int sad_count);
  56
  57 static const u32 pin_offsets[7] =
  58 {
  59         (0x5e00 - 0x5e00),
  60         (0x5e18 - 0x5e00),
  61         (0x5e30 - 0x5e00),
  62         (0x5e48 - 0x5e00),
  63         (0x5e60 - 0x5e00),
  64         (0x5e78 - 0x5e00),
  65         (0x5e90 - 0x5e00),
  66 };
  67
  68 static u32 radeon_audio_rreg(struct radeon_device *rdev, u32 offset, u32 reg)
  69 {
  70         return RREG32(reg);
  71 }
  72
  73 static void radeon_audio_wreg(struct radeon_device *rdev, u32 offset,
  74                 u32 reg, u32 v)
  75 {
  76         WREG32(reg, v);
  77 }
  78
  79 static struct radeon_audio_basic_funcs dce32_funcs = {
  80         .endpoint_rreg = radeon_audio_rreg,
  81         .endpoint_wreg = radeon_audio_wreg,
  82 };
  83
  84 static struct radeon_audio_basic_funcs dce4_funcs = {
  85         .endpoint_rreg = radeon_audio_rreg,
  86         .endpoint_wreg = radeon_audio_wreg,
  87 };
  88
  89 static struct radeon_audio_basic_funcs dce6_funcs = {
  90         .endpoint_rreg = dce6_endpoint_rreg,
  91         .endpoint_wreg = dce6_endpoint_wreg,
  92 };
  93
  94 static struct radeon_audio_funcs dce32_hdmi_funcs = {
  95         .write_sad_regs = dce3_2_afmt_write_sad_regs,
  96         .write_speaker_allocation = dce3_2_afmt_hdmi_write_speaker_allocation,
  97 };
  98
  99 static struct radeon_audio_funcs dce32_dp_funcs = {
 100         .write_sad_regs = dce3_2_afmt_write_sad_regs,
 101         .write_speaker_allocation = dce3_2_afmt_dp_write_speaker_allocation,
 102 };
 103
 104 static struct radeon_audio_funcs dce4_hdmi_funcs = {
 105         .write_sad_regs = evergreen_hdmi_write_sad_regs,
 106         .write_speaker_allocation = dce4_afmt_hdmi_write_speaker_allocation,
 107 };
 108
 109 static struct radeon_audio_funcs dce4_dp_funcs = {
 110         .write_sad_regs = evergreen_hdmi_write_sad_regs,
 111         .write_speaker_allocation = dce4_afmt_dp_write_speaker_allocation,
 112 };
 113
 114 static struct radeon_audio_funcs dce6_hdmi_funcs = {
 115         .write_sad_regs = dce6_afmt_write_sad_regs,
 116         .write_speaker_allocation = dce6_afmt_hdmi_write_speaker_allocation,
 117 };
 118
 119 static struct radeon_audio_funcs dce6_dp_funcs = {
 120         .write_sad_regs = dce6_afmt_write_sad_regs,
 121         .write_speaker_allocation = dce6_afmt_dp_write_speaker_allocation,
 122 };
 123
 124 static void radeon_audio_interface_init(struct radeon_device *rdev)
 125 {
 126         if (ASIC_IS_DCE6(rdev)) {
 127                 rdev->audio.funcs = &dce6_funcs;
 128                 rdev->audio.hdmi_funcs = &dce6_hdmi_funcs;
 129                 rdev->audio.dp_funcs = &dce6_dp_funcs;
 130         } else if (ASIC_IS_DCE4(rdev)) {
 131                 rdev->audio.funcs = &dce4_funcs;
 132                 rdev->audio.hdmi_funcs = &dce4_hdmi_funcs;
 133                 rdev->audio.dp_funcs = &dce4_dp_funcs;
 134         } else {
 135                 rdev->audio.funcs = &dce32_funcs;
 136                 rdev->audio.hdmi_funcs = &dce32_hdmi_funcs;
 137                 rdev->audio.dp_funcs = &dce32_dp_funcs;
 138         }
 139 }
 140
 141 static int radeon_audio_chipset_supported(struct radeon_device *rdev)
 142 {
 143         return ASIC_IS_DCE2(rdev) && !ASIC_IS_NODCE(rdev);
 144 }
 145
 146 int radeon_audio_init(struct radeon_device *rdev)
 147 {
 148         int i;
 149
 150         if (!radeon_audio || !radeon_audio_chipset_supported(rdev))
 151                 return 0;
 152
 153         rdev->audio.enabled = true;
 154
 155         if (ASIC_IS_DCE83(rdev))                /* KB: 2 streams, 3 endpoints */
 156                 rdev->audio.num_pins = 3;
 157         else if (ASIC_IS_DCE81(rdev))   /* KV: 4 streams, 7 endpoints */
 158                 rdev->audio.num_pins = 7;
 159         else if (ASIC_IS_DCE8(rdev))    /* BN/HW: 6 streams, 7 endpoints */
 160                 rdev->audio.num_pins = 7;
 161         else if (ASIC_IS_DCE64(rdev))   /* OL: 2 streams, 2 endpoints */
 162                 rdev->audio.num_pins = 2;
 163         else if (ASIC_IS_DCE61(rdev))   /* TN: 4 streams, 6 endpoints */
 164                 rdev->audio.num_pins = 6;
 165         else if (ASIC_IS_DCE6(rdev))    /* SI: 6 streams, 6 endpoints */
 166                 rdev->audio.num_pins = 6;
 167         else
 168                 rdev->audio.num_pins = 1;
 169
 170         for (i = 0; i < rdev->audio.num_pins; i++) {
 171                 rdev->audio.pin[i].channels = -1;
 172                 rdev->audio.pin[i].rate = -1;
 173                 rdev->audio.pin[i].bits_per_sample = -1;
 174                 rdev->audio.pin[i].status_bits = 0;
 175                 rdev->audio.pin[i].category_code = 0;
 176                 rdev->audio.pin[i].connected = false;
 177                 rdev->audio.pin[i].offset = pin_offsets[i];
 178                 rdev->audio.pin[i].id = i;
 179         }
 180
 181         radeon_audio_interface_init(rdev);
 182
 183         /* disable audio.  it will be set up later */
 184         for (i = 0; i < rdev->audio.num_pins; i++)
 185                 if (ASIC_IS_DCE6(rdev))
 186                         dce6_audio_enable(rdev, &rdev->audio.pin[i], false);
 187                 else
 188                         r600_audio_enable(rdev, &rdev->audio.pin[i], false);
 189
 190         return 0;
 191 }
 192
 193 void radeon_audio_detect(struct drm_connector *connector,
 194         enum drm_connector_status status)
 195 {
 196         if (!connector || !connector->encoder)
 197                 return;
 198
 199         if (status == connector_status_connected) {
 200                 int sink_type;
 201                 struct radeon_device *rdev = connector->encoder->dev->dev_private;
 202                 struct radeon_connector *radeon_connector;
 203                 struct radeon_encoder *radeon_encoder =
 204                         to_radeon_encoder(connector->encoder);
 205
 206                 if (!drm_detect_monitor_audio(radeon_connector_edid(connector))) {
 207                         radeon_encoder->audio = 0;
 208                         return;
 209                 }
 210
 211                 radeon_connector = to_radeon_connector(connector);
 212                 sink_type = radeon_dp_getsinktype(radeon_connector);
 213
 214                 if (connector->connector_type == DRM_MODE_CONNECTOR_DisplayPort &&
 215                         sink_type == CONNECTOR_OBJECT_ID_DISPLAYPORT)
 216                         radeon_encoder->audio = rdev->audio.dp_funcs;
 217                 else
 218                         radeon_encoder->audio = rdev->audio.hdmi_funcs;
 219                 /* TODO: set up the sads, etc. and set the audio enable_mask */
 220         } else {
 221                 /* TODO: reset the audio enable_mask */
 222         }
 223 }
 224
 225 u32 radeon_audio_endpoint_rreg(struct radeon_device *rdev, u32 offset, u32 reg)
 226 {
 227         if (rdev->audio.funcs->endpoint_rreg)
 228                 return rdev->audio.funcs->endpoint_rreg(rdev, offset, reg);
 229
 230         return 0;
 231 }
 232
 233 void radeon_audio_endpoint_wreg(struct radeon_device *rdev, u32 offset,
 234         u32 reg, u32 v)
 235 {
 236         if (rdev->audio.funcs->endpoint_wreg)
 237                 rdev->audio.funcs->endpoint_wreg(rdev, offset, reg, v);
 238 }
 239
 240 void radeon_audio_write_sad_regs(struct drm_encoder *encoder)
 241 {
 242         struct radeon_encoder *radeon_encoder;
 243         struct drm_connector *connector;
 244         struct radeon_connector *radeon_connector = NULL;
 245         struct cea_sad *sads;
 246         int sad_count;
 247
 248         list_for_each_entry(connector,
 249                 &encoder->dev->mode_config.connector_list, head) {
 250                 if (connector->encoder == encoder) {
 251                         radeon_connector = to_radeon_connector(connector);
 252                         break;
 253                 }
 254         }
 255
 256         if (!radeon_connector) {
 257                 DRM_ERROR("Couldn't find encoder's connector\n");
 258                 return;
 259         }
 260
 261         sad_count = drm_edid_to_sad(radeon_connector_edid(connector), &sads);
 262         if (sad_count <= 0) {
 263                 DRM_ERROR("Couldn't read SADs: %d\n", sad_count);
 264                 return;
 265         }
 266         BUG_ON(!sads);
 267
 268         radeon_encoder = to_radeon_encoder(encoder);
 269
 270         if (radeon_encoder->audio && radeon_encoder->audio->write_sad_regs)
 271                 radeon_encoder->audio->write_sad_regs(encoder, sads, sad_count);
 272
 273         kfree(sads);
 274 }
 275
 276 void radeon_audio_write_speaker_allocation(struct drm_encoder *encoder)
 277 {
 278         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
 279     struct drm_connector *connector;
 280     struct radeon_connector *radeon_connector = NULL;
 281     u8 *sadb = NULL;
 282     int sad_count;
 283
 284     list_for_each_entry(connector,
 285                 &encoder->dev->mode_config.connector_list, head) {
 286         if (connector->encoder == encoder) {
 287             radeon_connector = to_radeon_connector(connector);
 288             break;
 289         }
 290     }
 291
 292     if (!radeon_connector) {
 293         DRM_ERROR("Couldn't find encoder's connector\n");
 294         return;
 295     }
 296
 297     sad_count = drm_edid_to_speaker_allocation(
 298                 radeon_connector_edid(connector), &sadb);
 299     if (sad_count < 0) {
 300         DRM_DEBUG("Couldn't read Speaker Allocation Data Block: %d\n",
 301                         sad_count);
 302         sad_count = 0;
 303     }
 304
 305         if (radeon_encoder->audio && radeon_encoder->audio->write_speaker_allocation)
 306                 radeon_encoder->audio->write_speaker_allocation(encoder, sadb, sad_count);
 307
 308     kfree(sadb);
 309 }