// SPDX-License-Identifier: GPL-2.0-only//// Copyright(c) 2018 Intel Corporation//// Authors: Keyon Jie <yang.jie@linux.intel.com>// #include <linux/module.h>#include <sound/hdaudio_ext.h>#include <sound/hda_register.h>#include <sound/hda_codec.h>#include <sound/hda_i915.h>#include <sound/sof.h>#include "../ops.h"#include "hda.h" #if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA_AUDIO_CODEC)#include "../../codecs/hdac_hda.h" #define CODEC_PROBE_RETRIES	3 #define IDISP_VID_INTEL	0x80860000 static int hda_codec_mask = -1;module_param_named(codec_mask, hda_codec_mask, int, 0444);MODULE_PARM_DESC(codec_mask, "SOF HDA codec mask for probing"); /* load the legacy HDA codec driver */static int request_codec_module(struct hda_codec *codec){#ifdef MODULE	char alias[MODULE_NAME_LEN];	const char *mod = NULL; 	switch (codec->probe_id) {	case HDA_CODEC_ID_GENERIC:#if IS_MODULE(CONFIG_SND_HDA_GENERIC)		mod = "snd-hda-codec-generic";#endif		break;	default:		snd_hdac_codec_modalias(&codec->core, alias, sizeof(alias));		mod = alias;		break;	} 	if (mod) {		dev_dbg(&codec->core.dev, "loading codec module: %s\n", mod);		request_module(mod);	}#endif /* MODULE */	return device_attach(hda_codec_dev(codec));} static int hda_codec_load_module(struct hda_codec *codec){	int ret; 	ret = snd_hdac_device_register(&codec->core);	if (ret) {		dev_err(&codec->core.dev, "failed to register hdac device\n");		put_device(&codec->core.dev);		return ret;	} 	ret = request_codec_module(codec);	if (ret <= 0) {		codec->probe_id = HDA_CODEC_ID_GENERIC;		ret = request_codec_module(codec);	} 	return ret;} /* enable controller wake up event for all codecs with jack connectors */void hda_codec_jack_wake_enable(struct snd_sof_dev *sdev, bool enable){	struct hda_bus *hbus = sof_to_hbus(sdev);	struct hdac_bus *bus = sof_to_bus(sdev);	struct hda_codec *codec;	unsigned int mask = 0;	unsigned int val = 0; 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	if (enable) {		list_for_each_codec(codec, hbus) {			/* only set WAKEEN when needed for HDaudio codecs */			mask |= BIT(codec->core.addr);			if (codec->jacktbl.used)				val |= BIT(codec->core.addr);		}	} else {		list_for_each_codec(codec, hbus) {			/* reset WAKEEN only HDaudio codecs */			mask |= BIT(codec->core.addr);		}	} 	snd_hdac_chip_updatew(bus, WAKEEN, mask & STATESTS_INT_MASK, val);}EXPORT_SYMBOL_NS_GPL(hda_codec_jack_wake_enable, "SND_SOC_SOF_HDA_AUDIO_CODEC"); /* check jack status after resuming from suspend mode */void hda_codec_jack_check(struct snd_sof_dev *sdev){	struct hda_bus *hbus = sof_to_hbus(sdev);	struct hda_codec *codec; 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	list_for_each_codec(codec, hbus)		/*		 * Wake up all jack-detecting codecs regardless whether an event		 * has been recorded in STATESTS		 */		if (codec->jacktbl.used)			pm_request_resume(&codec->core.dev);}EXPORT_SYMBOL_NS_GPL(hda_codec_jack_check, "SND_SOC_SOF_HDA_AUDIO_CODEC"); #if IS_ENABLED(CONFIG_SND_HDA_GENERIC)#define is_generic_config(bus) \	((bus)->modelname && !strcmp((bus)->modelname, "generic"))#else#define is_generic_config(x)	0#endif static struct hda_codec *hda_codec_device_init(struct hdac_bus *bus, int addr, int type){	struct hda_codec *codec; 	codec = snd_hda_codec_device_init(to_hda_bus(bus), addr, "ehdaudio%dD%d", bus->idx, addr);	if (IS_ERR(codec)) {		dev_err(bus->dev, "device init failed for hdac device\n");		return codec;	} 	codec->core.type = type; 	return codec;} /* probe individual codec */static int hda_codec_probe(struct snd_sof_dev *sdev, int address){	struct hdac_hda_priv *hda_priv;	struct hda_bus *hbus = sof_to_hbus(sdev);	struct hda_codec *codec;	u32 hda_cmd = (address << 28) | (AC_NODE_ROOT << 20) |		(AC_VERB_PARAMETERS << 8) | AC_PAR_VENDOR_ID;	u32 resp = -1;	int ret, retry = 0; 	do {		mutex_lock(&hbus->core.cmd_mutex);		snd_hdac_bus_send_cmd(&hbus->core, hda_cmd);		snd_hdac_bus_get_response(&hbus->core, address, &resp);		mutex_unlock(&hbus->core.cmd_mutex);	} while (resp == -1 && retry++ < CODEC_PROBE_RETRIES); 	if (resp == -1)		return -EIO;	dev_dbg(sdev->dev, "HDA codec #%d probed OK: response: %x\n",		address, resp); 	hda_priv = devm_kzalloc(sdev->dev, sizeof(*hda_priv), GFP_KERNEL);	if (!hda_priv)		return -ENOMEM; 	codec = hda_codec_device_init(&hbus->core, address, HDA_DEV_LEGACY);	ret = PTR_ERR_OR_ZERO(codec);	if (ret < 0)		return ret; 	hda_priv->codec = codec;	hda_priv->dev_index = address;	dev_set_drvdata(&codec->core.dev, hda_priv); 	if ((resp & 0xFFFF0000) == IDISP_VID_INTEL) {		if (!hbus->core.audio_component) {			dev_dbg(sdev->dev,				"iDisp hw present but no driver\n");			ret = -ENOENT;			goto out;		}		hda_priv->need_display_power = true;	} 	if (is_generic_config(hbus))		codec->probe_id = HDA_CODEC_ID_GENERIC;	else		codec->probe_id = 0; 	ret = hda_codec_load_module(codec);	/*	 * handle ret==0 (no driver bound) as an error, but pass	 * other return codes without modification	 */	if (ret == 0)		ret = -ENOENT; out:	if (ret < 0) {		snd_hdac_device_unregister(&codec->core);		put_device(&codec->core.dev);	} 	return ret;} /* Codec initialization */void hda_codec_probe_bus(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev);	int i, ret; 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* probe codecs in avail slots */	for (i = 0; i < HDA_MAX_CODECS; i++) { 		if (!(bus->codec_mask & (1 << i)))			continue; 		ret = hda_codec_probe(sdev, i);		if (ret < 0) {			dev_warn(bus->dev, "codec #%d probe error, ret: %d\n",				 i, ret);			bus->codec_mask &= ~BIT(i);		}	}}EXPORT_SYMBOL_NS_GPL(hda_codec_probe_bus, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_check_for_state_change(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev);	unsigned int codec_mask; 	codec_mask = snd_hdac_chip_readw(bus, STATESTS);	if (codec_mask) {		hda_codec_jack_check(sdev);		snd_hdac_chip_writew(bus, STATESTS, codec_mask);	}}EXPORT_SYMBOL_NS_GPL(hda_codec_check_for_state_change, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_detect_mask(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* detect codecs */	if (!bus->codec_mask) {		bus->codec_mask = snd_hdac_chip_readw(bus, STATESTS);		dev_dbg(bus->dev, "codec_mask = 0x%lx\n", bus->codec_mask);	} 	if (hda_codec_mask != -1) {		bus->codec_mask &= hda_codec_mask;		dev_dbg(bus->dev, "filtered codec_mask = 0x%lx\n",			bus->codec_mask);	}}EXPORT_SYMBOL_NS_GPL(hda_codec_detect_mask, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_init_cmd_io(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* initialize the codec command I/O */	snd_hdac_bus_init_cmd_io(bus);}EXPORT_SYMBOL_NS_GPL(hda_codec_init_cmd_io, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_resume_cmd_io(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* set up CORB/RIRB buffers if was on before suspend */	if (bus->cmd_dma_state)		snd_hdac_bus_init_cmd_io(bus);}EXPORT_SYMBOL_NS_GPL(hda_codec_resume_cmd_io, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_stop_cmd_io(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* initialize the codec command I/O */	snd_hdac_bus_stop_cmd_io(bus);}EXPORT_SYMBOL_NS_GPL(hda_codec_stop_cmd_io, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_suspend_cmd_io(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* stop the CORB/RIRB DMA if it is On */	if (bus->cmd_dma_state)		snd_hdac_bus_stop_cmd_io(bus); }EXPORT_SYMBOL_NS_GPL(hda_codec_suspend_cmd_io, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_rirb_status_clear(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* clear rirb status */	snd_hdac_chip_writeb(bus, RIRBSTS, RIRB_INT_MASK);}EXPORT_SYMBOL_NS_GPL(hda_codec_rirb_status_clear, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_set_codec_wakeup(struct snd_sof_dev *sdev, bool status){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	snd_hdac_set_codec_wakeup(bus, status);}EXPORT_SYMBOL_NS_GPL(hda_codec_set_codec_wakeup, "SND_SOC_SOF_HDA_AUDIO_CODEC"); bool hda_codec_check_rirb_status(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev);	bool active = false;	u32 rirb_status; 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return false; 	rirb_status = snd_hdac_chip_readb(bus, RIRBSTS);	if (rirb_status & RIRB_INT_MASK) {		/*		 * Clearing the interrupt status here ensures		 * that no interrupt gets masked after the RIRB		 * wp is read in snd_hdac_bus_update_rirb.		 */		snd_hdac_chip_writeb(bus, RIRBSTS,				     RIRB_INT_MASK);		active = true;		if (rirb_status & RIRB_INT_RESPONSE)			snd_hdac_bus_update_rirb(bus);	}	return active;}EXPORT_SYMBOL_NS_GPL(hda_codec_check_rirb_status, "SND_SOC_SOF_HDA_AUDIO_CODEC"); void hda_codec_device_remove(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	/* codec removal, invoke bus_device_remove */	snd_hdac_ext_bus_device_remove(bus);}EXPORT_SYMBOL_NS_GPL(hda_codec_device_remove, "SND_SOC_SOF_HDA_AUDIO_CODEC"); #endif /* CONFIG_SND_SOC_SOF_HDA_AUDIO_CODEC */ #if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA_AUDIO_CODEC) && IS_ENABLED(CONFIG_SND_HDA_CODEC_HDMI) void hda_codec_i915_display_power(struct snd_sof_dev *sdev, bool enable){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return; 	if (HDA_IDISP_CODEC(bus->codec_mask)) {		dev_dbg(bus->dev, "Turning i915 HDAC power %d\n", enable);		snd_hdac_display_power(bus, HDA_CODEC_IDX_CONTROLLER, enable);	}}EXPORT_SYMBOL_NS_GPL(hda_codec_i915_display_power, "SND_SOC_SOF_HDA_AUDIO_CODEC_I915"); int hda_codec_i915_init(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev);	int ret; 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return 0; 	/* i915 exposes a HDA codec for HDMI audio */	ret = snd_hdac_i915_init(bus);	if (ret < 0)		return ret; 	/* codec_mask not yet known, power up for probe */	snd_hdac_display_power(bus, HDA_CODEC_IDX_CONTROLLER, true); 	return 0;}EXPORT_SYMBOL_NS_GPL(hda_codec_i915_init, "SND_SOC_SOF_HDA_AUDIO_CODEC_I915"); int hda_codec_i915_exit(struct snd_sof_dev *sdev){	struct hdac_bus *bus = sof_to_bus(sdev); 	if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&	    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))		return 0; 	if (!bus->audio_component)		return 0; 	/* power down unconditionally */	snd_hdac_display_power(bus, HDA_CODEC_IDX_CONTROLLER, false); 	return snd_hdac_i915_exit(bus);}EXPORT_SYMBOL_NS_GPL(hda_codec_i915_exit, "SND_SOC_SOF_HDA_AUDIO_CODEC_I915"); #endif MODULE_LICENSE("Dual BSD/GPL");MODULE_DESCRIPTION("SOF support for HDaudio codecs");