Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit b0362adb authored by Subhransu S. Prusty's avatar Subhransu S. Prusty Committed by Mark Brown
Browse files

ASoC: hdac_hdmi: Add hdac hdmi dai ops 



The DAI ops are used for triggering HDMI streams and configuring
the parameters

Signed-off-by: default avatarSubhransu S. Prusty <subhransu.s.prusty@intel.com>
Signed-off-by: default avatarVinod Koul <vinod.koul@intel.com>
Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent e342ac08

sound/soc/codecs/hdac_hdmi.c

+162 −0
Original line number Diff line number Diff line
@@ -26,7 +26,10 @@ 
#include <sound/hdaudio_ext.h>

#include "../../hda/local.h"



#define AMP_OUT_MUTE		0xb080

#define AMP_OUT_UNMUTE		0xb000

#define PIN_OUT			(AC_PINCTL_OUT_EN)



#define HDA_MAX_CONNECTIONS     32



struct hdac_hdmi_cvt_params {
@@ -67,6 +70,156 @@ static inline struct hdac_ext_device *to_hda_ext_device(struct device *dev) 
	return container_of(hdac, struct hdac_ext_device, hdac);

}



static int hdac_hdmi_setup_stream(struct hdac_ext_device *hdac,

				hda_nid_t cvt_nid, hda_nid_t pin_nid,

				u32 stream_tag, int format)

{

	unsigned int val;



	dev_dbg(&hdac->hdac.dev, "cvt nid %d pnid %d stream %d format 0x%x\n",

			cvt_nid, pin_nid, stream_tag, format);



	val = (stream_tag << 4);



	snd_hdac_codec_write(&hdac->hdac, cvt_nid, 0,

				AC_VERB_SET_CHANNEL_STREAMID, val);

	snd_hdac_codec_write(&hdac->hdac, cvt_nid, 0,

				AC_VERB_SET_STREAM_FORMAT, format);



	return 0;

}



static void hdac_hdmi_set_power_state(struct hdac_ext_device *edev,

		struct hdac_hdmi_dai_pin_map *dai_map, unsigned int pwr_state)

{

	/* Power up pin widget */

	if (!snd_hdac_check_power_state(&edev->hdac, dai_map->pin.nid, pwr_state))

		snd_hdac_codec_write(&edev->hdac, dai_map->pin.nid, 0,

			AC_VERB_SET_POWER_STATE, pwr_state);



	/* Power up converter */

	if (!snd_hdac_check_power_state(&edev->hdac, dai_map->cvt.nid, pwr_state))

		snd_hdac_codec_write(&edev->hdac, dai_map->cvt.nid, 0,

			AC_VERB_SET_POWER_STATE, pwr_state);

}



static int hdac_hdmi_playback_prepare(struct snd_pcm_substream *substream,

				struct snd_soc_dai *dai)

{

	struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai);

	struct hdac_hdmi_priv *hdmi = hdac->private_data;

	struct hdac_hdmi_dai_pin_map *dai_map;

	struct hdac_ext_dma_params *dd;



	if (dai->id > 0) {

		dev_err(&hdac->hdac.dev, "Only one dai supported as of now\n");

		return -ENODEV;

	}



	dai_map = &hdmi->dai_map[dai->id];



	dd = (struct hdac_ext_dma_params *)snd_soc_dai_get_dma_data(dai, substream);

	dev_dbg(&hdac->hdac.dev, "stream tag from cpu dai %d format in cvt 0x%x\n",

			dd->stream_tag,	dd->format);



	return hdac_hdmi_setup_stream(hdac, dai_map->cvt.nid, dai_map->pin.nid,

					dd->stream_tag, dd->format);

}



static int hdac_hdmi_set_hw_params(struct snd_pcm_substream *substream,

	struct snd_pcm_hw_params *hparams, struct snd_soc_dai *dai)

{

	struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai);

	struct hdac_ext_dma_params *dd;



	if (dai->id > 0) {

		dev_err(&hdac->hdac.dev, "Only one dai supported as of now\n");

		return -ENODEV;

	}



	dd = kzalloc(sizeof(*dd), GFP_KERNEL);

	dd->format = snd_hdac_calc_stream_format(params_rate(hparams),

			params_channels(hparams), params_format(hparams),

			24, 0);



	snd_soc_dai_set_dma_data(dai, substream, (void *)dd);



	return 0;

}



static int hdac_hdmi_playback_cleanup(struct snd_pcm_substream *substream,

		struct snd_soc_dai *dai)

{

	struct hdac_ext_device *edev = snd_soc_dai_get_drvdata(dai);

	struct hdac_ext_dma_params *dd;

	struct hdac_hdmi_priv *hdmi = edev->private_data;

	struct hdac_hdmi_dai_pin_map *dai_map;



	dai_map = &hdmi->dai_map[dai->id];



	snd_hdac_codec_write(&edev->hdac, dai_map->cvt.nid, 0,

				AC_VERB_SET_CHANNEL_STREAMID, 0);

	snd_hdac_codec_write(&edev->hdac, dai_map->cvt.nid, 0,

				AC_VERB_SET_STREAM_FORMAT, 0);



	dd = (struct hdac_ext_dma_params *)snd_soc_dai_get_dma_data(dai, substream);

	snd_soc_dai_set_dma_data(dai, substream, NULL);



	kfree(dd);



	return 0;

}



static int hdac_hdmi_pcm_open(struct snd_pcm_substream *substream,

			struct snd_soc_dai *dai)

{

	struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai);

	struct hdac_hdmi_priv *hdmi = hdac->private_data;

	struct hdac_hdmi_dai_pin_map *dai_map;

	int val;



	if (dai->id > 0) {

		dev_err(&hdac->hdac.dev, "Only one dai supported as of now\n");

		return -ENODEV;

	}



	dai_map = &hdmi->dai_map[dai->id];



	val = snd_hdac_codec_read(&hdac->hdac, dai_map->pin.nid, 0,

					AC_VERB_GET_PIN_SENSE, 0);

	dev_info(&hdac->hdac.dev, "Val for AC_VERB_GET_PIN_SENSE: %x\n", val);



	if ((!(val & AC_PINSENSE_PRESENCE)) || (!(val & AC_PINSENSE_ELDV))) {

		dev_err(&hdac->hdac.dev, "Monitor presence invalid with val: %x\n", val);

		return -ENODEV;

	}



	hdac_hdmi_set_power_state(hdac, dai_map, AC_PWRST_D0);



	snd_hdac_codec_write(&hdac->hdac, dai_map->pin.nid, 0,

			AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_UNMUTE);



	snd_pcm_hw_constraint_step(substream->runtime, 0,

				   SNDRV_PCM_HW_PARAM_CHANNELS, 2);



	return 0;

}



static void hdac_hdmi_pcm_close(struct snd_pcm_substream *substream,

		struct snd_soc_dai *dai)

{

	struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai);

	struct hdac_hdmi_priv *hdmi = hdac->private_data;

	struct hdac_hdmi_dai_pin_map *dai_map;



	dai_map = &hdmi->dai_map[dai->id];



	hdac_hdmi_set_power_state(hdac, dai_map, AC_PWRST_D3);



	snd_hdac_codec_write(&hdac->hdac, dai_map->pin.nid, 0,

			AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_MUTE);

}



static int

hdac_hdmi_query_cvt_params(struct hdac_device *hdac, struct hdac_hdmi_cvt *cvt)

{
@@ -282,6 +435,14 @@ static struct snd_soc_codec_driver hdmi_hda_codec = { 
	.idle_bias_off	= true,

};



static struct snd_soc_dai_ops hdmi_dai_ops = {

	.startup = hdac_hdmi_pcm_open,

	.shutdown = hdac_hdmi_pcm_close,

	.hw_params = hdac_hdmi_set_hw_params,

	.prepare = hdac_hdmi_playback_prepare,

	.hw_free = hdac_hdmi_playback_cleanup,

};



static struct snd_soc_dai_driver hdmi_dais[] = {

	{	.name = "intel-hdmi-hif1",

		.playback = {
@@ -298,6 +459,7 @@ static struct snd_soc_dai_driver hdmi_dais[] = { 
				SNDRV_PCM_FMTBIT_S32_LE,



		},

		.ops = &hdmi_dai_ops,

	},

};