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