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;
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 	snd_soc_dai_dma_data_set_playback(dai, data);
43 }
44 
45 struct meson_codec_glue_input *
46 meson_codec_glue_input_get_data(struct snd_soc_dai *dai)
47 {
48 	return snd_soc_dai_dma_data_get_playback(dai);
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 snd_soc_dapm_widget *w = snd_soc_dai_get_widget_capture(dai);
103 	struct meson_codec_glue_input *in_data = meson_codec_glue_output_get_input_data(w);
104 
105 	if (!in_data)
106 		return -ENODEV;
107 
108 	if (WARN_ON(!rtd->dai_link->c2c_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->c2c_params = &in_data->params;
115 	rtd->dai_link->num_c2c_params = 1;
116 
117 	return snd_soc_runtime_set_dai_fmt(rtd, in_data->fmt);
118 }
119 EXPORT_SYMBOL_GPL(meson_codec_glue_output_startup);
120 
121 int meson_codec_glue_input_dai_probe(struct snd_soc_dai *dai)
122 {
123 	struct meson_codec_glue_input *data;
124 
125 	data = kzalloc(sizeof(*data), GFP_KERNEL);
126 	if (!data)
127 		return -ENOMEM;
128 
129 	meson_codec_glue_input_set_data(dai, data);
130 	return 0;
131 }
132 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_probe);
133 
134 int meson_codec_glue_input_dai_remove(struct snd_soc_dai *dai)
135 {
136 	struct meson_codec_glue_input *data =
137 		meson_codec_glue_input_get_data(dai);
138 
139 	kfree(data);
140 	return 0;
141 }
142 EXPORT_SYMBOL_GPL(meson_codec_glue_input_dai_remove);
143 
144 MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
145 MODULE_DESCRIPTION("Amlogic Codec Glue Helpers");
146 MODULE_LICENSE("GPL v2");
147 
148