1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/input.h>
23#include <linux/slab.h>
24#include <linux/module.h>
25#include <sound/jack.h>
26#include <sound/core.h>
27
28static int jack_switch_types[SND_JACK_SWITCH_TYPES] = {
29 SW_HEADPHONE_INSERT,
30 SW_MICROPHONE_INSERT,
31 SW_LINEOUT_INSERT,
32 SW_JACK_PHYSICAL_INSERT,
33 SW_VIDEOOUT_INSERT,
34 SW_LINEIN_INSERT,
35};
36
37static int snd_jack_dev_disconnect(struct snd_device *device)
38{
39 struct snd_jack *jack = device->device_data;
40
41 if (!jack->input_dev)
42 return 0;
43
44
45
46 if (jack->registered)
47 input_unregister_device(jack->input_dev);
48 else
49 input_free_device(jack->input_dev);
50 jack->input_dev = NULL;
51 return 0;
52}
53
54static int snd_jack_dev_free(struct snd_device *device)
55{
56 struct snd_jack *jack = device->device_data;
57
58 if (jack->private_free)
59 jack->private_free(jack);
60
61 snd_jack_dev_disconnect(device);
62
63 kfree(jack->id);
64 kfree(jack);
65
66 return 0;
67}
68
69static int snd_jack_dev_register(struct snd_device *device)
70{
71 struct snd_jack *jack = device->device_data;
72 struct snd_card *card = device->card;
73 int err, i;
74
75 snprintf(jack->name, sizeof(jack->name), "%s %s",
76 card->shortname, jack->id);
77 jack->input_dev->name = jack->name;
78
79
80 if (!jack->input_dev->dev.parent)
81 jack->input_dev->dev.parent = snd_card_get_device_link(card);
82
83
84 for (i = 0; i < ARRAY_SIZE(jack->key); i++) {
85 int testbit = SND_JACK_BTN_0 >> i;
86
87 if (!(jack->type & testbit))
88 continue;
89
90 if (!jack->key[i])
91 jack->key[i] = BTN_0 + i;
92
93 input_set_capability(jack->input_dev, EV_KEY, jack->key[i]);
94 }
95
96 err = input_register_device(jack->input_dev);
97 if (err == 0)
98 jack->registered = 1;
99
100 return err;
101}
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116int snd_jack_new(struct snd_card *card, const char *id, int type,
117 struct snd_jack **jjack)
118{
119 struct snd_jack *jack;
120 int err;
121 int i;
122 static struct snd_device_ops ops = {
123 .dev_free = snd_jack_dev_free,
124 .dev_register = snd_jack_dev_register,
125 .dev_disconnect = snd_jack_dev_disconnect,
126 };
127
128 jack = kzalloc(sizeof(struct snd_jack), GFP_KERNEL);
129 if (jack == NULL)
130 return -ENOMEM;
131
132 jack->id = kstrdup(id, GFP_KERNEL);
133
134 jack->input_dev = input_allocate_device();
135 if (jack->input_dev == NULL) {
136 err = -ENOMEM;
137 goto fail_input;
138 }
139
140 jack->input_dev->phys = "ALSA";
141
142 jack->type = type;
143
144 for (i = 0; i < SND_JACK_SWITCH_TYPES; i++)
145 if (type & (1 << i))
146 input_set_capability(jack->input_dev, EV_SW,
147 jack_switch_types[i]);
148
149 err = snd_device_new(card, SNDRV_DEV_JACK, jack, &ops);
150 if (err < 0)
151 goto fail_input;
152
153 *jjack = jack;
154
155 return 0;
156
157fail_input:
158 input_free_device(jack->input_dev);
159 kfree(jack->id);
160 kfree(jack);
161 return err;
162}
163EXPORT_SYMBOL(snd_jack_new);
164
165
166
167
168
169
170
171
172
173
174
175void snd_jack_set_parent(struct snd_jack *jack, struct device *parent)
176{
177 WARN_ON(jack->registered);
178
179 jack->input_dev->dev.parent = parent;
180}
181EXPORT_SYMBOL(snd_jack_set_parent);
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208int snd_jack_set_key(struct snd_jack *jack, enum snd_jack_types type,
209 int keytype)
210{
211 int key = fls(SND_JACK_BTN_0) - fls(type);
212
213 WARN_ON(jack->registered);
214
215 if (!keytype || key >= ARRAY_SIZE(jack->key))
216 return -EINVAL;
217
218 jack->type |= type;
219 jack->key[key] = keytype;
220
221 return 0;
222}
223EXPORT_SYMBOL(snd_jack_set_key);
224
225
226
227
228
229
230
231void snd_jack_report(struct snd_jack *jack, int status)
232{
233 int i;
234
235 if (!jack)
236 return;
237
238 for (i = 0; i < ARRAY_SIZE(jack->key); i++) {
239 int testbit = SND_JACK_BTN_0 >> i;
240
241 if (jack->type & testbit)
242 input_report_key(jack->input_dev, jack->key[i],
243 status & testbit);
244 }
245
246 for (i = 0; i < ARRAY_SIZE(jack_switch_types); i++) {
247 int testbit = 1 << i;
248 if (jack->type & testbit)
249 input_report_switch(jack->input_dev,
250 jack_switch_types[i],
251 status & testbit);
252 }
253
254 input_sync(jack->input_dev);
255}
256EXPORT_SYMBOL(snd_jack_report);
257
258MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
259MODULE_DESCRIPTION("Jack detection support for ALSA");
260MODULE_LICENSE("GPL");
261