1 // SPDX-License-Identifier: GPL-2.0 2 // 3 // Copyright (c) 2019 BayLibre, SAS. 4 // Author: Jerome Brunet <jbrunet@baylibre.com> 5 6 #include <linux/module.h> 7 #include <sound/pcm_params.h> 8 #include <sound/soc.h> 9 #include <sound/soc-dai.h> 10 11 #include "meson-codec-glue.h" 12 13 static struct snd_soc_dapm_widget * 14 meson_codec_glue_get_input(struct snd_soc_dapm_widget *w) 15 { 16 struct snd_soc_dapm_path *p = NULL; 17 struct snd_soc_dapm_widget *in; 18 19 snd_soc_dapm_widget_for_each_source_path(w, p) { 20 if (!p->connect) 21 continue; 22 23 /* Check that we still are in the same component */ 24 if (snd_soc_dapm_to_component(w->dapm) != 25 snd_soc_dapm_to_component(p->source->dapm)) 26 continue; 27 28 if (p->source->id == snd_soc_dapm_dai_in) 29 return p->source; 30 31 in = meson_codec_glue_get_input(p->source); 32 if (in) 33 return in; 34 } 35 36 return NULL; 37 } 38 39 static void meson_codec_glue_input_set_data(struct snd_soc_dai *dai, 40 struct meson_codec_glue_input *data) 41 { 42 dai->playback_dma_data = data; 43 } 44 45 struct meson_codec_glue_input * 46 meson_codec_glue_input_get_data(struct snd_soc_dai *dai) 47 { 48 return dai->playback_dma_data; 49 } 50 EXPORT_SYMBOL_GPL(meson_codec_glue_input_get_data); 51 52 static struct meson_codec_glue_input * 53 meson_codec_glue_output_get_input_data(struct snd_soc_dapm_widget *w) 54 { 55 struct snd_soc_dapm_widget *in = 56 meson_codec_glue_get_input(w); 57 struct snd_soc_dai *dai; 58 59 if (WARN_ON(!in)) 60 return NULL; 61 62 dai = in->priv; 63 64 return meson_codec_glue_input_get_data(dai); 65 } 66 67 int meson_codec_glue_input_hw_params(struct snd_pcm_substream *substream, 68 struct snd_pcm_hw_params *params, 69 struct snd_soc_dai *dai) 70 { 71 struct meson_codec_glue_input *data = 72 meson_codec_glue_input_get_data(dai); 73 74 data->params.rates = snd_pcm_rate_to_rate_bit(params_rate(params)); 75 data->params.rate_min = params_rate(params); 76 data->params.rate_max = params_rate(params); 77 data->params.formats = 1ULL << (__force int) params_format(params); 78 data->params.channels_min = params_channels(params); 79 data->params.channels_max = params_channels(params); 80 data->params.sig_bits = dai->driver->playback.sig_bits; 81 82 return 0; 83 } 84 EXPORT_SYMBOL_GPL(meson_codec_glue_input_hw_params); 85 86 int meson_codec_glue_input_set_fmt(struct snd_soc_dai *dai, 87 unsigned int fmt) 88 { 89 struct meson_codec_glue_input *data = 90 meson_codec_glue_input_get_data(dai); 91 92 /* Save the source stream format for the downstream link */ 93 data->fmt = fmt; 94 return 0; 95 } 96 EXPORT_SYMBOL_GPL(meson_codec_glue_input_set_fmt); 97 98 int meson_codec_glue_output_startup(struct snd_pcm_substream *substream, 99 struct snd_soc_dai *dai) 100 { 101 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 102 struct meson_codec_glue_input *in_data = 103 meson_codec_glue_output_get_input_data(dai->capture_widget); 104 105 if (!in_data) 106 return -ENODEV; 107 108 if (WARN_ON(!rtd->dai_link->params)) { 109 dev_warn(dai->dev, "codec2codec link expected\n"); 110 return -EINVAL; 111 } 112 113 /* Replace link params with the input params */ 114 rtd->dai_link->params = &in_data->params; 115 116 return snd_soc_runtime_set_dai_fmt(rtd, in_data->fmt); 117 } 118 EXPORT_SYMBOL_GPL(meson_codec_glue_output_startup); 119 120 int meson_codec_glue_input_dai_probe(struct snd_soc_dai *dai) 121 { 122 struct meson_codec_glue_input *data; 123 124 data = kzalloc(sizeof(*data), GFP_KERNEL); 125 if (!data) 126 return -ENOMEM; 127 128 meson_codec_glue_input_set_data(dai, data); 129 return 0; 130 } 131 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_probe); 132 133 int meson_codec_glue_input_dai_remove(struct snd_soc_dai *dai) 134 { 135 struct meson_codec_glue_input *data = 136 meson_codec_glue_input_get_data(dai); 137 138 kfree(data); 139 return 0; 140 } 141 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_remove); 142 143 MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>"); 144 MODULE_DESCRIPTION("Amlogic Codec Glue Helpers"); 145 MODULE_LICENSE("GPL v2"); 146 147