1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * da7219-aad.c - Dialog DA7219 ALSA SoC AAD Driver
4 *
5 * Copyright (c) 2015 Dialog Semiconductor Ltd.
6 *
7 * Author: Adam Thomson <Adam.Thomson.Opensource@diasemi.com>
8 */
9
10 #include <linux/module.h>
11 #include <linux/platform_device.h>
12 #include <linux/clk.h>
13 #include <linux/i2c.h>
14 #include <linux/property.h>
15 #include <linux/pm_wakeirq.h>
16 #include <linux/slab.h>
17 #include <linux/delay.h>
18 #include <linux/workqueue.h>
19 #include <sound/soc.h>
20 #include <sound/jack.h>
21 #include <sound/da7219.h>
22
23 #include "da7219.h"
24 #include "da7219-aad.h"
25
26
27 /*
28 * Detection control
29 */
30
da7219_aad_jack_det(struct snd_soc_component * component,struct snd_soc_jack * jack)31 void da7219_aad_jack_det(struct snd_soc_component *component, struct snd_soc_jack *jack)
32 {
33 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
34
35 da7219->aad->jack = jack;
36 da7219->aad->jack_inserted = false;
37
38 /* Send an initial empty report */
39 snd_soc_jack_report(jack, 0, DA7219_AAD_REPORT_ALL_MASK);
40
41 /* Enable/Disable jack detection */
42 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
43 DA7219_ACCDET_EN_MASK,
44 (jack ? DA7219_ACCDET_EN_MASK : 0));
45 }
46
47 /*
48 * Button/HPTest work
49 */
50
da7219_aad_btn_det_work(struct work_struct * work)51 static void da7219_aad_btn_det_work(struct work_struct *work)
52 {
53 struct da7219_aad_priv *da7219_aad =
54 container_of(work, struct da7219_aad_priv, btn_det_work);
55 struct snd_soc_component *component = da7219_aad->component;
56 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
57 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
58 u8 statusa, micbias_ctrl;
59 bool micbias_up = false;
60 int retries = 0;
61
62 /* Disable ground switch */
63 snd_soc_component_update_bits(component, 0xFB, 0x01, 0x00);
64
65 /* Drive headphones/lineout */
66 snd_soc_component_update_bits(component, DA7219_HP_L_CTRL,
67 DA7219_HP_L_AMP_OE_MASK,
68 DA7219_HP_L_AMP_OE_MASK);
69 snd_soc_component_update_bits(component, DA7219_HP_R_CTRL,
70 DA7219_HP_R_AMP_OE_MASK,
71 DA7219_HP_R_AMP_OE_MASK);
72
73 /* Make sure mic bias is up */
74 snd_soc_dapm_force_enable_pin(dapm, "Mic Bias");
75 snd_soc_dapm_sync(dapm);
76
77 do {
78 statusa = snd_soc_component_read(component, DA7219_ACCDET_STATUS_A);
79 if (statusa & DA7219_MICBIAS_UP_STS_MASK)
80 micbias_up = true;
81 else if (retries++ < DA7219_AAD_MICBIAS_CHK_RETRIES)
82 msleep(DA7219_AAD_MICBIAS_CHK_DELAY);
83 } while ((!micbias_up) && (retries < DA7219_AAD_MICBIAS_CHK_RETRIES));
84
85 if (retries >= DA7219_AAD_MICBIAS_CHK_RETRIES)
86 dev_warn(component->dev, "Mic bias status check timed out");
87
88 da7219->micbias_on_event = true;
89
90 /*
91 * Mic bias pulse required to enable mic, must be done before enabling
92 * button detection to prevent erroneous button readings.
93 */
94 if (da7219_aad->micbias_pulse_lvl && da7219_aad->micbias_pulse_time) {
95 /* Pulse higher level voltage */
96 micbias_ctrl = snd_soc_component_read(component, DA7219_MICBIAS_CTRL);
97 snd_soc_component_update_bits(component, DA7219_MICBIAS_CTRL,
98 DA7219_MICBIAS1_LEVEL_MASK,
99 da7219_aad->micbias_pulse_lvl);
100 msleep(da7219_aad->micbias_pulse_time);
101 snd_soc_component_write(component, DA7219_MICBIAS_CTRL, micbias_ctrl);
102
103 }
104
105 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
106 DA7219_BUTTON_CONFIG_MASK,
107 da7219_aad->btn_cfg);
108 }
109
da7219_aad_hptest_work(struct work_struct * work)110 static void da7219_aad_hptest_work(struct work_struct *work)
111 {
112 struct da7219_aad_priv *da7219_aad =
113 container_of(work, struct da7219_aad_priv, hptest_work);
114 struct snd_soc_component *component = da7219_aad->component;
115 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
116 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
117
118 __le16 tonegen_freq_hptest;
119 u8 pll_srm_sts, pll_ctrl, gain_ramp_ctrl, accdet_cfg8;
120 int report = 0, ret;
121
122 /* Lock DAPM, Kcontrols affected by this test and the PLL */
123 snd_soc_dapm_mutex_lock(dapm);
124 mutex_lock(&da7219->ctrl_lock);
125 mutex_lock(&da7219->pll_lock);
126
127 /* Ensure MCLK is available for HP test procedure */
128 if (da7219->mclk) {
129 ret = clk_prepare_enable(da7219->mclk);
130 if (ret) {
131 dev_err(component->dev, "Failed to enable mclk - %d\n", ret);
132 mutex_unlock(&da7219->pll_lock);
133 mutex_unlock(&da7219->ctrl_lock);
134 snd_soc_dapm_mutex_unlock(dapm);
135 return;
136 }
137 }
138
139 /*
140 * If MCLK not present, then we're using the internal oscillator and
141 * require different frequency settings to achieve the same result.
142 *
143 * If MCLK is present, but PLL is not enabled then we enable it here to
144 * ensure a consistent detection procedure.
145 */
146 pll_srm_sts = snd_soc_component_read(component, DA7219_PLL_SRM_STS);
147 if (pll_srm_sts & DA7219_PLL_SRM_STS_MCLK) {
148 tonegen_freq_hptest = cpu_to_le16(DA7219_AAD_HPTEST_RAMP_FREQ);
149
150 pll_ctrl = snd_soc_component_read(component, DA7219_PLL_CTRL);
151 if ((pll_ctrl & DA7219_PLL_MODE_MASK) == DA7219_PLL_MODE_BYPASS)
152 da7219_set_pll(component, DA7219_SYSCLK_PLL,
153 DA7219_PLL_FREQ_OUT_98304);
154 } else {
155 tonegen_freq_hptest = cpu_to_le16(DA7219_AAD_HPTEST_RAMP_FREQ_INT_OSC);
156 }
157
158 /* Disable ground switch */
159 snd_soc_component_update_bits(component, 0xFB, 0x01, 0x00);
160
161 /* Ensure gain ramping at fastest rate */
162 gain_ramp_ctrl = snd_soc_component_read(component, DA7219_GAIN_RAMP_CTRL);
163 snd_soc_component_write(component, DA7219_GAIN_RAMP_CTRL, DA7219_GAIN_RAMP_RATE_X8);
164
165 /* Bypass cache so it saves current settings */
166 regcache_cache_bypass(da7219->regmap, true);
167
168 /* Make sure Tone Generator is disabled */
169 snd_soc_component_write(component, DA7219_TONE_GEN_CFG1, 0);
170
171 /* Enable HPTest block, 1KOhms check */
172 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_8,
173 DA7219_HPTEST_EN_MASK | DA7219_HPTEST_RES_SEL_MASK,
174 DA7219_HPTEST_EN_MASK |
175 DA7219_HPTEST_RES_SEL_1KOHMS);
176
177 /* Set gains to 0db */
178 snd_soc_component_write(component, DA7219_DAC_L_GAIN, DA7219_DAC_DIGITAL_GAIN_0DB);
179 snd_soc_component_write(component, DA7219_DAC_R_GAIN, DA7219_DAC_DIGITAL_GAIN_0DB);
180 snd_soc_component_write(component, DA7219_HP_L_GAIN, DA7219_HP_AMP_GAIN_0DB);
181 snd_soc_component_write(component, DA7219_HP_R_GAIN, DA7219_HP_AMP_GAIN_0DB);
182
183 /* Disable DAC filters, EQs and soft mute */
184 snd_soc_component_update_bits(component, DA7219_DAC_FILTERS1, DA7219_HPF_MODE_MASK,
185 0);
186 snd_soc_component_update_bits(component, DA7219_DAC_FILTERS4, DA7219_DAC_EQ_EN_MASK,
187 0);
188 snd_soc_component_update_bits(component, DA7219_DAC_FILTERS5,
189 DA7219_DAC_SOFTMUTE_EN_MASK, 0);
190
191 /* Enable HP left & right paths */
192 snd_soc_component_update_bits(component, DA7219_CP_CTRL, DA7219_CP_EN_MASK,
193 DA7219_CP_EN_MASK);
194 snd_soc_component_update_bits(component, DA7219_DIG_ROUTING_DAC,
195 DA7219_DAC_L_SRC_MASK | DA7219_DAC_R_SRC_MASK,
196 DA7219_DAC_L_SRC_TONEGEN |
197 DA7219_DAC_R_SRC_TONEGEN);
198 snd_soc_component_update_bits(component, DA7219_DAC_L_CTRL,
199 DA7219_DAC_L_EN_MASK | DA7219_DAC_L_MUTE_EN_MASK,
200 DA7219_DAC_L_EN_MASK);
201 snd_soc_component_update_bits(component, DA7219_DAC_R_CTRL,
202 DA7219_DAC_R_EN_MASK | DA7219_DAC_R_MUTE_EN_MASK,
203 DA7219_DAC_R_EN_MASK);
204 snd_soc_component_update_bits(component, DA7219_MIXOUT_L_SELECT,
205 DA7219_MIXOUT_L_MIX_SELECT_MASK,
206 DA7219_MIXOUT_L_MIX_SELECT_MASK);
207 snd_soc_component_update_bits(component, DA7219_MIXOUT_R_SELECT,
208 DA7219_MIXOUT_R_MIX_SELECT_MASK,
209 DA7219_MIXOUT_R_MIX_SELECT_MASK);
210 snd_soc_component_update_bits(component, DA7219_DROUTING_ST_OUTFILT_1L,
211 DA7219_OUTFILT_ST_1L_SRC_MASK,
212 DA7219_DMIX_ST_SRC_OUTFILT1L);
213 snd_soc_component_update_bits(component, DA7219_DROUTING_ST_OUTFILT_1R,
214 DA7219_OUTFILT_ST_1R_SRC_MASK,
215 DA7219_DMIX_ST_SRC_OUTFILT1R);
216 snd_soc_component_update_bits(component, DA7219_MIXOUT_L_CTRL,
217 DA7219_MIXOUT_L_AMP_EN_MASK,
218 DA7219_MIXOUT_L_AMP_EN_MASK);
219 snd_soc_component_update_bits(component, DA7219_MIXOUT_R_CTRL,
220 DA7219_MIXOUT_R_AMP_EN_MASK,
221 DA7219_MIXOUT_R_AMP_EN_MASK);
222 snd_soc_component_update_bits(component, DA7219_HP_L_CTRL,
223 DA7219_HP_L_AMP_OE_MASK | DA7219_HP_L_AMP_EN_MASK,
224 DA7219_HP_L_AMP_OE_MASK | DA7219_HP_L_AMP_EN_MASK);
225 snd_soc_component_update_bits(component, DA7219_HP_R_CTRL,
226 DA7219_HP_R_AMP_OE_MASK | DA7219_HP_R_AMP_EN_MASK,
227 DA7219_HP_R_AMP_OE_MASK | DA7219_HP_R_AMP_EN_MASK);
228 msleep(DA7219_SETTLING_DELAY);
229 snd_soc_component_update_bits(component, DA7219_HP_L_CTRL,
230 DA7219_HP_L_AMP_MUTE_EN_MASK |
231 DA7219_HP_L_AMP_MIN_GAIN_EN_MASK, 0);
232 snd_soc_component_update_bits(component, DA7219_HP_R_CTRL,
233 DA7219_HP_R_AMP_MUTE_EN_MASK |
234 DA7219_HP_R_AMP_MIN_GAIN_EN_MASK, 0);
235
236 /*
237 * If we're running from the internal oscillator then give audio paths
238 * time to settle before running test.
239 */
240 if (!(pll_srm_sts & DA7219_PLL_SRM_STS_MCLK))
241 msleep(DA7219_AAD_HPTEST_INT_OSC_PATH_DELAY);
242
243 /* Configure & start Tone Generator */
244 snd_soc_component_write(component, DA7219_TONE_GEN_ON_PER, DA7219_BEEP_ON_PER_MASK);
245 regmap_raw_write(da7219->regmap, DA7219_TONE_GEN_FREQ1_L,
246 &tonegen_freq_hptest, sizeof(tonegen_freq_hptest));
247 snd_soc_component_update_bits(component, DA7219_TONE_GEN_CFG2,
248 DA7219_SWG_SEL_MASK | DA7219_TONE_GEN_GAIN_MASK,
249 DA7219_SWG_SEL_SRAMP |
250 DA7219_TONE_GEN_GAIN_MINUS_15DB);
251 snd_soc_component_write(component, DA7219_TONE_GEN_CFG1, DA7219_START_STOPN_MASK);
252
253 msleep(DA7219_AAD_HPTEST_PERIOD);
254
255 /* Grab comparator reading */
256 accdet_cfg8 = snd_soc_component_read(component, DA7219_ACCDET_CONFIG_8);
257 if (accdet_cfg8 & DA7219_HPTEST_COMP_MASK)
258 report |= SND_JACK_HEADPHONE;
259 else
260 report |= SND_JACK_LINEOUT;
261
262 /* Stop tone generator */
263 snd_soc_component_write(component, DA7219_TONE_GEN_CFG1, 0);
264
265 msleep(DA7219_AAD_HPTEST_PERIOD);
266
267 /* Restore original settings from cache */
268 regcache_mark_dirty(da7219->regmap);
269 regcache_sync_region(da7219->regmap, DA7219_HP_L_CTRL,
270 DA7219_HP_R_CTRL);
271 msleep(DA7219_SETTLING_DELAY);
272 regcache_sync_region(da7219->regmap, DA7219_MIXOUT_L_CTRL,
273 DA7219_MIXOUT_R_CTRL);
274 regcache_sync_region(da7219->regmap, DA7219_DROUTING_ST_OUTFILT_1L,
275 DA7219_DROUTING_ST_OUTFILT_1R);
276 regcache_sync_region(da7219->regmap, DA7219_MIXOUT_L_SELECT,
277 DA7219_MIXOUT_R_SELECT);
278 regcache_sync_region(da7219->regmap, DA7219_DAC_L_CTRL,
279 DA7219_DAC_R_CTRL);
280 regcache_sync_region(da7219->regmap, DA7219_DIG_ROUTING_DAC,
281 DA7219_DIG_ROUTING_DAC);
282 regcache_sync_region(da7219->regmap, DA7219_CP_CTRL, DA7219_CP_CTRL);
283 regcache_sync_region(da7219->regmap, DA7219_DAC_FILTERS5,
284 DA7219_DAC_FILTERS5);
285 regcache_sync_region(da7219->regmap, DA7219_DAC_FILTERS4,
286 DA7219_DAC_FILTERS1);
287 regcache_sync_region(da7219->regmap, DA7219_HP_L_GAIN,
288 DA7219_HP_R_GAIN);
289 regcache_sync_region(da7219->regmap, DA7219_DAC_L_GAIN,
290 DA7219_DAC_R_GAIN);
291 regcache_sync_region(da7219->regmap, DA7219_TONE_GEN_ON_PER,
292 DA7219_TONE_GEN_ON_PER);
293 regcache_sync_region(da7219->regmap, DA7219_TONE_GEN_FREQ1_L,
294 DA7219_TONE_GEN_FREQ1_U);
295 regcache_sync_region(da7219->regmap, DA7219_TONE_GEN_CFG1,
296 DA7219_TONE_GEN_CFG2);
297
298 regcache_cache_bypass(da7219->regmap, false);
299
300 /* Disable HPTest block */
301 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_8,
302 DA7219_HPTEST_EN_MASK, 0);
303
304 /*
305 * If we're running from the internal oscillator then give audio paths
306 * time to settle before allowing headphones to be driven as required.
307 */
308 if (!(pll_srm_sts & DA7219_PLL_SRM_STS_MCLK))
309 msleep(DA7219_AAD_HPTEST_INT_OSC_PATH_DELAY);
310
311 /* Restore gain ramping rate */
312 snd_soc_component_write(component, DA7219_GAIN_RAMP_CTRL, gain_ramp_ctrl);
313
314 /* Drive Headphones/lineout */
315 snd_soc_component_update_bits(component, DA7219_HP_L_CTRL, DA7219_HP_L_AMP_OE_MASK,
316 DA7219_HP_L_AMP_OE_MASK);
317 snd_soc_component_update_bits(component, DA7219_HP_R_CTRL, DA7219_HP_R_AMP_OE_MASK,
318 DA7219_HP_R_AMP_OE_MASK);
319
320 /* Restore PLL to previous configuration, if re-configured */
321 if ((pll_srm_sts & DA7219_PLL_SRM_STS_MCLK) &&
322 ((pll_ctrl & DA7219_PLL_MODE_MASK) == DA7219_PLL_MODE_BYPASS))
323 da7219_set_pll(component, DA7219_SYSCLK_MCLK, 0);
324
325 /* Remove MCLK, if previously enabled */
326 if (da7219->mclk)
327 clk_disable_unprepare(da7219->mclk);
328
329 mutex_unlock(&da7219->pll_lock);
330 mutex_unlock(&da7219->ctrl_lock);
331 snd_soc_dapm_mutex_unlock(dapm);
332
333 /*
334 * Only send report if jack hasn't been removed during process,
335 * otherwise it's invalid and we drop it.
336 */
337 if (da7219_aad->jack_inserted)
338 snd_soc_jack_report(da7219_aad->jack, report,
339 SND_JACK_HEADSET | SND_JACK_LINEOUT);
340 }
341
da7219_aad_jack_det_work(struct work_struct * work)342 static void da7219_aad_jack_det_work(struct work_struct *work)
343 {
344 struct da7219_aad_priv *da7219_aad =
345 container_of(work, struct da7219_aad_priv, jack_det_work);
346 struct snd_soc_component *component = da7219_aad->component;
347 u8 srm_st;
348
349 mutex_lock(&da7219_aad->jack_det_mutex);
350
351 srm_st = snd_soc_component_read(component, DA7219_PLL_SRM_STS) & DA7219_PLL_SRM_STS_MCLK;
352 msleep(da7219_aad->gnd_switch_delay * ((srm_st == 0x0) ? 2 : 1) - 4);
353 /* Enable ground switch */
354 snd_soc_component_update_bits(component, 0xFB, 0x01, 0x01);
355
356 mutex_unlock(&da7219_aad->jack_det_mutex);
357 }
358
359
360 /*
361 * IRQ
362 */
363
da7219_aad_pre_irq_thread(int irq,void * data)364 static irqreturn_t da7219_aad_pre_irq_thread(int irq, void *data)
365 {
366
367 struct da7219_aad_priv *da7219_aad = data;
368
369 if (!da7219_aad->jack_inserted)
370 schedule_work(&da7219_aad->jack_det_work);
371
372 return IRQ_WAKE_THREAD;
373 }
374
da7219_aad_irq_thread(int irq,void * data)375 static irqreturn_t da7219_aad_irq_thread(int irq, void *data)
376 {
377 struct da7219_aad_priv *da7219_aad = data;
378 struct snd_soc_component *component = da7219_aad->component;
379 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
380 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
381 u8 events[DA7219_AAD_IRQ_REG_MAX];
382 u8 statusa;
383 int i, report = 0, mask = 0;
384
385 /* Read current IRQ events */
386 regmap_bulk_read(da7219->regmap, DA7219_ACCDET_IRQ_EVENT_A,
387 events, DA7219_AAD_IRQ_REG_MAX);
388
389 if (!events[DA7219_AAD_IRQ_REG_A] && !events[DA7219_AAD_IRQ_REG_B])
390 return IRQ_NONE;
391
392 /* Read status register for jack insertion & type status */
393 statusa = snd_soc_component_read(component, DA7219_ACCDET_STATUS_A);
394
395 /* Clear events */
396 regmap_bulk_write(da7219->regmap, DA7219_ACCDET_IRQ_EVENT_A,
397 events, DA7219_AAD_IRQ_REG_MAX);
398
399 dev_dbg(component->dev, "IRQ events = 0x%x|0x%x, status = 0x%x\n",
400 events[DA7219_AAD_IRQ_REG_A], events[DA7219_AAD_IRQ_REG_B],
401 statusa);
402
403 if (!da7219_aad->jack_inserted)
404 cancel_work_sync(&da7219_aad->jack_det_work);
405
406 if (statusa & DA7219_JACK_INSERTION_STS_MASK) {
407 /* Jack Insertion */
408 if (events[DA7219_AAD_IRQ_REG_A] &
409 DA7219_E_JACK_INSERTED_MASK) {
410 report |= SND_JACK_MECHANICAL;
411 mask |= SND_JACK_MECHANICAL;
412 da7219_aad->jack_inserted = true;
413 }
414
415 /* Jack type detection */
416 if (events[DA7219_AAD_IRQ_REG_A] &
417 DA7219_E_JACK_DETECT_COMPLETE_MASK) {
418 /*
419 * If 4-pole, then enable button detection, else perform
420 * HP impedance test to determine output type to report.
421 *
422 * We schedule work here as the tasks themselves can
423 * take time to complete, and in particular for hptest
424 * we want to be able to check if the jack was removed
425 * during the procedure as this will invalidate the
426 * result. By doing this as work, the IRQ thread can
427 * handle a removal, and we can check at the end of
428 * hptest if we have a valid result or not.
429 */
430 if (statusa & DA7219_JACK_TYPE_STS_MASK) {
431 report |= SND_JACK_HEADSET;
432 mask |= SND_JACK_HEADSET | SND_JACK_LINEOUT;
433 schedule_work(&da7219_aad->btn_det_work);
434 } else {
435 schedule_work(&da7219_aad->hptest_work);
436 }
437 }
438
439 /* Button support for 4-pole jack */
440 if (statusa & DA7219_JACK_TYPE_STS_MASK) {
441 for (i = 0; i < DA7219_AAD_MAX_BUTTONS; ++i) {
442 /* Button Press */
443 if (events[DA7219_AAD_IRQ_REG_B] &
444 (DA7219_E_BUTTON_A_PRESSED_MASK << i)) {
445 report |= SND_JACK_BTN_0 >> i;
446 mask |= SND_JACK_BTN_0 >> i;
447 }
448 }
449 snd_soc_jack_report(da7219_aad->jack, report, mask);
450
451 for (i = 0; i < DA7219_AAD_MAX_BUTTONS; ++i) {
452 /* Button Release */
453 if (events[DA7219_AAD_IRQ_REG_B] &
454 (DA7219_E_BUTTON_A_RELEASED_MASK >> i)) {
455 report &= ~(SND_JACK_BTN_0 >> i);
456 mask |= SND_JACK_BTN_0 >> i;
457 }
458 }
459 }
460 } else {
461 /* Jack removal */
462 if (events[DA7219_AAD_IRQ_REG_A] & DA7219_E_JACK_REMOVED_MASK) {
463 report = 0;
464 mask |= DA7219_AAD_REPORT_ALL_MASK;
465 da7219_aad->jack_inserted = false;
466
467 /* Cancel any pending work */
468 cancel_work_sync(&da7219_aad->btn_det_work);
469 cancel_work_sync(&da7219_aad->hptest_work);
470
471 /* Un-drive headphones/lineout */
472 snd_soc_component_update_bits(component, DA7219_HP_R_CTRL,
473 DA7219_HP_R_AMP_OE_MASK, 0);
474 snd_soc_component_update_bits(component, DA7219_HP_L_CTRL,
475 DA7219_HP_L_AMP_OE_MASK, 0);
476
477 /* Ensure button detection disabled */
478 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
479 DA7219_BUTTON_CONFIG_MASK, 0);
480
481 da7219->micbias_on_event = false;
482
483 /* Disable mic bias */
484 snd_soc_dapm_disable_pin(dapm, "Mic Bias");
485 snd_soc_dapm_sync(dapm);
486
487 /* Disable ground switch */
488 snd_soc_component_update_bits(component, 0xFB, 0x01, 0x00);
489 }
490 }
491
492 snd_soc_jack_report(da7219_aad->jack, report, mask);
493
494 return IRQ_HANDLED;
495 }
496
497 /*
498 * DT/ACPI to pdata conversion
499 */
500
501 static enum da7219_aad_micbias_pulse_lvl
da7219_aad_fw_micbias_pulse_lvl(struct device * dev,u32 val)502 da7219_aad_fw_micbias_pulse_lvl(struct device *dev, u32 val)
503 {
504 switch (val) {
505 case 2800:
506 return DA7219_AAD_MICBIAS_PULSE_LVL_2_8V;
507 case 2900:
508 return DA7219_AAD_MICBIAS_PULSE_LVL_2_9V;
509 default:
510 dev_warn(dev, "Invalid micbias pulse level");
511 return DA7219_AAD_MICBIAS_PULSE_LVL_OFF;
512 }
513 }
514
515 static enum da7219_aad_btn_cfg
da7219_aad_fw_btn_cfg(struct device * dev,u32 val)516 da7219_aad_fw_btn_cfg(struct device *dev, u32 val)
517 {
518 switch (val) {
519 case 2:
520 return DA7219_AAD_BTN_CFG_2MS;
521 case 5:
522 return DA7219_AAD_BTN_CFG_5MS;
523 case 10:
524 return DA7219_AAD_BTN_CFG_10MS;
525 case 50:
526 return DA7219_AAD_BTN_CFG_50MS;
527 case 100:
528 return DA7219_AAD_BTN_CFG_100MS;
529 case 200:
530 return DA7219_AAD_BTN_CFG_200MS;
531 case 500:
532 return DA7219_AAD_BTN_CFG_500MS;
533 default:
534 dev_warn(dev, "Invalid button config");
535 return DA7219_AAD_BTN_CFG_10MS;
536 }
537 }
538
539 static enum da7219_aad_mic_det_thr
da7219_aad_fw_mic_det_thr(struct device * dev,u32 val)540 da7219_aad_fw_mic_det_thr(struct device *dev, u32 val)
541 {
542 switch (val) {
543 case 200:
544 return DA7219_AAD_MIC_DET_THR_200_OHMS;
545 case 500:
546 return DA7219_AAD_MIC_DET_THR_500_OHMS;
547 case 750:
548 return DA7219_AAD_MIC_DET_THR_750_OHMS;
549 case 1000:
550 return DA7219_AAD_MIC_DET_THR_1000_OHMS;
551 default:
552 dev_warn(dev, "Invalid mic detect threshold");
553 return DA7219_AAD_MIC_DET_THR_500_OHMS;
554 }
555 }
556
557 static enum da7219_aad_jack_ins_deb
da7219_aad_fw_jack_ins_deb(struct device * dev,u32 val)558 da7219_aad_fw_jack_ins_deb(struct device *dev, u32 val)
559 {
560 switch (val) {
561 case 5:
562 return DA7219_AAD_JACK_INS_DEB_5MS;
563 case 10:
564 return DA7219_AAD_JACK_INS_DEB_10MS;
565 case 20:
566 return DA7219_AAD_JACK_INS_DEB_20MS;
567 case 50:
568 return DA7219_AAD_JACK_INS_DEB_50MS;
569 case 100:
570 return DA7219_AAD_JACK_INS_DEB_100MS;
571 case 200:
572 return DA7219_AAD_JACK_INS_DEB_200MS;
573 case 500:
574 return DA7219_AAD_JACK_INS_DEB_500MS;
575 case 1000:
576 return DA7219_AAD_JACK_INS_DEB_1S;
577 default:
578 dev_warn(dev, "Invalid jack insert debounce");
579 return DA7219_AAD_JACK_INS_DEB_20MS;
580 }
581 }
582
583 static enum da7219_aad_jack_det_rate
da7219_aad_fw_jack_det_rate(struct device * dev,const char * str)584 da7219_aad_fw_jack_det_rate(struct device *dev, const char *str)
585 {
586 if (!strcmp(str, "32ms_64ms")) {
587 return DA7219_AAD_JACK_DET_RATE_32_64MS;
588 } else if (!strcmp(str, "64ms_128ms")) {
589 return DA7219_AAD_JACK_DET_RATE_64_128MS;
590 } else if (!strcmp(str, "128ms_256ms")) {
591 return DA7219_AAD_JACK_DET_RATE_128_256MS;
592 } else if (!strcmp(str, "256ms_512ms")) {
593 return DA7219_AAD_JACK_DET_RATE_256_512MS;
594 } else {
595 dev_warn(dev, "Invalid jack detect rate");
596 return DA7219_AAD_JACK_DET_RATE_256_512MS;
597 }
598 }
599
600 static enum da7219_aad_jack_rem_deb
da7219_aad_fw_jack_rem_deb(struct device * dev,u32 val)601 da7219_aad_fw_jack_rem_deb(struct device *dev, u32 val)
602 {
603 switch (val) {
604 case 1:
605 return DA7219_AAD_JACK_REM_DEB_1MS;
606 case 5:
607 return DA7219_AAD_JACK_REM_DEB_5MS;
608 case 10:
609 return DA7219_AAD_JACK_REM_DEB_10MS;
610 case 20:
611 return DA7219_AAD_JACK_REM_DEB_20MS;
612 default:
613 dev_warn(dev, "Invalid jack removal debounce");
614 return DA7219_AAD_JACK_REM_DEB_1MS;
615 }
616 }
617
618 static enum da7219_aad_btn_avg
da7219_aad_fw_btn_avg(struct device * dev,u32 val)619 da7219_aad_fw_btn_avg(struct device *dev, u32 val)
620 {
621 switch (val) {
622 case 1:
623 return DA7219_AAD_BTN_AVG_1;
624 case 2:
625 return DA7219_AAD_BTN_AVG_2;
626 case 4:
627 return DA7219_AAD_BTN_AVG_4;
628 case 8:
629 return DA7219_AAD_BTN_AVG_8;
630 default:
631 dev_warn(dev, "Invalid button average value");
632 return DA7219_AAD_BTN_AVG_2;
633 }
634 }
635
636 static enum da7219_aad_adc_1bit_rpt
da7219_aad_fw_adc_1bit_rpt(struct device * dev,u32 val)637 da7219_aad_fw_adc_1bit_rpt(struct device *dev, u32 val)
638 {
639 switch (val) {
640 case 1:
641 return DA7219_AAD_ADC_1BIT_RPT_1;
642 case 2:
643 return DA7219_AAD_ADC_1BIT_RPT_2;
644 case 4:
645 return DA7219_AAD_ADC_1BIT_RPT_4;
646 case 8:
647 return DA7219_AAD_ADC_1BIT_RPT_8;
648 default:
649 dev_warn(dev, "Invalid ADC 1-bit repeat value");
650 return DA7219_AAD_ADC_1BIT_RPT_1;
651 }
652 }
653
da7219_aad_fw_to_pdata(struct device * dev)654 static struct da7219_aad_pdata *da7219_aad_fw_to_pdata(struct device *dev)
655 {
656 struct i2c_client *i2c = to_i2c_client(dev);
657 struct fwnode_handle *aad_np;
658 struct da7219_aad_pdata *aad_pdata;
659 const char *fw_str;
660 u32 fw_val32;
661
662 aad_np = device_get_named_child_node(dev, "da7219_aad");
663 if (!aad_np)
664 return NULL;
665
666 aad_pdata = devm_kzalloc(dev, sizeof(*aad_pdata), GFP_KERNEL);
667 if (!aad_pdata)
668 return NULL;
669
670 aad_pdata->irq = i2c->irq;
671
672 if (fwnode_property_read_u32(aad_np, "dlg,micbias-pulse-lvl",
673 &fw_val32) >= 0)
674 aad_pdata->micbias_pulse_lvl =
675 da7219_aad_fw_micbias_pulse_lvl(dev, fw_val32);
676 else
677 aad_pdata->micbias_pulse_lvl = DA7219_AAD_MICBIAS_PULSE_LVL_OFF;
678
679 if (fwnode_property_read_u32(aad_np, "dlg,micbias-pulse-time",
680 &fw_val32) >= 0)
681 aad_pdata->micbias_pulse_time = fw_val32;
682
683 if (fwnode_property_read_u32(aad_np, "dlg,btn-cfg", &fw_val32) >= 0)
684 aad_pdata->btn_cfg = da7219_aad_fw_btn_cfg(dev, fw_val32);
685 else
686 aad_pdata->btn_cfg = DA7219_AAD_BTN_CFG_10MS;
687
688 if (fwnode_property_read_u32(aad_np, "dlg,mic-det-thr", &fw_val32) >= 0)
689 aad_pdata->mic_det_thr =
690 da7219_aad_fw_mic_det_thr(dev, fw_val32);
691 else
692 aad_pdata->mic_det_thr = DA7219_AAD_MIC_DET_THR_500_OHMS;
693
694 if (fwnode_property_read_u32(aad_np, "dlg,jack-ins-deb", &fw_val32) >= 0)
695 aad_pdata->jack_ins_deb =
696 da7219_aad_fw_jack_ins_deb(dev, fw_val32);
697 else
698 aad_pdata->jack_ins_deb = DA7219_AAD_JACK_INS_DEB_20MS;
699
700 if (!fwnode_property_read_string(aad_np, "dlg,jack-det-rate", &fw_str))
701 aad_pdata->jack_det_rate =
702 da7219_aad_fw_jack_det_rate(dev, fw_str);
703 else
704 aad_pdata->jack_det_rate = DA7219_AAD_JACK_DET_RATE_256_512MS;
705
706 if (fwnode_property_read_u32(aad_np, "dlg,jack-rem-deb", &fw_val32) >= 0)
707 aad_pdata->jack_rem_deb =
708 da7219_aad_fw_jack_rem_deb(dev, fw_val32);
709 else
710 aad_pdata->jack_rem_deb = DA7219_AAD_JACK_REM_DEB_1MS;
711
712 if (fwnode_property_read_u32(aad_np, "dlg,a-d-btn-thr", &fw_val32) >= 0)
713 aad_pdata->a_d_btn_thr = (u8) fw_val32;
714 else
715 aad_pdata->a_d_btn_thr = 0xA;
716
717 if (fwnode_property_read_u32(aad_np, "dlg,d-b-btn-thr", &fw_val32) >= 0)
718 aad_pdata->d_b_btn_thr = (u8) fw_val32;
719 else
720 aad_pdata->d_b_btn_thr = 0x16;
721
722 if (fwnode_property_read_u32(aad_np, "dlg,b-c-btn-thr", &fw_val32) >= 0)
723 aad_pdata->b_c_btn_thr = (u8) fw_val32;
724 else
725 aad_pdata->b_c_btn_thr = 0x21;
726
727 if (fwnode_property_read_u32(aad_np, "dlg,c-mic-btn-thr", &fw_val32) >= 0)
728 aad_pdata->c_mic_btn_thr = (u8) fw_val32;
729 else
730 aad_pdata->c_mic_btn_thr = 0x3E;
731
732 if (fwnode_property_read_u32(aad_np, "dlg,btn-avg", &fw_val32) >= 0)
733 aad_pdata->btn_avg = da7219_aad_fw_btn_avg(dev, fw_val32);
734 else
735 aad_pdata->btn_avg = DA7219_AAD_BTN_AVG_2;
736
737 if (fwnode_property_read_u32(aad_np, "dlg,adc-1bit-rpt", &fw_val32) >= 0)
738 aad_pdata->adc_1bit_rpt =
739 da7219_aad_fw_adc_1bit_rpt(dev, fw_val32);
740 else
741 aad_pdata->adc_1bit_rpt = DA7219_AAD_ADC_1BIT_RPT_1;
742
743 return aad_pdata;
744 }
745
da7219_aad_handle_pdata(struct snd_soc_component * component)746 static void da7219_aad_handle_pdata(struct snd_soc_component *component)
747 {
748 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
749 struct da7219_aad_priv *da7219_aad = da7219->aad;
750 struct da7219_pdata *pdata = da7219->pdata;
751
752 if ((pdata) && (pdata->aad_pdata)) {
753 struct da7219_aad_pdata *aad_pdata = pdata->aad_pdata;
754 u8 cfg, mask;
755
756 da7219_aad->irq = aad_pdata->irq;
757
758 switch (aad_pdata->micbias_pulse_lvl) {
759 case DA7219_AAD_MICBIAS_PULSE_LVL_2_8V:
760 case DA7219_AAD_MICBIAS_PULSE_LVL_2_9V:
761 da7219_aad->micbias_pulse_lvl =
762 (aad_pdata->micbias_pulse_lvl <<
763 DA7219_MICBIAS1_LEVEL_SHIFT);
764 break;
765 default:
766 break;
767 }
768
769 da7219_aad->micbias_pulse_time = aad_pdata->micbias_pulse_time;
770
771 switch (aad_pdata->btn_cfg) {
772 case DA7219_AAD_BTN_CFG_2MS:
773 case DA7219_AAD_BTN_CFG_5MS:
774 case DA7219_AAD_BTN_CFG_10MS:
775 case DA7219_AAD_BTN_CFG_50MS:
776 case DA7219_AAD_BTN_CFG_100MS:
777 case DA7219_AAD_BTN_CFG_200MS:
778 case DA7219_AAD_BTN_CFG_500MS:
779 da7219_aad->btn_cfg = (aad_pdata->btn_cfg <<
780 DA7219_BUTTON_CONFIG_SHIFT);
781 }
782
783 cfg = 0;
784 mask = 0;
785 switch (aad_pdata->mic_det_thr) {
786 case DA7219_AAD_MIC_DET_THR_200_OHMS:
787 case DA7219_AAD_MIC_DET_THR_500_OHMS:
788 case DA7219_AAD_MIC_DET_THR_750_OHMS:
789 case DA7219_AAD_MIC_DET_THR_1000_OHMS:
790 cfg |= (aad_pdata->mic_det_thr <<
791 DA7219_MIC_DET_THRESH_SHIFT);
792 mask |= DA7219_MIC_DET_THRESH_MASK;
793 }
794 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1, mask, cfg);
795
796 cfg = 0;
797 mask = 0;
798 switch (aad_pdata->jack_ins_deb) {
799 case DA7219_AAD_JACK_INS_DEB_5MS:
800 case DA7219_AAD_JACK_INS_DEB_10MS:
801 case DA7219_AAD_JACK_INS_DEB_20MS:
802 case DA7219_AAD_JACK_INS_DEB_50MS:
803 case DA7219_AAD_JACK_INS_DEB_100MS:
804 case DA7219_AAD_JACK_INS_DEB_200MS:
805 case DA7219_AAD_JACK_INS_DEB_500MS:
806 case DA7219_AAD_JACK_INS_DEB_1S:
807 cfg |= (aad_pdata->jack_ins_deb <<
808 DA7219_JACKDET_DEBOUNCE_SHIFT);
809 mask |= DA7219_JACKDET_DEBOUNCE_MASK;
810 }
811 switch (aad_pdata->jack_det_rate) {
812 case DA7219_AAD_JACK_DET_RATE_32_64MS:
813 case DA7219_AAD_JACK_DET_RATE_64_128MS:
814 case DA7219_AAD_JACK_DET_RATE_128_256MS:
815 case DA7219_AAD_JACK_DET_RATE_256_512MS:
816 cfg |= (aad_pdata->jack_det_rate <<
817 DA7219_JACK_DETECT_RATE_SHIFT);
818 mask |= DA7219_JACK_DETECT_RATE_MASK;
819 }
820 switch (aad_pdata->jack_rem_deb) {
821 case DA7219_AAD_JACK_REM_DEB_1MS:
822 case DA7219_AAD_JACK_REM_DEB_5MS:
823 case DA7219_AAD_JACK_REM_DEB_10MS:
824 case DA7219_AAD_JACK_REM_DEB_20MS:
825 cfg |= (aad_pdata->jack_rem_deb <<
826 DA7219_JACKDET_REM_DEB_SHIFT);
827 mask |= DA7219_JACKDET_REM_DEB_MASK;
828 }
829 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_2, mask, cfg);
830
831 snd_soc_component_write(component, DA7219_ACCDET_CONFIG_3,
832 aad_pdata->a_d_btn_thr);
833 snd_soc_component_write(component, DA7219_ACCDET_CONFIG_4,
834 aad_pdata->d_b_btn_thr);
835 snd_soc_component_write(component, DA7219_ACCDET_CONFIG_5,
836 aad_pdata->b_c_btn_thr);
837 snd_soc_component_write(component, DA7219_ACCDET_CONFIG_6,
838 aad_pdata->c_mic_btn_thr);
839
840 cfg = 0;
841 mask = 0;
842 switch (aad_pdata->btn_avg) {
843 case DA7219_AAD_BTN_AVG_1:
844 case DA7219_AAD_BTN_AVG_2:
845 case DA7219_AAD_BTN_AVG_4:
846 case DA7219_AAD_BTN_AVG_8:
847 cfg |= (aad_pdata->btn_avg <<
848 DA7219_BUTTON_AVERAGE_SHIFT);
849 mask |= DA7219_BUTTON_AVERAGE_MASK;
850 }
851 switch (aad_pdata->adc_1bit_rpt) {
852 case DA7219_AAD_ADC_1BIT_RPT_1:
853 case DA7219_AAD_ADC_1BIT_RPT_2:
854 case DA7219_AAD_ADC_1BIT_RPT_4:
855 case DA7219_AAD_ADC_1BIT_RPT_8:
856 cfg |= (aad_pdata->adc_1bit_rpt <<
857 DA7219_ADC_1_BIT_REPEAT_SHIFT);
858 mask |= DA7219_ADC_1_BIT_REPEAT_MASK;
859 }
860 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_7, mask, cfg);
861 }
862 }
863
da7219_aad_handle_gnd_switch_time(struct snd_soc_component * component)864 static void da7219_aad_handle_gnd_switch_time(struct snd_soc_component *component)
865 {
866 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
867 struct da7219_aad_priv *da7219_aad = da7219->aad;
868 u8 jack_det;
869
870 jack_det = snd_soc_component_read(component, DA7219_ACCDET_CONFIG_2)
871 & DA7219_JACK_DETECT_RATE_MASK;
872 switch (jack_det) {
873 case 0x00:
874 da7219_aad->gnd_switch_delay = 32;
875 break;
876 case 0x10:
877 da7219_aad->gnd_switch_delay = 64;
878 break;
879 case 0x20:
880 da7219_aad->gnd_switch_delay = 128;
881 break;
882 case 0x30:
883 da7219_aad->gnd_switch_delay = 256;
884 break;
885 default:
886 da7219_aad->gnd_switch_delay = 32;
887 break;
888 }
889 }
890
891 /*
892 * Suspend/Resume
893 */
894
da7219_aad_suspend(struct snd_soc_component * component)895 void da7219_aad_suspend(struct snd_soc_component *component)
896 {
897 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
898 struct da7219_aad_priv *da7219_aad = da7219->aad;
899 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
900 u8 micbias_ctrl;
901
902 if (da7219_aad->jack) {
903 /* Disable jack detection during suspend */
904 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
905 DA7219_ACCDET_EN_MASK, 0);
906
907 /*
908 * If we have a 4-pole jack inserted, then micbias will be
909 * enabled. We can disable micbias here, and keep a note to
910 * re-enable it on resume. If jack removal occurred during
911 * suspend then this will be dealt with through the IRQ handler.
912 */
913 if (da7219_aad->jack_inserted) {
914 micbias_ctrl = snd_soc_component_read(component, DA7219_MICBIAS_CTRL);
915 if (micbias_ctrl & DA7219_MICBIAS1_EN_MASK) {
916 snd_soc_dapm_disable_pin(dapm, "Mic Bias");
917 snd_soc_dapm_sync(dapm);
918 da7219_aad->micbias_resume_enable = true;
919 }
920 }
921 }
922 }
923
da7219_aad_resume(struct snd_soc_component * component)924 void da7219_aad_resume(struct snd_soc_component *component)
925 {
926 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
927 struct da7219_aad_priv *da7219_aad = da7219->aad;
928 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
929
930 if (da7219_aad->jack) {
931 /* Re-enable micbias if previously enabled for 4-pole jack */
932 if (da7219_aad->jack_inserted &&
933 da7219_aad->micbias_resume_enable) {
934 snd_soc_dapm_force_enable_pin(dapm, "Mic Bias");
935 snd_soc_dapm_sync(dapm);
936 da7219_aad->micbias_resume_enable = false;
937 }
938
939 /* Re-enable jack detection */
940 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
941 DA7219_ACCDET_EN_MASK,
942 DA7219_ACCDET_EN_MASK);
943 }
944 }
945
946
947 /*
948 * Init/Exit
949 */
950
da7219_aad_init(struct snd_soc_component * component)951 int da7219_aad_init(struct snd_soc_component *component)
952 {
953 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
954 struct da7219_aad_priv *da7219_aad = da7219->aad;
955 u8 mask[DA7219_AAD_IRQ_REG_MAX];
956 int ret;
957
958 da7219_aad->component = component;
959
960 /* Handle any DT/ACPI/platform data */
961 da7219_aad_handle_pdata(component);
962
963 /* Disable button detection */
964 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
965 DA7219_BUTTON_CONFIG_MASK, 0);
966
967 INIT_WORK(&da7219_aad->btn_det_work, da7219_aad_btn_det_work);
968 INIT_WORK(&da7219_aad->hptest_work, da7219_aad_hptest_work);
969 INIT_WORK(&da7219_aad->jack_det_work, da7219_aad_jack_det_work);
970
971 ret = request_threaded_irq(da7219_aad->irq, da7219_aad_pre_irq_thread,
972 da7219_aad_irq_thread,
973 IRQF_TRIGGER_LOW | IRQF_ONESHOT,
974 "da7219-aad", da7219_aad);
975 if (ret) {
976 dev_err(component->dev, "Failed to request IRQ: %d\n", ret);
977 return ret;
978 }
979
980 /* Unmask AAD IRQs */
981 memset(mask, 0, DA7219_AAD_IRQ_REG_MAX);
982 regmap_bulk_write(da7219->regmap, DA7219_ACCDET_IRQ_MASK_A,
983 &mask, DA7219_AAD_IRQ_REG_MAX);
984
985 da7219_aad_handle_gnd_switch_time(component);
986
987 return 0;
988 }
989
da7219_aad_exit(struct snd_soc_component * component)990 void da7219_aad_exit(struct snd_soc_component *component)
991 {
992 struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
993 struct da7219_aad_priv *da7219_aad = da7219->aad;
994 u8 mask[DA7219_AAD_IRQ_REG_MAX];
995
996 /* Mask off AAD IRQs */
997 memset(mask, DA7219_BYTE_MASK, DA7219_AAD_IRQ_REG_MAX);
998 regmap_bulk_write(da7219->regmap, DA7219_ACCDET_IRQ_MASK_A,
999 mask, DA7219_AAD_IRQ_REG_MAX);
1000
1001 free_irq(da7219_aad->irq, da7219_aad);
1002
1003 cancel_work_sync(&da7219_aad->btn_det_work);
1004 cancel_work_sync(&da7219_aad->hptest_work);
1005 }
1006
1007 /*
1008 * AAD related I2C probe handling
1009 */
1010
da7219_aad_probe(struct i2c_client * i2c)1011 int da7219_aad_probe(struct i2c_client *i2c)
1012 {
1013 struct da7219_priv *da7219 = i2c_get_clientdata(i2c);
1014 struct device *dev = &i2c->dev;
1015 struct da7219_aad_priv *da7219_aad;
1016
1017 da7219_aad = devm_kzalloc(dev, sizeof(*da7219_aad), GFP_KERNEL);
1018 if (!da7219_aad)
1019 return -ENOMEM;
1020
1021 da7219->aad = da7219_aad;
1022
1023 /* Retrieve any DT/ACPI/platform data */
1024 if (da7219->pdata && !da7219->pdata->aad_pdata)
1025 da7219->pdata->aad_pdata = da7219_aad_fw_to_pdata(dev);
1026
1027 return 0;
1028 }
1029
1030 MODULE_DESCRIPTION("ASoC DA7219 AAD Driver");
1031 MODULE_AUTHOR("Adam Thomson <Adam.Thomson.Opensource@diasemi.com>");
1032 MODULE_LICENSE("GPL");
1033