ASoC: hdac_hdmi: Add hdac hdmi dai ops

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

Signed-off-by: Subhransu S. Prusty <subhransu.s.prusty@intel.com>
Signed-off-by: Vinod Koul <vinod.koul@intel.com>
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/codecs/hdac_hdmi.c b/sound/soc/codecs/hdac_hdmi.c
index 45dfc4f..f96bd2f 100644 (file)
--- a/sound/soc/codecs/hdac_hdmi.c
+++ b/sound/soc/codecs/hdac_hdmi.c
@@ -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,
        },
 };