461 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2//3// Copyright(c) 2018 Intel Corporation4//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 321 22#define IDISP_VID_INTEL 0x8086000023 24static int hda_codec_mask = -1;25module_param_named(codec_mask, hda_codec_mask, int, 0444);26MODULE_PARM_DESC(codec_mask, "SOF HDA codec mask for probing");27 28/* load the legacy HDA codec driver */29static int request_codec_module(struct hda_codec *codec)30{31#ifdef MODULE32 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#endif40 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 55static 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 */76void 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}104EXPORT_SYMBOL_NS_GPL(hda_codec_jack_wake_enable, SND_SOC_SOF_HDA_AUDIO_CODEC);105 106/* check jack status after resuming from suspend mode */107void 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 event119 * has been recorded in STATESTS120 */121 if (codec->jacktbl.used)122 pm_request_resume(&codec->core.dev);123}124EXPORT_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#else130#define is_generic_config(x) 0131#endif132 133static 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 */149static 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 else197 codec->probe_id = 0;198 199 ret = hda_codec_load_module(codec);200 /*201 * handle ret==0 (no driver bound) as an error, but pass202 * other return codes without modification203 */204 if (ret == 0)205 ret = -ENOENT;206 207out: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 */217void 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}240EXPORT_SYMBOL_NS_GPL(hda_codec_probe_bus, SND_SOC_SOF_HDA_AUDIO_CODEC);241 242void 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}253EXPORT_SYMBOL_NS_GPL(hda_codec_check_for_state_change, SND_SOC_SOF_HDA_AUDIO_CODEC);254 255void 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}278EXPORT_SYMBOL_NS_GPL(hda_codec_detect_mask, SND_SOC_SOF_HDA_AUDIO_CODEC);279 280void 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}291EXPORT_SYMBOL_NS_GPL(hda_codec_init_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC);292 293void 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}305EXPORT_SYMBOL_NS_GPL(hda_codec_resume_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC);306 307void 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}318EXPORT_SYMBOL_NS_GPL(hda_codec_stop_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC);319 320void 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}333EXPORT_SYMBOL_NS_GPL(hda_codec_suspend_cmd_io, SND_SOC_SOF_HDA_AUDIO_CODEC);334 335void 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}346EXPORT_SYMBOL_NS_GPL(hda_codec_rirb_status_clear, SND_SOC_SOF_HDA_AUDIO_CODEC);347 348void 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}357EXPORT_SYMBOL_NS_GPL(hda_codec_set_codec_wakeup, SND_SOC_SOF_HDA_AUDIO_CODEC);358 359bool 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 ensures373 * that no interrupt gets masked after the RIRB374 * 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}384EXPORT_SYMBOL_NS_GPL(hda_codec_check_rirb_status, SND_SOC_SOF_HDA_AUDIO_CODEC);385 386void 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}397EXPORT_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 403void 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}416EXPORT_SYMBOL_NS_GPL(hda_codec_i915_display_power, SND_SOC_SOF_HDA_AUDIO_CODEC_I915);417 418int 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}437EXPORT_SYMBOL_NS_GPL(hda_codec_i915_init, SND_SOC_SOF_HDA_AUDIO_CODEC_I915);438 439int 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}455EXPORT_SYMBOL_NS_GPL(hda_codec_i915_exit, SND_SOC_SOF_HDA_AUDIO_CODEC_I915);456 457#endif458 459MODULE_LICENSE("Dual BSD/GPL");460MODULE_DESCRIPTION("SOF support for HDaudio codecs");461