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/workqueue.h>
25#include <linux/export.h>
26#include <sound/core.h>
27#include "hda_beep.h"
28#include "hda_local.h"
29
30enum {
31 DIGBEEP_HZ_STEP = 46875,
32 DIGBEEP_HZ_MIN = 93750,
33 DIGBEEP_HZ_MAX = 12000000,
34};
35
36
37static void generate_tone(struct hda_beep *beep, int tone)
38{
39 struct hda_codec *codec = beep->codec;
40
41 if (tone && !beep->playing) {
42 snd_hda_power_up(codec);
43 if (beep->power_hook)
44 beep->power_hook(beep, true);
45 beep->playing = 1;
46 }
47 snd_hda_codec_write(codec, beep->nid, 0,
48 AC_VERB_SET_BEEP_CONTROL, tone);
49 if (!tone && beep->playing) {
50 beep->playing = 0;
51 if (beep->power_hook)
52 beep->power_hook(beep, false);
53 snd_hda_power_down(codec);
54 }
55}
56
57static void snd_hda_generate_beep(struct work_struct *work)
58{
59 struct hda_beep *beep =
60 container_of(work, struct hda_beep, beep_work);
61
62 if (beep->enabled)
63 generate_tone(beep, beep->tone);
64}
65
66
67
68
69
70
71
72
73static int beep_linear_tone(struct hda_beep *beep, int hz)
74{
75 if (hz <= 0)
76 return 0;
77 hz *= 1000;
78 hz = hz - DIGBEEP_HZ_MIN
79 + DIGBEEP_HZ_STEP / 2;
80 if (hz < 0)
81 hz = 0;
82 else if (hz >= (DIGBEEP_HZ_MAX - DIGBEEP_HZ_MIN))
83 hz = 1;
84 else {
85 hz /= DIGBEEP_HZ_STEP;
86 hz = 255 - hz;
87 }
88 return hz;
89}
90
91
92
93
94
95
96
97static int beep_standard_tone(struct hda_beep *beep, int hz)
98{
99 if (hz <= 0)
100 return 0;
101 hz = 12000 / hz;
102 if (hz > 0xff)
103 return 0xff;
104 if (hz <= 0)
105 return 1;
106 return hz;
107}
108
109static int snd_hda_beep_event(struct input_dev *dev, unsigned int type,
110 unsigned int code, int hz)
111{
112 struct hda_beep *beep = input_get_drvdata(dev);
113
114 switch (code) {
115 case SND_BELL:
116 if (hz)
117 hz = 1000;
118
119 case SND_TONE:
120 if (beep->linear_tone)
121 beep->tone = beep_linear_tone(beep, hz);
122 else
123 beep->tone = beep_standard_tone(beep, hz);
124 break;
125 default:
126 return -1;
127 }
128
129
130 schedule_work(&beep->beep_work);
131 return 0;
132}
133
134static void turn_off_beep(struct hda_beep *beep)
135{
136 cancel_work_sync(&beep->beep_work);
137 if (beep->playing) {
138
139 generate_tone(beep, 0);
140 }
141}
142
143static void snd_hda_do_detach(struct hda_beep *beep)
144{
145 if (beep->registered)
146 input_unregister_device(beep->dev);
147 else
148 input_free_device(beep->dev);
149 beep->dev = NULL;
150 turn_off_beep(beep);
151}
152
153static int snd_hda_do_attach(struct hda_beep *beep)
154{
155 struct input_dev *input_dev;
156 struct hda_codec *codec = beep->codec;
157
158 input_dev = input_allocate_device();
159 if (!input_dev)
160 return -ENOMEM;
161
162
163 input_dev->name = "HDA Digital PCBeep";
164 input_dev->phys = beep->phys;
165 input_dev->id.bustype = BUS_PCI;
166 input_dev->dev.parent = &codec->card->card_dev;
167
168 input_dev->id.vendor = codec->core.vendor_id >> 16;
169 input_dev->id.product = codec->core.vendor_id & 0xffff;
170 input_dev->id.version = 0x01;
171
172 input_dev->evbit[0] = BIT_MASK(EV_SND);
173 input_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE);
174 input_dev->event = snd_hda_beep_event;
175 input_set_drvdata(input_dev, beep);
176
177 beep->dev = input_dev;
178 return 0;
179}
180
181
182
183
184
185
186int snd_hda_enable_beep_device(struct hda_codec *codec, int enable)
187{
188 struct hda_beep *beep = codec->beep;
189 if (!beep)
190 return 0;
191 enable = !!enable;
192 if (beep->enabled != enable) {
193 beep->enabled = enable;
194 if (!enable)
195 turn_off_beep(beep);
196 return 1;
197 }
198 return 0;
199}
200EXPORT_SYMBOL_GPL(snd_hda_enable_beep_device);
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216int snd_hda_attach_beep_device(struct hda_codec *codec, int nid)
217{
218 struct hda_beep *beep;
219 int err;
220
221 if (!snd_hda_get_bool_hint(codec, "beep"))
222 return 0;
223 if (codec->beep_mode == HDA_BEEP_MODE_OFF)
224 return 0;
225
226 beep = kzalloc(sizeof(*beep), GFP_KERNEL);
227 if (beep == NULL)
228 return -ENOMEM;
229 snprintf(beep->phys, sizeof(beep->phys),
230 "card%d/codec#%d/beep0", codec->card->number, codec->addr);
231
232 snd_hda_codec_write_cache(codec, nid, 0,
233 AC_VERB_SET_DIGI_CONVERT_2, 0x01);
234
235 beep->nid = nid;
236 beep->codec = codec;
237 codec->beep = beep;
238
239 INIT_WORK(&beep->beep_work, &snd_hda_generate_beep);
240 mutex_init(&beep->mutex);
241
242 err = snd_hda_do_attach(beep);
243 if (err < 0) {
244 kfree(beep);
245 codec->beep = NULL;
246 return err;
247 }
248
249 return 0;
250}
251EXPORT_SYMBOL_GPL(snd_hda_attach_beep_device);
252
253
254
255
256
257void snd_hda_detach_beep_device(struct hda_codec *codec)
258{
259 struct hda_beep *beep = codec->beep;
260 if (beep) {
261 if (beep->dev)
262 snd_hda_do_detach(beep);
263 codec->beep = NULL;
264 kfree(beep);
265 }
266}
267EXPORT_SYMBOL_GPL(snd_hda_detach_beep_device);
268
269
270
271
272
273int snd_hda_register_beep_device(struct hda_codec *codec)
274{
275 struct hda_beep *beep = codec->beep;
276 int err;
277
278 if (!beep || !beep->dev)
279 return 0;
280
281 err = input_register_device(beep->dev);
282 if (err < 0) {
283 codec_err(codec, "hda_beep: unable to register input device\n");
284 input_free_device(beep->dev);
285 codec->beep = NULL;
286 kfree(beep);
287 return err;
288 }
289 beep->registered = true;
290 return 0;
291}
292EXPORT_SYMBOL_GPL(snd_hda_register_beep_device);
293
294static bool ctl_has_mute(struct snd_kcontrol *kcontrol)
295{
296 struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
297 return query_amp_caps(codec, get_amp_nid(kcontrol),
298 get_amp_direction(kcontrol)) & AC_AMPCAP_MUTE;
299}
300
301
302
303
304
305
306
307
308int snd_hda_mixer_amp_switch_get_beep(struct snd_kcontrol *kcontrol,
309 struct snd_ctl_elem_value *ucontrol)
310{
311 struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
312 struct hda_beep *beep = codec->beep;
313 if (beep && (!beep->enabled || !ctl_has_mute(kcontrol))) {
314 ucontrol->value.integer.value[0] =
315 ucontrol->value.integer.value[1] = beep->enabled;
316 return 0;
317 }
318 return snd_hda_mixer_amp_switch_get(kcontrol, ucontrol);
319}
320EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_get_beep);
321
322
323
324
325
326
327int snd_hda_mixer_amp_switch_put_beep(struct snd_kcontrol *kcontrol,
328 struct snd_ctl_elem_value *ucontrol)
329{
330 struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
331 struct hda_beep *beep = codec->beep;
332 if (beep) {
333 u8 chs = get_amp_channels(kcontrol);
334 int enable = 0;
335 long *valp = ucontrol->value.integer.value;
336 if (chs & 1) {
337 enable |= *valp;
338 valp++;
339 }
340 if (chs & 2)
341 enable |= *valp;
342 snd_hda_enable_beep_device(codec, enable);
343 }
344 if (!ctl_has_mute(kcontrol))
345 return 0;
346 return snd_hda_mixer_amp_switch_put(kcontrol, ucontrol);
347}
348EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_put_beep);
349