1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <sound/jack.h>
15#include <sound/soc.h>
16#include <linux/gpio.h>
17#include <linux/interrupt.h>
18#include <linux/workqueue.h>
19#include <linux/delay.h>
20#include <linux/export.h>
21#include <trace/events/asoc.h>
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36int snd_soc_jack_new(struct snd_soc_codec *codec, const char *id, int type,
37 struct snd_soc_jack *jack)
38{
39 mutex_init(&jack->mutex);
40 jack->codec = codec;
41 INIT_LIST_HEAD(&jack->pins);
42 INIT_LIST_HEAD(&jack->jack_zones);
43 BLOCKING_INIT_NOTIFIER_HEAD(&jack->notifier);
44
45 return snd_jack_new(codec->card->snd_card, id, type, &jack->jack);
46}
47EXPORT_SYMBOL_GPL(snd_soc_jack_new);
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63void snd_soc_jack_report(struct snd_soc_jack *jack, int status, int mask)
64{
65 struct snd_soc_codec *codec;
66 struct snd_soc_dapm_context *dapm;
67 struct snd_soc_jack_pin *pin;
68 int enable;
69
70 trace_snd_soc_jack_report(jack, mask, status);
71
72 if (!jack)
73 return;
74
75 codec = jack->codec;
76 dapm = &codec->dapm;
77
78 mutex_lock(&jack->mutex);
79
80 jack->status &= ~mask;
81 jack->status |= status & mask;
82
83 trace_snd_soc_jack_notify(jack, status);
84
85 list_for_each_entry(pin, &jack->pins, list) {
86 enable = pin->mask & jack->status;
87
88 if (pin->invert)
89 enable = !enable;
90
91 if (enable)
92 snd_soc_dapm_enable_pin(dapm, pin->pin);
93 else
94 snd_soc_dapm_disable_pin(dapm, pin->pin);
95 }
96
97
98 blocking_notifier_call_chain(&jack->notifier, jack->status, jack);
99
100 snd_soc_dapm_sync(dapm);
101
102 snd_jack_report(jack->jack, jack->status);
103
104 mutex_unlock(&jack->mutex);
105}
106EXPORT_SYMBOL_GPL(snd_soc_jack_report);
107
108
109
110
111
112
113
114
115
116
117
118int snd_soc_jack_add_zones(struct snd_soc_jack *jack, int count,
119 struct snd_soc_jack_zone *zones)
120{
121 int i;
122
123 for (i = 0; i < count; i++) {
124 INIT_LIST_HEAD(&zones[i].list);
125 list_add(&(zones[i].list), &jack->jack_zones);
126 }
127 return 0;
128}
129EXPORT_SYMBOL_GPL(snd_soc_jack_add_zones);
130
131
132
133
134
135
136
137
138
139
140
141int snd_soc_jack_get_type(struct snd_soc_jack *jack, int micbias_voltage)
142{
143 struct snd_soc_jack_zone *zone;
144
145 list_for_each_entry(zone, &jack->jack_zones, list) {
146 if (micbias_voltage >= zone->min_mv &&
147 micbias_voltage < zone->max_mv)
148 return zone->jack_type;
149 }
150 return 0;
151}
152EXPORT_SYMBOL_GPL(snd_soc_jack_get_type);
153
154
155
156
157
158
159
160
161
162
163
164
165int snd_soc_jack_add_pins(struct snd_soc_jack *jack, int count,
166 struct snd_soc_jack_pin *pins)
167{
168 int i;
169
170 for (i = 0; i < count; i++) {
171 if (!pins[i].pin) {
172 dev_err(jack->codec->dev, "ASoC: No name for pin %d\n",
173 i);
174 return -EINVAL;
175 }
176 if (!pins[i].mask) {
177 dev_err(jack->codec->dev, "ASoC: No mask for pin %d"
178 " (%s)\n", i, pins[i].pin);
179 return -EINVAL;
180 }
181
182 INIT_LIST_HEAD(&pins[i].list);
183 list_add(&(pins[i].list), &jack->pins);
184 }
185
186 snd_soc_dapm_new_widgets(&jack->codec->card->dapm);
187
188
189
190
191
192 snd_soc_jack_report(jack, 0, 0);
193
194 return 0;
195}
196EXPORT_SYMBOL_GPL(snd_soc_jack_add_pins);
197
198
199
200
201
202
203
204
205
206
207
208
209
210void snd_soc_jack_notifier_register(struct snd_soc_jack *jack,
211 struct notifier_block *nb)
212{
213 blocking_notifier_chain_register(&jack->notifier, nb);
214}
215EXPORT_SYMBOL_GPL(snd_soc_jack_notifier_register);
216
217
218
219
220
221
222
223
224
225void snd_soc_jack_notifier_unregister(struct snd_soc_jack *jack,
226 struct notifier_block *nb)
227{
228 blocking_notifier_chain_unregister(&jack->notifier, nb);
229}
230EXPORT_SYMBOL_GPL(snd_soc_jack_notifier_unregister);
231
232#ifdef CONFIG_GPIOLIB
233
234static void snd_soc_jack_gpio_detect(struct snd_soc_jack_gpio *gpio)
235{
236 struct snd_soc_jack *jack = gpio->jack;
237 int enable;
238 int report;
239
240 enable = gpio_get_value_cansleep(gpio->gpio);
241 if (gpio->invert)
242 enable = !enable;
243
244 if (enable)
245 report = gpio->report;
246 else
247 report = 0;
248
249 if (gpio->jack_status_check)
250 report = gpio->jack_status_check();
251
252 snd_soc_jack_report(jack, report, gpio->report);
253}
254
255
256static irqreturn_t gpio_handler(int irq, void *data)
257{
258 struct snd_soc_jack_gpio *gpio = data;
259 struct device *dev = gpio->jack->codec->card->dev;
260
261 trace_snd_soc_jack_irq(gpio->name);
262
263 if (device_may_wakeup(dev))
264 pm_wakeup_event(dev, gpio->debounce_time + 50);
265
266 schedule_delayed_work(&gpio->work,
267 msecs_to_jiffies(gpio->debounce_time));
268
269 return IRQ_HANDLED;
270}
271
272
273static void gpio_work(struct work_struct *work)
274{
275 struct snd_soc_jack_gpio *gpio;
276
277 gpio = container_of(work, struct snd_soc_jack_gpio, work.work);
278 snd_soc_jack_gpio_detect(gpio);
279}
280
281
282
283
284
285
286
287
288
289
290
291int snd_soc_jack_add_gpios(struct snd_soc_jack *jack, int count,
292 struct snd_soc_jack_gpio *gpios)
293{
294 int i, ret;
295
296 for (i = 0; i < count; i++) {
297 if (!gpio_is_valid(gpios[i].gpio)) {
298 dev_err(jack->codec->dev, "ASoC: Invalid gpio %d\n",
299 gpios[i].gpio);
300 ret = -EINVAL;
301 goto undo;
302 }
303 if (!gpios[i].name) {
304 dev_err(jack->codec->dev, "ASoC: No name for gpio %d\n",
305 gpios[i].gpio);
306 ret = -EINVAL;
307 goto undo;
308 }
309
310 ret = gpio_request(gpios[i].gpio, gpios[i].name);
311 if (ret)
312 goto undo;
313
314 ret = gpio_direction_input(gpios[i].gpio);
315 if (ret)
316 goto err;
317
318 INIT_DELAYED_WORK(&gpios[i].work, gpio_work);
319 gpios[i].jack = jack;
320
321 ret = request_any_context_irq(gpio_to_irq(gpios[i].gpio),
322 gpio_handler,
323 IRQF_TRIGGER_RISING |
324 IRQF_TRIGGER_FALLING,
325 gpios[i].name,
326 &gpios[i]);
327 if (ret < 0)
328 goto err;
329
330 if (gpios[i].wake) {
331 ret = irq_set_irq_wake(gpio_to_irq(gpios[i].gpio), 1);
332 if (ret != 0)
333 dev_err(jack->codec->dev, "ASoC: "
334 "Failed to mark GPIO %d as wake source: %d\n",
335 gpios[i].gpio, ret);
336 }
337
338
339 gpio_export(gpios[i].gpio, false);
340
341
342 snd_soc_jack_gpio_detect(&gpios[i]);
343 }
344
345 return 0;
346
347err:
348 gpio_free(gpios[i].gpio);
349undo:
350 snd_soc_jack_free_gpios(jack, i, gpios);
351
352 return ret;
353}
354EXPORT_SYMBOL_GPL(snd_soc_jack_add_gpios);
355
356
357
358
359
360
361
362
363
364
365void snd_soc_jack_free_gpios(struct snd_soc_jack *jack, int count,
366 struct snd_soc_jack_gpio *gpios)
367{
368 int i;
369
370 for (i = 0; i < count; i++) {
371 gpio_unexport(gpios[i].gpio);
372 free_irq(gpio_to_irq(gpios[i].gpio), &gpios[i]);
373 cancel_delayed_work_sync(&gpios[i].work);
374 gpio_free(gpios[i].gpio);
375 gpios[i].jack = NULL;
376 }
377}
378EXPORT_SYMBOL_GPL(snd_soc_jack_free_gpios);
379#endif
380