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