1 // SPDX-License-Identifier: GPL-2.0-only 2 // 3 // Copyright(c) 2018 Intel Corporation 4 // 5 // Authors: Keyon Jie <yang.jie@linux.intel.com> 6 // 7 8 #include <linux/module.h> 9 #include <sound/hdaudio_ext.h> 10 #include <sound/hda_register.h> 11 #include <sound/hda_codec.h> 12 #include <sound/hda_i915.h> 13 #include <sound/sof.h> 14 #include "../ops.h" 15 #include "hda.h" 16 17 #if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA_AUDIO_CODEC) 18 #include "../../codecs/hdac_hda.h" 19 20 #define CODEC_PROBE_RETRIES 3 21 22 #define IDISP_VID_INTEL 0x80860000 23 24 static int hda_codec_mask = -1; 25 module_param_named(codec_mask, hda_codec_mask, int, 0444); 26 MODULE_PARM_DESC(codec_mask, "SOF HDA codec mask for probing"); 27 28 /* load the legacy HDA codec driver */ 29 static int request_codec_module(struct hda_codec *codec) 30 { 31 #ifdef MODULE 32 char alias[MODULE_NAME_LEN]; 33 const char *mod = NULL; 34 35 switch (codec->probe_id) { 36 case HDA_CODEC_ID_GENERIC: 37 #if IS_MODULE(CONFIG_SND_HDA_GENERIC) 38 mod = "snd-hda-codec-generic"; 39 #endif 40 break; 41 default: 42 snd_hdac_codec_modalias(&codec->core, alias, sizeof(alias)); 43 mod = alias; 44 break; 45 } 46 47 if (mod) { 48 dev_dbg(&codec->core.dev, "loading codec module: %s\n", mod); 49 request_module(mod); 50 } 51 #endif /* MODULE */ 52 return device_attach(hda_codec_dev(codec)); 53 } 54 55 static int hda_codec_load_module(struct hda_codec *codec) 56 { 57 int ret; 58 59 ret = snd_hdac_device_register(&codec->core); 60 if (ret) { 61 dev_err(&codec->core.dev, "failed to register hdac device\n"); 62 put_device(&codec->core.dev); 63 return ret; 64 } 65 66 ret = request_codec_module(codec); 67 if (ret <= 0) { 68 codec->probe_id = HDA_CODEC_ID_GENERIC; 69 ret = request_codec_module(codec); 70 } 71 72 return ret; 73 } 74 75 /* enable controller wake up event for all codecs with jack connectors */ 76 void hda_codec_jack_wake_enable(struct snd_sof_dev *sdev, bool enable) 77 { 78 struct hda_bus *hbus = sof_to_hbus(sdev); 79 struct hdac_bus *bus = sof_to_bus(sdev); 80 struct hda_codec *codec; 81 unsigned int mask = 0; 82 unsigned int val = 0; 83 84 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 85 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 86 return; 87 88 if (enable) { 89 list_for_each_codec(codec, hbus) { 90 /* only set WAKEEN when needed for HDaudio codecs */ 91 mask |= BIT(codec->core.addr); 92 if (codec->jacktbl.used) 93 val |= BIT(codec->core.addr); 94 } 95 } else { 96 list_for_each_codec(codec, hbus) { 97 /* reset WAKEEN only HDaudio codecs */ 98 mask |= BIT(codec->core.addr); 99 } 100 } 101 102 snd_hdac_chip_updatew(bus, WAKEEN, mask & STATESTS_INT_MASK, val); 103 } 104 EXPORT_SYMBOL_NS_GPL(hda_codec_jack_wake_enable, SND_SOC_SOF_HDA_AUDIO_CODEC); 105 106 /* check jack status after resuming from suspend mode */ 107 void hda_codec_jack_check(struct snd_sof_dev *sdev) 108 { 109 struct hda_bus *hbus = sof_to_hbus(sdev); 110 struct hda_codec *codec; 111 112 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 113 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 114 return; 115 116 list_for_each_codec(codec, hbus) 117 /* 118 * Wake up all jack-detecting codecs regardless whether an event 119 * has been recorded in STATESTS 120 */ 121 if (codec->jacktbl.used) 122 pm_request_resume(&codec->core.dev); 123 } 124 EXPORT_SYMBOL_NS_GPL(hda_codec_jack_check, SND_SOC_SOF_HDA_AUDIO_CODEC); 125 126 #if IS_ENABLED(CONFIG_SND_HDA_GENERIC) 127 #define is_generic_config(bus) \ 128 ((bus)->modelname && !strcmp((bus)->modelname, "generic")) 129 #else 130 #define is_generic_config(x) 0 131 #endif 132 133 static struct hda_codec *hda_codec_device_init(struct hdac_bus *bus, int addr, int type) 134 { 135 struct hda_codec *codec; 136 137 codec = snd_hda_codec_device_init(to_hda_bus(bus), addr, "ehdaudio%dD%d", bus->idx, addr); 138 if (IS_ERR(codec)) { 139 dev_err(bus->dev, "device init failed for hdac device\n"); 140 return codec; 141 } 142 143 codec->core.type = type; 144 145 return codec; 146 } 147 148 /* probe individual codec */ 149 static int hda_codec_probe(struct snd_sof_dev *sdev, int address) 150 { 151 struct hdac_hda_priv *hda_priv; 152 struct hda_bus *hbus = sof_to_hbus(sdev); 153 struct hda_codec *codec; 154 u32 hda_cmd = (address << 28) | (AC_NODE_ROOT << 20) | 155 (AC_VERB_PARAMETERS << 8) | AC_PAR_VENDOR_ID; 156 u32 resp = -1; 157 int ret, retry = 0; 158 159 do { 160 mutex_lock(&hbus->core.cmd_mutex); 161 snd_hdac_bus_send_cmd(&hbus->core, hda_cmd); 162 snd_hdac_bus_get_response(&hbus->core, address, &resp); 163 mutex_unlock(&hbus->core.cmd_mutex); 164 } while (resp == -1 && retry++ < CODEC_PROBE_RETRIES); 165 166 if (resp == -1) 167 return -EIO; 168 dev_dbg(sdev->dev, "HDA codec #%d probed OK: response: %x\n", 169 address, resp); 170 171 hda_priv = devm_kzalloc(sdev->dev, sizeof(*hda_priv), GFP_KERNEL); 172 if (!hda_priv) 173 return -ENOMEM; 174 175 codec = hda_codec_device_init(&hbus->core, address, HDA_DEV_LEGACY); 176 ret = PTR_ERR_OR_ZERO(codec); 177 if (ret < 0) 178 return ret; 179 180 hda_priv->codec = codec; 181 hda_priv->dev_index = address; 182 dev_set_drvdata(&codec->core.dev, hda_priv); 183 184 if ((resp & 0xFFFF0000) == IDISP_VID_INTEL) { 185 if (!hbus->core.audio_component) { 186 dev_dbg(sdev->dev, 187 "iDisp hw present but no driver\n"); 188 ret = -ENOENT; 189 goto out; 190 } 191 hda_priv->need_display_power = true; 192 } 193 194 if (is_generic_config(hbus)) 195 codec->probe_id = HDA_CODEC_ID_GENERIC; 196 else 197 codec->probe_id = 0; 198 199 ret = hda_codec_load_module(codec); 200 /* 201 * handle ret==0 (no driver bound) as an error, but pass 202 * other return codes without modification 203 */ 204 if (ret == 0) 205 ret = -ENOENT; 206 207 out: 208 if (ret < 0) { 209 snd_hdac_device_unregister(&codec->core); 210 put_device(&codec->core.dev); 211 } 212 213 return ret; 214 } 215 216 /* Codec initialization */ 217 void hda_codec_probe_bus(struct snd_sof_dev *sdev) 218 { 219 struct hdac_bus *bus = sof_to_bus(sdev); 220 int i, ret; 221 222 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 223 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 224 return; 225 226 /* probe codecs in avail slots */ 227 for (i = 0; i < HDA_MAX_CODECS; i++) { 228 229 if (!(bus->codec_mask & (1 << i))) 230 continue; 231 232 ret = hda_codec_probe(sdev, i); 233 if (ret < 0) { 234 dev_warn(bus->dev, "codec #%d probe error, ret: %d\n", 235 i, ret); 236 bus->codec_mask &= ~BIT(i); 237 } 238 } 239 } 240 EXPORT_SYMBOL_NS_GPL(hda_codec_probe_bus, SND_SOC_SOF_HDA_AUDIO_CODEC); 241 242 void hda_codec_check_for_state_change(struct snd_sof_dev *sdev) 243 { 244 struct hdac_bus *bus = sof_to_bus(sdev); 245 unsigned int codec_mask; 246 247 codec_mask = snd_hdac_chip_readw(bus, STATESTS); 248 if (codec_mask) { 249 hda_codec_jack_check(sdev); 250 snd_hdac_chip_writew(bus, STATESTS, codec_mask); 251 } 252 } 253 EXPORT_SYMBOL_NS_GPL(hda_codec_check_for_state_change, SND_SOC_SOF_HDA_AUDIO_CODEC); 254 255 void hda_codec_detect_mask(struct snd_sof_dev *sdev) 256 { 257 struct hdac_bus *bus = sof_to_bus(sdev); 258 259 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 260 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 261 return; 262 263 /* Accept unsolicited responses */ 264 snd_hdac_chip_updatel(bus, GCTL, AZX_GCTL_UNSOL, AZX_GCTL_UNSOL); 265 266 /* detect codecs */ 267 if (!bus->codec_mask) { 268 bus->codec_mask = snd_hdac_chip_readw(bus, STATESTS); 269 dev_dbg(bus->dev, "codec_mask = 0x%lx\n", bus->codec_mask); 270 } 271 272 if (hda_codec_mask != -1) { 273 bus->codec_mask &= hda_codec_mask; 274 dev_dbg(bus->dev, "filtered codec_mask = 0x%lx\n", 275 bus->codec_mask); 276 } 277 } 278 EXPORT_SYMBOL_NS_GPL(hda_codec_detect_mask, SND_SOC_SOF_HDA_AUDIO_CODEC); 279 280 void hda_codec_init_cmd_io(struct snd_sof_dev *sdev) 281 { 282 struct hdac_bus *bus = sof_to_bus(sdev); 283 284 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 285 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 286 return; 287 288 /* initialize the codec command I/O */ 289 snd_hdac_bus_init_cmd_io(bus); 290 } 291 EXPORT_SYMBOL_NS_GPL(hda_codec_init_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC); 292 293 void hda_codec_resume_cmd_io(struct snd_sof_dev *sdev) 294 { 295 struct hdac_bus *bus = sof_to_bus(sdev); 296 297 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 298 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 299 return; 300 301 /* set up CORB/RIRB buffers if was on before suspend */ 302 if (bus->cmd_dma_state) 303 snd_hdac_bus_init_cmd_io(bus); 304 } 305 EXPORT_SYMBOL_NS_GPL(hda_codec_resume_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC); 306 307 void hda_codec_stop_cmd_io(struct snd_sof_dev *sdev) 308 { 309 struct hdac_bus *bus = sof_to_bus(sdev); 310 311 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 312 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 313 return; 314 315 /* initialize the codec command I/O */ 316 snd_hdac_bus_stop_cmd_io(bus); 317 } 318 EXPORT_SYMBOL_NS_GPL(hda_codec_stop_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC); 319 320 void hda_codec_suspend_cmd_io(struct snd_sof_dev *sdev) 321 { 322 struct hdac_bus *bus = sof_to_bus(sdev); 323 324 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 325 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 326 return; 327 328 /* stop the CORB/RIRB DMA if it is On */ 329 if (bus->cmd_dma_state) 330 snd_hdac_bus_stop_cmd_io(bus); 331 332 } 333 EXPORT_SYMBOL_NS_GPL(hda_codec_suspend_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC); 334 335 void hda_codec_rirb_status_clear(struct snd_sof_dev *sdev) 336 { 337 struct hdac_bus *bus = sof_to_bus(sdev); 338 339 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 340 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 341 return; 342 343 /* clear rirb status */ 344 snd_hdac_chip_writeb(bus, RIRBSTS, RIRB_INT_MASK); 345 } 346 EXPORT_SYMBOL_NS_GPL(hda_codec_rirb_status_clear, SND_SOC_SOF_HDA_AUDIO_CODEC); 347 348 void hda_codec_set_codec_wakeup(struct snd_sof_dev *sdev, bool status) 349 { 350 struct hdac_bus *bus = sof_to_bus(sdev); 351 352 if (sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 353 return; 354 355 snd_hdac_set_codec_wakeup(bus, status); 356 } 357 EXPORT_SYMBOL_NS_GPL(hda_codec_set_codec_wakeup, SND_SOC_SOF_HDA_AUDIO_CODEC); 358 359 bool hda_codec_check_rirb_status(struct snd_sof_dev *sdev) 360 { 361 struct hdac_bus *bus = sof_to_bus(sdev); 362 bool active = false; 363 u32 rirb_status; 364 365 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 366 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 367 return false; 368 369 rirb_status = snd_hdac_chip_readb(bus, RIRBSTS); 370 if (rirb_status & RIRB_INT_MASK) { 371 /* 372 * Clearing the interrupt status here ensures 373 * that no interrupt gets masked after the RIRB 374 * wp is read in snd_hdac_bus_update_rirb. 375 */ 376 snd_hdac_chip_writeb(bus, RIRBSTS, 377 RIRB_INT_MASK); 378 active = true; 379 if (rirb_status & RIRB_INT_RESPONSE) 380 snd_hdac_bus_update_rirb(bus); 381 } 382 return active; 383 } 384 EXPORT_SYMBOL_NS_GPL(hda_codec_check_rirb_status, SND_SOC_SOF_HDA_AUDIO_CODEC); 385 386 void hda_codec_device_remove(struct snd_sof_dev *sdev) 387 { 388 struct hdac_bus *bus = sof_to_bus(sdev); 389 390 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 391 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 392 return; 393 394 /* codec removal, invoke bus_device_remove */ 395 snd_hdac_ext_bus_device_remove(bus); 396 } 397 EXPORT_SYMBOL_NS_GPL(hda_codec_device_remove, SND_SOC_SOF_HDA_AUDIO_CODEC); 398 399 #endif /* CONFIG_SND_SOC_SOF_HDA_AUDIO_CODEC */ 400 401 #if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA_AUDIO_CODEC) && IS_ENABLED(CONFIG_SND_HDA_CODEC_HDMI) 402 403 void hda_codec_i915_display_power(struct snd_sof_dev *sdev, bool enable) 404 { 405 struct hdac_bus *bus = sof_to_bus(sdev); 406 407 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 408 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 409 return; 410 411 if (HDA_IDISP_CODEC(bus->codec_mask)) { 412 dev_dbg(bus->dev, "Turning i915 HDAC power %d\n", enable); 413 snd_hdac_display_power(bus, HDA_CODEC_IDX_CONTROLLER, enable); 414 } 415 } 416 EXPORT_SYMBOL_NS_GPL(hda_codec_i915_display_power, SND_SOC_SOF_HDA_AUDIO_CODEC_I915); 417 418 int hda_codec_i915_init(struct snd_sof_dev *sdev) 419 { 420 struct hdac_bus *bus = sof_to_bus(sdev); 421 int ret; 422 423 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 424 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 425 return 0; 426 427 /* i915 exposes a HDA codec for HDMI audio */ 428 ret = snd_hdac_i915_init(bus); 429 if (ret < 0) 430 return ret; 431 432 /* codec_mask not yet known, power up for probe */ 433 snd_hdac_display_power(bus, HDA_CODEC_IDX_CONTROLLER, true); 434 435 return 0; 436 } 437 EXPORT_SYMBOL_NS_GPL(hda_codec_i915_init, SND_SOC_SOF_HDA_AUDIO_CODEC_I915); 438 439 int hda_codec_i915_exit(struct snd_sof_dev *sdev) 440 { 441 struct hdac_bus *bus = sof_to_bus(sdev); 442 443 if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) && 444 sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC)) 445 return 0; 446 447 if (!bus->audio_component) 448 return 0; 449 450 /* power down unconditionally */ 451 snd_hdac_display_power(bus, HDA_CODEC_IDX_CONTROLLER, false); 452 453 return snd_hdac_i915_exit(bus); 454 } 455 EXPORT_SYMBOL_NS_GPL(hda_codec_i915_exit, SND_SOC_SOF_HDA_AUDIO_CODEC_I915); 456 457 #endif 458 459 MODULE_LICENSE("Dual BSD/GPL"); 460 MODULE_DESCRIPTION("SOF support for HDaudio codecs"); 461