blob: 6bb11304489024eafa59bfe739a13f935070153d [file] [log] [blame]
Meng Wang43bbb872018-12-10 12:32:05 +08001// SPDX-License-Identifier: GPL-2.0-only
Vatsal Bucha39ead2c2018-12-14 12:22:46 +05302/* Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
Laxminath Kasam989fccf2018-06-15 16:53:31 +05303 */
4
5#include <linux/module.h>
6#include <linux/init.h>
7#include <linux/clk.h>
8#include <linux/io.h>
9#include <linux/platform_device.h>
10#include <linux/regmap.h>
Sudheer Papothi7601cc62019-03-30 03:00:52 +053011#include <linux/pm_runtime.h>
Laxminath Kasam989fccf2018-06-15 16:53:31 +053012#include <sound/soc.h>
13#include <sound/soc-dapm.h>
14#include <sound/tlv.h>
Sudheer Papothia3e969d2018-10-27 06:22:10 +053015#include <soc/swr-common.h>
Laxminath Kasamfb0d6832018-09-22 01:49:52 +053016#include <soc/swr-wcd.h>
Meng Wang11a25cf2018-10-31 14:11:26 +080017#include <asoc/msm-cdc-pinctrl.h>
Laxminath Kasam989fccf2018-06-15 16:53:31 +053018#include "bolero-cdc.h"
19#include "bolero-cdc-registers.h"
Vidyakumar Athota5d45f4c2019-03-10 22:35:07 -070020#include "bolero-clk-rsc.h"
Laxminath Kasam989fccf2018-06-15 16:53:31 +053021
Sudheer Papothi7601cc62019-03-30 03:00:52 +053022#define AUTO_SUSPEND_DELAY 50 /* delay in msec */
Laxminath Kasam989fccf2018-06-15 16:53:31 +053023#define TX_MACRO_MAX_OFFSET 0x1000
24
25#define NUM_DECIMATORS 8
26
27#define TX_MACRO_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
28 SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\
29 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
30#define TX_MACRO_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
31 SNDRV_PCM_FMTBIT_S24_LE |\
32 SNDRV_PCM_FMTBIT_S24_3LE)
33
34#define TX_HPF_CUT_OFF_FREQ_MASK 0x60
35#define CF_MIN_3DB_4HZ 0x0
36#define CF_MIN_3DB_75HZ 0x1
37#define CF_MIN_3DB_150HZ 0x2
38
39#define TX_MACRO_DMIC_SAMPLE_RATE_UNDEFINED 0
40#define TX_MACRO_MCLK_FREQ 9600000
41#define TX_MACRO_TX_PATH_OFFSET 0x80
Laxminath Kasam497a6512018-09-17 16:11:52 +053042#define TX_MACRO_SWR_MIC_MUX_SEL_MASK 0xF
43#define TX_MACRO_ADC_MUX_CFG_OFFSET 0x2
Laxminath Kasam989fccf2018-06-15 16:53:31 +053044
45#define TX_MACRO_TX_UNMUTE_DELAY_MS 40
46
47static int tx_unmute_delay = TX_MACRO_TX_UNMUTE_DELAY_MS;
48module_param(tx_unmute_delay, int, 0664);
49MODULE_PARM_DESC(tx_unmute_delay, "delay to unmute the tx path");
50
51static const DECLARE_TLV_DB_SCALE(digital_gain, 0, 1, 0);
52
53static int tx_macro_hw_params(struct snd_pcm_substream *substream,
54 struct snd_pcm_hw_params *params,
55 struct snd_soc_dai *dai);
56static int tx_macro_get_channel_map(struct snd_soc_dai *dai,
57 unsigned int *tx_num, unsigned int *tx_slot,
58 unsigned int *rx_num, unsigned int *rx_slot);
59
60#define TX_MACRO_SWR_STRING_LEN 80
61#define TX_MACRO_CHILD_DEVICES_MAX 3
62
63/* Hold instance to soundwire platform device */
64struct tx_macro_swr_ctrl_data {
65 struct platform_device *tx_swr_pdev;
66};
67
68struct tx_macro_swr_ctrl_platform_data {
69 void *handle; /* holds codec private data */
70 int (*read)(void *handle, int reg);
71 int (*write)(void *handle, int reg, int val);
72 int (*bulk_write)(void *handle, u32 *reg, u32 *val, size_t len);
73 int (*clk)(void *handle, bool enable);
74 int (*handle_irq)(void *handle,
75 irqreturn_t (*swrm_irq_handler)(int irq,
76 void *data),
77 void *swrm_handle,
78 int action);
79};
80
81enum {
Laxminath Kasam59c7a1d2018-08-09 16:11:17 +053082 TX_MACRO_AIF_INVALID = 0,
83 TX_MACRO_AIF1_CAP,
Laxminath Kasam989fccf2018-06-15 16:53:31 +053084 TX_MACRO_AIF2_CAP,
85 TX_MACRO_MAX_DAIS
86};
87
88enum {
89 TX_MACRO_DEC0,
90 TX_MACRO_DEC1,
91 TX_MACRO_DEC2,
92 TX_MACRO_DEC3,
93 TX_MACRO_DEC4,
94 TX_MACRO_DEC5,
95 TX_MACRO_DEC6,
96 TX_MACRO_DEC7,
97 TX_MACRO_DEC_MAX,
98};
99
100enum {
101 TX_MACRO_CLK_DIV_2,
102 TX_MACRO_CLK_DIV_3,
103 TX_MACRO_CLK_DIV_4,
104 TX_MACRO_CLK_DIV_6,
105 TX_MACRO_CLK_DIV_8,
106 TX_MACRO_CLK_DIV_16,
107};
108
Laxminath Kasam497a6512018-09-17 16:11:52 +0530109enum {
110 MSM_DMIC,
111 SWR_MIC,
112 ANC_FB_TUNE1
113};
114
Sudheer Papothia7397942019-03-19 03:14:23 +0530115enum {
116 TX_MCLK,
117 VA_MCLK,
118};
119
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530120struct tx_mute_work {
121 struct tx_macro_priv *tx_priv;
122 u32 decimator;
123 struct delayed_work dwork;
124};
125
126struct hpf_work {
127 struct tx_macro_priv *tx_priv;
128 u8 decimator;
129 u8 hpf_cut_off_freq;
130 struct delayed_work dwork;
131};
132
133struct tx_macro_priv {
134 struct device *dev;
135 bool dec_active[NUM_DECIMATORS];
136 int tx_mclk_users;
137 int swr_clk_users;
Ramprasad Katkam452772a2019-01-07 17:30:36 +0530138 bool dapm_mclk_enable;
Ramprasad Katkama4c747b2018-12-11 19:15:53 +0530139 bool reset_swr;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530140 struct mutex mclk_lock;
141 struct mutex swr_clk_lock;
Meng Wang15c825d2018-09-06 10:49:18 +0800142 struct snd_soc_component *component;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530143 struct device_node *tx_swr_gpio_p;
144 struct tx_macro_swr_ctrl_data *swr_ctrl_data;
145 struct tx_macro_swr_ctrl_platform_data swr_plat_data;
146 struct work_struct tx_macro_add_child_devices_work;
147 struct hpf_work tx_hpf_work[NUM_DECIMATORS];
148 struct tx_mute_work tx_mute_dwork[NUM_DECIMATORS];
149 s32 dmic_0_1_clk_cnt;
150 s32 dmic_2_3_clk_cnt;
151 s32 dmic_4_5_clk_cnt;
152 s32 dmic_6_7_clk_cnt;
153 u16 dmic_clk_div;
154 unsigned long active_ch_mask[TX_MACRO_MAX_DAIS];
155 unsigned long active_ch_cnt[TX_MACRO_MAX_DAIS];
156 char __iomem *tx_io_base;
157 struct platform_device *pdev_child_devices
158 [TX_MACRO_CHILD_DEVICES_MAX];
159 int child_count;
Sudheer Papothie456c2c2019-03-05 07:08:45 +0530160 int tx_swr_clk_cnt;
161 int va_swr_clk_cnt;
Sudheer Papothicf3b4062019-05-10 10:48:43 +0530162 int va_clk_status;
163 int tx_clk_status;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530164};
165
Meng Wang15c825d2018-09-06 10:49:18 +0800166static bool tx_macro_get_data(struct snd_soc_component *component,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530167 struct device **tx_dev,
168 struct tx_macro_priv **tx_priv,
169 const char *func_name)
170{
Meng Wang15c825d2018-09-06 10:49:18 +0800171 *tx_dev = bolero_get_device_ptr(component->dev, TX_MACRO);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530172 if (!(*tx_dev)) {
Meng Wang15c825d2018-09-06 10:49:18 +0800173 dev_err(component->dev,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530174 "%s: null device for macro!\n", func_name);
175 return false;
176 }
177
178 *tx_priv = dev_get_drvdata((*tx_dev));
179 if (!(*tx_priv)) {
Meng Wang15c825d2018-09-06 10:49:18 +0800180 dev_err(component->dev,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530181 "%s: priv is null for macro!\n", func_name);
182 return false;
183 }
184
Meng Wang15c825d2018-09-06 10:49:18 +0800185 if (!(*tx_priv)->component) {
186 dev_err(component->dev,
187 "%s: tx_priv->component not initialized!\n", func_name);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530188 return false;
189 }
190
191 return true;
192}
193
194static int tx_macro_mclk_enable(struct tx_macro_priv *tx_priv,
195 bool mclk_enable)
196{
197 struct regmap *regmap = dev_get_regmap(tx_priv->dev->parent, NULL);
198 int ret = 0;
199
Tanya Dixit8530fb92018-09-14 16:01:25 +0530200 if (regmap == NULL) {
201 dev_err(tx_priv->dev, "%s: regmap is NULL\n", __func__);
202 return -EINVAL;
203 }
204
Laxminath Kasamb7f823c2018-08-02 13:23:11 +0530205 dev_dbg(tx_priv->dev, "%s: mclk_enable = %u,clk_users= %d\n",
206 __func__, mclk_enable, tx_priv->tx_mclk_users);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530207
208 mutex_lock(&tx_priv->mclk_lock);
209 if (mclk_enable) {
210 if (tx_priv->tx_mclk_users == 0) {
Vidyakumar Athota5d45f4c2019-03-10 22:35:07 -0700211 ret = bolero_clk_rsc_request_clock(tx_priv->dev,
212 TX_CORE_CLK,
213 TX_CORE_CLK,
214 true);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530215 if (ret < 0) {
Ramprasad Katkam14efed62019-03-07 13:16:50 +0530216 dev_err_ratelimited(tx_priv->dev,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530217 "%s: request clock enable failed\n",
218 __func__);
219 goto exit;
220 }
Vidyakumar Athota5d45f4c2019-03-10 22:35:07 -0700221 bolero_clk_rsc_fs_gen_request(tx_priv->dev,
222 true);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530223 regcache_mark_dirty(regmap);
224 regcache_sync_region(regmap,
225 TX_START_OFFSET,
226 TX_MAX_OFFSET);
227 /* 9.6MHz MCLK, set value 0x00 if other frequency */
228 regmap_update_bits(regmap,
229 BOLERO_CDC_TX_TOP_CSR_FREQ_MCLK, 0x01, 0x01);
230 regmap_update_bits(regmap,
231 BOLERO_CDC_TX_CLK_RST_CTRL_MCLK_CONTROL,
232 0x01, 0x01);
233 regmap_update_bits(regmap,
234 BOLERO_CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL,
235 0x01, 0x01);
236 }
237 tx_priv->tx_mclk_users++;
238 } else {
239 if (tx_priv->tx_mclk_users <= 0) {
240 dev_err(tx_priv->dev, "%s: clock already disabled\n",
241 __func__);
242 tx_priv->tx_mclk_users = 0;
243 goto exit;
244 }
245 tx_priv->tx_mclk_users--;
246 if (tx_priv->tx_mclk_users == 0) {
247 regmap_update_bits(regmap,
248 BOLERO_CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL,
249 0x01, 0x00);
250 regmap_update_bits(regmap,
251 BOLERO_CDC_TX_CLK_RST_CTRL_MCLK_CONTROL,
252 0x01, 0x00);
Vidyakumar Athota5d45f4c2019-03-10 22:35:07 -0700253 bolero_clk_rsc_fs_gen_request(tx_priv->dev,
254 false);
255
256 bolero_clk_rsc_request_clock(tx_priv->dev,
257 TX_CORE_CLK,
258 TX_CORE_CLK,
259 false);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530260 }
261 }
262exit:
263 mutex_unlock(&tx_priv->mclk_lock);
264 return ret;
265}
266
Sudheer Papothie456c2c2019-03-05 07:08:45 +0530267static int tx_macro_va_swr_clk_event(struct snd_soc_dapm_widget *w,
268 struct snd_kcontrol *kcontrol, int event)
269{
270 struct device *tx_dev = NULL;
271 struct tx_macro_priv *tx_priv = NULL;
272 struct snd_soc_component *component =
273 snd_soc_dapm_to_component(w->dapm);
274
275 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
276 return -EINVAL;
277
278 if (SND_SOC_DAPM_EVENT_ON(event))
279 ++tx_priv->va_swr_clk_cnt;
280 if (SND_SOC_DAPM_EVENT_OFF(event))
281 --tx_priv->va_swr_clk_cnt;
282
283 return 0;
284}
285
286static int tx_macro_tx_swr_clk_event(struct snd_soc_dapm_widget *w,
287 struct snd_kcontrol *kcontrol, int event)
288{
289 struct device *tx_dev = NULL;
290 struct tx_macro_priv *tx_priv = NULL;
291 struct snd_soc_component *component =
292 snd_soc_dapm_to_component(w->dapm);
293
294 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
295 return -EINVAL;
296
297 if (SND_SOC_DAPM_EVENT_ON(event))
298 ++tx_priv->tx_swr_clk_cnt;
299 if (SND_SOC_DAPM_EVENT_OFF(event))
300 --tx_priv->tx_swr_clk_cnt;
301
302 return 0;
303}
304
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530305static int tx_macro_mclk_event(struct snd_soc_dapm_widget *w,
306 struct snd_kcontrol *kcontrol, int event)
307{
Meng Wang15c825d2018-09-06 10:49:18 +0800308 struct snd_soc_component *component =
309 snd_soc_dapm_to_component(w->dapm);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530310 int ret = 0;
311 struct device *tx_dev = NULL;
312 struct tx_macro_priv *tx_priv = NULL;
313
Meng Wang15c825d2018-09-06 10:49:18 +0800314 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530315 return -EINVAL;
316
317 dev_dbg(tx_dev, "%s: event = %d\n", __func__, event);
318 switch (event) {
319 case SND_SOC_DAPM_PRE_PMU:
320 ret = tx_macro_mclk_enable(tx_priv, 1);
Ramprasad Katkam452772a2019-01-07 17:30:36 +0530321 if (ret)
322 tx_priv->dapm_mclk_enable = false;
323 else
324 tx_priv->dapm_mclk_enable = true;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530325 break;
326 case SND_SOC_DAPM_POST_PMD:
Ramprasad Katkam452772a2019-01-07 17:30:36 +0530327 if (tx_priv->dapm_mclk_enable)
328 ret = tx_macro_mclk_enable(tx_priv, 0);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530329 break;
330 default:
331 dev_err(tx_priv->dev,
332 "%s: invalid DAPM event %d\n", __func__, event);
333 ret = -EINVAL;
334 }
335 return ret;
336}
337
Meng Wang15c825d2018-09-06 10:49:18 +0800338static int tx_macro_event_handler(struct snd_soc_component *component,
339 u16 event, u32 data)
Laxminath Kasamfb0d6832018-09-22 01:49:52 +0530340{
341 struct device *tx_dev = NULL;
342 struct tx_macro_priv *tx_priv = NULL;
343
Meng Wang15c825d2018-09-06 10:49:18 +0800344 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasamfb0d6832018-09-22 01:49:52 +0530345 return -EINVAL;
346
347 switch (event) {
348 case BOLERO_MACRO_EVT_SSR_DOWN:
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -0700349 if (tx_priv->swr_ctrl_data) {
350 swrm_wcd_notify(
351 tx_priv->swr_ctrl_data[0].tx_swr_pdev,
352 SWR_DEVICE_DOWN, NULL);
353 swrm_wcd_notify(
354 tx_priv->swr_ctrl_data[0].tx_swr_pdev,
355 SWR_DEVICE_SSR_DOWN, NULL);
356 }
Meng Wangbf1fe8f2019-06-26 15:39:41 +0800357 if (!pm_runtime_status_suspended(tx_dev))
358 bolero_runtime_suspend(tx_dev);
Laxminath Kasamfb0d6832018-09-22 01:49:52 +0530359 break;
360 case BOLERO_MACRO_EVT_SSR_UP:
Ramprasad Katkama4c747b2018-12-11 19:15:53 +0530361 /* reset swr after ssr/pdr */
362 tx_priv->reset_swr = true;
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -0700363 if (tx_priv->swr_ctrl_data)
364 swrm_wcd_notify(
365 tx_priv->swr_ctrl_data[0].tx_swr_pdev,
366 SWR_DEVICE_SSR_UP, NULL);
Laxminath Kasamfb0d6832018-09-22 01:49:52 +0530367 break;
Meng Wang8ef0cc22019-05-08 15:12:56 +0800368 case BOLERO_MACRO_EVT_CLK_RESET:
369 bolero_rsc_clk_reset(tx_dev, TX_CORE_CLK);
370 break;
Laxminath Kasamfb0d6832018-09-22 01:49:52 +0530371 }
372 return 0;
373}
374
Meng Wang15c825d2018-09-06 10:49:18 +0800375static int tx_macro_reg_wake_irq(struct snd_soc_component *component,
Aditya Bavanaric4e96122018-11-14 14:46:38 +0530376 u32 data)
377{
378 struct device *tx_dev = NULL;
379 struct tx_macro_priv *tx_priv = NULL;
380 u32 ipc_wakeup = data;
381 int ret = 0;
382
Meng Wang15c825d2018-09-06 10:49:18 +0800383 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Aditya Bavanaric4e96122018-11-14 14:46:38 +0530384 return -EINVAL;
385
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -0700386 if (tx_priv->swr_ctrl_data)
387 ret = swrm_wcd_notify(
388 tx_priv->swr_ctrl_data[0].tx_swr_pdev,
389 SWR_REGISTER_WAKE_IRQ, &ipc_wakeup);
Aditya Bavanaric4e96122018-11-14 14:46:38 +0530390
391 return ret;
392}
393
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530394static void tx_macro_tx_hpf_corner_freq_callback(struct work_struct *work)
395{
396 struct delayed_work *hpf_delayed_work = NULL;
397 struct hpf_work *hpf_work = NULL;
398 struct tx_macro_priv *tx_priv = NULL;
Meng Wang15c825d2018-09-06 10:49:18 +0800399 struct snd_soc_component *component = NULL;
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530400 u16 dec_cfg_reg = 0, hpf_gate_reg = 0;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530401 u8 hpf_cut_off_freq = 0;
Laxminath Kasam497a6512018-09-17 16:11:52 +0530402 u16 adc_mux_reg = 0, adc_n = 0, adc_reg = 0;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530403
404 hpf_delayed_work = to_delayed_work(work);
405 hpf_work = container_of(hpf_delayed_work, struct hpf_work, dwork);
406 tx_priv = hpf_work->tx_priv;
Meng Wang15c825d2018-09-06 10:49:18 +0800407 component = tx_priv->component;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530408 hpf_cut_off_freq = hpf_work->hpf_cut_off_freq;
409
410 dec_cfg_reg = BOLERO_CDC_TX0_TX_PATH_CFG0 +
411 TX_MACRO_TX_PATH_OFFSET * hpf_work->decimator;
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530412 hpf_gate_reg = BOLERO_CDC_TX0_TX_PATH_SEC2 +
413 TX_MACRO_TX_PATH_OFFSET * hpf_work->decimator;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530414
Meng Wang15c825d2018-09-06 10:49:18 +0800415 dev_dbg(component->dev, "%s: decimator %u hpf_cut_of_freq 0x%x\n",
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530416 __func__, hpf_work->decimator, hpf_cut_off_freq);
417
Laxminath Kasam497a6512018-09-17 16:11:52 +0530418 adc_mux_reg = BOLERO_CDC_TX_INP_MUX_ADC_MUX0_CFG1 +
419 TX_MACRO_ADC_MUX_CFG_OFFSET * hpf_work->decimator;
Meng Wang15c825d2018-09-06 10:49:18 +0800420 if (snd_soc_component_read32(component, adc_mux_reg) & SWR_MIC) {
Laxminath Kasam497a6512018-09-17 16:11:52 +0530421 adc_reg = BOLERO_CDC_TX_INP_MUX_ADC_MUX0_CFG0 +
422 TX_MACRO_ADC_MUX_CFG_OFFSET * hpf_work->decimator;
Meng Wang15c825d2018-09-06 10:49:18 +0800423 adc_n = snd_soc_component_read32(component, adc_reg) &
Laxminath Kasam497a6512018-09-17 16:11:52 +0530424 TX_MACRO_SWR_MIC_MUX_SEL_MASK;
425 if (adc_n >= BOLERO_ADC_MAX)
426 goto tx_hpf_set;
427 /* analog mic clear TX hold */
Meng Wang15c825d2018-09-06 10:49:18 +0800428 bolero_clear_amic_tx_hold(component->dev, adc_n);
Laxminath Kasam497a6512018-09-17 16:11:52 +0530429 }
430tx_hpf_set:
Meng Wang15c825d2018-09-06 10:49:18 +0800431 snd_soc_component_update_bits(component,
432 dec_cfg_reg, TX_HPF_CUT_OFF_FREQ_MASK,
433 hpf_cut_off_freq << 5);
434 snd_soc_component_update_bits(component, hpf_gate_reg, 0x03, 0x02);
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530435 /* Minimum 1 clk cycle delay is required as per HW spec */
436 usleep_range(1000, 1010);
Meng Wang15c825d2018-09-06 10:49:18 +0800437 snd_soc_component_update_bits(component, hpf_gate_reg, 0x03, 0x01);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530438}
439
440static void tx_macro_mute_update_callback(struct work_struct *work)
441{
442 struct tx_mute_work *tx_mute_dwork = NULL;
Meng Wang15c825d2018-09-06 10:49:18 +0800443 struct snd_soc_component *component = NULL;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530444 struct tx_macro_priv *tx_priv = NULL;
445 struct delayed_work *delayed_work = NULL;
Xiaojun Sangd155fdc2018-10-11 15:11:59 +0800446 u16 tx_vol_ctl_reg = 0;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530447 u8 decimator = 0;
448
449 delayed_work = to_delayed_work(work);
450 tx_mute_dwork = container_of(delayed_work, struct tx_mute_work, dwork);
451 tx_priv = tx_mute_dwork->tx_priv;
Meng Wang15c825d2018-09-06 10:49:18 +0800452 component = tx_priv->component;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530453 decimator = tx_mute_dwork->decimator;
454
455 tx_vol_ctl_reg =
456 BOLERO_CDC_TX0_TX_PATH_CTL +
457 TX_MACRO_TX_PATH_OFFSET * decimator;
Meng Wang15c825d2018-09-06 10:49:18 +0800458 snd_soc_component_update_bits(component, tx_vol_ctl_reg, 0x10, 0x00);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530459 dev_dbg(tx_priv->dev, "%s: decimator %u unmute\n",
460 __func__, decimator);
461}
462
463static int tx_macro_put_dec_enum(struct snd_kcontrol *kcontrol,
464 struct snd_ctl_elem_value *ucontrol)
465{
466 struct snd_soc_dapm_widget *widget =
467 snd_soc_dapm_kcontrol_widget(kcontrol);
Meng Wang15c825d2018-09-06 10:49:18 +0800468 struct snd_soc_component *component =
469 snd_soc_dapm_to_component(widget->dapm);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530470 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
471 unsigned int val = 0;
472 u16 mic_sel_reg = 0;
473
474 val = ucontrol->value.enumerated.item[0];
475 if (val > e->items - 1)
476 return -EINVAL;
477
Meng Wang15c825d2018-09-06 10:49:18 +0800478 dev_dbg(component->dev, "%s: wname: %s, val: 0x%x\n", __func__,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530479 widget->name, val);
480
481 switch (e->reg) {
482 case BOLERO_CDC_TX_INP_MUX_ADC_MUX0_CFG0:
483 mic_sel_reg = BOLERO_CDC_TX0_TX_PATH_CFG0;
484 break;
485 case BOLERO_CDC_TX_INP_MUX_ADC_MUX1_CFG0:
486 mic_sel_reg = BOLERO_CDC_TX1_TX_PATH_CFG0;
487 break;
488 case BOLERO_CDC_TX_INP_MUX_ADC_MUX2_CFG0:
489 mic_sel_reg = BOLERO_CDC_TX2_TX_PATH_CFG0;
490 break;
491 case BOLERO_CDC_TX_INP_MUX_ADC_MUX3_CFG0:
492 mic_sel_reg = BOLERO_CDC_TX3_TX_PATH_CFG0;
493 break;
494 case BOLERO_CDC_TX_INP_MUX_ADC_MUX4_CFG0:
495 mic_sel_reg = BOLERO_CDC_TX4_TX_PATH_CFG0;
496 break;
497 case BOLERO_CDC_TX_INP_MUX_ADC_MUX5_CFG0:
498 mic_sel_reg = BOLERO_CDC_TX5_TX_PATH_CFG0;
499 break;
500 case BOLERO_CDC_TX_INP_MUX_ADC_MUX6_CFG0:
501 mic_sel_reg = BOLERO_CDC_TX6_TX_PATH_CFG0;
502 break;
503 case BOLERO_CDC_TX_INP_MUX_ADC_MUX7_CFG0:
504 mic_sel_reg = BOLERO_CDC_TX7_TX_PATH_CFG0;
505 break;
506 default:
Meng Wang15c825d2018-09-06 10:49:18 +0800507 dev_err(component->dev, "%s: e->reg: 0x%x not expected\n",
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530508 __func__, e->reg);
509 return -EINVAL;
510 }
Laxminath Kasam497a6512018-09-17 16:11:52 +0530511 if (strnstr(widget->name, "SMIC", strlen(widget->name))) {
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530512 if (val != 0) {
513 if (val < 5)
Meng Wang15c825d2018-09-06 10:49:18 +0800514 snd_soc_component_update_bits(component,
515 mic_sel_reg,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530516 1 << 7, 0x0 << 7);
517 else
Meng Wang15c825d2018-09-06 10:49:18 +0800518 snd_soc_component_update_bits(component,
519 mic_sel_reg,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530520 1 << 7, 0x1 << 7);
521 }
522 } else {
523 /* DMIC selected */
524 if (val != 0)
Meng Wang15c825d2018-09-06 10:49:18 +0800525 snd_soc_component_update_bits(component, mic_sel_reg,
526 1 << 7, 1 << 7);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530527 }
528
529 return snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
530}
531
532static int tx_macro_tx_mixer_get(struct snd_kcontrol *kcontrol,
533 struct snd_ctl_elem_value *ucontrol)
534{
535 struct snd_soc_dapm_widget *widget =
536 snd_soc_dapm_kcontrol_widget(kcontrol);
Meng Wang15c825d2018-09-06 10:49:18 +0800537 struct snd_soc_component *component =
538 snd_soc_dapm_to_component(widget->dapm);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530539 struct soc_multi_mixer_control *mixer =
540 ((struct soc_multi_mixer_control *)kcontrol->private_value);
541 u32 dai_id = widget->shift;
542 u32 dec_id = mixer->shift;
543 struct device *tx_dev = NULL;
544 struct tx_macro_priv *tx_priv = NULL;
545
Meng Wang15c825d2018-09-06 10:49:18 +0800546 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530547 return -EINVAL;
548
549 if (test_bit(dec_id, &tx_priv->active_ch_mask[dai_id]))
550 ucontrol->value.integer.value[0] = 1;
551 else
552 ucontrol->value.integer.value[0] = 0;
553 return 0;
554}
555
556static int tx_macro_tx_mixer_put(struct snd_kcontrol *kcontrol,
557 struct snd_ctl_elem_value *ucontrol)
558{
559 struct snd_soc_dapm_widget *widget =
560 snd_soc_dapm_kcontrol_widget(kcontrol);
Meng Wang15c825d2018-09-06 10:49:18 +0800561 struct snd_soc_component *component =
562 snd_soc_dapm_to_component(widget->dapm);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530563 struct snd_soc_dapm_update *update = NULL;
564 struct soc_multi_mixer_control *mixer =
565 ((struct soc_multi_mixer_control *)kcontrol->private_value);
566 u32 dai_id = widget->shift;
567 u32 dec_id = mixer->shift;
568 u32 enable = ucontrol->value.integer.value[0];
569 struct device *tx_dev = NULL;
570 struct tx_macro_priv *tx_priv = NULL;
571
Meng Wang15c825d2018-09-06 10:49:18 +0800572 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530573 return -EINVAL;
574
575 if (enable) {
576 set_bit(dec_id, &tx_priv->active_ch_mask[dai_id]);
577 tx_priv->active_ch_cnt[dai_id]++;
578 } else {
579 tx_priv->active_ch_cnt[dai_id]--;
580 clear_bit(dec_id, &tx_priv->active_ch_mask[dai_id]);
581 }
582 snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, update);
583
584 return 0;
585}
586
587static int tx_macro_enable_dmic(struct snd_soc_dapm_widget *w,
588 struct snd_kcontrol *kcontrol, int event)
589{
Meng Wang15c825d2018-09-06 10:49:18 +0800590 struct snd_soc_component *component =
591 snd_soc_dapm_to_component(w->dapm);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530592 u8 dmic_clk_en = 0x01;
593 u16 dmic_clk_reg = 0;
594 s32 *dmic_clk_cnt = NULL;
595 unsigned int dmic = 0;
596 int ret = 0;
597 char *wname = NULL;
598 struct device *tx_dev = NULL;
599 struct tx_macro_priv *tx_priv = NULL;
600
Meng Wang15c825d2018-09-06 10:49:18 +0800601 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530602 return -EINVAL;
603
604 wname = strpbrk(w->name, "01234567");
605 if (!wname) {
Meng Wang15c825d2018-09-06 10:49:18 +0800606 dev_err(component->dev, "%s: widget not found\n", __func__);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530607 return -EINVAL;
608 }
609
610 ret = kstrtouint(wname, 10, &dmic);
611 if (ret < 0) {
Meng Wang15c825d2018-09-06 10:49:18 +0800612 dev_err(component->dev, "%s: Invalid DMIC line on the codec\n",
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530613 __func__);
614 return -EINVAL;
615 }
616
617 switch (dmic) {
618 case 0:
619 case 1:
620 dmic_clk_cnt = &(tx_priv->dmic_0_1_clk_cnt);
621 dmic_clk_reg = BOLERO_CDC_VA_TOP_CSR_DMIC0_CTL;
622 break;
623 case 2:
624 case 3:
625 dmic_clk_cnt = &(tx_priv->dmic_2_3_clk_cnt);
626 dmic_clk_reg = BOLERO_CDC_VA_TOP_CSR_DMIC1_CTL;
627 break;
628 case 4:
629 case 5:
630 dmic_clk_cnt = &(tx_priv->dmic_4_5_clk_cnt);
631 dmic_clk_reg = BOLERO_CDC_VA_TOP_CSR_DMIC2_CTL;
632 break;
633 case 6:
634 case 7:
635 dmic_clk_cnt = &(tx_priv->dmic_6_7_clk_cnt);
636 dmic_clk_reg = BOLERO_CDC_VA_TOP_CSR_DMIC3_CTL;
637 break;
638 default:
Meng Wang15c825d2018-09-06 10:49:18 +0800639 dev_err(component->dev, "%s: Invalid DMIC Selection\n",
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530640 __func__);
641 return -EINVAL;
642 }
Meng Wang15c825d2018-09-06 10:49:18 +0800643 dev_dbg(component->dev, "%s: event %d DMIC%d dmic_clk_cnt %d\n",
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530644 __func__, event, dmic, *dmic_clk_cnt);
645
646 switch (event) {
647 case SND_SOC_DAPM_PRE_PMU:
648 (*dmic_clk_cnt)++;
649 if (*dmic_clk_cnt == 1) {
Meng Wang15c825d2018-09-06 10:49:18 +0800650 snd_soc_component_update_bits(component,
651 BOLERO_CDC_VA_TOP_CSR_DMIC_CFG,
Ramprasad Katkam9c2394a2018-08-23 13:13:48 +0530652 0x80, 0x00);
653
Meng Wang15c825d2018-09-06 10:49:18 +0800654 snd_soc_component_update_bits(component, dmic_clk_reg,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530655 0x0E, tx_priv->dmic_clk_div << 0x1);
Meng Wang15c825d2018-09-06 10:49:18 +0800656 snd_soc_component_update_bits(component, dmic_clk_reg,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530657 dmic_clk_en, dmic_clk_en);
658 }
659 break;
660 case SND_SOC_DAPM_POST_PMD:
661 (*dmic_clk_cnt)--;
662 if (*dmic_clk_cnt == 0)
Meng Wang15c825d2018-09-06 10:49:18 +0800663 snd_soc_component_update_bits(component, dmic_clk_reg,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530664 dmic_clk_en, 0);
665 break;
666 }
667
668 return 0;
669}
670
671static int tx_macro_enable_dec(struct snd_soc_dapm_widget *w,
672 struct snd_kcontrol *kcontrol, int event)
673{
Meng Wang15c825d2018-09-06 10:49:18 +0800674 struct snd_soc_component *component =
675 snd_soc_dapm_to_component(w->dapm);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530676 unsigned int decimator = 0;
677 u16 tx_vol_ctl_reg = 0;
678 u16 dec_cfg_reg = 0;
679 u16 hpf_gate_reg = 0;
680 u16 tx_gain_ctl_reg = 0;
681 u8 hpf_cut_off_freq = 0;
682 struct device *tx_dev = NULL;
683 struct tx_macro_priv *tx_priv = NULL;
684
Meng Wang15c825d2018-09-06 10:49:18 +0800685 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530686 return -EINVAL;
687
688 decimator = w->shift;
689
Meng Wang15c825d2018-09-06 10:49:18 +0800690 dev_dbg(component->dev, "%s(): widget = %s decimator = %u\n", __func__,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530691 w->name, decimator);
692
693 tx_vol_ctl_reg = BOLERO_CDC_TX0_TX_PATH_CTL +
694 TX_MACRO_TX_PATH_OFFSET * decimator;
695 hpf_gate_reg = BOLERO_CDC_TX0_TX_PATH_SEC2 +
696 TX_MACRO_TX_PATH_OFFSET * decimator;
697 dec_cfg_reg = BOLERO_CDC_TX0_TX_PATH_CFG0 +
698 TX_MACRO_TX_PATH_OFFSET * decimator;
699 tx_gain_ctl_reg = BOLERO_CDC_TX0_TX_VOL_CTL +
700 TX_MACRO_TX_PATH_OFFSET * decimator;
701
702 switch (event) {
703 case SND_SOC_DAPM_PRE_PMU:
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530704 /* Enable TX PGA Mute */
Meng Wang15c825d2018-09-06 10:49:18 +0800705 snd_soc_component_update_bits(component,
706 tx_vol_ctl_reg, 0x10, 0x10);
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530707 break;
708 case SND_SOC_DAPM_POST_PMU:
Meng Wang15c825d2018-09-06 10:49:18 +0800709 snd_soc_component_update_bits(component,
710 tx_vol_ctl_reg, 0x20, 0x20);
711 snd_soc_component_update_bits(component,
712 hpf_gate_reg, 0x01, 0x00);
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530713
Meng Wang15c825d2018-09-06 10:49:18 +0800714 hpf_cut_off_freq = (
715 snd_soc_component_read32(component, dec_cfg_reg) &
716 TX_HPF_CUT_OFF_FREQ_MASK) >> 5;
717
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530718 tx_priv->tx_hpf_work[decimator].hpf_cut_off_freq =
Meng Wang15c825d2018-09-06 10:49:18 +0800719 hpf_cut_off_freq;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530720
721 if (hpf_cut_off_freq != CF_MIN_3DB_150HZ)
Meng Wang15c825d2018-09-06 10:49:18 +0800722 snd_soc_component_update_bits(component, dec_cfg_reg,
723 TX_HPF_CUT_OFF_FREQ_MASK,
724 CF_MIN_3DB_150HZ << 5);
725
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530726 /* schedule work queue to Remove Mute */
727 schedule_delayed_work(&tx_priv->tx_mute_dwork[decimator].dwork,
728 msecs_to_jiffies(tx_unmute_delay));
729 if (tx_priv->tx_hpf_work[decimator].hpf_cut_off_freq !=
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530730 CF_MIN_3DB_150HZ) {
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530731 schedule_delayed_work(
732 &tx_priv->tx_hpf_work[decimator].dwork,
Mangesh Kunchamwar3d4eec42019-03-05 15:06:48 +0530733 msecs_to_jiffies(50));
Meng Wang15c825d2018-09-06 10:49:18 +0800734 snd_soc_component_update_bits(component,
735 hpf_gate_reg, 0x02, 0x02);
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530736 /*
737 * Minimum 1 clk cycle delay is required as per HW spec
738 */
739 usleep_range(1000, 1010);
Meng Wang15c825d2018-09-06 10:49:18 +0800740 snd_soc_component_update_bits(component,
741 hpf_gate_reg, 0x02, 0x00);
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530742 }
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530743 /* apply gain after decimator is enabled */
Meng Wang15c825d2018-09-06 10:49:18 +0800744 snd_soc_component_write(component, tx_gain_ctl_reg,
745 snd_soc_component_read32(component,
746 tx_gain_ctl_reg));
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530747 break;
748 case SND_SOC_DAPM_PRE_PMD:
749 hpf_cut_off_freq =
750 tx_priv->tx_hpf_work[decimator].hpf_cut_off_freq;
Meng Wang15c825d2018-09-06 10:49:18 +0800751 snd_soc_component_update_bits(component,
752 tx_vol_ctl_reg, 0x10, 0x10);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530753 if (cancel_delayed_work_sync(
754 &tx_priv->tx_hpf_work[decimator].dwork)) {
755 if (hpf_cut_off_freq != CF_MIN_3DB_150HZ) {
Meng Wang15c825d2018-09-06 10:49:18 +0800756 snd_soc_component_update_bits(
757 component, dec_cfg_reg,
758 TX_HPF_CUT_OFF_FREQ_MASK,
759 hpf_cut_off_freq << 5);
760 snd_soc_component_update_bits(component,
761 hpf_gate_reg,
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530762 0x02, 0x02);
763 /*
764 * Minimum 1 clk cycle delay is required
765 * as per HW spec
766 */
767 usleep_range(1000, 1010);
Meng Wang15c825d2018-09-06 10:49:18 +0800768 snd_soc_component_update_bits(component,
769 hpf_gate_reg,
Laxminath Kasam9eb80222018-08-29 21:53:14 +0530770 0x02, 0x00);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530771 }
772 }
773 cancel_delayed_work_sync(
774 &tx_priv->tx_mute_dwork[decimator].dwork);
775 break;
776 case SND_SOC_DAPM_POST_PMD:
Meng Wang15c825d2018-09-06 10:49:18 +0800777 snd_soc_component_update_bits(component, tx_vol_ctl_reg,
778 0x20, 0x00);
779 snd_soc_component_update_bits(component, tx_vol_ctl_reg,
780 0x10, 0x00);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530781 break;
782 }
783 return 0;
784}
785
786static int tx_macro_enable_micbias(struct snd_soc_dapm_widget *w,
787 struct snd_kcontrol *kcontrol, int event)
788{
789 return 0;
790}
791
792static int tx_macro_hw_params(struct snd_pcm_substream *substream,
793 struct snd_pcm_hw_params *params,
794 struct snd_soc_dai *dai)
795{
796 int tx_fs_rate = -EINVAL;
Meng Wang15c825d2018-09-06 10:49:18 +0800797 struct snd_soc_component *component = dai->component;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530798 u32 decimator = 0;
Laxminath Kasamb7f823c2018-08-02 13:23:11 +0530799 u32 sample_rate = 0;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530800 u16 tx_fs_reg = 0;
801 struct device *tx_dev = NULL;
802 struct tx_macro_priv *tx_priv = NULL;
803
Meng Wang15c825d2018-09-06 10:49:18 +0800804 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530805 return -EINVAL;
806
807 pr_debug("%s: dai_name = %s DAI-ID %x rate %d num_ch %d\n", __func__,
808 dai->name, dai->id, params_rate(params),
809 params_channels(params));
810
811 sample_rate = params_rate(params);
812 switch (sample_rate) {
813 case 8000:
814 tx_fs_rate = 0;
815 break;
816 case 16000:
817 tx_fs_rate = 1;
818 break;
819 case 32000:
820 tx_fs_rate = 3;
821 break;
822 case 48000:
823 tx_fs_rate = 4;
824 break;
825 case 96000:
826 tx_fs_rate = 5;
827 break;
828 case 192000:
829 tx_fs_rate = 6;
830 break;
831 case 384000:
832 tx_fs_rate = 7;
833 break;
834 default:
Meng Wang15c825d2018-09-06 10:49:18 +0800835 dev_err(component->dev, "%s: Invalid TX sample rate: %d\n",
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530836 __func__, params_rate(params));
837 return -EINVAL;
838 }
839 for_each_set_bit(decimator, &tx_priv->active_ch_mask[dai->id],
840 TX_MACRO_DEC_MAX) {
841 if (decimator >= 0) {
842 tx_fs_reg = BOLERO_CDC_TX0_TX_PATH_CTL +
843 TX_MACRO_TX_PATH_OFFSET * decimator;
Meng Wang15c825d2018-09-06 10:49:18 +0800844 dev_dbg(component->dev, "%s: set DEC%u rate to %u\n",
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530845 __func__, decimator, sample_rate);
Meng Wang15c825d2018-09-06 10:49:18 +0800846 snd_soc_component_update_bits(component, tx_fs_reg,
847 0x0F, tx_fs_rate);
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530848 } else {
Meng Wang15c825d2018-09-06 10:49:18 +0800849 dev_err(component->dev,
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530850 "%s: ERROR: Invalid decimator: %d\n",
851 __func__, decimator);
852 return -EINVAL;
853 }
854 }
855 return 0;
856}
857
858static int tx_macro_get_channel_map(struct snd_soc_dai *dai,
859 unsigned int *tx_num, unsigned int *tx_slot,
860 unsigned int *rx_num, unsigned int *rx_slot)
861{
Meng Wang15c825d2018-09-06 10:49:18 +0800862 struct snd_soc_component *component = dai->component;
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530863 struct device *tx_dev = NULL;
864 struct tx_macro_priv *tx_priv = NULL;
865
Meng Wang15c825d2018-09-06 10:49:18 +0800866 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530867 return -EINVAL;
868
869 switch (dai->id) {
870 case TX_MACRO_AIF1_CAP:
871 case TX_MACRO_AIF2_CAP:
872 *tx_slot = tx_priv->active_ch_mask[dai->id];
873 *tx_num = tx_priv->active_ch_cnt[dai->id];
874 break;
875 default:
876 dev_err(tx_dev, "%s: Invalid AIF\n", __func__);
877 break;
878 }
879 return 0;
880}
881
882static struct snd_soc_dai_ops tx_macro_dai_ops = {
883 .hw_params = tx_macro_hw_params,
884 .get_channel_map = tx_macro_get_channel_map,
885};
886
887static struct snd_soc_dai_driver tx_macro_dai[] = {
888 {
889 .name = "tx_macro_tx1",
890 .id = TX_MACRO_AIF1_CAP,
891 .capture = {
892 .stream_name = "TX_AIF1 Capture",
893 .rates = TX_MACRO_RATES,
894 .formats = TX_MACRO_FORMATS,
895 .rate_max = 192000,
896 .rate_min = 8000,
897 .channels_min = 1,
898 .channels_max = 8,
899 },
900 .ops = &tx_macro_dai_ops,
901 },
902 {
903 .name = "tx_macro_tx2",
904 .id = TX_MACRO_AIF2_CAP,
905 .capture = {
906 .stream_name = "TX_AIF2 Capture",
907 .rates = TX_MACRO_RATES,
908 .formats = TX_MACRO_FORMATS,
909 .rate_max = 192000,
910 .rate_min = 8000,
911 .channels_min = 1,
912 .channels_max = 8,
913 },
914 .ops = &tx_macro_dai_ops,
915 },
916};
917
918#define STRING(name) #name
919#define TX_MACRO_DAPM_ENUM(name, reg, offset, text) \
920static SOC_ENUM_SINGLE_DECL(name##_enum, reg, offset, text); \
921static const struct snd_kcontrol_new name##_mux = \
922 SOC_DAPM_ENUM(STRING(name), name##_enum)
923
924#define TX_MACRO_DAPM_ENUM_EXT(name, reg, offset, text, getname, putname) \
925static SOC_ENUM_SINGLE_DECL(name##_enum, reg, offset, text); \
926static const struct snd_kcontrol_new name##_mux = \
927 SOC_DAPM_ENUM_EXT(STRING(name), name##_enum, getname, putname)
928
929#define TX_MACRO_DAPM_MUX(name, shift, kctl) \
930 SND_SOC_DAPM_MUX(name, SND_SOC_NOPM, shift, 0, &kctl##_mux)
931
932static const char * const adc_mux_text[] = {
933 "MSM_DMIC", "SWR_MIC", "ANC_FB_TUNE1"
934};
935
936TX_MACRO_DAPM_ENUM(tx_dec0, BOLERO_CDC_TX_INP_MUX_ADC_MUX0_CFG1,
937 0, adc_mux_text);
938TX_MACRO_DAPM_ENUM(tx_dec1, BOLERO_CDC_TX_INP_MUX_ADC_MUX1_CFG1,
939 0, adc_mux_text);
940TX_MACRO_DAPM_ENUM(tx_dec2, BOLERO_CDC_TX_INP_MUX_ADC_MUX2_CFG1,
941 0, adc_mux_text);
942TX_MACRO_DAPM_ENUM(tx_dec3, BOLERO_CDC_TX_INP_MUX_ADC_MUX3_CFG1,
943 0, adc_mux_text);
944TX_MACRO_DAPM_ENUM(tx_dec4, BOLERO_CDC_TX_INP_MUX_ADC_MUX4_CFG1,
945 0, adc_mux_text);
946TX_MACRO_DAPM_ENUM(tx_dec5, BOLERO_CDC_TX_INP_MUX_ADC_MUX5_CFG1,
947 0, adc_mux_text);
948TX_MACRO_DAPM_ENUM(tx_dec6, BOLERO_CDC_TX_INP_MUX_ADC_MUX6_CFG1,
949 0, adc_mux_text);
950TX_MACRO_DAPM_ENUM(tx_dec7, BOLERO_CDC_TX_INP_MUX_ADC_MUX7_CFG1,
951 0, adc_mux_text);
952
953
954static const char * const dmic_mux_text[] = {
955 "ZERO", "DMIC0", "DMIC1", "DMIC2", "DMIC3",
956 "DMIC4", "DMIC5", "DMIC6", "DMIC7"
957};
958
959TX_MACRO_DAPM_ENUM_EXT(tx_dmic0, BOLERO_CDC_TX_INP_MUX_ADC_MUX0_CFG0,
960 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
961 tx_macro_put_dec_enum);
962
963TX_MACRO_DAPM_ENUM_EXT(tx_dmic1, BOLERO_CDC_TX_INP_MUX_ADC_MUX1_CFG0,
964 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
965 tx_macro_put_dec_enum);
966
967TX_MACRO_DAPM_ENUM_EXT(tx_dmic2, BOLERO_CDC_TX_INP_MUX_ADC_MUX2_CFG0,
968 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
969 tx_macro_put_dec_enum);
970
971TX_MACRO_DAPM_ENUM_EXT(tx_dmic3, BOLERO_CDC_TX_INP_MUX_ADC_MUX3_CFG0,
972 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
973 tx_macro_put_dec_enum);
974
975TX_MACRO_DAPM_ENUM_EXT(tx_dmic4, BOLERO_CDC_TX_INP_MUX_ADC_MUX4_CFG0,
976 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
977 tx_macro_put_dec_enum);
978
979TX_MACRO_DAPM_ENUM_EXT(tx_dmic5, BOLERO_CDC_TX_INP_MUX_ADC_MUX5_CFG0,
980 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
981 tx_macro_put_dec_enum);
982
983TX_MACRO_DAPM_ENUM_EXT(tx_dmic6, BOLERO_CDC_TX_INP_MUX_ADC_MUX6_CFG0,
984 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
985 tx_macro_put_dec_enum);
986
987TX_MACRO_DAPM_ENUM_EXT(tx_dmic7, BOLERO_CDC_TX_INP_MUX_ADC_MUX7_CFG0,
988 4, dmic_mux_text, snd_soc_dapm_get_enum_double,
989 tx_macro_put_dec_enum);
990
991static const char * const smic_mux_text[] = {
Sudheer Papothi324b4952019-06-11 04:14:51 +0530992 "ZERO", "ADC0", "ADC1", "ADC2", "ADC3", "SWR_DMIC0",
993 "SWR_DMIC1", "SWR_DMIC2", "SWR_DMIC3", "SWR_DMIC4",
994 "SWR_DMIC5", "SWR_DMIC6", "SWR_DMIC7"
Laxminath Kasam989fccf2018-06-15 16:53:31 +0530995};
996
997TX_MACRO_DAPM_ENUM_EXT(tx_smic0, BOLERO_CDC_TX_INP_MUX_ADC_MUX0_CFG0,
998 0, smic_mux_text, snd_soc_dapm_get_enum_double,
999 tx_macro_put_dec_enum);
1000
1001TX_MACRO_DAPM_ENUM_EXT(tx_smic1, BOLERO_CDC_TX_INP_MUX_ADC_MUX1_CFG0,
1002 0, smic_mux_text, snd_soc_dapm_get_enum_double,
1003 tx_macro_put_dec_enum);
1004
1005TX_MACRO_DAPM_ENUM_EXT(tx_smic2, BOLERO_CDC_TX_INP_MUX_ADC_MUX2_CFG0,
1006 0, smic_mux_text, snd_soc_dapm_get_enum_double,
1007 tx_macro_put_dec_enum);
1008
1009TX_MACRO_DAPM_ENUM_EXT(tx_smic3, BOLERO_CDC_TX_INP_MUX_ADC_MUX3_CFG0,
1010 0, smic_mux_text, snd_soc_dapm_get_enum_double,
1011 tx_macro_put_dec_enum);
1012
1013TX_MACRO_DAPM_ENUM_EXT(tx_smic4, BOLERO_CDC_TX_INP_MUX_ADC_MUX4_CFG0,
1014 0, smic_mux_text, snd_soc_dapm_get_enum_double,
1015 tx_macro_put_dec_enum);
1016
1017TX_MACRO_DAPM_ENUM_EXT(tx_smic5, BOLERO_CDC_TX_INP_MUX_ADC_MUX5_CFG0,
1018 0, smic_mux_text, snd_soc_dapm_get_enum_double,
1019 tx_macro_put_dec_enum);
1020
1021TX_MACRO_DAPM_ENUM_EXT(tx_smic6, BOLERO_CDC_TX_INP_MUX_ADC_MUX6_CFG0,
1022 0, smic_mux_text, snd_soc_dapm_get_enum_double,
1023 tx_macro_put_dec_enum);
1024
1025TX_MACRO_DAPM_ENUM_EXT(tx_smic7, BOLERO_CDC_TX_INP_MUX_ADC_MUX7_CFG0,
1026 0, smic_mux_text, snd_soc_dapm_get_enum_double,
1027 tx_macro_put_dec_enum);
1028
1029static const struct snd_kcontrol_new tx_aif1_cap_mixer[] = {
1030 SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, TX_MACRO_DEC0, 1, 0,
1031 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1032 SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, TX_MACRO_DEC1, 1, 0,
1033 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1034 SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, TX_MACRO_DEC2, 1, 0,
1035 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1036 SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, TX_MACRO_DEC3, 1, 0,
1037 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1038 SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, TX_MACRO_DEC4, 1, 0,
1039 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1040 SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, TX_MACRO_DEC5, 1, 0,
1041 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1042 SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, TX_MACRO_DEC6, 1, 0,
1043 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1044 SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, TX_MACRO_DEC7, 1, 0,
1045 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1046};
1047
1048static const struct snd_kcontrol_new tx_aif2_cap_mixer[] = {
1049 SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, TX_MACRO_DEC0, 1, 0,
1050 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1051 SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, TX_MACRO_DEC1, 1, 0,
1052 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1053 SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, TX_MACRO_DEC2, 1, 0,
1054 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1055 SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, TX_MACRO_DEC3, 1, 0,
1056 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1057 SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, TX_MACRO_DEC4, 1, 0,
1058 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1059 SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, TX_MACRO_DEC5, 1, 0,
1060 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1061 SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, TX_MACRO_DEC6, 1, 0,
1062 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1063 SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, TX_MACRO_DEC7, 1, 0,
1064 tx_macro_tx_mixer_get, tx_macro_tx_mixer_put),
1065};
1066
1067static const struct snd_soc_dapm_widget tx_macro_dapm_widgets[] = {
1068 SND_SOC_DAPM_AIF_OUT("TX_AIF1 CAP", "TX_AIF1 Capture", 0,
1069 SND_SOC_NOPM, TX_MACRO_AIF1_CAP, 0),
1070
1071 SND_SOC_DAPM_AIF_OUT("TX_AIF2 CAP", "TX_AIF2 Capture", 0,
1072 SND_SOC_NOPM, TX_MACRO_AIF2_CAP, 0),
1073
1074 SND_SOC_DAPM_MIXER("TX_AIF1_CAP Mixer", SND_SOC_NOPM, TX_MACRO_AIF1_CAP, 0,
1075 tx_aif1_cap_mixer, ARRAY_SIZE(tx_aif1_cap_mixer)),
1076
1077 SND_SOC_DAPM_MIXER("TX_AIF2_CAP Mixer", SND_SOC_NOPM, TX_MACRO_AIF2_CAP, 0,
1078 tx_aif2_cap_mixer, ARRAY_SIZE(tx_aif2_cap_mixer)),
1079
1080
1081 TX_MACRO_DAPM_MUX("TX DMIC MUX0", 0, tx_dmic0),
1082 TX_MACRO_DAPM_MUX("TX DMIC MUX1", 0, tx_dmic1),
1083 TX_MACRO_DAPM_MUX("TX DMIC MUX2", 0, tx_dmic2),
1084 TX_MACRO_DAPM_MUX("TX DMIC MUX3", 0, tx_dmic3),
1085 TX_MACRO_DAPM_MUX("TX DMIC MUX4", 0, tx_dmic4),
1086 TX_MACRO_DAPM_MUX("TX DMIC MUX5", 0, tx_dmic5),
1087 TX_MACRO_DAPM_MUX("TX DMIC MUX6", 0, tx_dmic6),
1088 TX_MACRO_DAPM_MUX("TX DMIC MUX7", 0, tx_dmic7),
1089
1090 TX_MACRO_DAPM_MUX("TX SMIC MUX0", 0, tx_smic0),
1091 TX_MACRO_DAPM_MUX("TX SMIC MUX1", 0, tx_smic1),
1092 TX_MACRO_DAPM_MUX("TX SMIC MUX2", 0, tx_smic2),
1093 TX_MACRO_DAPM_MUX("TX SMIC MUX3", 0, tx_smic3),
1094 TX_MACRO_DAPM_MUX("TX SMIC MUX4", 0, tx_smic4),
1095 TX_MACRO_DAPM_MUX("TX SMIC MUX5", 0, tx_smic5),
1096 TX_MACRO_DAPM_MUX("TX SMIC MUX6", 0, tx_smic6),
1097 TX_MACRO_DAPM_MUX("TX SMIC MUX7", 0, tx_smic7),
1098
1099 SND_SOC_DAPM_MICBIAS_E("TX MIC BIAS1", SND_SOC_NOPM, 0, 0,
1100 tx_macro_enable_micbias,
1101 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1102 SND_SOC_DAPM_ADC_E("TX DMIC0", NULL, SND_SOC_NOPM, 0, 0,
1103 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1104 SND_SOC_DAPM_POST_PMD),
1105
1106 SND_SOC_DAPM_ADC_E("TX DMIC1", NULL, SND_SOC_NOPM, 0, 0,
1107 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1108 SND_SOC_DAPM_POST_PMD),
1109
1110 SND_SOC_DAPM_ADC_E("TX DMIC2", NULL, SND_SOC_NOPM, 0, 0,
1111 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1112 SND_SOC_DAPM_POST_PMD),
1113
1114 SND_SOC_DAPM_ADC_E("TX DMIC3", NULL, SND_SOC_NOPM, 0, 0,
1115 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1116 SND_SOC_DAPM_POST_PMD),
1117
1118 SND_SOC_DAPM_ADC_E("TX DMIC4", NULL, SND_SOC_NOPM, 0, 0,
1119 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1120 SND_SOC_DAPM_POST_PMD),
1121
1122 SND_SOC_DAPM_ADC_E("TX DMIC5", NULL, SND_SOC_NOPM, 0, 0,
1123 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1124 SND_SOC_DAPM_POST_PMD),
1125
1126 SND_SOC_DAPM_ADC_E("TX DMIC6", NULL, SND_SOC_NOPM, 0, 0,
1127 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1128 SND_SOC_DAPM_POST_PMD),
1129
1130 SND_SOC_DAPM_ADC_E("TX DMIC7", NULL, SND_SOC_NOPM, 0, 0,
1131 tx_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1132 SND_SOC_DAPM_POST_PMD),
1133
1134 SND_SOC_DAPM_INPUT("TX SWR_ADC0"),
1135 SND_SOC_DAPM_INPUT("TX SWR_ADC1"),
1136 SND_SOC_DAPM_INPUT("TX SWR_ADC2"),
1137 SND_SOC_DAPM_INPUT("TX SWR_ADC3"),
1138 SND_SOC_DAPM_INPUT("TX SWR_DMIC0"),
1139 SND_SOC_DAPM_INPUT("TX SWR_DMIC1"),
1140 SND_SOC_DAPM_INPUT("TX SWR_DMIC2"),
1141 SND_SOC_DAPM_INPUT("TX SWR_DMIC3"),
1142 SND_SOC_DAPM_INPUT("TX SWR_DMIC4"),
1143 SND_SOC_DAPM_INPUT("TX SWR_DMIC5"),
1144 SND_SOC_DAPM_INPUT("TX SWR_DMIC6"),
1145 SND_SOC_DAPM_INPUT("TX SWR_DMIC7"),
1146
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301147 SND_SOC_DAPM_MUX_E("TX DEC0 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301148 TX_MACRO_DEC0, 0,
1149 &tx_dec0_mux, tx_macro_enable_dec,
1150 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1151 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1152
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301153 SND_SOC_DAPM_MUX_E("TX DEC1 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301154 TX_MACRO_DEC1, 0,
1155 &tx_dec1_mux, tx_macro_enable_dec,
1156 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1157 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1158
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301159 SND_SOC_DAPM_MUX_E("TX DEC2 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301160 TX_MACRO_DEC2, 0,
1161 &tx_dec2_mux, tx_macro_enable_dec,
1162 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1163 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1164
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301165 SND_SOC_DAPM_MUX_E("TX DEC3 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301166 TX_MACRO_DEC3, 0,
1167 &tx_dec3_mux, tx_macro_enable_dec,
1168 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1169 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1170
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301171 SND_SOC_DAPM_MUX_E("TX DEC4 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301172 TX_MACRO_DEC4, 0,
1173 &tx_dec4_mux, tx_macro_enable_dec,
1174 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1175 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1176
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301177 SND_SOC_DAPM_MUX_E("TX DEC5 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301178 TX_MACRO_DEC5, 0,
1179 &tx_dec5_mux, tx_macro_enable_dec,
1180 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1181 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1182
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301183 SND_SOC_DAPM_MUX_E("TX DEC6 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301184 TX_MACRO_DEC6, 0,
1185 &tx_dec6_mux, tx_macro_enable_dec,
1186 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1187 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1188
Ramprasad Katkamf83acfb2018-08-11 23:28:57 +05301189 SND_SOC_DAPM_MUX_E("TX DEC7 MUX", SND_SOC_NOPM,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301190 TX_MACRO_DEC7, 0,
1191 &tx_dec7_mux, tx_macro_enable_dec,
1192 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1193 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1194
1195 SND_SOC_DAPM_SUPPLY_S("TX_MCLK", 0, SND_SOC_NOPM, 0, 0,
1196 tx_macro_mclk_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301197
1198 SND_SOC_DAPM_SUPPLY_S("TX_SWR_CLK", 0, SND_SOC_NOPM, 0, 0,
1199 tx_macro_tx_swr_clk_event,
1200 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1201
1202 SND_SOC_DAPM_SUPPLY_S("VA_SWR_CLK", 0, SND_SOC_NOPM, 0, 0,
1203 tx_macro_va_swr_clk_event,
1204 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301205};
1206
1207static const struct snd_soc_dapm_route tx_audio_map[] = {
1208 {"TX_AIF1 CAP", NULL, "TX_MCLK"},
1209 {"TX_AIF2 CAP", NULL, "TX_MCLK"},
1210
1211 {"TX_AIF1 CAP", NULL, "TX_AIF1_CAP Mixer"},
1212 {"TX_AIF2 CAP", NULL, "TX_AIF2_CAP Mixer"},
1213
1214 {"TX_AIF1_CAP Mixer", "DEC0", "TX DEC0 MUX"},
1215 {"TX_AIF1_CAP Mixer", "DEC1", "TX DEC1 MUX"},
1216 {"TX_AIF1_CAP Mixer", "DEC2", "TX DEC2 MUX"},
1217 {"TX_AIF1_CAP Mixer", "DEC3", "TX DEC3 MUX"},
1218 {"TX_AIF1_CAP Mixer", "DEC4", "TX DEC4 MUX"},
1219 {"TX_AIF1_CAP Mixer", "DEC5", "TX DEC5 MUX"},
1220 {"TX_AIF1_CAP Mixer", "DEC6", "TX DEC6 MUX"},
1221 {"TX_AIF1_CAP Mixer", "DEC7", "TX DEC7 MUX"},
1222
1223 {"TX_AIF2_CAP Mixer", "DEC0", "TX DEC0 MUX"},
1224 {"TX_AIF2_CAP Mixer", "DEC1", "TX DEC1 MUX"},
1225 {"TX_AIF2_CAP Mixer", "DEC2", "TX DEC2 MUX"},
1226 {"TX_AIF2_CAP Mixer", "DEC3", "TX DEC3 MUX"},
1227 {"TX_AIF2_CAP Mixer", "DEC4", "TX DEC4 MUX"},
1228 {"TX_AIF2_CAP Mixer", "DEC5", "TX DEC5 MUX"},
1229 {"TX_AIF2_CAP Mixer", "DEC6", "TX DEC6 MUX"},
1230 {"TX_AIF2_CAP Mixer", "DEC7", "TX DEC7 MUX"},
1231
Laxminath Kasamfc281ad2018-08-06 20:19:40 +05301232 {"TX DEC0 MUX", NULL, "TX_MCLK"},
1233 {"TX DEC1 MUX", NULL, "TX_MCLK"},
1234 {"TX DEC2 MUX", NULL, "TX_MCLK"},
1235 {"TX DEC3 MUX", NULL, "TX_MCLK"},
1236 {"TX DEC4 MUX", NULL, "TX_MCLK"},
1237 {"TX DEC5 MUX", NULL, "TX_MCLK"},
1238 {"TX DEC6 MUX", NULL, "TX_MCLK"},
1239 {"TX DEC7 MUX", NULL, "TX_MCLK"},
1240
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301241 {"TX DEC0 MUX", "MSM_DMIC", "TX DMIC MUX0"},
1242 {"TX DMIC MUX0", "DMIC0", "TX DMIC0"},
1243 {"TX DMIC MUX0", "DMIC1", "TX DMIC1"},
1244 {"TX DMIC MUX0", "DMIC2", "TX DMIC2"},
1245 {"TX DMIC MUX0", "DMIC3", "TX DMIC3"},
1246 {"TX DMIC MUX0", "DMIC4", "TX DMIC4"},
1247 {"TX DMIC MUX0", "DMIC5", "TX DMIC5"},
1248 {"TX DMIC MUX0", "DMIC6", "TX DMIC6"},
1249 {"TX DMIC MUX0", "DMIC7", "TX DMIC7"},
1250
1251 {"TX DEC0 MUX", "SWR_MIC", "TX SMIC MUX0"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301252 {"TX SMIC MUX0", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301253 {"TX SMIC MUX0", "ADC0", "TX SWR_ADC0"},
1254 {"TX SMIC MUX0", "ADC1", "TX SWR_ADC1"},
1255 {"TX SMIC MUX0", "ADC2", "TX SWR_ADC2"},
1256 {"TX SMIC MUX0", "ADC3", "TX SWR_ADC3"},
1257 {"TX SMIC MUX0", "SWR_DMIC0", "TX SWR_DMIC0"},
1258 {"TX SMIC MUX0", "SWR_DMIC1", "TX SWR_DMIC1"},
1259 {"TX SMIC MUX0", "SWR_DMIC2", "TX SWR_DMIC2"},
1260 {"TX SMIC MUX0", "SWR_DMIC3", "TX SWR_DMIC3"},
1261 {"TX SMIC MUX0", "SWR_DMIC4", "TX SWR_DMIC4"},
1262 {"TX SMIC MUX0", "SWR_DMIC5", "TX SWR_DMIC5"},
1263 {"TX SMIC MUX0", "SWR_DMIC6", "TX SWR_DMIC6"},
1264 {"TX SMIC MUX0", "SWR_DMIC7", "TX SWR_DMIC7"},
1265
1266 {"TX DEC1 MUX", "MSM_DMIC", "TX DMIC MUX1"},
1267 {"TX DMIC MUX1", "DMIC0", "TX DMIC0"},
1268 {"TX DMIC MUX1", "DMIC1", "TX DMIC1"},
1269 {"TX DMIC MUX1", "DMIC2", "TX DMIC2"},
1270 {"TX DMIC MUX1", "DMIC3", "TX DMIC3"},
1271 {"TX DMIC MUX1", "DMIC4", "TX DMIC4"},
1272 {"TX DMIC MUX1", "DMIC5", "TX DMIC5"},
1273 {"TX DMIC MUX1", "DMIC6", "TX DMIC6"},
1274 {"TX DMIC MUX1", "DMIC7", "TX DMIC7"},
1275
1276 {"TX DEC1 MUX", "SWR_MIC", "TX SMIC MUX1"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301277 {"TX SMIC MUX1", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301278 {"TX SMIC MUX1", "ADC0", "TX SWR_ADC0"},
1279 {"TX SMIC MUX1", "ADC1", "TX SWR_ADC1"},
1280 {"TX SMIC MUX1", "ADC2", "TX SWR_ADC2"},
1281 {"TX SMIC MUX1", "ADC3", "TX SWR_ADC3"},
1282 {"TX SMIC MUX1", "SWR_DMIC0", "TX SWR_DMIC0"},
1283 {"TX SMIC MUX1", "SWR_DMIC1", "TX SWR_DMIC1"},
1284 {"TX SMIC MUX1", "SWR_DMIC2", "TX SWR_DMIC2"},
1285 {"TX SMIC MUX1", "SWR_DMIC3", "TX SWR_DMIC3"},
1286 {"TX SMIC MUX1", "SWR_DMIC4", "TX SWR_DMIC4"},
1287 {"TX SMIC MUX1", "SWR_DMIC5", "TX SWR_DMIC5"},
1288 {"TX SMIC MUX1", "SWR_DMIC6", "TX SWR_DMIC6"},
1289 {"TX SMIC MUX1", "SWR_DMIC7", "TX SWR_DMIC7"},
1290
1291 {"TX DEC2 MUX", "MSM_DMIC", "TX DMIC MUX2"},
1292 {"TX DMIC MUX2", "DMIC0", "TX DMIC0"},
1293 {"TX DMIC MUX2", "DMIC1", "TX DMIC1"},
1294 {"TX DMIC MUX2", "DMIC2", "TX DMIC2"},
1295 {"TX DMIC MUX2", "DMIC3", "TX DMIC3"},
1296 {"TX DMIC MUX2", "DMIC4", "TX DMIC4"},
1297 {"TX DMIC MUX2", "DMIC5", "TX DMIC5"},
1298 {"TX DMIC MUX2", "DMIC6", "TX DMIC6"},
1299 {"TX DMIC MUX2", "DMIC7", "TX DMIC7"},
1300
1301 {"TX DEC2 MUX", "SWR_MIC", "TX SMIC MUX2"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301302 {"TX SMIC MUX2", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301303 {"TX SMIC MUX2", "ADC0", "TX SWR_ADC0"},
1304 {"TX SMIC MUX2", "ADC1", "TX SWR_ADC1"},
1305 {"TX SMIC MUX2", "ADC2", "TX SWR_ADC2"},
1306 {"TX SMIC MUX2", "ADC3", "TX SWR_ADC3"},
1307 {"TX SMIC MUX2", "SWR_DMIC0", "TX SWR_DMIC0"},
1308 {"TX SMIC MUX2", "SWR_DMIC1", "TX SWR_DMIC1"},
1309 {"TX SMIC MUX2", "SWR_DMIC2", "TX SWR_DMIC2"},
1310 {"TX SMIC MUX2", "SWR_DMIC3", "TX SWR_DMIC3"},
1311 {"TX SMIC MUX2", "SWR_DMIC4", "TX SWR_DMIC4"},
1312 {"TX SMIC MUX2", "SWR_DMIC5", "TX SWR_DMIC5"},
1313 {"TX SMIC MUX2", "SWR_DMIC6", "TX SWR_DMIC6"},
1314 {"TX SMIC MUX2", "SWR_DMIC7", "TX SWR_DMIC7"},
1315
1316 {"TX DEC3 MUX", "MSM_DMIC", "TX DMIC MUX3"},
1317 {"TX DMIC MUX3", "DMIC0", "TX DMIC0"},
1318 {"TX DMIC MUX3", "DMIC1", "TX DMIC1"},
1319 {"TX DMIC MUX3", "DMIC2", "TX DMIC2"},
1320 {"TX DMIC MUX3", "DMIC3", "TX DMIC3"},
1321 {"TX DMIC MUX3", "DMIC4", "TX DMIC4"},
1322 {"TX DMIC MUX3", "DMIC5", "TX DMIC5"},
1323 {"TX DMIC MUX3", "DMIC6", "TX DMIC6"},
1324 {"TX DMIC MUX3", "DMIC7", "TX DMIC7"},
1325
1326 {"TX DEC3 MUX", "SWR_MIC", "TX SMIC MUX3"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301327 {"TX SMIC MUX3", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301328 {"TX SMIC MUX3", "ADC0", "TX SWR_ADC0"},
1329 {"TX SMIC MUX3", "ADC1", "TX SWR_ADC1"},
1330 {"TX SMIC MUX3", "ADC2", "TX SWR_ADC2"},
1331 {"TX SMIC MUX3", "ADC3", "TX SWR_ADC3"},
1332 {"TX SMIC MUX3", "SWR_DMIC0", "TX SWR_DMIC0"},
1333 {"TX SMIC MUX3", "SWR_DMIC1", "TX SWR_DMIC1"},
1334 {"TX SMIC MUX3", "SWR_DMIC2", "TX SWR_DMIC2"},
1335 {"TX SMIC MUX3", "SWR_DMIC3", "TX SWR_DMIC3"},
1336 {"TX SMIC MUX3", "SWR_DMIC4", "TX SWR_DMIC4"},
1337 {"TX SMIC MUX3", "SWR_DMIC5", "TX SWR_DMIC5"},
1338 {"TX SMIC MUX3", "SWR_DMIC6", "TX SWR_DMIC6"},
1339 {"TX SMIC MUX3", "SWR_DMIC7", "TX SWR_DMIC7"},
1340
1341 {"TX DEC4 MUX", "MSM_DMIC", "TX DMIC MUX4"},
1342 {"TX DMIC MUX4", "DMIC0", "TX DMIC0"},
1343 {"TX DMIC MUX4", "DMIC1", "TX DMIC1"},
1344 {"TX DMIC MUX4", "DMIC2", "TX DMIC2"},
1345 {"TX DMIC MUX4", "DMIC3", "TX DMIC3"},
1346 {"TX DMIC MUX4", "DMIC4", "TX DMIC4"},
1347 {"TX DMIC MUX4", "DMIC5", "TX DMIC5"},
1348 {"TX DMIC MUX4", "DMIC6", "TX DMIC6"},
1349 {"TX DMIC MUX4", "DMIC7", "TX DMIC7"},
1350
1351 {"TX DEC4 MUX", "SWR_MIC", "TX SMIC MUX4"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301352 {"TX SMIC MUX4", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301353 {"TX SMIC MUX4", "ADC0", "TX SWR_ADC0"},
1354 {"TX SMIC MUX4", "ADC1", "TX SWR_ADC1"},
1355 {"TX SMIC MUX4", "ADC2", "TX SWR_ADC2"},
1356 {"TX SMIC MUX4", "ADC3", "TX SWR_ADC3"},
1357 {"TX SMIC MUX4", "SWR_DMIC0", "TX SWR_DMIC0"},
1358 {"TX SMIC MUX4", "SWR_DMIC1", "TX SWR_DMIC1"},
1359 {"TX SMIC MUX4", "SWR_DMIC2", "TX SWR_DMIC2"},
1360 {"TX SMIC MUX4", "SWR_DMIC3", "TX SWR_DMIC3"},
1361 {"TX SMIC MUX4", "SWR_DMIC4", "TX SWR_DMIC4"},
1362 {"TX SMIC MUX4", "SWR_DMIC5", "TX SWR_DMIC5"},
1363 {"TX SMIC MUX4", "SWR_DMIC6", "TX SWR_DMIC6"},
1364 {"TX SMIC MUX4", "SWR_DMIC7", "TX SWR_DMIC7"},
1365
1366 {"TX DEC5 MUX", "MSM_DMIC", "TX DMIC MUX5"},
1367 {"TX DMIC MUX5", "DMIC0", "TX DMIC0"},
1368 {"TX DMIC MUX5", "DMIC1", "TX DMIC1"},
1369 {"TX DMIC MUX5", "DMIC2", "TX DMIC2"},
1370 {"TX DMIC MUX5", "DMIC3", "TX DMIC3"},
1371 {"TX DMIC MUX5", "DMIC4", "TX DMIC4"},
1372 {"TX DMIC MUX5", "DMIC5", "TX DMIC5"},
1373 {"TX DMIC MUX5", "DMIC6", "TX DMIC6"},
1374 {"TX DMIC MUX5", "DMIC7", "TX DMIC7"},
1375
1376 {"TX DEC5 MUX", "SWR_MIC", "TX SMIC MUX5"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301377 {"TX SMIC MUX5", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301378 {"TX SMIC MUX5", "ADC0", "TX SWR_ADC0"},
1379 {"TX SMIC MUX5", "ADC1", "TX SWR_ADC1"},
1380 {"TX SMIC MUX5", "ADC2", "TX SWR_ADC2"},
1381 {"TX SMIC MUX5", "ADC3", "TX SWR_ADC3"},
1382 {"TX SMIC MUX5", "SWR_DMIC0", "TX SWR_DMIC0"},
1383 {"TX SMIC MUX5", "SWR_DMIC1", "TX SWR_DMIC1"},
1384 {"TX SMIC MUX5", "SWR_DMIC2", "TX SWR_DMIC2"},
1385 {"TX SMIC MUX5", "SWR_DMIC3", "TX SWR_DMIC3"},
1386 {"TX SMIC MUX5", "SWR_DMIC4", "TX SWR_DMIC4"},
1387 {"TX SMIC MUX5", "SWR_DMIC5", "TX SWR_DMIC5"},
1388 {"TX SMIC MUX5", "SWR_DMIC6", "TX SWR_DMIC6"},
1389 {"TX SMIC MUX5", "SWR_DMIC7", "TX SWR_DMIC7"},
1390
1391 {"TX DEC6 MUX", "MSM_DMIC", "TX DMIC MUX6"},
1392 {"TX DMIC MUX6", "DMIC0", "TX DMIC0"},
1393 {"TX DMIC MUX6", "DMIC1", "TX DMIC1"},
1394 {"TX DMIC MUX6", "DMIC2", "TX DMIC2"},
1395 {"TX DMIC MUX6", "DMIC3", "TX DMIC3"},
1396 {"TX DMIC MUX6", "DMIC4", "TX DMIC4"},
1397 {"TX DMIC MUX6", "DMIC5", "TX DMIC5"},
1398 {"TX DMIC MUX6", "DMIC6", "TX DMIC6"},
1399 {"TX DMIC MUX6", "DMIC7", "TX DMIC7"},
1400
1401 {"TX DEC6 MUX", "SWR_MIC", "TX SMIC MUX6"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301402 {"TX SMIC MUX6", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301403 {"TX SMIC MUX6", "ADC0", "TX SWR_ADC0"},
1404 {"TX SMIC MUX6", "ADC1", "TX SWR_ADC1"},
1405 {"TX SMIC MUX6", "ADC2", "TX SWR_ADC2"},
1406 {"TX SMIC MUX6", "ADC3", "TX SWR_ADC3"},
1407 {"TX SMIC MUX6", "SWR_DMIC0", "TX SWR_DMIC0"},
1408 {"TX SMIC MUX6", "SWR_DMIC1", "TX SWR_DMIC1"},
1409 {"TX SMIC MUX6", "SWR_DMIC2", "TX SWR_DMIC2"},
1410 {"TX SMIC MUX6", "SWR_DMIC3", "TX SWR_DMIC3"},
1411 {"TX SMIC MUX6", "SWR_DMIC4", "TX SWR_DMIC4"},
1412 {"TX SMIC MUX6", "SWR_DMIC5", "TX SWR_DMIC5"},
1413 {"TX SMIC MUX6", "SWR_DMIC6", "TX SWR_DMIC6"},
1414 {"TX SMIC MUX6", "SWR_DMIC7", "TX SWR_DMIC7"},
1415
1416 {"TX DEC7 MUX", "MSM_DMIC", "TX DMIC MUX7"},
1417 {"TX DMIC MUX7", "DMIC0", "TX DMIC0"},
1418 {"TX DMIC MUX7", "DMIC1", "TX DMIC1"},
1419 {"TX DMIC MUX7", "DMIC2", "TX DMIC2"},
1420 {"TX DMIC MUX7", "DMIC3", "TX DMIC3"},
1421 {"TX DMIC MUX7", "DMIC4", "TX DMIC4"},
1422 {"TX DMIC MUX7", "DMIC5", "TX DMIC5"},
1423 {"TX DMIC MUX7", "DMIC6", "TX DMIC6"},
1424 {"TX DMIC MUX7", "DMIC7", "TX DMIC7"},
1425
1426 {"TX DEC7 MUX", "SWR_MIC", "TX SMIC MUX7"},
Sudheer Papothie456c2c2019-03-05 07:08:45 +05301427 {"TX SMIC MUX7", NULL, "TX_SWR_CLK"},
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301428 {"TX SMIC MUX7", "ADC0", "TX SWR_ADC0"},
1429 {"TX SMIC MUX7", "ADC1", "TX SWR_ADC1"},
1430 {"TX SMIC MUX7", "ADC2", "TX SWR_ADC2"},
1431 {"TX SMIC MUX7", "ADC3", "TX SWR_ADC3"},
1432 {"TX SMIC MUX7", "SWR_DMIC0", "TX SWR_DMIC0"},
1433 {"TX SMIC MUX7", "SWR_DMIC1", "TX SWR_DMIC1"},
1434 {"TX SMIC MUX7", "SWR_DMIC2", "TX SWR_DMIC2"},
1435 {"TX SMIC MUX7", "SWR_DMIC3", "TX SWR_DMIC3"},
1436 {"TX SMIC MUX7", "SWR_DMIC4", "TX SWR_DMIC4"},
1437 {"TX SMIC MUX7", "SWR_DMIC5", "TX SWR_DMIC5"},
1438 {"TX SMIC MUX7", "SWR_DMIC6", "TX SWR_DMIC6"},
1439 {"TX SMIC MUX7", "SWR_DMIC7", "TX SWR_DMIC7"},
1440};
1441
1442static const struct snd_kcontrol_new tx_macro_snd_controls[] = {
1443 SOC_SINGLE_SX_TLV("TX_DEC0 Volume",
1444 BOLERO_CDC_TX0_TX_VOL_CTL,
1445 0, -84, 40, digital_gain),
1446 SOC_SINGLE_SX_TLV("TX_DEC1 Volume",
1447 BOLERO_CDC_TX1_TX_VOL_CTL,
1448 0, -84, 40, digital_gain),
1449 SOC_SINGLE_SX_TLV("TX_DEC2 Volume",
1450 BOLERO_CDC_TX2_TX_VOL_CTL,
1451 0, -84, 40, digital_gain),
1452 SOC_SINGLE_SX_TLV("TX_DEC3 Volume",
1453 BOLERO_CDC_TX3_TX_VOL_CTL,
1454 0, -84, 40, digital_gain),
1455 SOC_SINGLE_SX_TLV("TX_DEC4 Volume",
1456 BOLERO_CDC_TX4_TX_VOL_CTL,
1457 0, -84, 40, digital_gain),
1458 SOC_SINGLE_SX_TLV("TX_DEC5 Volume",
1459 BOLERO_CDC_TX5_TX_VOL_CTL,
1460 0, -84, 40, digital_gain),
1461 SOC_SINGLE_SX_TLV("TX_DEC6 Volume",
1462 BOLERO_CDC_TX6_TX_VOL_CTL,
1463 0, -84, 40, digital_gain),
1464 SOC_SINGLE_SX_TLV("TX_DEC7 Volume",
1465 BOLERO_CDC_TX7_TX_VOL_CTL,
1466 0, -84, 40, digital_gain),
1467};
1468
Sudheer Papothia7397942019-03-19 03:14:23 +05301469static int tx_macro_tx_va_mclk_enable(struct tx_macro_priv *tx_priv,
1470 struct regmap *regmap, int clk_type,
1471 bool enable)
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301472{
Meng Wang69b55c82019-05-29 11:04:29 +08001473 int ret = 0, clk_tx_ret = 0;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301474
Sudheer Papothi7601cc62019-03-30 03:00:52 +05301475 dev_dbg(tx_priv->dev,
1476 "%s: clock type %s, enable: %s tx_mclk_users: %d\n",
Sudheer Papothia7397942019-03-19 03:14:23 +05301477 __func__, (clk_type ? "VA_MCLK" : "TX_MCLK"),
Sudheer Papothi7601cc62019-03-30 03:00:52 +05301478 (enable ? "enable" : "disable"), tx_priv->tx_mclk_users);
Tanya Dixit8530fb92018-09-14 16:01:25 +05301479
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301480 if (enable) {
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301481 if (tx_priv->swr_clk_users == 0)
Karthikeyan Mani01f1ba42019-02-26 18:48:15 -08001482 msm_cdc_pinctrl_select_active_state(
1483 tx_priv->tx_swr_gpio_p);
Sudheer Papothia7397942019-03-19 03:14:23 +05301484
Meng Wang69b55c82019-05-29 11:04:29 +08001485 clk_tx_ret = bolero_clk_rsc_request_clock(tx_priv->dev,
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301486 TX_CORE_CLK,
1487 TX_CORE_CLK,
1488 true);
1489 if (clk_type == TX_MCLK) {
1490 ret = tx_macro_mclk_enable(tx_priv, 1);
1491 if (ret < 0) {
1492 if (tx_priv->swr_clk_users == 0)
1493 msm_cdc_pinctrl_select_sleep_state(
1494 tx_priv->tx_swr_gpio_p);
1495 dev_err_ratelimited(tx_priv->dev,
1496 "%s: request clock enable failed\n",
1497 __func__);
1498 goto done;
1499 }
1500 }
1501 if (clk_type == VA_MCLK) {
Sudheer Papothia7397942019-03-19 03:14:23 +05301502 ret = bolero_clk_rsc_request_clock(tx_priv->dev,
1503 TX_CORE_CLK,
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301504 VA_CORE_CLK,
Sudheer Papothia7397942019-03-19 03:14:23 +05301505 true);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301506 if (ret < 0) {
1507 if (tx_priv->swr_clk_users == 0)
Sudheer Papothia7397942019-03-19 03:14:23 +05301508 msm_cdc_pinctrl_select_sleep_state(
1509 tx_priv->tx_swr_gpio_p);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301510 dev_err_ratelimited(tx_priv->dev,
1511 "%s: swr request clk failed\n",
1512 __func__);
1513 goto done;
Sudheer Papothia7397942019-03-19 03:14:23 +05301514 }
Sudheer Papothi296867b2019-06-20 09:24:09 +05301515 bolero_clk_rsc_fs_gen_request(tx_priv->dev,
1516 true);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301517 if (tx_priv->tx_mclk_users == 0) {
1518 regmap_update_bits(regmap,
1519 BOLERO_CDC_TX_TOP_CSR_FREQ_MCLK,
1520 0x01, 0x01);
1521 regmap_update_bits(regmap,
1522 BOLERO_CDC_TX_CLK_RST_CTRL_MCLK_CONTROL,
1523 0x01, 0x01);
1524 regmap_update_bits(regmap,
1525 BOLERO_CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL,
1526 0x01, 0x01);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301527 }
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301528 }
1529 if (tx_priv->swr_clk_users == 0) {
Sudheer Papothi7601cc62019-03-30 03:00:52 +05301530 dev_dbg(tx_priv->dev, "%s: reset_swr: %d\n",
1531 __func__, tx_priv->reset_swr);
Ramprasad Katkama4c747b2018-12-11 19:15:53 +05301532 if (tx_priv->reset_swr)
1533 regmap_update_bits(regmap,
1534 BOLERO_CDC_TX_CLK_RST_CTRL_SWR_CONTROL,
1535 0x02, 0x02);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301536 regmap_update_bits(regmap,
1537 BOLERO_CDC_TX_CLK_RST_CTRL_SWR_CONTROL,
1538 0x01, 0x01);
Ramprasad Katkama4c747b2018-12-11 19:15:53 +05301539 if (tx_priv->reset_swr)
1540 regmap_update_bits(regmap,
1541 BOLERO_CDC_TX_CLK_RST_CTRL_SWR_CONTROL,
1542 0x02, 0x00);
1543 tx_priv->reset_swr = false;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301544 }
Meng Wang69b55c82019-05-29 11:04:29 +08001545 if (!clk_tx_ret)
1546 ret = bolero_clk_rsc_request_clock(tx_priv->dev,
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301547 TX_CORE_CLK,
1548 TX_CORE_CLK,
1549 false);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301550 tx_priv->swr_clk_users++;
1551 } else {
1552 if (tx_priv->swr_clk_users <= 0) {
Sudheer Papothia7397942019-03-19 03:14:23 +05301553 dev_err_ratelimited(tx_priv->dev,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301554 "tx swrm clock users already 0\n");
1555 tx_priv->swr_clk_users = 0;
Sudheer Papothia7397942019-03-19 03:14:23 +05301556 return 0;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301557 }
Meng Wang69b55c82019-05-29 11:04:29 +08001558 clk_tx_ret = bolero_clk_rsc_request_clock(tx_priv->dev,
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301559 TX_CORE_CLK,
1560 TX_CORE_CLK,
1561 true);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301562 tx_priv->swr_clk_users--;
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301563 if (tx_priv->swr_clk_users == 0)
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301564 regmap_update_bits(regmap,
1565 BOLERO_CDC_TX_CLK_RST_CTRL_SWR_CONTROL,
1566 0x01, 0x00);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301567 if (clk_type == TX_MCLK)
1568 tx_macro_mclk_enable(tx_priv, 0);
1569 if (clk_type == VA_MCLK) {
1570 if (tx_priv->tx_mclk_users == 0) {
1571 regmap_update_bits(regmap,
1572 BOLERO_CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL,
1573 0x01, 0x00);
1574 regmap_update_bits(regmap,
1575 BOLERO_CDC_TX_CLK_RST_CTRL_MCLK_CONTROL,
1576 0x01, 0x00);
Sudheer Papothia7397942019-03-19 03:14:23 +05301577 }
Sudheer Papothi296867b2019-06-20 09:24:09 +05301578 bolero_clk_rsc_fs_gen_request(tx_priv->dev,
1579 false);
Sudheer Papothia7397942019-03-19 03:14:23 +05301580 ret = bolero_clk_rsc_request_clock(tx_priv->dev,
1581 TX_CORE_CLK,
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301582 VA_CORE_CLK,
Sudheer Papothia7397942019-03-19 03:14:23 +05301583 false);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301584 if (ret < 0) {
1585 dev_err_ratelimited(tx_priv->dev,
1586 "%s: swr request clk failed\n",
1587 __func__);
1588 goto done;
1589 }
1590 }
Meng Wang69b55c82019-05-29 11:04:29 +08001591 if (!clk_tx_ret)
1592 ret = bolero_clk_rsc_request_clock(tx_priv->dev,
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301593 TX_CORE_CLK,
1594 TX_CORE_CLK,
1595 false);
1596 if (tx_priv->swr_clk_users == 0)
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301597 msm_cdc_pinctrl_select_sleep_state(
1598 tx_priv->tx_swr_gpio_p);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301599 }
Sudheer Papothia7397942019-03-19 03:14:23 +05301600 return 0;
1601
1602done:
Meng Wang69b55c82019-05-29 11:04:29 +08001603 if (!clk_tx_ret)
1604 bolero_clk_rsc_request_clock(tx_priv->dev,
Sudheer Papothia7397942019-03-19 03:14:23 +05301605 TX_CORE_CLK,
1606 TX_CORE_CLK,
1607 false);
1608 return ret;
1609}
1610
Sudheer Papothi6cc7f522019-06-28 11:04:03 +05301611static int tx_macro_clk_switch(struct snd_soc_component *component)
1612{
1613 struct device *tx_dev = NULL;
1614 struct tx_macro_priv *tx_priv = NULL;
1615 int ret = 0;
1616
1617 if (!component)
1618 return -EINVAL;
1619
1620 tx_dev = bolero_get_device_ptr(component->dev, TX_MACRO);
1621 if (!tx_dev) {
1622 dev_err(component->dev,
1623 "%s: null device for macro!\n", __func__);
1624 return -EINVAL;
1625 }
1626 tx_priv = dev_get_drvdata(tx_dev);
1627 if (!tx_priv) {
1628 dev_err(component->dev,
1629 "%s: priv is null for macro!\n", __func__);
1630 return -EINVAL;
1631 }
1632 if (tx_priv->swr_ctrl_data) {
1633 ret = swrm_wcd_notify(
1634 tx_priv->swr_ctrl_data[0].tx_swr_pdev,
1635 SWR_REQ_CLK_SWITCH, NULL);
1636 }
1637
1638 return ret;
1639}
1640
Sudheer Papothia7397942019-03-19 03:14:23 +05301641static int tx_macro_swrm_clock(void *handle, bool enable)
1642{
1643 struct tx_macro_priv *tx_priv = (struct tx_macro_priv *) handle;
1644 struct regmap *regmap = dev_get_regmap(tx_priv->dev->parent, NULL);
1645 int ret = 0;
1646
1647 if (regmap == NULL) {
1648 dev_err(tx_priv->dev, "%s: regmap is NULL\n", __func__);
1649 return -EINVAL;
1650 }
1651
1652 mutex_lock(&tx_priv->swr_clk_lock);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301653 dev_dbg(tx_priv->dev,
1654 "%s: swrm clock %s tx_swr_clk_cnt: %d va_swr_clk_cnt: %d\n",
1655 __func__, (enable ? "enable" : "disable"),
1656 tx_priv->tx_swr_clk_cnt, tx_priv->va_swr_clk_cnt);
Sudheer Papothia7397942019-03-19 03:14:23 +05301657
1658 if (enable) {
Sudheer Papothi7601cc62019-03-30 03:00:52 +05301659 pm_runtime_get_sync(tx_priv->dev);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301660 if (tx_priv->va_swr_clk_cnt && !tx_priv->tx_swr_clk_cnt) {
Sudheer Papothia7397942019-03-19 03:14:23 +05301661 ret = tx_macro_tx_va_mclk_enable(tx_priv, regmap,
1662 VA_MCLK, enable);
1663 if (ret)
1664 goto done;
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301665 tx_priv->va_clk_status++;
Sudheer Papothia7397942019-03-19 03:14:23 +05301666 } else {
Sudheer Papothia7397942019-03-19 03:14:23 +05301667 ret = tx_macro_tx_va_mclk_enable(tx_priv, regmap,
1668 TX_MCLK, enable);
1669 if (ret)
1670 goto done;
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301671 tx_priv->tx_clk_status++;
Sudheer Papothia7397942019-03-19 03:14:23 +05301672 }
Sudheer Papothi7601cc62019-03-30 03:00:52 +05301673 pm_runtime_mark_last_busy(tx_priv->dev);
1674 pm_runtime_put_autosuspend(tx_priv->dev);
Sudheer Papothia7397942019-03-19 03:14:23 +05301675 } else {
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301676 if (tx_priv->va_clk_status && !tx_priv->tx_clk_status) {
Sudheer Papothia7397942019-03-19 03:14:23 +05301677 ret = tx_macro_tx_va_mclk_enable(tx_priv, regmap,
1678 VA_MCLK, enable);
1679 if (ret)
1680 goto done;
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301681 --tx_priv->va_clk_status;
1682 } else if (!tx_priv->va_clk_status && tx_priv->tx_clk_status) {
Sudheer Papothia7397942019-03-19 03:14:23 +05301683 ret = tx_macro_tx_va_mclk_enable(tx_priv, regmap,
1684 TX_MCLK, enable);
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301685 if (ret)
1686 goto done;
1687 --tx_priv->tx_clk_status;
1688 } else if (tx_priv->va_clk_status && tx_priv->tx_clk_status) {
1689 if (!tx_priv->va_swr_clk_cnt && tx_priv->tx_swr_clk_cnt) {
1690 ret = tx_macro_tx_va_mclk_enable(tx_priv, regmap,
1691 VA_MCLK, enable);
Sudheer Papothia7397942019-03-19 03:14:23 +05301692 if (ret)
1693 goto done;
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301694 --tx_priv->va_clk_status;
1695 } else {
1696 ret = tx_macro_tx_va_mclk_enable(tx_priv, regmap,
1697 TX_MCLK, enable);
1698 if (ret)
1699 goto done;
1700 --tx_priv->tx_clk_status;
Sudheer Papothia7397942019-03-19 03:14:23 +05301701 }
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301702
1703 } else {
1704 dev_dbg(tx_priv->dev,
1705 "%s: Both clocks are disabled\n", __func__);
Sudheer Papothia7397942019-03-19 03:14:23 +05301706 }
1707 }
Sudheer Papothicf3b4062019-05-10 10:48:43 +05301708
1709 dev_dbg(tx_priv->dev,
1710 "%s: swrm clock users %d tx_clk_sts_cnt: %d va_clk_sts_cnt: %d\n",
1711 __func__, tx_priv->swr_clk_users, tx_priv->tx_clk_status,
1712 tx_priv->va_clk_status);
Sudheer Papothia7397942019-03-19 03:14:23 +05301713done:
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301714 mutex_unlock(&tx_priv->swr_clk_lock);
1715 return ret;
1716}
1717
1718static int tx_macro_validate_dmic_sample_rate(u32 dmic_sample_rate,
1719 struct tx_macro_priv *tx_priv)
1720{
1721 u32 div_factor = TX_MACRO_CLK_DIV_2;
1722 u32 mclk_rate = TX_MACRO_MCLK_FREQ;
1723
1724 if (dmic_sample_rate == TX_MACRO_DMIC_SAMPLE_RATE_UNDEFINED ||
1725 mclk_rate % dmic_sample_rate != 0)
1726 goto undefined_rate;
1727
1728 div_factor = mclk_rate / dmic_sample_rate;
1729
1730 switch (div_factor) {
1731 case 2:
1732 tx_priv->dmic_clk_div = TX_MACRO_CLK_DIV_2;
1733 break;
1734 case 3:
1735 tx_priv->dmic_clk_div = TX_MACRO_CLK_DIV_3;
1736 break;
1737 case 4:
1738 tx_priv->dmic_clk_div = TX_MACRO_CLK_DIV_4;
1739 break;
1740 case 6:
1741 tx_priv->dmic_clk_div = TX_MACRO_CLK_DIV_6;
1742 break;
1743 case 8:
1744 tx_priv->dmic_clk_div = TX_MACRO_CLK_DIV_8;
1745 break;
1746 case 16:
1747 tx_priv->dmic_clk_div = TX_MACRO_CLK_DIV_16;
1748 break;
1749 default:
1750 /* Any other DIV factor is invalid */
1751 goto undefined_rate;
1752 }
1753
1754 /* Valid dmic DIV factors */
1755 dev_dbg(tx_priv->dev, "%s: DMIC_DIV = %u, mclk_rate = %u\n",
1756 __func__, div_factor, mclk_rate);
1757
1758 return dmic_sample_rate;
1759
1760undefined_rate:
1761 dev_dbg(tx_priv->dev, "%s: Invalid rate %d, for mclk %d\n",
1762 __func__, dmic_sample_rate, mclk_rate);
1763 dmic_sample_rate = TX_MACRO_DMIC_SAMPLE_RATE_UNDEFINED;
1764
1765 return dmic_sample_rate;
1766}
1767
Meng Wang15c825d2018-09-06 10:49:18 +08001768static int tx_macro_init(struct snd_soc_component *component)
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301769{
Meng Wang15c825d2018-09-06 10:49:18 +08001770 struct snd_soc_dapm_context *dapm =
1771 snd_soc_component_get_dapm(component);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301772 int ret = 0, i = 0;
1773 struct device *tx_dev = NULL;
1774 struct tx_macro_priv *tx_priv = NULL;
1775
Meng Wang15c825d2018-09-06 10:49:18 +08001776 tx_dev = bolero_get_device_ptr(component->dev, TX_MACRO);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301777 if (!tx_dev) {
Meng Wang15c825d2018-09-06 10:49:18 +08001778 dev_err(component->dev,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301779 "%s: null device for macro!\n", __func__);
1780 return -EINVAL;
1781 }
1782 tx_priv = dev_get_drvdata(tx_dev);
1783 if (!tx_priv) {
Meng Wang15c825d2018-09-06 10:49:18 +08001784 dev_err(component->dev,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301785 "%s: priv is null for macro!\n", __func__);
1786 return -EINVAL;
1787 }
1788 ret = snd_soc_dapm_new_controls(dapm, tx_macro_dapm_widgets,
1789 ARRAY_SIZE(tx_macro_dapm_widgets));
1790 if (ret < 0) {
1791 dev_err(tx_dev, "%s: Failed to add controls\n", __func__);
1792 return ret;
1793 }
1794
1795 ret = snd_soc_dapm_add_routes(dapm, tx_audio_map,
1796 ARRAY_SIZE(tx_audio_map));
1797 if (ret < 0) {
1798 dev_err(tx_dev, "%s: Failed to add routes\n", __func__);
1799 return ret;
1800 }
1801
1802 ret = snd_soc_dapm_new_widgets(dapm->card);
1803 if (ret < 0) {
1804 dev_err(tx_dev, "%s: Failed to add widgets\n", __func__);
1805 return ret;
1806 }
1807
Meng Wang15c825d2018-09-06 10:49:18 +08001808 ret = snd_soc_add_component_controls(component, tx_macro_snd_controls,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301809 ARRAY_SIZE(tx_macro_snd_controls));
1810 if (ret < 0) {
1811 dev_err(tx_dev, "%s: Failed to add snd_ctls\n", __func__);
1812 return ret;
1813 }
Laxminath Kasam638b5602018-09-24 13:19:52 +05301814
1815 snd_soc_dapm_ignore_suspend(dapm, "TX_AIF1 Capture");
1816 snd_soc_dapm_ignore_suspend(dapm, "TX_AIF2 Capture");
1817 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_ADC0");
1818 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_ADC1");
1819 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_ADC2");
1820 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_ADC3");
Vatsal Bucha39ead2c2018-12-14 12:22:46 +05301821 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC0");
1822 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC1");
1823 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC2");
1824 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC3");
1825 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC4");
1826 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC5");
1827 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC6");
1828 snd_soc_dapm_ignore_suspend(dapm, "TX SWR_DMIC7");
Laxminath Kasam638b5602018-09-24 13:19:52 +05301829 snd_soc_dapm_sync(dapm);
1830
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301831 for (i = 0; i < NUM_DECIMATORS; i++) {
1832 tx_priv->tx_hpf_work[i].tx_priv = tx_priv;
1833 tx_priv->tx_hpf_work[i].decimator = i;
1834 INIT_DELAYED_WORK(&tx_priv->tx_hpf_work[i].dwork,
1835 tx_macro_tx_hpf_corner_freq_callback);
1836 }
1837
1838 for (i = 0; i < NUM_DECIMATORS; i++) {
1839 tx_priv->tx_mute_dwork[i].tx_priv = tx_priv;
1840 tx_priv->tx_mute_dwork[i].decimator = i;
1841 INIT_DELAYED_WORK(&tx_priv->tx_mute_dwork[i].dwork,
1842 tx_macro_mute_update_callback);
1843 }
Meng Wang15c825d2018-09-06 10:49:18 +08001844 tx_priv->component = component;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301845
1846 return 0;
1847}
1848
Meng Wang15c825d2018-09-06 10:49:18 +08001849static int tx_macro_deinit(struct snd_soc_component *component)
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301850{
1851 struct device *tx_dev = NULL;
1852 struct tx_macro_priv *tx_priv = NULL;
1853
Meng Wang15c825d2018-09-06 10:49:18 +08001854 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301855 return -EINVAL;
1856
Meng Wang15c825d2018-09-06 10:49:18 +08001857 tx_priv->component = NULL;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301858 return 0;
1859}
1860
1861static void tx_macro_add_child_devices(struct work_struct *work)
1862{
1863 struct tx_macro_priv *tx_priv = NULL;
1864 struct platform_device *pdev = NULL;
1865 struct device_node *node = NULL;
1866 struct tx_macro_swr_ctrl_data *swr_ctrl_data = NULL, *temp = NULL;
1867 int ret = 0;
1868 u16 count = 0, ctrl_num = 0;
1869 struct tx_macro_swr_ctrl_platform_data *platdata = NULL;
1870 char plat_dev_name[TX_MACRO_SWR_STRING_LEN] = "";
1871 bool tx_swr_master_node = false;
1872
1873 tx_priv = container_of(work, struct tx_macro_priv,
1874 tx_macro_add_child_devices_work);
1875 if (!tx_priv) {
1876 pr_err("%s: Memory for tx_priv does not exist\n",
1877 __func__);
1878 return;
1879 }
1880
1881 if (!tx_priv->dev) {
1882 pr_err("%s: tx dev does not exist\n", __func__);
1883 return;
1884 }
1885
1886 if (!tx_priv->dev->of_node) {
1887 dev_err(tx_priv->dev,
1888 "%s: DT node for tx_priv does not exist\n", __func__);
1889 return;
1890 }
1891
1892 platdata = &tx_priv->swr_plat_data;
1893 tx_priv->child_count = 0;
1894
1895 for_each_available_child_of_node(tx_priv->dev->of_node, node) {
1896 tx_swr_master_node = false;
1897 if (strnstr(node->name, "tx_swr_master",
1898 strlen("tx_swr_master")) != NULL)
1899 tx_swr_master_node = true;
1900
1901 if (tx_swr_master_node)
1902 strlcpy(plat_dev_name, "tx_swr_ctrl",
1903 (TX_MACRO_SWR_STRING_LEN - 1));
1904 else
1905 strlcpy(plat_dev_name, node->name,
1906 (TX_MACRO_SWR_STRING_LEN - 1));
1907
1908 pdev = platform_device_alloc(plat_dev_name, -1);
1909 if (!pdev) {
1910 dev_err(tx_priv->dev, "%s: pdev memory alloc failed\n",
1911 __func__);
1912 ret = -ENOMEM;
1913 goto err;
1914 }
1915 pdev->dev.parent = tx_priv->dev;
1916 pdev->dev.of_node = node;
1917
1918 if (tx_swr_master_node) {
1919 ret = platform_device_add_data(pdev, platdata,
1920 sizeof(*platdata));
1921 if (ret) {
1922 dev_err(&pdev->dev,
1923 "%s: cannot add plat data ctrl:%d\n",
1924 __func__, ctrl_num);
1925 goto fail_pdev_add;
1926 }
1927 }
1928
1929 ret = platform_device_add(pdev);
1930 if (ret) {
1931 dev_err(&pdev->dev,
1932 "%s: Cannot add platform device\n",
1933 __func__);
1934 goto fail_pdev_add;
1935 }
1936
1937 if (tx_swr_master_node) {
1938 temp = krealloc(swr_ctrl_data,
1939 (ctrl_num + 1) * sizeof(
1940 struct tx_macro_swr_ctrl_data),
1941 GFP_KERNEL);
1942 if (!temp) {
1943 ret = -ENOMEM;
1944 goto fail_pdev_add;
1945 }
1946 swr_ctrl_data = temp;
1947 swr_ctrl_data[ctrl_num].tx_swr_pdev = pdev;
1948 ctrl_num++;
1949 dev_dbg(&pdev->dev,
1950 "%s: Added soundwire ctrl device(s)\n",
1951 __func__);
1952 tx_priv->swr_ctrl_data = swr_ctrl_data;
1953 }
1954 if (tx_priv->child_count < TX_MACRO_CHILD_DEVICES_MAX)
1955 tx_priv->pdev_child_devices[
1956 tx_priv->child_count++] = pdev;
1957 else
1958 goto err;
1959 }
1960 return;
1961fail_pdev_add:
1962 for (count = 0; count < tx_priv->child_count; count++)
1963 platform_device_put(tx_priv->pdev_child_devices[count]);
1964err:
1965 return;
1966}
1967
Sudheer Papothia3e969d2018-10-27 06:22:10 +05301968static int tx_macro_set_port_map(struct snd_soc_component *component,
1969 u32 usecase, u32 size, void *data)
1970{
1971 struct device *tx_dev = NULL;
1972 struct tx_macro_priv *tx_priv = NULL;
1973 struct swrm_port_config port_cfg;
1974 int ret = 0;
1975
1976 if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
1977 return -EINVAL;
1978
1979 memset(&port_cfg, 0, sizeof(port_cfg));
1980 port_cfg.uc = usecase;
1981 port_cfg.size = size;
1982 port_cfg.params = data;
1983
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -07001984 if (tx_priv->swr_ctrl_data)
1985 ret = swrm_wcd_notify(
1986 tx_priv->swr_ctrl_data[0].tx_swr_pdev,
1987 SWR_SET_PORT_MAP, &port_cfg);
Sudheer Papothia3e969d2018-10-27 06:22:10 +05301988
1989 return ret;
1990}
1991
Laxminath Kasam989fccf2018-06-15 16:53:31 +05301992static void tx_macro_init_ops(struct macro_ops *ops,
1993 char __iomem *tx_io_base)
1994{
1995 memset(ops, 0, sizeof(struct macro_ops));
1996 ops->init = tx_macro_init;
1997 ops->exit = tx_macro_deinit;
1998 ops->io_base = tx_io_base;
1999 ops->dai_ptr = tx_macro_dai;
2000 ops->num_dais = ARRAY_SIZE(tx_macro_dai);
Laxminath Kasamfb0d6832018-09-22 01:49:52 +05302001 ops->event_handler = tx_macro_event_handler;
Aditya Bavanaric4e96122018-11-14 14:46:38 +05302002 ops->reg_wake_irq = tx_macro_reg_wake_irq;
Sudheer Papothia3e969d2018-10-27 06:22:10 +05302003 ops->set_port_map = tx_macro_set_port_map;
Sudheer Papothi6cc7f522019-06-28 11:04:03 +05302004 ops->clk_switch = tx_macro_clk_switch;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302005}
2006
2007static int tx_macro_probe(struct platform_device *pdev)
2008{
2009 struct macro_ops ops = {0};
2010 struct tx_macro_priv *tx_priv = NULL;
2011 u32 tx_base_addr = 0, sample_rate = 0;
2012 char __iomem *tx_io_base = NULL;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302013 int ret = 0;
2014 const char *dmic_sample_rate = "qcom,tx-dmic-sample-rate";
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -07002015 u32 is_used_tx_swr_gpio = 1;
2016 const char *is_used_tx_swr_gpio_dt = "qcom,is-used-swr-gpio";
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302017
2018 tx_priv = devm_kzalloc(&pdev->dev, sizeof(struct tx_macro_priv),
2019 GFP_KERNEL);
2020 if (!tx_priv)
2021 return -ENOMEM;
2022 platform_set_drvdata(pdev, tx_priv);
2023
2024 tx_priv->dev = &pdev->dev;
2025 ret = of_property_read_u32(pdev->dev.of_node, "reg",
2026 &tx_base_addr);
2027 if (ret) {
2028 dev_err(&pdev->dev, "%s: could not find %s entry in dt\n",
2029 __func__, "reg");
2030 return ret;
2031 }
2032 dev_set_drvdata(&pdev->dev, tx_priv);
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -07002033 if (of_find_property(pdev->dev.of_node, is_used_tx_swr_gpio_dt,
2034 NULL)) {
2035 ret = of_property_read_u32(pdev->dev.of_node,
2036 is_used_tx_swr_gpio_dt,
2037 &is_used_tx_swr_gpio);
2038 if (ret) {
2039 dev_err(&pdev->dev, "%s: error reading %s in dt\n",
2040 __func__, is_used_tx_swr_gpio_dt);
2041 is_used_tx_swr_gpio = 1;
2042 }
2043 }
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302044 tx_priv->tx_swr_gpio_p = of_parse_phandle(pdev->dev.of_node,
2045 "qcom,tx-swr-gpios", 0);
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -07002046 if (!tx_priv->tx_swr_gpio_p && is_used_tx_swr_gpio) {
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302047 dev_err(&pdev->dev, "%s: swr_gpios handle not provided!\n",
2048 __func__);
2049 return -EINVAL;
2050 }
Karthikeyan Mani326536d2019-06-03 13:29:43 -07002051 if (msm_cdc_pinctrl_get_state(tx_priv->tx_swr_gpio_p) < 0) {
2052 dev_err(&pdev->dev, "%s: failed to get swr pin state\n",
2053 __func__);
2054 return -EPROBE_DEFER;
2055 }
2056
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302057 tx_io_base = devm_ioremap(&pdev->dev,
2058 tx_base_addr, TX_MACRO_MAX_OFFSET);
2059 if (!tx_io_base) {
2060 dev_err(&pdev->dev, "%s: ioremap failed\n", __func__);
2061 return -ENOMEM;
2062 }
2063 tx_priv->tx_io_base = tx_io_base;
2064 ret = of_property_read_u32(pdev->dev.of_node, dmic_sample_rate,
2065 &sample_rate);
2066 if (ret) {
2067 dev_err(&pdev->dev,
2068 "%s: could not find sample_rate entry in dt\n",
2069 __func__);
2070 tx_priv->dmic_clk_div = TX_MACRO_CLK_DIV_2;
2071 } else {
2072 if (tx_macro_validate_dmic_sample_rate(
2073 sample_rate, tx_priv) == TX_MACRO_DMIC_SAMPLE_RATE_UNDEFINED)
2074 return -EINVAL;
2075 }
Ramprasad Katkama4c747b2018-12-11 19:15:53 +05302076 tx_priv->reset_swr = true;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302077 INIT_WORK(&tx_priv->tx_macro_add_child_devices_work,
2078 tx_macro_add_child_devices);
2079 tx_priv->swr_plat_data.handle = (void *) tx_priv;
2080 tx_priv->swr_plat_data.read = NULL;
2081 tx_priv->swr_plat_data.write = NULL;
2082 tx_priv->swr_plat_data.bulk_write = NULL;
2083 tx_priv->swr_plat_data.clk = tx_macro_swrm_clock;
2084 tx_priv->swr_plat_data.handle_irq = NULL;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302085
2086 mutex_init(&tx_priv->mclk_lock);
2087 mutex_init(&tx_priv->swr_clk_lock);
2088 tx_macro_init_ops(&ops, tx_io_base);
Vidyakumar Athota5d45f4c2019-03-10 22:35:07 -07002089 ops.clk_id_req = TX_CORE_CLK;
2090 ops.default_clk_id = TX_CORE_CLK;
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302091 ret = bolero_register_macro(&pdev->dev, TX_MACRO, &ops);
2092 if (ret) {
2093 dev_err(&pdev->dev,
2094 "%s: register macro failed\n", __func__);
2095 goto err_reg_macro;
2096 }
Vidyakumar Athota5d45f4c2019-03-10 22:35:07 -07002097
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302098 schedule_work(&tx_priv->tx_macro_add_child_devices_work);
Sudheer Papothi7601cc62019-03-30 03:00:52 +05302099 pm_runtime_set_autosuspend_delay(&pdev->dev, AUTO_SUSPEND_DELAY);
2100 pm_runtime_use_autosuspend(&pdev->dev);
2101 pm_runtime_set_suspended(&pdev->dev);
Sudheer Papothi296867b2019-06-20 09:24:09 +05302102 pm_suspend_ignore_children(&pdev->dev, true);
Sudheer Papothi7601cc62019-03-30 03:00:52 +05302103 pm_runtime_enable(&pdev->dev);
2104
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302105 return 0;
2106err_reg_macro:
2107 mutex_destroy(&tx_priv->mclk_lock);
2108 mutex_destroy(&tx_priv->swr_clk_lock);
2109 return ret;
2110}
2111
2112static int tx_macro_remove(struct platform_device *pdev)
2113{
2114 struct tx_macro_priv *tx_priv = NULL;
2115 u16 count = 0;
2116
2117 tx_priv = platform_get_drvdata(pdev);
2118
2119 if (!tx_priv)
2120 return -EINVAL;
2121
Karthikeyan Mani3bd80a52019-06-04 23:40:16 -07002122 if (tx_priv->swr_ctrl_data)
2123 kfree(tx_priv->swr_ctrl_data);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302124 for (count = 0; count < tx_priv->child_count &&
2125 count < TX_MACRO_CHILD_DEVICES_MAX; count++)
2126 platform_device_unregister(tx_priv->pdev_child_devices[count]);
2127
Sudheer Papothi7601cc62019-03-30 03:00:52 +05302128 pm_runtime_disable(&pdev->dev);
2129 pm_runtime_set_suspended(&pdev->dev);
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302130 mutex_destroy(&tx_priv->mclk_lock);
2131 mutex_destroy(&tx_priv->swr_clk_lock);
2132 bolero_unregister_macro(&pdev->dev, TX_MACRO);
2133 return 0;
2134}
2135
2136
2137static const struct of_device_id tx_macro_dt_match[] = {
2138 {.compatible = "qcom,tx-macro"},
2139 {}
2140};
2141
Sudheer Papothi7601cc62019-03-30 03:00:52 +05302142static const struct dev_pm_ops bolero_dev_pm_ops = {
2143 SET_RUNTIME_PM_OPS(
2144 bolero_runtime_suspend,
2145 bolero_runtime_resume,
2146 NULL
2147 )
2148};
2149
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302150static struct platform_driver tx_macro_driver = {
2151 .driver = {
2152 .name = "tx_macro",
2153 .owner = THIS_MODULE,
Sudheer Papothi7601cc62019-03-30 03:00:52 +05302154 .pm = &bolero_dev_pm_ops,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302155 .of_match_table = tx_macro_dt_match,
Xiaojun Sang53cd13a2018-06-29 15:14:37 +08002156 .suppress_bind_attrs = true,
Laxminath Kasam989fccf2018-06-15 16:53:31 +05302157 },
2158 .probe = tx_macro_probe,
2159 .remove = tx_macro_remove,
2160};
2161
2162module_platform_driver(tx_macro_driver);
2163
2164MODULE_DESCRIPTION("TX macro driver");
2165MODULE_LICENSE("GPL v2");