Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 1 | /* |
| 2 | * hdac_hdmi.c - ASoc HDA-HDMI codec driver for Intel platforms |
| 3 | * |
| 4 | * Copyright (C) 2014-2015 Intel Corp |
| 5 | * Author: Samreen Nilofer <samreen.nilofer@intel.com> |
| 6 | * Subhransu S. Prusty <subhransu.s.prusty@intel.com> |
| 7 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 8 | * |
| 9 | * This program is free software; you can redistribute it and/or modify |
| 10 | * it under the terms of the GNU General Public License as published by |
| 11 | * the Free Software Foundation; version 2 of the License. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, but |
| 14 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 16 | * General Public License for more details. |
| 17 | * |
| 18 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 19 | */ |
| 20 | #include <linux/init.h> |
| 21 | #include <linux/delay.h> |
| 22 | #include <linux/module.h> |
| 23 | #include <linux/pm_runtime.h> |
Subhransu S. Prusty | a657f1d | 2015-11-10 18:42:09 +0530 | [diff] [blame] | 24 | #include <linux/hdmi.h> |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 25 | #include <sound/pcm_params.h> |
| 26 | #include <sound/soc.h> |
| 27 | #include <sound/hdaudio_ext.h> |
Subhransu S. Prusty | 07f083a | 2015-11-10 18:42:10 +0530 | [diff] [blame] | 28 | #include <sound/hda_i915.h> |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 29 | #include "../../hda/local.h" |
| 30 | |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 31 | #define AMP_OUT_MUTE 0xb080 |
| 32 | #define AMP_OUT_UNMUTE 0xb000 |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 33 | #define PIN_OUT (AC_PINCTL_OUT_EN) |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 34 | |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 35 | #define HDA_MAX_CONNECTIONS 32 |
| 36 | |
| 37 | struct hdac_hdmi_cvt_params { |
| 38 | unsigned int channels_min; |
| 39 | unsigned int channels_max; |
| 40 | u32 rates; |
| 41 | u64 formats; |
| 42 | unsigned int maxbps; |
| 43 | }; |
| 44 | |
| 45 | struct hdac_hdmi_cvt { |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 46 | struct list_head head; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 47 | hda_nid_t nid; |
| 48 | struct hdac_hdmi_cvt_params params; |
| 49 | }; |
| 50 | |
| 51 | struct hdac_hdmi_pin { |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 52 | struct list_head head; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 53 | hda_nid_t nid; |
| 54 | int num_mux_nids; |
| 55 | hda_nid_t mux_nids[HDA_MAX_CONNECTIONS]; |
| 56 | }; |
| 57 | |
| 58 | struct hdac_hdmi_dai_pin_map { |
| 59 | int dai_id; |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 60 | struct hdac_hdmi_pin *pin; |
| 61 | struct hdac_hdmi_cvt *cvt; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 62 | }; |
| 63 | |
| 64 | struct hdac_hdmi_priv { |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 65 | struct hdac_hdmi_dai_pin_map dai_map[3]; |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 66 | struct list_head pin_list; |
| 67 | struct list_head cvt_list; |
| 68 | int num_pin; |
| 69 | int num_cvt; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 70 | }; |
| 71 | |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 72 | static inline struct hdac_ext_device *to_hda_ext_device(struct device *dev) |
| 73 | { |
Geliang Tang | 51b2c42 | 2015-12-28 22:47:13 +0800 | [diff] [blame] | 74 | struct hdac_device *hdac = dev_to_hdac_dev(dev); |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 75 | |
Geliang Tang | 51b2c42 | 2015-12-28 22:47:13 +0800 | [diff] [blame] | 76 | return to_ehdac_device(hdac); |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 77 | } |
| 78 | |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 79 | static int hdac_hdmi_setup_stream(struct hdac_ext_device *hdac, |
| 80 | hda_nid_t cvt_nid, hda_nid_t pin_nid, |
| 81 | u32 stream_tag, int format) |
| 82 | { |
| 83 | unsigned int val; |
| 84 | |
| 85 | dev_dbg(&hdac->hdac.dev, "cvt nid %d pnid %d stream %d format 0x%x\n", |
| 86 | cvt_nid, pin_nid, stream_tag, format); |
| 87 | |
| 88 | val = (stream_tag << 4); |
| 89 | |
| 90 | snd_hdac_codec_write(&hdac->hdac, cvt_nid, 0, |
| 91 | AC_VERB_SET_CHANNEL_STREAMID, val); |
| 92 | snd_hdac_codec_write(&hdac->hdac, cvt_nid, 0, |
| 93 | AC_VERB_SET_STREAM_FORMAT, format); |
| 94 | |
| 95 | return 0; |
| 96 | } |
| 97 | |
Subhransu S. Prusty | a657f1d | 2015-11-10 18:42:09 +0530 | [diff] [blame] | 98 | static void |
| 99 | hdac_hdmi_set_dip_index(struct hdac_ext_device *hdac, hda_nid_t pin_nid, |
| 100 | int packet_index, int byte_index) |
| 101 | { |
| 102 | int val; |
| 103 | |
| 104 | val = (packet_index << 5) | (byte_index & 0x1f); |
| 105 | |
| 106 | snd_hdac_codec_write(&hdac->hdac, pin_nid, 0, |
| 107 | AC_VERB_SET_HDMI_DIP_INDEX, val); |
| 108 | } |
| 109 | |
| 110 | static int hdac_hdmi_setup_audio_infoframe(struct hdac_ext_device *hdac, |
| 111 | hda_nid_t cvt_nid, hda_nid_t pin_nid) |
| 112 | { |
| 113 | uint8_t buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AUDIO_INFOFRAME_SIZE]; |
| 114 | struct hdmi_audio_infoframe frame; |
| 115 | u8 *dip = (u8 *)&frame; |
| 116 | int ret; |
| 117 | int i; |
| 118 | |
| 119 | hdmi_audio_infoframe_init(&frame); |
| 120 | |
| 121 | /* Default stereo for now */ |
| 122 | frame.channels = 2; |
| 123 | |
| 124 | /* setup channel count */ |
| 125 | snd_hdac_codec_write(&hdac->hdac, cvt_nid, 0, |
| 126 | AC_VERB_SET_CVT_CHAN_COUNT, frame.channels - 1); |
| 127 | |
| 128 | ret = hdmi_audio_infoframe_pack(&frame, buffer, sizeof(buffer)); |
| 129 | if (ret < 0) |
| 130 | return ret; |
| 131 | |
| 132 | /* stop infoframe transmission */ |
| 133 | hdac_hdmi_set_dip_index(hdac, pin_nid, 0x0, 0x0); |
| 134 | snd_hdac_codec_write(&hdac->hdac, pin_nid, 0, |
| 135 | AC_VERB_SET_HDMI_DIP_XMIT, AC_DIPXMIT_DISABLE); |
| 136 | |
| 137 | |
| 138 | /* Fill infoframe. Index auto-incremented */ |
| 139 | hdac_hdmi_set_dip_index(hdac, pin_nid, 0x0, 0x0); |
| 140 | for (i = 0; i < sizeof(frame); i++) |
| 141 | snd_hdac_codec_write(&hdac->hdac, pin_nid, 0, |
| 142 | AC_VERB_SET_HDMI_DIP_DATA, dip[i]); |
| 143 | |
| 144 | /* Start infoframe */ |
| 145 | hdac_hdmi_set_dip_index(hdac, pin_nid, 0x0, 0x0); |
| 146 | snd_hdac_codec_write(&hdac->hdac, pin_nid, 0, |
| 147 | AC_VERB_SET_HDMI_DIP_XMIT, AC_DIPXMIT_BEST); |
| 148 | |
| 149 | return 0; |
| 150 | } |
| 151 | |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 152 | static void hdac_hdmi_set_power_state(struct hdac_ext_device *edev, |
| 153 | struct hdac_hdmi_dai_pin_map *dai_map, unsigned int pwr_state) |
| 154 | { |
| 155 | /* Power up pin widget */ |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 156 | if (!snd_hdac_check_power_state(&edev->hdac, dai_map->pin->nid, |
| 157 | pwr_state)) |
| 158 | snd_hdac_codec_write(&edev->hdac, dai_map->pin->nid, 0, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 159 | AC_VERB_SET_POWER_STATE, pwr_state); |
| 160 | |
| 161 | /* Power up converter */ |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 162 | if (!snd_hdac_check_power_state(&edev->hdac, dai_map->cvt->nid, |
| 163 | pwr_state)) |
| 164 | snd_hdac_codec_write(&edev->hdac, dai_map->cvt->nid, 0, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 165 | AC_VERB_SET_POWER_STATE, pwr_state); |
| 166 | } |
| 167 | |
| 168 | static int hdac_hdmi_playback_prepare(struct snd_pcm_substream *substream, |
| 169 | struct snd_soc_dai *dai) |
| 170 | { |
| 171 | struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai); |
| 172 | struct hdac_hdmi_priv *hdmi = hdac->private_data; |
| 173 | struct hdac_hdmi_dai_pin_map *dai_map; |
| 174 | struct hdac_ext_dma_params *dd; |
Subhransu S. Prusty | a657f1d | 2015-11-10 18:42:09 +0530 | [diff] [blame] | 175 | int ret; |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 176 | |
| 177 | if (dai->id > 0) { |
| 178 | dev_err(&hdac->hdac.dev, "Only one dai supported as of now\n"); |
| 179 | return -ENODEV; |
| 180 | } |
| 181 | |
| 182 | dai_map = &hdmi->dai_map[dai->id]; |
| 183 | |
| 184 | dd = (struct hdac_ext_dma_params *)snd_soc_dai_get_dma_data(dai, substream); |
| 185 | dev_dbg(&hdac->hdac.dev, "stream tag from cpu dai %d format in cvt 0x%x\n", |
| 186 | dd->stream_tag, dd->format); |
| 187 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 188 | ret = hdac_hdmi_setup_audio_infoframe(hdac, dai_map->cvt->nid, |
| 189 | dai_map->pin->nid); |
Subhransu S. Prusty | a657f1d | 2015-11-10 18:42:09 +0530 | [diff] [blame] | 190 | if (ret < 0) |
| 191 | return ret; |
| 192 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 193 | return hdac_hdmi_setup_stream(hdac, dai_map->cvt->nid, |
| 194 | dai_map->pin->nid, dd->stream_tag, dd->format); |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 195 | } |
| 196 | |
| 197 | static int hdac_hdmi_set_hw_params(struct snd_pcm_substream *substream, |
| 198 | struct snd_pcm_hw_params *hparams, struct snd_soc_dai *dai) |
| 199 | { |
| 200 | struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai); |
| 201 | struct hdac_ext_dma_params *dd; |
| 202 | |
| 203 | if (dai->id > 0) { |
| 204 | dev_err(&hdac->hdac.dev, "Only one dai supported as of now\n"); |
| 205 | return -ENODEV; |
| 206 | } |
| 207 | |
| 208 | dd = kzalloc(sizeof(*dd), GFP_KERNEL); |
Sudip Mukherjee | 8d33ab2 | 2015-11-23 17:45:13 +0530 | [diff] [blame] | 209 | if (!dd) |
| 210 | return -ENOMEM; |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 211 | dd->format = snd_hdac_calc_stream_format(params_rate(hparams), |
| 212 | params_channels(hparams), params_format(hparams), |
| 213 | 24, 0); |
| 214 | |
| 215 | snd_soc_dai_set_dma_data(dai, substream, (void *)dd); |
| 216 | |
| 217 | return 0; |
| 218 | } |
| 219 | |
| 220 | static int hdac_hdmi_playback_cleanup(struct snd_pcm_substream *substream, |
| 221 | struct snd_soc_dai *dai) |
| 222 | { |
| 223 | struct hdac_ext_device *edev = snd_soc_dai_get_drvdata(dai); |
| 224 | struct hdac_ext_dma_params *dd; |
| 225 | struct hdac_hdmi_priv *hdmi = edev->private_data; |
| 226 | struct hdac_hdmi_dai_pin_map *dai_map; |
| 227 | |
| 228 | dai_map = &hdmi->dai_map[dai->id]; |
| 229 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 230 | snd_hdac_codec_write(&edev->hdac, dai_map->cvt->nid, 0, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 231 | AC_VERB_SET_CHANNEL_STREAMID, 0); |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 232 | snd_hdac_codec_write(&edev->hdac, dai_map->cvt->nid, 0, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 233 | AC_VERB_SET_STREAM_FORMAT, 0); |
| 234 | |
| 235 | dd = (struct hdac_ext_dma_params *)snd_soc_dai_get_dma_data(dai, substream); |
| 236 | snd_soc_dai_set_dma_data(dai, substream, NULL); |
| 237 | |
| 238 | kfree(dd); |
| 239 | |
| 240 | return 0; |
| 241 | } |
| 242 | |
| 243 | static int hdac_hdmi_pcm_open(struct snd_pcm_substream *substream, |
| 244 | struct snd_soc_dai *dai) |
| 245 | { |
| 246 | struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai); |
| 247 | struct hdac_hdmi_priv *hdmi = hdac->private_data; |
| 248 | struct hdac_hdmi_dai_pin_map *dai_map; |
| 249 | int val; |
| 250 | |
| 251 | if (dai->id > 0) { |
| 252 | dev_err(&hdac->hdac.dev, "Only one dai supported as of now\n"); |
| 253 | return -ENODEV; |
| 254 | } |
| 255 | |
| 256 | dai_map = &hdmi->dai_map[dai->id]; |
| 257 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 258 | val = snd_hdac_codec_read(&hdac->hdac, dai_map->pin->nid, 0, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 259 | AC_VERB_GET_PIN_SENSE, 0); |
| 260 | dev_info(&hdac->hdac.dev, "Val for AC_VERB_GET_PIN_SENSE: %x\n", val); |
| 261 | |
| 262 | if ((!(val & AC_PINSENSE_PRESENCE)) || (!(val & AC_PINSENSE_ELDV))) { |
| 263 | dev_err(&hdac->hdac.dev, "Monitor presence invalid with val: %x\n", val); |
| 264 | return -ENODEV; |
| 265 | } |
| 266 | |
| 267 | hdac_hdmi_set_power_state(hdac, dai_map, AC_PWRST_D0); |
| 268 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 269 | snd_hdac_codec_write(&hdac->hdac, dai_map->pin->nid, 0, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 270 | AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_UNMUTE); |
| 271 | |
| 272 | snd_pcm_hw_constraint_step(substream->runtime, 0, |
| 273 | SNDRV_PCM_HW_PARAM_CHANNELS, 2); |
| 274 | |
| 275 | return 0; |
| 276 | } |
| 277 | |
| 278 | static void hdac_hdmi_pcm_close(struct snd_pcm_substream *substream, |
| 279 | struct snd_soc_dai *dai) |
| 280 | { |
| 281 | struct hdac_ext_device *hdac = snd_soc_dai_get_drvdata(dai); |
| 282 | struct hdac_hdmi_priv *hdmi = hdac->private_data; |
| 283 | struct hdac_hdmi_dai_pin_map *dai_map; |
| 284 | |
| 285 | dai_map = &hdmi->dai_map[dai->id]; |
| 286 | |
| 287 | hdac_hdmi_set_power_state(hdac, dai_map, AC_PWRST_D3); |
| 288 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 289 | snd_hdac_codec_write(&hdac->hdac, dai_map->pin->nid, 0, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 290 | AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_MUTE); |
| 291 | } |
| 292 | |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 293 | static int |
| 294 | hdac_hdmi_query_cvt_params(struct hdac_device *hdac, struct hdac_hdmi_cvt *cvt) |
| 295 | { |
| 296 | int err; |
| 297 | |
| 298 | /* Only stereo supported as of now */ |
| 299 | cvt->params.channels_min = cvt->params.channels_max = 2; |
| 300 | |
| 301 | err = snd_hdac_query_supported_pcm(hdac, cvt->nid, |
| 302 | &cvt->params.rates, |
| 303 | &cvt->params.formats, |
| 304 | &cvt->params.maxbps); |
| 305 | if (err < 0) |
| 306 | dev_err(&hdac->dev, |
| 307 | "Failed to query pcm params for nid %d: %d\n", |
| 308 | cvt->nid, err); |
| 309 | |
| 310 | return err; |
| 311 | } |
| 312 | |
| 313 | static int hdac_hdmi_query_pin_connlist(struct hdac_ext_device *hdac, |
| 314 | struct hdac_hdmi_pin *pin) |
| 315 | { |
| 316 | if (!(get_wcaps(&hdac->hdac, pin->nid) & AC_WCAP_CONN_LIST)) { |
| 317 | dev_warn(&hdac->hdac.dev, |
| 318 | "HDMI: pin %d wcaps %#x does not support connection list\n", |
| 319 | pin->nid, get_wcaps(&hdac->hdac, pin->nid)); |
| 320 | return -EINVAL; |
| 321 | } |
| 322 | |
| 323 | pin->num_mux_nids = snd_hdac_get_connections(&hdac->hdac, pin->nid, |
| 324 | pin->mux_nids, HDA_MAX_CONNECTIONS); |
Subhransu S. Prusty | 5307246 | 2015-12-09 21:46:09 +0530 | [diff] [blame] | 325 | if (pin->num_mux_nids == 0) |
| 326 | dev_warn(&hdac->hdac.dev, "No connections found for pin: %d\n", |
| 327 | pin->nid); |
| 328 | |
| 329 | dev_dbg(&hdac->hdac.dev, "num_mux_nids %d for pin: %d\n", |
| 330 | pin->num_mux_nids, pin->nid); |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 331 | |
| 332 | return pin->num_mux_nids; |
| 333 | } |
| 334 | |
| 335 | static void hdac_hdmi_fill_widget_info(struct snd_soc_dapm_widget *w, |
| 336 | enum snd_soc_dapm_type id, |
| 337 | const char *wname, const char *stream) |
| 338 | { |
| 339 | w->id = id; |
| 340 | w->name = wname; |
| 341 | w->sname = stream; |
| 342 | w->reg = SND_SOC_NOPM; |
| 343 | w->shift = 0; |
| 344 | w->kcontrol_news = NULL; |
| 345 | w->num_kcontrols = 0; |
| 346 | w->priv = NULL; |
| 347 | } |
| 348 | |
| 349 | static void hdac_hdmi_fill_route(struct snd_soc_dapm_route *route, |
| 350 | const char *sink, const char *control, const char *src) |
| 351 | { |
| 352 | route->sink = sink; |
| 353 | route->source = src; |
| 354 | route->control = control; |
| 355 | route->connected = NULL; |
| 356 | } |
| 357 | |
| 358 | static void create_fill_widget_route_map(struct snd_soc_dapm_context *dapm, |
| 359 | struct hdac_hdmi_dai_pin_map *dai_map) |
| 360 | { |
| 361 | struct snd_soc_dapm_route route[1]; |
| 362 | struct snd_soc_dapm_widget widgets[2] = { {0} }; |
| 363 | |
| 364 | memset(&route, 0, sizeof(route)); |
| 365 | |
| 366 | hdac_hdmi_fill_widget_info(&widgets[0], snd_soc_dapm_output, |
| 367 | "hif1 Output", NULL); |
| 368 | hdac_hdmi_fill_widget_info(&widgets[1], snd_soc_dapm_aif_in, |
| 369 | "Coverter 1", "hif1"); |
| 370 | |
| 371 | hdac_hdmi_fill_route(&route[0], "hif1 Output", NULL, "Coverter 1"); |
| 372 | |
| 373 | snd_soc_dapm_new_controls(dapm, widgets, ARRAY_SIZE(widgets)); |
| 374 | snd_soc_dapm_add_routes(dapm, route, ARRAY_SIZE(route)); |
| 375 | } |
| 376 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 377 | static int hdac_hdmi_init_dai_map(struct hdac_ext_device *edev) |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 378 | { |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 379 | struct hdac_hdmi_priv *hdmi = edev->private_data; |
| 380 | struct hdac_hdmi_dai_pin_map *dai_map = &hdmi->dai_map[0]; |
| 381 | struct hdac_hdmi_cvt *cvt; |
| 382 | struct hdac_hdmi_pin *pin; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 383 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 384 | if (list_empty(&hdmi->cvt_list) || list_empty(&hdmi->pin_list)) |
| 385 | return -EINVAL; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 386 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 387 | /* |
| 388 | * Currently on board only 1 pin and 1 converter is enabled for |
| 389 | * simplification, more will be added eventually |
| 390 | * So using fixed map for dai_id:pin:cvt |
| 391 | */ |
| 392 | cvt = list_first_entry(&hdmi->cvt_list, struct hdac_hdmi_cvt, head); |
| 393 | pin = list_first_entry(&hdmi->pin_list, struct hdac_hdmi_pin, head); |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 394 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 395 | dai_map->dai_id = 0; |
| 396 | dai_map->pin = pin; |
| 397 | |
| 398 | dai_map->cvt = cvt; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 399 | |
| 400 | /* Enable out path for this pin widget */ |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 401 | snd_hdac_codec_write(&edev->hdac, pin->nid, 0, |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 402 | AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT); |
| 403 | |
| 404 | /* Enable transmission */ |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 405 | snd_hdac_codec_write(&edev->hdac, cvt->nid, 0, |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 406 | AC_VERB_SET_DIGI_CONVERT_1, 1); |
| 407 | |
| 408 | /* Category Code (CC) to zero */ |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 409 | snd_hdac_codec_write(&edev->hdac, cvt->nid, 0, |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 410 | AC_VERB_SET_DIGI_CONVERT_2, 0); |
| 411 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 412 | snd_hdac_codec_write(&edev->hdac, pin->nid, 0, |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 413 | AC_VERB_SET_CONNECT_SEL, 0); |
| 414 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 415 | return 0; |
| 416 | } |
| 417 | |
| 418 | static int hdac_hdmi_add_cvt(struct hdac_ext_device *edev, hda_nid_t nid) |
| 419 | { |
| 420 | struct hdac_hdmi_priv *hdmi = edev->private_data; |
| 421 | struct hdac_hdmi_cvt *cvt; |
| 422 | |
| 423 | cvt = kzalloc(sizeof(*cvt), GFP_KERNEL); |
| 424 | if (!cvt) |
| 425 | return -ENOMEM; |
| 426 | |
| 427 | cvt->nid = nid; |
| 428 | |
| 429 | list_add_tail(&cvt->head, &hdmi->cvt_list); |
| 430 | hdmi->num_cvt++; |
| 431 | |
| 432 | return hdac_hdmi_query_cvt_params(&edev->hdac, cvt); |
| 433 | } |
| 434 | |
| 435 | static int hdac_hdmi_add_pin(struct hdac_ext_device *edev, hda_nid_t nid) |
| 436 | { |
| 437 | struct hdac_hdmi_priv *hdmi = edev->private_data; |
| 438 | struct hdac_hdmi_pin *pin; |
| 439 | |
| 440 | pin = kzalloc(sizeof(*pin), GFP_KERNEL); |
| 441 | if (!pin) |
| 442 | return -ENOMEM; |
| 443 | |
| 444 | pin->nid = nid; |
| 445 | |
| 446 | list_add_tail(&pin->head, &hdmi->pin_list); |
| 447 | hdmi->num_pin++; |
| 448 | |
| 449 | return 0; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 450 | } |
| 451 | |
| 452 | /* |
| 453 | * Parse all nodes and store the cvt/pin nids in array |
| 454 | * Add one time initialization for pin and cvt widgets |
| 455 | */ |
| 456 | static int hdac_hdmi_parse_and_map_nid(struct hdac_ext_device *edev) |
| 457 | { |
| 458 | hda_nid_t nid; |
Sudip Mukherjee | 3c83ac2 | 2015-12-01 14:29:35 +0530 | [diff] [blame] | 459 | int i, num_nodes; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 460 | struct hdac_device *hdac = &edev->hdac; |
| 461 | struct hdac_hdmi_priv *hdmi = edev->private_data; |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 462 | int ret; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 463 | |
Sudip Mukherjee | 3c83ac2 | 2015-12-01 14:29:35 +0530 | [diff] [blame] | 464 | num_nodes = snd_hdac_get_sub_nodes(hdac, hdac->afg, &nid); |
Subhransu S. Prusty | 541140d | 2015-12-09 21:46:08 +0530 | [diff] [blame] | 465 | if (!nid || num_nodes <= 0) { |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 466 | dev_warn(&hdac->dev, "HDMI: failed to get afg sub nodes\n"); |
| 467 | return -EINVAL; |
| 468 | } |
| 469 | |
Sudip Mukherjee | 3c83ac2 | 2015-12-01 14:29:35 +0530 | [diff] [blame] | 470 | hdac->num_nodes = num_nodes; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 471 | hdac->start_nid = nid; |
| 472 | |
| 473 | for (i = 0; i < hdac->num_nodes; i++, nid++) { |
| 474 | unsigned int caps; |
| 475 | unsigned int type; |
| 476 | |
| 477 | caps = get_wcaps(hdac, nid); |
| 478 | type = get_wcaps_type(caps); |
| 479 | |
| 480 | if (!(caps & AC_WCAP_DIGITAL)) |
| 481 | continue; |
| 482 | |
| 483 | switch (type) { |
| 484 | |
| 485 | case AC_WID_AUD_OUT: |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 486 | ret = hdac_hdmi_add_cvt(edev, nid); |
| 487 | if (ret < 0) |
| 488 | return ret; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 489 | break; |
| 490 | |
| 491 | case AC_WID_PIN: |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 492 | ret = hdac_hdmi_add_pin(edev, nid); |
| 493 | if (ret < 0) |
| 494 | return ret; |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 495 | break; |
| 496 | } |
| 497 | } |
| 498 | |
| 499 | hdac->end_nid = nid; |
| 500 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 501 | if (!hdmi->num_pin || !hdmi->num_cvt) |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 502 | return -EIO; |
| 503 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 504 | return hdac_hdmi_init_dai_map(edev); |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 505 | } |
| 506 | |
| 507 | static int hdmi_codec_probe(struct snd_soc_codec *codec) |
| 508 | { |
| 509 | struct hdac_ext_device *edev = snd_soc_codec_get_drvdata(codec); |
| 510 | struct hdac_hdmi_priv *hdmi = edev->private_data; |
| 511 | struct snd_soc_dapm_context *dapm = |
| 512 | snd_soc_component_get_dapm(&codec->component); |
| 513 | |
| 514 | edev->scodec = codec; |
| 515 | |
| 516 | create_fill_widget_route_map(dapm, &hdmi->dai_map[0]); |
| 517 | |
| 518 | /* Imp: Store the card pointer in hda_codec */ |
| 519 | edev->card = dapm->card->snd_card; |
| 520 | |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 521 | /* |
| 522 | * hdac_device core already sets the state to active and calls |
| 523 | * get_noresume. So enable runtime and set the device to suspend. |
| 524 | */ |
| 525 | pm_runtime_enable(&edev->hdac.dev); |
| 526 | pm_runtime_put(&edev->hdac.dev); |
| 527 | pm_runtime_suspend(&edev->hdac.dev); |
| 528 | |
| 529 | return 0; |
| 530 | } |
| 531 | |
| 532 | static int hdmi_codec_remove(struct snd_soc_codec *codec) |
| 533 | { |
| 534 | struct hdac_ext_device *edev = snd_soc_codec_get_drvdata(codec); |
| 535 | |
| 536 | pm_runtime_disable(&edev->hdac.dev); |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 537 | return 0; |
| 538 | } |
| 539 | |
| 540 | static struct snd_soc_codec_driver hdmi_hda_codec = { |
| 541 | .probe = hdmi_codec_probe, |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 542 | .remove = hdmi_codec_remove, |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 543 | .idle_bias_off = true, |
| 544 | }; |
| 545 | |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 546 | static struct snd_soc_dai_ops hdmi_dai_ops = { |
| 547 | .startup = hdac_hdmi_pcm_open, |
| 548 | .shutdown = hdac_hdmi_pcm_close, |
| 549 | .hw_params = hdac_hdmi_set_hw_params, |
| 550 | .prepare = hdac_hdmi_playback_prepare, |
| 551 | .hw_free = hdac_hdmi_playback_cleanup, |
| 552 | }; |
| 553 | |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 554 | static struct snd_soc_dai_driver hdmi_dais[] = { |
| 555 | { .name = "intel-hdmi-hif1", |
| 556 | .playback = { |
| 557 | .stream_name = "hif1", |
| 558 | .channels_min = 2, |
| 559 | .channels_max = 2, |
| 560 | .rates = SNDRV_PCM_RATE_32000 | |
| 561 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 | |
| 562 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | |
| 563 | SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_192000, |
| 564 | .formats = SNDRV_PCM_FMTBIT_S16_LE | |
| 565 | SNDRV_PCM_FMTBIT_S20_3LE | |
| 566 | SNDRV_PCM_FMTBIT_S24_LE | |
| 567 | SNDRV_PCM_FMTBIT_S32_LE, |
| 568 | |
| 569 | }, |
Subhransu S. Prusty | b0362ad | 2015-11-10 18:42:08 +0530 | [diff] [blame] | 570 | .ops = &hdmi_dai_ops, |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 571 | }, |
| 572 | }; |
| 573 | |
| 574 | static int hdac_hdmi_dev_probe(struct hdac_ext_device *edev) |
| 575 | { |
| 576 | struct hdac_device *codec = &edev->hdac; |
| 577 | struct hdac_hdmi_priv *hdmi_priv; |
| 578 | int ret = 0; |
| 579 | |
| 580 | hdmi_priv = devm_kzalloc(&codec->dev, sizeof(*hdmi_priv), GFP_KERNEL); |
| 581 | if (hdmi_priv == NULL) |
| 582 | return -ENOMEM; |
| 583 | |
| 584 | edev->private_data = hdmi_priv; |
| 585 | |
| 586 | dev_set_drvdata(&codec->dev, edev); |
| 587 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 588 | INIT_LIST_HEAD(&hdmi_priv->pin_list); |
| 589 | INIT_LIST_HEAD(&hdmi_priv->cvt_list); |
| 590 | |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 591 | ret = hdac_hdmi_parse_and_map_nid(edev); |
| 592 | if (ret < 0) |
| 593 | return ret; |
| 594 | |
| 595 | /* ASoC specific initialization */ |
| 596 | return snd_soc_register_codec(&codec->dev, &hdmi_hda_codec, |
| 597 | hdmi_dais, ARRAY_SIZE(hdmi_dais)); |
| 598 | } |
| 599 | |
| 600 | static int hdac_hdmi_dev_remove(struct hdac_ext_device *edev) |
| 601 | { |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 602 | struct hdac_hdmi_priv *hdmi = edev->private_data; |
| 603 | struct hdac_hdmi_pin *pin, *pin_next; |
| 604 | struct hdac_hdmi_cvt *cvt, *cvt_next; |
| 605 | |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 606 | snd_soc_unregister_codec(&edev->hdac.dev); |
| 607 | |
Subhransu S. Prusty | 15b9144 | 2015-12-09 21:46:10 +0530 | [diff] [blame^] | 608 | list_for_each_entry_safe(cvt, cvt_next, &hdmi->cvt_list, head) { |
| 609 | list_del(&cvt->head); |
| 610 | kfree(cvt); |
| 611 | } |
| 612 | |
| 613 | list_for_each_entry_safe(pin, pin_next, &hdmi->pin_list, head) { |
| 614 | list_del(&pin->head); |
| 615 | kfree(pin); |
| 616 | } |
| 617 | |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 618 | return 0; |
| 619 | } |
| 620 | |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 621 | #ifdef CONFIG_PM |
| 622 | static int hdac_hdmi_runtime_suspend(struct device *dev) |
| 623 | { |
| 624 | struct hdac_ext_device *edev = to_hda_ext_device(dev); |
| 625 | struct hdac_device *hdac = &edev->hdac; |
Subhransu S. Prusty | 07f083a | 2015-11-10 18:42:10 +0530 | [diff] [blame] | 626 | struct hdac_bus *bus = hdac->bus; |
| 627 | int err; |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 628 | |
| 629 | dev_dbg(dev, "Enter: %s\n", __func__); |
| 630 | |
Subhransu S. Prusty | 07f083a | 2015-11-10 18:42:10 +0530 | [diff] [blame] | 631 | /* controller may not have been initialized for the first time */ |
| 632 | if (!bus) |
| 633 | return 0; |
| 634 | |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 635 | /* Power down afg */ |
| 636 | if (!snd_hdac_check_power_state(hdac, hdac->afg, AC_PWRST_D3)) |
| 637 | snd_hdac_codec_write(hdac, hdac->afg, 0, |
| 638 | AC_VERB_SET_POWER_STATE, AC_PWRST_D3); |
| 639 | |
Subhransu S. Prusty | 07f083a | 2015-11-10 18:42:10 +0530 | [diff] [blame] | 640 | err = snd_hdac_display_power(bus, false); |
| 641 | if (err < 0) { |
| 642 | dev_err(bus->dev, "Cannot turn on display power on i915\n"); |
| 643 | return err; |
| 644 | } |
| 645 | |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 646 | return 0; |
| 647 | } |
| 648 | |
| 649 | static int hdac_hdmi_runtime_resume(struct device *dev) |
| 650 | { |
| 651 | struct hdac_ext_device *edev = to_hda_ext_device(dev); |
| 652 | struct hdac_device *hdac = &edev->hdac; |
Subhransu S. Prusty | 07f083a | 2015-11-10 18:42:10 +0530 | [diff] [blame] | 653 | struct hdac_bus *bus = hdac->bus; |
| 654 | int err; |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 655 | |
| 656 | dev_dbg(dev, "Enter: %s\n", __func__); |
| 657 | |
Subhransu S. Prusty | 07f083a | 2015-11-10 18:42:10 +0530 | [diff] [blame] | 658 | /* controller may not have been initialized for the first time */ |
| 659 | if (!bus) |
| 660 | return 0; |
| 661 | |
| 662 | err = snd_hdac_display_power(bus, true); |
| 663 | if (err < 0) { |
| 664 | dev_err(bus->dev, "Cannot turn on display power on i915\n"); |
| 665 | return err; |
| 666 | } |
| 667 | |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 668 | /* Power up afg */ |
| 669 | if (!snd_hdac_check_power_state(hdac, hdac->afg, AC_PWRST_D0)) |
| 670 | snd_hdac_codec_write(hdac, hdac->afg, 0, |
| 671 | AC_VERB_SET_POWER_STATE, AC_PWRST_D0); |
| 672 | |
| 673 | return 0; |
| 674 | } |
| 675 | #else |
| 676 | #define hdac_hdmi_runtime_suspend NULL |
| 677 | #define hdac_hdmi_runtime_resume NULL |
| 678 | #endif |
| 679 | |
| 680 | static const struct dev_pm_ops hdac_hdmi_pm = { |
| 681 | SET_RUNTIME_PM_OPS(hdac_hdmi_runtime_suspend, hdac_hdmi_runtime_resume, NULL) |
| 682 | }; |
| 683 | |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 684 | static const struct hda_device_id hdmi_list[] = { |
| 685 | HDA_CODEC_EXT_ENTRY(0x80862809, 0x100000, "Skylake HDMI", 0), |
| 686 | {} |
| 687 | }; |
| 688 | |
| 689 | MODULE_DEVICE_TABLE(hdaudio, hdmi_list); |
| 690 | |
| 691 | static struct hdac_ext_driver hdmi_driver = { |
| 692 | . hdac = { |
| 693 | .driver = { |
| 694 | .name = "HDMI HDA Codec", |
Subhransu S. Prusty | e342ac0 | 2015-11-10 18:42:07 +0530 | [diff] [blame] | 695 | .pm = &hdac_hdmi_pm, |
Subhransu S. Prusty | 18382ea | 2015-11-10 18:42:06 +0530 | [diff] [blame] | 696 | }, |
| 697 | .id_table = hdmi_list, |
| 698 | }, |
| 699 | .probe = hdac_hdmi_dev_probe, |
| 700 | .remove = hdac_hdmi_dev_remove, |
| 701 | }; |
| 702 | |
| 703 | static int __init hdmi_init(void) |
| 704 | { |
| 705 | return snd_hda_ext_driver_register(&hdmi_driver); |
| 706 | } |
| 707 | |
| 708 | static void __exit hdmi_exit(void) |
| 709 | { |
| 710 | snd_hda_ext_driver_unregister(&hdmi_driver); |
| 711 | } |
| 712 | |
| 713 | module_init(hdmi_init); |
| 714 | module_exit(hdmi_exit); |
| 715 | |
| 716 | MODULE_LICENSE("GPL v2"); |
| 717 | MODULE_DESCRIPTION("HDMI HD codec"); |
| 718 | MODULE_AUTHOR("Samreen Nilofer<samreen.nilofer@intel.com>"); |
| 719 | MODULE_AUTHOR("Subhransu S. Prusty<subhransu.s.prusty@intel.com>"); |