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