~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/sound/soc/codecs/da7219-aad.c

Version: ~ [ linux-6.11.5 ] ~ [ linux-6.10.14 ] ~ [ linux-6.9.12 ] ~ [ linux-6.8.12 ] ~ [ linux-6.7.12 ] ~ [ linux-6.6.58 ] ~ [ linux-6.5.13 ] ~ [ linux-6.4.16 ] ~ [ linux-6.3.13 ] ~ [ linux-6.2.16 ] ~ [ linux-6.1.114 ] ~ [ linux-6.0.19 ] ~ [ linux-5.19.17 ] ~ [ linux-5.18.19 ] ~ [ linux-5.17.15 ] ~ [ linux-5.16.20 ] ~ [ linux-5.15.169 ] ~ [ linux-5.14.21 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.228 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.284 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.322 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.336 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.337 ] ~ [ linux-4.4.302 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.9 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  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 
 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 
 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 
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 
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 
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
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
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
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
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
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
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
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
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
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 
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 
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 
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 
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         disable_irq(da7219_aad->irq);
935 
936         if (da7219_aad->jack) {
937                 /* Disable jack detection during suspend */
938                 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
939                                     DA7219_ACCDET_EN_MASK, 0);
940                 cancel_delayed_work_sync(&da7219_aad->jack_det_work);
941                 /* Disable ground switch */
942                 snd_soc_component_update_bits(component, 0xFB, 0x01, 0x00);
943 
944                 /*
945                  * If we have a 4-pole jack inserted, then micbias will be
946                  * enabled. We can disable micbias here, and keep a note to
947                  * re-enable it on resume. If jack removal occurred during
948                  * suspend then this will be dealt with through the IRQ handler.
949                  */
950                 if (da7219_aad->jack_inserted) {
951                         micbias_ctrl = snd_soc_component_read(component, DA7219_MICBIAS_CTRL);
952                         if (micbias_ctrl & DA7219_MICBIAS1_EN_MASK) {
953                                 snd_soc_dapm_disable_pin(dapm, "Mic Bias");
954                                 snd_soc_dapm_sync(dapm);
955                                 da7219_aad->micbias_resume_enable = true;
956                         }
957                 }
958         }
959 }
960 
961 void da7219_aad_resume(struct snd_soc_component *component)
962 {
963         struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
964         struct da7219_aad_priv *da7219_aad = da7219->aad;
965         struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
966 
967         if (da7219_aad->jack) {
968                 /* Re-enable micbias if previously enabled for 4-pole jack */
969                 if (da7219_aad->jack_inserted &&
970                     da7219_aad->micbias_resume_enable) {
971                         snd_soc_dapm_force_enable_pin(dapm, "Mic Bias");
972                         snd_soc_dapm_sync(dapm);
973                         da7219_aad->micbias_resume_enable = false;
974                 }
975 
976                 /* Re-enable jack detection */
977                 snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
978                                     DA7219_ACCDET_EN_MASK,
979                                     DA7219_ACCDET_EN_MASK);
980         }
981 
982         enable_irq(da7219_aad->irq);
983 }
984 
985 
986 /*
987  * Init/Exit
988  */
989 
990 int da7219_aad_init(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         int ret;
996 
997         da7219_aad->component = component;
998 
999         /* Handle any DT/ACPI/platform data */
1000         da7219_aad_handle_pdata(component);
1001 
1002         /* Disable button detection */
1003         snd_soc_component_update_bits(component, DA7219_ACCDET_CONFIG_1,
1004                             DA7219_BUTTON_CONFIG_MASK, 0);
1005 
1006         da7219_aad_handle_gnd_switch_time(component);
1007 
1008         da7219_aad->aad_wq = create_singlethread_workqueue("da7219-aad");
1009         if (!da7219_aad->aad_wq) {
1010                 dev_err(component->dev, "Failed to create aad workqueue\n");
1011                 return -ENOMEM;
1012         }
1013 
1014         INIT_DELAYED_WORK(&da7219_aad->jack_det_work, da7219_aad_jack_det_work);
1015         INIT_WORK(&da7219_aad->btn_det_work, da7219_aad_btn_det_work);
1016         INIT_WORK(&da7219_aad->hptest_work, da7219_aad_hptest_work);
1017 
1018         ret = request_threaded_irq(da7219_aad->irq, NULL,
1019                                    da7219_aad_irq_thread,
1020                                    IRQF_TRIGGER_LOW | IRQF_ONESHOT,
1021                                    "da7219-aad", da7219_aad);
1022         if (ret) {
1023                 dev_err(component->dev, "Failed to request IRQ: %d\n", ret);
1024                 return ret;
1025         }
1026 
1027         /* Unmask AAD IRQs */
1028         memset(mask, 0, DA7219_AAD_IRQ_REG_MAX);
1029         regmap_bulk_write(da7219->regmap, DA7219_ACCDET_IRQ_MASK_A,
1030                           &mask, DA7219_AAD_IRQ_REG_MAX);
1031 
1032         return 0;
1033 }
1034 
1035 void da7219_aad_exit(struct snd_soc_component *component)
1036 {
1037         struct da7219_priv *da7219 = snd_soc_component_get_drvdata(component);
1038         struct da7219_aad_priv *da7219_aad = da7219->aad;
1039         u8 mask[DA7219_AAD_IRQ_REG_MAX];
1040 
1041         /* Mask off AAD IRQs */
1042         memset(mask, DA7219_BYTE_MASK, DA7219_AAD_IRQ_REG_MAX);
1043         regmap_bulk_write(da7219->regmap, DA7219_ACCDET_IRQ_MASK_A,
1044                           mask, DA7219_AAD_IRQ_REG_MAX);
1045 
1046         free_irq(da7219_aad->irq, da7219_aad);
1047 
1048         cancel_delayed_work_sync(&da7219_aad->jack_det_work);
1049         cancel_work_sync(&da7219_aad->btn_det_work);
1050         cancel_work_sync(&da7219_aad->hptest_work);
1051         destroy_workqueue(da7219_aad->aad_wq);
1052 }
1053 
1054 /*
1055  * AAD related I2C probe handling
1056  */
1057 
1058 int da7219_aad_probe(struct i2c_client *i2c)
1059 {
1060         struct da7219_priv *da7219 = i2c_get_clientdata(i2c);
1061         struct device *dev = &i2c->dev;
1062         struct da7219_aad_priv *da7219_aad;
1063 
1064         da7219_aad = devm_kzalloc(dev, sizeof(*da7219_aad), GFP_KERNEL);
1065         if (!da7219_aad)
1066                 return -ENOMEM;
1067 
1068         da7219->aad = da7219_aad;
1069 
1070         /* Retrieve any DT/ACPI/platform data */
1071         if (da7219->pdata && !da7219->pdata->aad_pdata)
1072                 da7219->pdata->aad_pdata = da7219_aad_fw_to_pdata(dev);
1073 
1074         return 0;
1075 }
1076 
1077 MODULE_DESCRIPTION("ASoC DA7219 AAD Driver");
1078 MODULE_AUTHOR("Adam Thomson <Adam.Thomson.Opensource@diasemi.com>");
1079 MODULE_AUTHOR("David Rau <David.Rau.opensource@dm.renesas.com>");
1080 MODULE_LICENSE("GPL");
1081 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

sflogo.php