1// SPDX-License-Identifier: GPL-2.0
2// Copyright (c) 2018-2023, Linaro Limited.
3// Copyright (c) 2018, The Linux Foundation. All rights reserved.
4
5#include <dt-bindings/sound/qcom,lpass.h>
6#include <dt-bindings/sound/qcom,q6afe.h>
7#include <linux/module.h>
8#include <sound/soc.h>
9#include "sdw.h"
10
11static bool qcom_snd_is_sdw_dai(int id)
12{
13 switch (id) {
14 case WSA_CODEC_DMA_RX_0:
15 case WSA_CODEC_DMA_TX_0:
16 case WSA_CODEC_DMA_RX_1:
17 case WSA_CODEC_DMA_TX_1:
18 case WSA_CODEC_DMA_TX_2:
19 case RX_CODEC_DMA_RX_0:
20 case TX_CODEC_DMA_TX_0:
21 case RX_CODEC_DMA_RX_1:
22 case TX_CODEC_DMA_TX_1:
23 case RX_CODEC_DMA_RX_2:
24 case TX_CODEC_DMA_TX_2:
25 case RX_CODEC_DMA_RX_3:
26 case TX_CODEC_DMA_TX_3:
27 case RX_CODEC_DMA_RX_4:
28 case TX_CODEC_DMA_TX_4:
29 case RX_CODEC_DMA_RX_5:
30 case TX_CODEC_DMA_TX_5:
31 case RX_CODEC_DMA_RX_6:
32 case RX_CODEC_DMA_RX_7:
33 case SLIMBUS_0_RX...SLIMBUS_6_TX:
34 return true;
35 default:
36 break;
37 }
38
39 /* DSP Bypass usecase, cpu dai index overlaps with DSP dai ids,
40 * DO NOT MERGE into top switch case */
41 switch (id) {
42 case LPASS_CDC_DMA_TX3:
43 case LPASS_CDC_DMA_RX0:
44 return true;
45 default:
46 break;
47 }
48
49 return false;
50}
51
52/**
53 * qcom_snd_sdw_startup() - Helper to start Soundwire stream for SoC audio card
54 * @substream: The PCM substream from audio, as passed to snd_soc_ops->startup()
55 *
56 * Helper for the SoC audio card (snd_soc_ops->startup()) to allocate and set
57 * Soundwire stream runtime to each codec DAI.
58 *
59 * The shutdown() callback should call sdw_release_stream() on the same
60 * sdw_stream_runtime.
61 *
62 * Return: 0 or errno
63 */
64int qcom_snd_sdw_startup(struct snd_pcm_substream *substream)
65{
66 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
67 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
68 u32 rx_ch[SDW_MAX_PORTS], tx_ch[SDW_MAX_PORTS];
69 struct sdw_stream_runtime *sruntime;
70 struct snd_soc_dai *codec_dai;
71 u32 rx_ch_cnt = 0, tx_ch_cnt = 0;
72 int ret, i, j;
73
74 if (!qcom_snd_is_sdw_dai(id: cpu_dai->id))
75 return 0;
76
77 sruntime = sdw_alloc_stream(stream_name: cpu_dai->name, type: SDW_STREAM_PCM);
78 if (!sruntime)
79 return -ENOMEM;
80
81 for_each_rtd_codec_dais(rtd, i, codec_dai) {
82 ret = snd_soc_dai_set_stream(dai: codec_dai, stream: sruntime,
83 direction: substream->stream);
84 if (ret < 0 && ret != -ENOTSUPP) {
85 dev_err(rtd->dev, "Failed to set sdw stream on %s\n", codec_dai->name);
86 goto err_set_stream;
87 } else if (ret == -ENOTSUPP) {
88 /* Ignore unsupported */
89 continue;
90 }
91
92 ret = snd_soc_dai_get_channel_map(dai: codec_dai, tx_num: &tx_ch_cnt, tx_slot: tx_ch,
93 rx_num: &rx_ch_cnt, rx_slot: rx_ch);
94 if (ret != 0 && ret != -ENOTSUPP) {
95 dev_err(rtd->dev, "Failed to get codec chan map %s\n", codec_dai->name);
96 goto err_set_stream;
97 } else if (ret == -ENOTSUPP) {
98 /* Ignore unsupported */
99 continue;
100 }
101 }
102
103 switch (cpu_dai->id) {
104 case RX_CODEC_DMA_RX_0:
105 case TX_CODEC_DMA_TX_3:
106 if (tx_ch_cnt || rx_ch_cnt) {
107 for_each_rtd_codec_dais(rtd, j, codec_dai) {
108 ret = snd_soc_dai_set_channel_map(dai: codec_dai,
109 tx_num: tx_ch_cnt, tx_slot: tx_ch,
110 rx_num: rx_ch_cnt, rx_slot: rx_ch);
111 if (ret != 0 && ret != -ENOTSUPP)
112 goto err_set_stream;
113 }
114 }
115 }
116
117 return 0;
118
119err_set_stream:
120 sdw_release_stream(stream: sruntime);
121
122 return ret;
123}
124EXPORT_SYMBOL_GPL(qcom_snd_sdw_startup);
125
126int qcom_snd_sdw_prepare(struct snd_pcm_substream *substream,
127 bool *stream_prepared)
128{
129 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
130 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
131 struct sdw_stream_runtime *sruntime;
132 int ret;
133
134
135 if (!qcom_snd_is_sdw_dai(id: cpu_dai->id))
136 return 0;
137
138 sruntime = qcom_snd_sdw_get_stream(stream: substream);
139 if (!sruntime)
140 return 0;
141
142 if (*stream_prepared)
143 return 0;
144
145 ret = sdw_prepare_stream(stream: sruntime);
146 if (ret)
147 return ret;
148
149 /**
150 * NOTE: there is a strict hw requirement about the ordering of port
151 * enables and actual WSA881x PA enable. PA enable should only happen
152 * after soundwire ports are enabled if not DC on the line is
153 * accumulated resulting in Click/Pop Noise
154 * PA enable/mute are handled as part of codec DAPM and digital mute.
155 */
156
157 ret = sdw_enable_stream(stream: sruntime);
158 if (ret) {
159 sdw_deprepare_stream(stream: sruntime);
160 return ret;
161 }
162 *stream_prepared = true;
163
164 return ret;
165}
166EXPORT_SYMBOL_GPL(qcom_snd_sdw_prepare);
167
168struct sdw_stream_runtime *qcom_snd_sdw_get_stream(struct snd_pcm_substream *substream)
169{
170 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
171 struct snd_soc_dai *codec_dai;
172 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
173 struct sdw_stream_runtime *sruntime;
174 int i;
175
176 if (!qcom_snd_is_sdw_dai(id: cpu_dai->id))
177 return NULL;
178
179 for_each_rtd_codec_dais(rtd, i, codec_dai) {
180 sruntime = snd_soc_dai_get_stream(dai: codec_dai, direction: substream->stream);
181 if (sruntime != ERR_PTR(error: -ENOTSUPP))
182 return sruntime;
183 }
184 return NULL;
185}
186EXPORT_SYMBOL_GPL(qcom_snd_sdw_get_stream);
187
188void qcom_snd_sdw_shutdown(struct snd_pcm_substream *substream)
189{
190 struct sdw_stream_runtime *sruntime = qcom_snd_sdw_get_stream(substream);
191
192 sdw_release_stream(stream: sruntime);
193}
194EXPORT_SYMBOL_GPL(qcom_snd_sdw_shutdown);
195
196int qcom_snd_sdw_hw_free(struct snd_pcm_substream *substream, bool *stream_prepared)
197{
198 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
199 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
200 struct sdw_stream_runtime *sruntime;
201
202 if (!qcom_snd_is_sdw_dai(id: cpu_dai->id))
203 return 0;
204
205 sruntime = qcom_snd_sdw_get_stream(substream);
206 if (sruntime && *stream_prepared) {
207 sdw_disable_stream(stream: sruntime);
208 sdw_deprepare_stream(stream: sruntime);
209 *stream_prepared = false;
210 }
211
212 return 0;
213}
214EXPORT_SYMBOL_GPL(qcom_snd_sdw_hw_free);
215MODULE_DESCRIPTION("Qualcomm ASoC SoundWire helper functions");
216MODULE_LICENSE("GPL");
217

source code of linux/sound/soc/qcom/sdw.c