ASoC: qcom: Add checks for devm_kcalloc
[platform/kernel/linux-rpi.git] / sound / soc / qcom / lpass-sc7180.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (c) 2020, The Linux Foundation. All rights reserved.
4  *
5  * lpass-sc7180.c -- ALSA SoC platform-machine driver for QTi LPASS
6  */
7
8 #include <linux/clk.h>
9 #include <linux/device.h>
10 #include <linux/err.h>
11 #include <linux/kernel.h>
12 #include <linux/module.h>
13 #include <linux/of.h>
14 #include <linux/platform_device.h>
15 #include <dt-bindings/sound/sc7180-lpass.h>
16 #include <sound/pcm.h>
17 #include <sound/soc.h>
18
19 #include "lpass-lpaif-reg.h"
20 #include "lpass.h"
21
22 static struct snd_soc_dai_driver sc7180_lpass_cpu_dai_driver[] = {
23         {
24                 .id = MI2S_PRIMARY,
25                 .name = "Primary MI2S",
26                 .playback = {
27                         .stream_name = "Primary Playback",
28                         .formats        = SNDRV_PCM_FMTBIT_S16,
29                         .rates = SNDRV_PCM_RATE_48000,
30                         .rate_min       = 48000,
31                         .rate_max       = 48000,
32                         .channels_min   = 2,
33                         .channels_max   = 2,
34                 },
35                 .capture = {
36                         .stream_name = "Primary Capture",
37                         .formats = SNDRV_PCM_FMTBIT_S16 |
38                                 SNDRV_PCM_FMTBIT_S32,
39                         .rates = SNDRV_PCM_RATE_48000,
40                         .rate_min       = 48000,
41                         .rate_max       = 48000,
42                         .channels_min   = 2,
43                         .channels_max   = 2,
44                 },
45                 .probe  = &asoc_qcom_lpass_cpu_dai_probe,
46                 .ops    = &asoc_qcom_lpass_cpu_dai_ops,
47         }, {
48                 .id = MI2S_SECONDARY,
49                 .name = "Secondary MI2S",
50                 .playback = {
51                         .stream_name = "Secondary Playback",
52                         .formats        = SNDRV_PCM_FMTBIT_S16,
53                         .rates = SNDRV_PCM_RATE_48000,
54                         .rate_min       = 48000,
55                         .rate_max       = 48000,
56                         .channels_min   = 2,
57                         .channels_max   = 2,
58                 },
59                 .probe  = &asoc_qcom_lpass_cpu_dai_probe,
60                 .ops    = &asoc_qcom_lpass_cpu_dai_ops,
61                 .pcm_new = lpass_cpu_pcm_new,
62         }, {
63                 .id = LPASS_DP_RX,
64                 .name = "Hdmi",
65                 .playback = {
66                         .stream_name = "Hdmi Playback",
67                         .formats        = SNDRV_PCM_FMTBIT_S24,
68                         .rates = SNDRV_PCM_RATE_48000,
69                         .rate_min       = 48000,
70                         .rate_max       = 48000,
71                         .channels_min   = 2,
72                         .channels_max   = 2,
73                 },
74                 .ops    = &asoc_qcom_lpass_hdmi_dai_ops,
75         },
76 };
77
78 static int sc7180_lpass_alloc_dma_channel(struct lpass_data *drvdata,
79                                            int direction, unsigned int dai_id)
80 {
81         struct lpass_variant *v = drvdata->variant;
82         int chan = 0;
83
84         if (dai_id == LPASS_DP_RX) {
85                 if (direction == SNDRV_PCM_STREAM_PLAYBACK) {
86                         chan = find_first_zero_bit(&drvdata->hdmi_dma_ch_bit_map,
87                                                 v->hdmi_rdma_channels);
88
89                         if (chan >= v->hdmi_rdma_channels)
90                                 return -EBUSY;
91                 }
92                 set_bit(chan, &drvdata->hdmi_dma_ch_bit_map);
93         } else {
94                 if (direction == SNDRV_PCM_STREAM_PLAYBACK) {
95                         chan = find_first_zero_bit(&drvdata->dma_ch_bit_map,
96                                                 v->rdma_channels);
97
98                         if (chan >= v->rdma_channels)
99                                 return -EBUSY;
100                 } else {
101                         chan = find_next_zero_bit(&drvdata->dma_ch_bit_map,
102                                         v->wrdma_channel_start +
103                                         v->wrdma_channels,
104                                         v->wrdma_channel_start);
105
106                         if (chan >=  v->wrdma_channel_start + v->wrdma_channels)
107                                 return -EBUSY;
108                 }
109
110                 set_bit(chan, &drvdata->dma_ch_bit_map);
111         }
112         return chan;
113 }
114
115 static int sc7180_lpass_free_dma_channel(struct lpass_data *drvdata, int chan, unsigned int dai_id)
116 {
117         if (dai_id == LPASS_DP_RX)
118                 clear_bit(chan, &drvdata->hdmi_dma_ch_bit_map);
119         else
120                 clear_bit(chan, &drvdata->dma_ch_bit_map);
121
122         return 0;
123 }
124
125 static int sc7180_lpass_init(struct platform_device *pdev)
126 {
127         struct lpass_data *drvdata = platform_get_drvdata(pdev);
128         struct lpass_variant *variant = drvdata->variant;
129         struct device *dev = &pdev->dev;
130         int ret, i;
131
132         drvdata->clks = devm_kcalloc(dev, variant->num_clks,
133                                      sizeof(*drvdata->clks), GFP_KERNEL);
134         if (!drvdata->clks)
135                 return -ENOMEM;
136
137         drvdata->num_clks = variant->num_clks;
138
139         for (i = 0; i < drvdata->num_clks; i++)
140                 drvdata->clks[i].id = variant->clk_name[i];
141
142         ret = devm_clk_bulk_get(dev, drvdata->num_clks, drvdata->clks);
143         if (ret) {
144                 dev_err(dev, "Failed to get clocks %d\n", ret);
145                 return ret;
146         }
147
148         ret = clk_bulk_prepare_enable(drvdata->num_clks, drvdata->clks);
149         if (ret) {
150                 dev_err(dev, "sc7180 clk_enable failed\n");
151                 return ret;
152         }
153
154         return 0;
155 }
156
157 static int sc7180_lpass_exit(struct platform_device *pdev)
158 {
159         struct lpass_data *drvdata = platform_get_drvdata(pdev);
160
161         clk_bulk_disable_unprepare(drvdata->num_clks, drvdata->clks);
162
163         return 0;
164 }
165
166 static struct lpass_variant sc7180_data = {
167         .i2sctrl_reg_base       = 0x1000,
168         .i2sctrl_reg_stride     = 0x1000,
169         .i2s_ports              = 3,
170         .irq_reg_base           = 0x9000,
171         .irq_reg_stride         = 0x1000,
172         .irq_ports              = 3,
173         .rdma_reg_base          = 0xC000,
174         .rdma_reg_stride        = 0x1000,
175         .rdma_channels          = 5,
176         .hdmi_rdma_reg_base             = 0x64000,
177         .hdmi_rdma_reg_stride   = 0x1000,
178         .hdmi_rdma_channels             = 4,
179         .dmactl_audif_start     = 1,
180         .wrdma_reg_base         = 0x18000,
181         .wrdma_reg_stride       = 0x1000,
182         .wrdma_channel_start    = 5,
183         .wrdma_channels         = 4,
184
185         .loopback               = REG_FIELD_ID(0x1000, 17, 17, 3, 0x1000),
186         .spken                  = REG_FIELD_ID(0x1000, 16, 16, 3, 0x1000),
187         .spkmode                = REG_FIELD_ID(0x1000, 11, 15, 3, 0x1000),
188         .spkmono                = REG_FIELD_ID(0x1000, 10, 10, 3, 0x1000),
189         .micen                  = REG_FIELD_ID(0x1000, 9, 9, 3, 0x1000),
190         .micmode                = REG_FIELD_ID(0x1000, 4, 8, 3, 0x1000),
191         .micmono                = REG_FIELD_ID(0x1000, 3, 3, 3, 0x1000),
192         .wssrc                  = REG_FIELD_ID(0x1000, 2, 2, 3, 0x1000),
193         .bitwidth               = REG_FIELD_ID(0x1000, 0, 1, 3, 0x1000),
194
195         .rdma_dyncclk           = REG_FIELD_ID(0xC000, 21, 21, 5, 0x1000),
196         .rdma_bursten           = REG_FIELD_ID(0xC000, 20, 20, 5, 0x1000),
197         .rdma_wpscnt            = REG_FIELD_ID(0xC000, 16, 19, 5, 0x1000),
198         .rdma_intf                      = REG_FIELD_ID(0xC000, 12, 15, 5, 0x1000),
199         .rdma_fifowm            = REG_FIELD_ID(0xC000, 1, 5, 5, 0x1000),
200         .rdma_enable            = REG_FIELD_ID(0xC000, 0, 0, 5, 0x1000),
201
202         .wrdma_dyncclk          = REG_FIELD_ID(0x18000, 22, 22, 4, 0x1000),
203         .wrdma_bursten          = REG_FIELD_ID(0x18000, 21, 21, 4, 0x1000),
204         .wrdma_wpscnt           = REG_FIELD_ID(0x18000, 17, 20, 4, 0x1000),
205         .wrdma_intf             = REG_FIELD_ID(0x18000, 12, 16, 4, 0x1000),
206         .wrdma_fifowm           = REG_FIELD_ID(0x18000, 1, 5, 4, 0x1000),
207         .wrdma_enable           = REG_FIELD_ID(0x18000, 0, 0, 4, 0x1000),
208
209         .hdmi_tx_ctl_addr       = 0x1000,
210         .hdmi_legacy_addr       = 0x1008,
211         .hdmi_vbit_addr         = 0x610c0,
212         .hdmi_ch_lsb_addr       = 0x61048,
213         .hdmi_ch_msb_addr       = 0x6104c,
214         .ch_stride              = 0x8,
215         .hdmi_parity_addr       = 0x61034,
216         .hdmi_dmactl_addr       = 0x61038,
217         .hdmi_dma_stride        = 0x4,
218         .hdmi_DP_addr           = 0x610c8,
219         .hdmi_sstream_addr      = 0x6101c,
220         .hdmi_irq_reg_base              = 0x63000,
221         .hdmi_irq_ports         = 1,
222
223         .hdmi_rdma_dyncclk              = REG_FIELD_ID(0x64000, 14, 14, 4, 0x1000),
224         .hdmi_rdma_bursten              = REG_FIELD_ID(0x64000, 13, 13, 4, 0x1000),
225         .hdmi_rdma_burst8               = REG_FIELD_ID(0x64000, 15, 15, 4, 0x1000),
226         .hdmi_rdma_burst16              = REG_FIELD_ID(0x64000, 16, 16, 4, 0x1000),
227         .hdmi_rdma_dynburst             = REG_FIELD_ID(0x64000, 18, 18, 4, 0x1000),
228         .hdmi_rdma_wpscnt               = REG_FIELD_ID(0x64000, 10, 12, 4, 0x1000),
229         .hdmi_rdma_fifowm               = REG_FIELD_ID(0x64000, 1, 5, 4, 0x1000),
230         .hdmi_rdma_enable               = REG_FIELD_ID(0x64000, 0, 0, 4, 0x1000),
231
232         .sstream_en             = REG_FIELD(0x6101c, 0, 0),
233         .dma_sel                        = REG_FIELD(0x6101c, 1, 2),
234         .auto_bbit_en   = REG_FIELD(0x6101c, 3, 3),
235         .layout                 = REG_FIELD(0x6101c, 4, 4),
236         .layout_sp              = REG_FIELD(0x6101c, 5, 8),
237         .set_sp_on_en   = REG_FIELD(0x6101c, 10, 10),
238         .dp_audio               = REG_FIELD(0x6101c, 11, 11),
239         .dp_staffing_en = REG_FIELD(0x6101c, 12, 12),
240         .dp_sp_b_hw_en  = REG_FIELD(0x6101c, 13, 13),
241
242         .mute                   = REG_FIELD(0x610c8, 0, 0),
243         .as_sdp_cc              = REG_FIELD(0x610c8, 1, 3),
244         .as_sdp_ct              = REG_FIELD(0x610c8, 4, 7),
245         .aif_db4                        = REG_FIELD(0x610c8, 8, 15),
246         .frequency              = REG_FIELD(0x610c8, 16, 21),
247         .mst_index              = REG_FIELD(0x610c8, 28, 29),
248         .dptx_index             = REG_FIELD(0x610c8, 30, 31),
249
250         .soft_reset             = REG_FIELD(0x1000, 31, 31),
251         .force_reset    = REG_FIELD(0x1000, 30, 30),
252
253         .use_hw_chs             = REG_FIELD(0x61038, 0, 0),
254         .use_hw_usr             = REG_FIELD(0x61038, 1, 1),
255         .hw_chs_sel             = REG_FIELD(0x61038, 2, 4),
256         .hw_usr_sel             = REG_FIELD(0x61038, 5, 6),
257
258         .replace_vbit   = REG_FIELD(0x610c0, 0, 0),
259         .vbit_stream    = REG_FIELD(0x610c0, 1, 1),
260
261         .legacy_en              =  REG_FIELD(0x1008, 0, 0),
262         .calc_en                =  REG_FIELD(0x61034, 0, 0),
263         .lsb_bits               =  REG_FIELD(0x61048, 0, 31),
264         .msb_bits               =  REG_FIELD(0x6104c, 0, 31),
265
266
267         .clk_name               = (const char*[]) {
268                                    "pcnoc-sway-clk",
269                                    "audio-core",
270                                    "pcnoc-mport-clk",
271                                 },
272         .num_clks               = 3,
273         .dai_driver             = sc7180_lpass_cpu_dai_driver,
274         .num_dai                = ARRAY_SIZE(sc7180_lpass_cpu_dai_driver),
275         .dai_osr_clk_names      = (const char *[]) {
276                                    "mclk0",
277                                    "null",
278                                 },
279         .dai_bit_clk_names      = (const char *[]) {
280                                    "mi2s-bit-clk0",
281                                    "mi2s-bit-clk1",
282                                 },
283         .init                   = sc7180_lpass_init,
284         .exit                   = sc7180_lpass_exit,
285         .alloc_dma_channel      = sc7180_lpass_alloc_dma_channel,
286         .free_dma_channel       = sc7180_lpass_free_dma_channel,
287 };
288
289 static const struct of_device_id sc7180_lpass_cpu_device_id[] __maybe_unused = {
290         {.compatible = "qcom,sc7180-lpass-cpu", .data = &sc7180_data},
291         {}
292 };
293 MODULE_DEVICE_TABLE(of, sc7180_lpass_cpu_device_id);
294
295 static struct platform_driver sc7180_lpass_cpu_platform_driver = {
296         .driver = {
297                 .name = "sc7180-lpass-cpu",
298                 .of_match_table = of_match_ptr(sc7180_lpass_cpu_device_id),
299         },
300         .probe = asoc_qcom_lpass_cpu_platform_probe,
301         .remove = asoc_qcom_lpass_cpu_platform_remove,
302         .shutdown = asoc_qcom_lpass_cpu_platform_shutdown,
303 };
304
305 module_platform_driver(sc7180_lpass_cpu_platform_driver);
306
307 MODULE_DESCRIPTION("SC7180 LPASS CPU DRIVER");
308 MODULE_LICENSE("GPL v2");