2015-11-10 13:12:06 +00:00
|
|
|
/*
|
|
|
|
* hdac_hdmi.c - ASoc HDA-HDMI codec driver for Intel platforms
|
|
|
|
*
|
|
|
|
* Copyright (C) 2014-2015 Intel Corp
|
|
|
|
* Author: Samreen Nilofer <samreen.nilofer@intel.com>
|
|
|
|
* Subhransu S. Prusty <subhransu.s.prusty@intel.com>
|
|
|
|
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; version 2 of the License.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful, but
|
|
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
* General Public License for more details.
|
|
|
|
*
|
|
|
|
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
|
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/pm_runtime.h>
|
2015-11-10 13:12:09 +00:00
|
|
|
#include <linux/hdmi.h>
|
2015-11-10 13:12:06 +00:00
|
|
|
#include <sound/pcm_params.h>
|
|
|
|
#include <sound/soc.h>
|
|
|
|
#include <sound/hdaudio_ext.h>
|
2015-11-10 13:12:10 +00:00
|
|
|
#include <sound/hda_i915.h>
|
2015-11-10 13:12:06 +00:00
|
|
|
#include "../../hda/local.h"
|
|
|
|
|
2015-11-10 13:12:08 +00:00
|
|
|
#define AMP_OUT_MUTE 0xb080
|
|
|
|
#define AMP_OUT_UNMUTE 0xb000
|
2015-11-10 13:12:06 +00:00
|
|
|
#define PIN_OUT (AC_PINCTL_OUT_EN)
|
2015-11-10 13:12:08 +00:00
|
|
|
|
2015-11-10 13:12:06 +00:00
|
|
|
#define HDA_MAX_CONNECTIONS 32
|
|
|
|
|
|
|
|
struct hdac_hdmi_cvt_params {
|
|
|
|
unsigned int channels_min;
|
|
|
|
unsigned int channels_max;
|
|
|
|
u32 rates;
|
|
|
|
u64 formats;
|
|
|
|
unsigned int maxbps;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct hdac_hdmi_cvt {
|
2015-12-09 16:16:10 +00:00
|
|
|
struct list_head head;
|
2015-11-10 13:12:06 +00:00
|
|
|
hda_nid_t nid;
|
|
|
|
struct hdac_hdmi_cvt_params params;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct hdac_hdmi_pin {
|
2015-12-09 16:16:10 +00:00
|
|
|
struct list_head head;
|
2015-11-10 13:12:06 +00:00
|
|
|
hda_nid_t nid;
|
|
|
|
int num_mux_nids;
|
|
|
|
hda_nid_t mux_nids[HDA_MAX_CONNECTIONS];
|
|
|
|
};
|
|
|
|
|
|
|
|
struct hdac_hdmi_dai_pin_map {
|
|
|
|
int dai_id;
|
2015-12-09 16:16:10 +00:00
|
|
|
struct hdac_hdmi_pin *pin;
|
|
|
|
struct hdac_hdmi_cvt *cvt;
|
2015-11-10 13:12:06 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
struct hdac_hdmi_priv {
|
|
|
|
struct hdac_hdmi_dai_pin_map dai_map[3];
|
2015-12-09 16:16:10 +00:00
|
|
|
struct list_head pin_list;
|
|
|
|
struct list_head cvt_list;
|
|
|
|
int num_pin;
|
|
|
|
int num_cvt;
|
2015-11-10 13:12:06 +00:00
|
|
|
};
|
|
|
|
|
2015-11-10 13:12:07 +00:00
|
|
|
static inline struct hdac_ext_device *to_hda_ext_device(struct device *dev)
|
|
|
|
{
|
2015-12-28 14:47:13 +00:00
|
|
|
struct hdac_device *hdac = dev_to_hdac_dev(dev);
|
2015-11-10 13:12:07 +00:00
|
|
|
|
2015-12-28 14:47:13 +00:00
|
|
|
return to_ehdac_device(hdac);
|
2015-11-10 13:12:07 +00:00
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:08 +00:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:09 +00:00
|
|
|
static void
|
|
|
|
hdac_hdmi_set_dip_index(struct hdac_ext_device *hdac, hda_nid_t pin_nid,
|
|
|
|
int packet_index, int byte_index)
|
|
|
|
{
|
|
|
|
int val;
|
|
|
|
|
|
|
|
val = (packet_index << 5) | (byte_index & 0x1f);
|
|
|
|
|
|
|
|
snd_hdac_codec_write(&hdac->hdac, pin_nid, 0,
|
|
|
|
AC_VERB_SET_HDMI_DIP_INDEX, val);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int hdac_hdmi_setup_audio_infoframe(struct hdac_ext_device *hdac,
|
|
|
|
hda_nid_t cvt_nid, hda_nid_t pin_nid)
|
|
|
|
{
|
|
|
|
uint8_t buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AUDIO_INFOFRAME_SIZE];
|
|
|
|
struct hdmi_audio_infoframe frame;
|
|
|
|
u8 *dip = (u8 *)&frame;
|
|
|
|
int ret;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
hdmi_audio_infoframe_init(&frame);
|
|
|
|
|
|
|
|
/* Default stereo for now */
|
|
|
|
frame.channels = 2;
|
|
|
|
|
|
|
|
/* setup channel count */
|
|
|
|
snd_hdac_codec_write(&hdac->hdac, cvt_nid, 0,
|
|
|
|
AC_VERB_SET_CVT_CHAN_COUNT, frame.channels - 1);
|
|
|
|
|
|
|
|
ret = hdmi_audio_infoframe_pack(&frame, buffer, sizeof(buffer));
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
/* stop infoframe transmission */
|
|
|
|
hdac_hdmi_set_dip_index(hdac, pin_nid, 0x0, 0x0);
|
|
|
|
snd_hdac_codec_write(&hdac->hdac, pin_nid, 0,
|
|
|
|
AC_VERB_SET_HDMI_DIP_XMIT, AC_DIPXMIT_DISABLE);
|
|
|
|
|
|
|
|
|
|
|
|
/* Fill infoframe. Index auto-incremented */
|
|
|
|
hdac_hdmi_set_dip_index(hdac, pin_nid, 0x0, 0x0);
|
|
|
|
for (i = 0; i < sizeof(frame); i++)
|
|
|
|
snd_hdac_codec_write(&hdac->hdac, pin_nid, 0,
|
|
|
|
AC_VERB_SET_HDMI_DIP_DATA, dip[i]);
|
|
|
|
|
|
|
|
/* Start infoframe */
|
|
|
|
hdac_hdmi_set_dip_index(hdac, pin_nid, 0x0, 0x0);
|
|
|
|
snd_hdac_codec_write(&hdac->hdac, pin_nid, 0,
|
|
|
|
AC_VERB_SET_HDMI_DIP_XMIT, AC_DIPXMIT_BEST);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:08 +00:00
|
|
|
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 */
|
2015-12-09 16:16:10 +00:00
|
|
|
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,
|
2015-11-10 13:12:08 +00:00
|
|
|
AC_VERB_SET_POWER_STATE, pwr_state);
|
|
|
|
|
|
|
|
/* Power up converter */
|
2015-12-09 16:16:10 +00:00
|
|
|
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,
|
2015-11-10 13:12:08 +00:00
|
|
|
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;
|
2015-11-10 13:12:09 +00:00
|
|
|
int ret;
|
2015-11-10 13:12:08 +00:00
|
|
|
|
|
|
|
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);
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
ret = hdac_hdmi_setup_audio_infoframe(hdac, dai_map->cvt->nid,
|
|
|
|
dai_map->pin->nid);
|
2015-11-10 13:12:09 +00:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
return hdac_hdmi_setup_stream(hdac, dai_map->cvt->nid,
|
|
|
|
dai_map->pin->nid, dd->stream_tag, dd->format);
|
2015-11-10 13:12:08 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
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);
|
2015-11-23 12:15:13 +00:00
|
|
|
if (!dd)
|
|
|
|
return -ENOMEM;
|
2015-11-10 13:12:08 +00:00
|
|
|
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];
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&edev->hdac, dai_map->cvt->nid, 0,
|
2015-11-10 13:12:08 +00:00
|
|
|
AC_VERB_SET_CHANNEL_STREAMID, 0);
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&edev->hdac, dai_map->cvt->nid, 0,
|
2015-11-10 13:12:08 +00:00
|
|
|
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];
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
val = snd_hdac_codec_read(&hdac->hdac, dai_map->pin->nid, 0,
|
2015-11-10 13:12:08 +00:00
|
|
|
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);
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&hdac->hdac, dai_map->pin->nid, 0,
|
2015-11-10 13:12:08 +00:00
|
|
|
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);
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&hdac->hdac, dai_map->pin->nid, 0,
|
2015-11-10 13:12:08 +00:00
|
|
|
AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_MUTE);
|
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:06 +00:00
|
|
|
static int
|
|
|
|
hdac_hdmi_query_cvt_params(struct hdac_device *hdac, struct hdac_hdmi_cvt *cvt)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
|
|
|
/* Only stereo supported as of now */
|
|
|
|
cvt->params.channels_min = cvt->params.channels_max = 2;
|
|
|
|
|
|
|
|
err = snd_hdac_query_supported_pcm(hdac, cvt->nid,
|
|
|
|
&cvt->params.rates,
|
|
|
|
&cvt->params.formats,
|
|
|
|
&cvt->params.maxbps);
|
|
|
|
if (err < 0)
|
|
|
|
dev_err(&hdac->dev,
|
|
|
|
"Failed to query pcm params for nid %d: %d\n",
|
|
|
|
cvt->nid, err);
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void hdac_hdmi_fill_widget_info(struct snd_soc_dapm_widget *w,
|
|
|
|
enum snd_soc_dapm_type id,
|
|
|
|
const char *wname, const char *stream)
|
|
|
|
{
|
|
|
|
w->id = id;
|
|
|
|
w->name = wname;
|
|
|
|
w->sname = stream;
|
|
|
|
w->reg = SND_SOC_NOPM;
|
|
|
|
w->shift = 0;
|
|
|
|
w->kcontrol_news = NULL;
|
|
|
|
w->num_kcontrols = 0;
|
|
|
|
w->priv = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void hdac_hdmi_fill_route(struct snd_soc_dapm_route *route,
|
|
|
|
const char *sink, const char *control, const char *src)
|
|
|
|
{
|
|
|
|
route->sink = sink;
|
|
|
|
route->source = src;
|
|
|
|
route->control = control;
|
|
|
|
route->connected = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void create_fill_widget_route_map(struct snd_soc_dapm_context *dapm,
|
|
|
|
struct hdac_hdmi_dai_pin_map *dai_map)
|
|
|
|
{
|
|
|
|
struct snd_soc_dapm_route route[1];
|
|
|
|
struct snd_soc_dapm_widget widgets[2] = { {0} };
|
|
|
|
|
|
|
|
memset(&route, 0, sizeof(route));
|
|
|
|
|
|
|
|
hdac_hdmi_fill_widget_info(&widgets[0], snd_soc_dapm_output,
|
|
|
|
"hif1 Output", NULL);
|
|
|
|
hdac_hdmi_fill_widget_info(&widgets[1], snd_soc_dapm_aif_in,
|
|
|
|
"Coverter 1", "hif1");
|
|
|
|
|
|
|
|
hdac_hdmi_fill_route(&route[0], "hif1 Output", NULL, "Coverter 1");
|
|
|
|
|
|
|
|
snd_soc_dapm_new_controls(dapm, widgets, ARRAY_SIZE(widgets));
|
|
|
|
snd_soc_dapm_add_routes(dapm, route, ARRAY_SIZE(route));
|
|
|
|
}
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
static int hdac_hdmi_init_dai_map(struct hdac_ext_device *edev)
|
2015-11-10 13:12:06 +00:00
|
|
|
{
|
2015-12-09 16:16:10 +00:00
|
|
|
struct hdac_hdmi_priv *hdmi = edev->private_data;
|
|
|
|
struct hdac_hdmi_dai_pin_map *dai_map = &hdmi->dai_map[0];
|
|
|
|
struct hdac_hdmi_cvt *cvt;
|
|
|
|
struct hdac_hdmi_pin *pin;
|
2015-11-10 13:12:06 +00:00
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
if (list_empty(&hdmi->cvt_list) || list_empty(&hdmi->pin_list))
|
|
|
|
return -EINVAL;
|
2015-11-10 13:12:06 +00:00
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
/*
|
|
|
|
* Currently on board only 1 pin and 1 converter is enabled for
|
|
|
|
* simplification, more will be added eventually
|
|
|
|
* So using fixed map for dai_id:pin:cvt
|
|
|
|
*/
|
|
|
|
cvt = list_first_entry(&hdmi->cvt_list, struct hdac_hdmi_cvt, head);
|
|
|
|
pin = list_first_entry(&hdmi->pin_list, struct hdac_hdmi_pin, head);
|
|
|
|
|
|
|
|
dai_map->dai_id = 0;
|
|
|
|
dai_map->pin = pin;
|
2015-11-10 13:12:06 +00:00
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
dai_map->cvt = cvt;
|
2015-11-10 13:12:06 +00:00
|
|
|
|
|
|
|
/* Enable out path for this pin widget */
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&edev->hdac, pin->nid, 0,
|
2015-11-10 13:12:06 +00:00
|
|
|
AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT);
|
|
|
|
|
|
|
|
/* Enable transmission */
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&edev->hdac, cvt->nid, 0,
|
2015-11-10 13:12:06 +00:00
|
|
|
AC_VERB_SET_DIGI_CONVERT_1, 1);
|
|
|
|
|
|
|
|
/* Category Code (CC) to zero */
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&edev->hdac, cvt->nid, 0,
|
2015-11-10 13:12:06 +00:00
|
|
|
AC_VERB_SET_DIGI_CONVERT_2, 0);
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
snd_hdac_codec_write(&edev->hdac, pin->nid, 0,
|
2015-11-10 13:12:06 +00:00
|
|
|
AC_VERB_SET_CONNECT_SEL, 0);
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int hdac_hdmi_add_cvt(struct hdac_ext_device *edev, hda_nid_t nid)
|
|
|
|
{
|
|
|
|
struct hdac_hdmi_priv *hdmi = edev->private_data;
|
|
|
|
struct hdac_hdmi_cvt *cvt;
|
|
|
|
|
|
|
|
cvt = kzalloc(sizeof(*cvt), GFP_KERNEL);
|
|
|
|
if (!cvt)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
cvt->nid = nid;
|
|
|
|
|
|
|
|
list_add_tail(&cvt->head, &hdmi->cvt_list);
|
|
|
|
hdmi->num_cvt++;
|
|
|
|
|
|
|
|
return hdac_hdmi_query_cvt_params(&edev->hdac, cvt);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int hdac_hdmi_add_pin(struct hdac_ext_device *edev, hda_nid_t nid)
|
|
|
|
{
|
|
|
|
struct hdac_hdmi_priv *hdmi = edev->private_data;
|
|
|
|
struct hdac_hdmi_pin *pin;
|
|
|
|
|
|
|
|
pin = kzalloc(sizeof(*pin), GFP_KERNEL);
|
|
|
|
if (!pin)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
pin->nid = nid;
|
|
|
|
|
|
|
|
list_add_tail(&pin->head, &hdmi->pin_list);
|
|
|
|
hdmi->num_pin++;
|
|
|
|
|
|
|
|
return 0;
|
2015-11-10 13:12:06 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Parse all nodes and store the cvt/pin nids in array
|
|
|
|
* Add one time initialization for pin and cvt widgets
|
|
|
|
*/
|
|
|
|
static int hdac_hdmi_parse_and_map_nid(struct hdac_ext_device *edev)
|
|
|
|
{
|
|
|
|
hda_nid_t nid;
|
2015-12-01 08:59:35 +00:00
|
|
|
int i, num_nodes;
|
2015-11-10 13:12:06 +00:00
|
|
|
struct hdac_device *hdac = &edev->hdac;
|
|
|
|
struct hdac_hdmi_priv *hdmi = edev->private_data;
|
2015-12-09 16:16:10 +00:00
|
|
|
int ret;
|
2015-11-10 13:12:06 +00:00
|
|
|
|
2015-12-01 08:59:35 +00:00
|
|
|
num_nodes = snd_hdac_get_sub_nodes(hdac, hdac->afg, &nid);
|
2015-12-09 16:16:08 +00:00
|
|
|
if (!nid || num_nodes <= 0) {
|
2015-11-10 13:12:06 +00:00
|
|
|
dev_warn(&hdac->dev, "HDMI: failed to get afg sub nodes\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2015-12-01 08:59:35 +00:00
|
|
|
hdac->num_nodes = num_nodes;
|
2015-11-10 13:12:06 +00:00
|
|
|
hdac->start_nid = nid;
|
|
|
|
|
|
|
|
for (i = 0; i < hdac->num_nodes; i++, nid++) {
|
|
|
|
unsigned int caps;
|
|
|
|
unsigned int type;
|
|
|
|
|
|
|
|
caps = get_wcaps(hdac, nid);
|
|
|
|
type = get_wcaps_type(caps);
|
|
|
|
|
|
|
|
if (!(caps & AC_WCAP_DIGITAL))
|
|
|
|
continue;
|
|
|
|
|
|
|
|
switch (type) {
|
|
|
|
|
|
|
|
case AC_WID_AUD_OUT:
|
2015-12-09 16:16:10 +00:00
|
|
|
ret = hdac_hdmi_add_cvt(edev, nid);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
2015-11-10 13:12:06 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case AC_WID_PIN:
|
2015-12-09 16:16:10 +00:00
|
|
|
ret = hdac_hdmi_add_pin(edev, nid);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
2015-11-10 13:12:06 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
hdac->end_nid = nid;
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
if (!hdmi->num_pin || !hdmi->num_cvt)
|
2015-11-10 13:12:06 +00:00
|
|
|
return -EIO;
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
return hdac_hdmi_init_dai_map(edev);
|
2015-11-10 13:12:06 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int hdmi_codec_probe(struct snd_soc_codec *codec)
|
|
|
|
{
|
|
|
|
struct hdac_ext_device *edev = snd_soc_codec_get_drvdata(codec);
|
|
|
|
struct hdac_hdmi_priv *hdmi = edev->private_data;
|
|
|
|
struct snd_soc_dapm_context *dapm =
|
|
|
|
snd_soc_component_get_dapm(&codec->component);
|
|
|
|
|
|
|
|
edev->scodec = codec;
|
|
|
|
|
|
|
|
create_fill_widget_route_map(dapm, &hdmi->dai_map[0]);
|
|
|
|
|
|
|
|
/* Imp: Store the card pointer in hda_codec */
|
|
|
|
edev->card = dapm->card->snd_card;
|
|
|
|
|
2015-11-10 13:12:07 +00:00
|
|
|
/*
|
|
|
|
* hdac_device core already sets the state to active and calls
|
|
|
|
* get_noresume. So enable runtime and set the device to suspend.
|
|
|
|
*/
|
|
|
|
pm_runtime_enable(&edev->hdac.dev);
|
|
|
|
pm_runtime_put(&edev->hdac.dev);
|
|
|
|
pm_runtime_suspend(&edev->hdac.dev);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int hdmi_codec_remove(struct snd_soc_codec *codec)
|
|
|
|
{
|
|
|
|
struct hdac_ext_device *edev = snd_soc_codec_get_drvdata(codec);
|
|
|
|
|
|
|
|
pm_runtime_disable(&edev->hdac.dev);
|
2015-11-10 13:12:06 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct snd_soc_codec_driver hdmi_hda_codec = {
|
|
|
|
.probe = hdmi_codec_probe,
|
2015-11-10 13:12:07 +00:00
|
|
|
.remove = hdmi_codec_remove,
|
2015-11-10 13:12:06 +00:00
|
|
|
.idle_bias_off = true,
|
|
|
|
};
|
|
|
|
|
2015-11-10 13:12:08 +00:00
|
|
|
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,
|
|
|
|
};
|
|
|
|
|
2015-11-10 13:12:06 +00:00
|
|
|
static struct snd_soc_dai_driver hdmi_dais[] = {
|
|
|
|
{ .name = "intel-hdmi-hif1",
|
|
|
|
.playback = {
|
|
|
|
.stream_name = "hif1",
|
|
|
|
.channels_min = 2,
|
|
|
|
.channels_max = 2,
|
|
|
|
.rates = SNDRV_PCM_RATE_32000 |
|
|
|
|
SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
|
|
|
|
SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 |
|
|
|
|
SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_192000,
|
|
|
|
.formats = SNDRV_PCM_FMTBIT_S16_LE |
|
|
|
|
SNDRV_PCM_FMTBIT_S20_3LE |
|
|
|
|
SNDRV_PCM_FMTBIT_S24_LE |
|
|
|
|
SNDRV_PCM_FMTBIT_S32_LE,
|
|
|
|
|
|
|
|
},
|
2015-11-10 13:12:08 +00:00
|
|
|
.ops = &hdmi_dai_ops,
|
2015-11-10 13:12:06 +00:00
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static int hdac_hdmi_dev_probe(struct hdac_ext_device *edev)
|
|
|
|
{
|
|
|
|
struct hdac_device *codec = &edev->hdac;
|
|
|
|
struct hdac_hdmi_priv *hdmi_priv;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
hdmi_priv = devm_kzalloc(&codec->dev, sizeof(*hdmi_priv), GFP_KERNEL);
|
|
|
|
if (hdmi_priv == NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
edev->private_data = hdmi_priv;
|
|
|
|
|
|
|
|
dev_set_drvdata(&codec->dev, edev);
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
INIT_LIST_HEAD(&hdmi_priv->pin_list);
|
|
|
|
INIT_LIST_HEAD(&hdmi_priv->cvt_list);
|
|
|
|
|
2015-11-10 13:12:06 +00:00
|
|
|
ret = hdac_hdmi_parse_and_map_nid(edev);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
/* ASoC specific initialization */
|
|
|
|
return snd_soc_register_codec(&codec->dev, &hdmi_hda_codec,
|
|
|
|
hdmi_dais, ARRAY_SIZE(hdmi_dais));
|
|
|
|
}
|
|
|
|
|
|
|
|
static int hdac_hdmi_dev_remove(struct hdac_ext_device *edev)
|
|
|
|
{
|
2015-12-09 16:16:10 +00:00
|
|
|
struct hdac_hdmi_priv *hdmi = edev->private_data;
|
|
|
|
struct hdac_hdmi_pin *pin, *pin_next;
|
|
|
|
struct hdac_hdmi_cvt *cvt, *cvt_next;
|
|
|
|
|
2015-11-10 13:12:06 +00:00
|
|
|
snd_soc_unregister_codec(&edev->hdac.dev);
|
|
|
|
|
2015-12-09 16:16:10 +00:00
|
|
|
list_for_each_entry_safe(cvt, cvt_next, &hdmi->cvt_list, head) {
|
|
|
|
list_del(&cvt->head);
|
|
|
|
kfree(cvt);
|
|
|
|
}
|
|
|
|
|
|
|
|
list_for_each_entry_safe(pin, pin_next, &hdmi->pin_list, head) {
|
|
|
|
list_del(&pin->head);
|
|
|
|
kfree(pin);
|
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:06 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:07 +00:00
|
|
|
#ifdef CONFIG_PM
|
|
|
|
static int hdac_hdmi_runtime_suspend(struct device *dev)
|
|
|
|
{
|
|
|
|
struct hdac_ext_device *edev = to_hda_ext_device(dev);
|
|
|
|
struct hdac_device *hdac = &edev->hdac;
|
2015-11-10 13:12:10 +00:00
|
|
|
struct hdac_bus *bus = hdac->bus;
|
|
|
|
int err;
|
2015-11-10 13:12:07 +00:00
|
|
|
|
|
|
|
dev_dbg(dev, "Enter: %s\n", __func__);
|
|
|
|
|
2015-11-10 13:12:10 +00:00
|
|
|
/* controller may not have been initialized for the first time */
|
|
|
|
if (!bus)
|
|
|
|
return 0;
|
|
|
|
|
2015-11-10 13:12:07 +00:00
|
|
|
/* Power down afg */
|
|
|
|
if (!snd_hdac_check_power_state(hdac, hdac->afg, AC_PWRST_D3))
|
|
|
|
snd_hdac_codec_write(hdac, hdac->afg, 0,
|
|
|
|
AC_VERB_SET_POWER_STATE, AC_PWRST_D3);
|
|
|
|
|
2015-11-10 13:12:10 +00:00
|
|
|
err = snd_hdac_display_power(bus, false);
|
|
|
|
if (err < 0) {
|
|
|
|
dev_err(bus->dev, "Cannot turn on display power on i915\n");
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:07 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int hdac_hdmi_runtime_resume(struct device *dev)
|
|
|
|
{
|
|
|
|
struct hdac_ext_device *edev = to_hda_ext_device(dev);
|
|
|
|
struct hdac_device *hdac = &edev->hdac;
|
2015-11-10 13:12:10 +00:00
|
|
|
struct hdac_bus *bus = hdac->bus;
|
|
|
|
int err;
|
2015-11-10 13:12:07 +00:00
|
|
|
|
|
|
|
dev_dbg(dev, "Enter: %s\n", __func__);
|
|
|
|
|
2015-11-10 13:12:10 +00:00
|
|
|
/* controller may not have been initialized for the first time */
|
|
|
|
if (!bus)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
err = snd_hdac_display_power(bus, true);
|
|
|
|
if (err < 0) {
|
|
|
|
dev_err(bus->dev, "Cannot turn on display power on i915\n");
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2015-11-10 13:12:07 +00:00
|
|
|
/* Power up afg */
|
|
|
|
if (!snd_hdac_check_power_state(hdac, hdac->afg, AC_PWRST_D0))
|
|
|
|
snd_hdac_codec_write(hdac, hdac->afg, 0,
|
|
|
|
AC_VERB_SET_POWER_STATE, AC_PWRST_D0);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
#define hdac_hdmi_runtime_suspend NULL
|
|
|
|
#define hdac_hdmi_runtime_resume NULL
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static const struct dev_pm_ops hdac_hdmi_pm = {
|
|
|
|
SET_RUNTIME_PM_OPS(hdac_hdmi_runtime_suspend, hdac_hdmi_runtime_resume, NULL)
|
|
|
|
};
|
|
|
|
|
2015-11-10 13:12:06 +00:00
|
|
|
static const struct hda_device_id hdmi_list[] = {
|
|
|
|
HDA_CODEC_EXT_ENTRY(0x80862809, 0x100000, "Skylake HDMI", 0),
|
|
|
|
{}
|
|
|
|
};
|
|
|
|
|
|
|
|
MODULE_DEVICE_TABLE(hdaudio, hdmi_list);
|
|
|
|
|
|
|
|
static struct hdac_ext_driver hdmi_driver = {
|
|
|
|
. hdac = {
|
|
|
|
.driver = {
|
|
|
|
.name = "HDMI HDA Codec",
|
2015-11-10 13:12:07 +00:00
|
|
|
.pm = &hdac_hdmi_pm,
|
2015-11-10 13:12:06 +00:00
|
|
|
},
|
|
|
|
.id_table = hdmi_list,
|
|
|
|
},
|
|
|
|
.probe = hdac_hdmi_dev_probe,
|
|
|
|
.remove = hdac_hdmi_dev_remove,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init hdmi_init(void)
|
|
|
|
{
|
|
|
|
return snd_hda_ext_driver_register(&hdmi_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit hdmi_exit(void)
|
|
|
|
{
|
|
|
|
snd_hda_ext_driver_unregister(&hdmi_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(hdmi_init);
|
|
|
|
module_exit(hdmi_exit);
|
|
|
|
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
|
|
MODULE_DESCRIPTION("HDMI HD codec");
|
|
|
|
MODULE_AUTHOR("Samreen Nilofer<samreen.nilofer@intel.com>");
|
|
|
|
MODULE_AUTHOR("Subhransu S. Prusty<subhransu.s.prusty@intel.com>");
|