audio.c revision 1.4 1 /* $NetBSD: audio.c,v 1.4 2012/02/01 07:46:22 kardel Exp $ */
2
3 /*
4 * audio.c - audio interface for reference clock audio drivers
5 */
6 #ifdef HAVE_CONFIG_H
7 # include <config.h>
8 #endif
9
10 #if defined(HAVE_SYS_AUDIOIO_H) || defined(HAVE_SUN_AUDIOIO_H) || \
11 defined(HAVE_SYS_SOUNDCARD_H) || defined(HAVE_MACHINE_SOUNDCARD_H)
12
13 #include "audio.h"
14 #include "ntp_stdlib.h"
15 #include "ntp_syslog.h"
16 #ifdef HAVE_UNISTD_H
17 # include <unistd.h>
18 #endif
19 #include <stdio.h>
20 #include "ntp_string.h"
21
22 #ifdef HAVE_SYS_AUDIOIO_H
23 # include <sys/audioio.h>
24 #endif /* HAVE_SYS_AUDIOIO_H */
25
26 #ifdef HAVE_SUN_AUDIOIO_H
27 # include <sys/ioccom.h>
28 # include <sun/audioio.h>
29 #endif /* HAVE_SUN_AUDIOIO_H */
30
31 #ifdef HAVE_SYS_IOCTL_H
32 # include <sys/ioctl.h>
33 #endif /* HAVE_SYS_IOCTL_H */
34
35 #include <fcntl.h>
36
37 #ifdef HAVE_MACHINE_SOUNDCARD_H
38 # include <machine/soundcard.h>
39 # define PCM_STYLE_SOUND
40 #else
41 # ifdef HAVE_SYS_SOUNDCARD_H
42 # include <sys/soundcard.h>
43 # define PCM_STYLE_SOUND
44 # endif
45 #endif
46
47 #ifdef PCM_STYLE_SOUND
48 # include <ctype.h>
49 #endif
50
51 /*
52 * Global variables
53 */
54 #ifdef HAVE_SYS_AUDIOIO_H
55 static struct audio_device device; /* audio device ident */
56 #endif /* HAVE_SYS_AUDIOIO_H */
57 #ifdef PCM_STYLE_SOUND
58 # define INIT_FILE "/etc/ntp.audio"
59 int agc = SOUND_MIXER_WRITE_RECLEV; /* or IGAIN or LINE */
60 int monitor = SOUND_MIXER_WRITE_VOLUME; /* or OGAIN */
61 int devmask = 0;
62 int recmask = 0;
63 char cf_c_dev[100], cf_i_dev[100], cf_agc[100], cf_monitor[100];
64
65 const char *m_names[SOUND_MIXER_NRDEVICES] = SOUND_DEVICE_NAMES;
66 #else /* not PCM_STYLE_SOUND */
67 static struct audio_info info; /* audio device info */
68 #endif /* not PCM_STYLE_SOUND */
69 static int ctl_fd; /* audio control file descriptor */
70
71 #ifdef PCM_STYLE_SOUND
72 static void audio_config_read (int, char **, char **);
73 static int mixer_name (const char *, int);
74
75
76 int
77 mixer_name(
78 const char *m_name,
79 int m_mask
80 )
81 {
82 int i;
83
84 for (i = 0; i < SOUND_MIXER_NRDEVICES; ++i)
85 if (((1 << i) & m_mask)
86 && !strcmp(m_names[i], m_name))
87 break;
88
89 return (SOUND_MIXER_NRDEVICES == i)
90 ? -1
91 : i
92 ;
93 }
94
95
96 /*
97 * Check:
98 *
99 * /etc/ntp.audio# where # is the unit number
100 * /etc/ntp.audio.# where # is the unit number
101 * /etc/ntp.audio
102 *
103 * for contents of the form:
104 *
105 * idev /dev/input_device
106 * cdev /dev/control_device
107 * agc pcm_input_device {igain,line,line1,...}
108 * monitor pcm_monitor_device {ogain,...}
109 *
110 * The device names for the "agc" and "monitor" keywords
111 * can be found by running either the "mixer" program or the
112 * util/audio-pcm program.
113 *
114 * Great hunks of this subroutine were swiped from refclock_oncore.c
115 */
116 static void
117 audio_config_read(
118 int unit,
119 char **c_dev, /* Control device */
120 char **i_dev /* input device */
121 )
122 {
123 FILE *fd;
124 char device[20], line[100], ab[100];
125
126 snprintf(device, sizeof(device), "%s%d", INIT_FILE, unit);
127 if ((fd = fopen(device, "r")) == NULL) {
128 printf("audio_config_read: <%s> NO\n", device);
129 snprintf(device, sizeof(device), "%s.%d", INIT_FILE,
130 unit);
131 if ((fd = fopen(device, "r")) == NULL) {
132 printf("audio_config_read: <%s> NO\n", device);
133 snprintf(device, sizeof(device), "%s",
134 INIT_FILE);
135 if ((fd = fopen(device, "r")) == NULL) {
136 printf("audio_config_read: <%s> NO\n",
137 device);
138 return;
139 }
140 }
141 }
142 printf("audio_config_read: reading <%s>\n", device);
143 while (fgets(line, sizeof line, fd)) {
144 char *cp, *cc, *ca;
145 int i;
146
147 /* Remove comments */
148 if ((cp = strchr(line, '#')))
149 *cp = '\0';
150
151 /* Remove any trailing spaces */
152 for (i = strlen(line);
153 i > 0 && isascii((unsigned char)line[i - 1]) && isspace((unsigned char)line[i - 1]);
154 )
155 line[--i] = '\0';
156
157 /* Remove leading space */
158 for (cc = line; *cc && isascii((unsigned char)*cc) && isspace((unsigned char)*cc); cc++)
159 continue;
160
161 /* Stop if nothing left */
162 if (!*cc)
163 continue;
164
165 /* Uppercase the command and find the arg */
166 for (ca = cc; *ca; ca++) {
167 if (isascii((unsigned char)*ca)) {
168 if (islower((unsigned char)*ca)) {
169 *ca = toupper((unsigned char)*ca);
170 } else if (isspace((unsigned char)*ca) || (*ca == '='))
171 break;
172 }
173 }
174
175 /* Remove space (and possible =) leading the arg */
176 for (; *ca && isascii((unsigned char)*ca) && (isspace((unsigned char)*ca) || (*ca == '=')); ca++)
177 continue;
178
179 if (!strncmp(cc, "IDEV", 4) &&
180 1 == sscanf(ca, "%99s", ab)) {
181 strncpy(cf_i_dev, ab, sizeof(cf_i_dev));
182 printf("idev <%s>\n", ab);
183 } else if (!strncmp(cc, "CDEV", 4) &&
184 1 == sscanf(ca, "%99s", ab)) {
185 strncpy(cf_c_dev, ab, sizeof(cf_c_dev));
186 printf("cdev <%s>\n", ab);
187 } else if (!strncmp(cc, "AGC", 3) &&
188 1 == sscanf(ca, "%99s", ab)) {
189 strncpy(cf_agc, ab, sizeof(cf_agc));
190 printf("agc <%s> %d\n", ab, i);
191 } else if (!strncmp(cc, "MONITOR", 7) &&
192 1 == sscanf(ca, "%99s", ab)) {
193 strncpy(cf_monitor, ab, sizeof(cf_monitor));
194 printf("monitor <%s> %d\n", ab, mixer_name(ab, -1));
195 }
196 }
197 fclose(fd);
198 return;
199 }
200 #endif /* PCM_STYLE_SOUND */
201
202 /*
203 * audio_init - open and initialize audio device
204 *
205 * This code works with SunOS 4.x, Solaris 2.x, and PCM; however, it is
206 * believed generic and applicable to other systems with a minor twid
207 * or two. All it does is open the device, set the buffer size (Solaris
208 * only), preset the gain and set the input port. It assumes that the
209 * codec sample rate (8000 Hz), precision (8 bits), number of channels
210 * (1) and encoding (ITU-T G.711 mu-law companded) have been set by
211 * default.
212 */
213 int
214 audio_init(
215 const char *dname, /* device name */
216 int bufsiz, /* buffer size */
217 int unit /* device unit (0-3) */
218 )
219 {
220 #ifdef PCM_STYLE_SOUND
221 # define ACTL_DEV "/dev/mixer%d"
222 char actl_dev[30];
223 # ifdef HAVE_STRUCT_SND_SIZE
224 struct snd_size s_size;
225 # endif
226 # ifdef AIOGFMT
227 snd_chan_param s_c_p;
228 # endif
229 #endif
230 int fd;
231 int rval;
232 const char *actl =
233 #ifdef PCM_STYLE_SOUND
234 actl_dev
235 #else
236 "/dev/audioctl"
237 #endif
238 ;
239
240 #ifdef PCM_STYLE_SOUND
241 snprintf(actl_dev, sizeof(actl_dev), ACTL_DEV, unit);
242
243 audio_config_read(unit, &actl, &dname);
244 /* If we have values for cf_c_dev or cf_i_dev, use them. */
245 if (*cf_c_dev)
246 actl = cf_c_dev;
247 if (*cf_i_dev)
248 dname = cf_i_dev;
249 #endif
250
251 /*
252 * Open audio device
253 */
254 fd = open(dname, O_RDWR | O_NONBLOCK, 0777);
255 if (fd < 0) {
256 msyslog(LOG_ERR, "audio_init: %s %m\n", dname);
257 return (fd);
258 }
259
260 /*
261 * Open audio control device.
262 */
263 ctl_fd = open(actl, O_RDWR);
264 if (ctl_fd < 0) {
265 msyslog(LOG_ERR, "audio_init: invalid control device <%s>\n",
266 actl);
267 close(fd);
268 return(ctl_fd);
269 }
270
271 /*
272 * Set audio device parameters.
273 */
274 #ifdef PCM_STYLE_SOUND
275 printf("audio_init: <%s> bufsiz %d\n", dname, bufsiz);
276 rval = fd;
277
278 # ifdef HAVE_STRUCT_SND_SIZE
279 if (ioctl(fd, AIOGSIZE, &s_size) == -1)
280 printf("audio_init: AIOGSIZE: %s\n", strerror(errno));
281 else
282 printf("audio_init: orig: play_size %d, rec_size %d\n",
283 s_size.play_size, s_size.rec_size);
284
285 s_size.play_size = s_size.rec_size = bufsiz;
286 printf("audio_init: want: play_size %d, rec_size %d\n",
287 s_size.play_size, s_size.rec_size);
288
289 if (ioctl(fd, AIOSSIZE, &s_size) == -1)
290 printf("audio_init: AIOSSIZE: %s\n", strerror(errno));
291 else
292 printf("audio_init: set: play_size %d, rec_size %d\n",
293 s_size.play_size, s_size.rec_size);
294 # endif /* HAVE_STRUCT_SND_SIZE */
295
296 # ifdef SNDCTL_DSP_SETFRAGMENT
297 {
298 int tmp = (16 << 16) + 6; /* 16 fragments, each 2^6 bytes */
299 if (ioctl(fd, SNDCTL_DSP_SETFRAGMENT, &tmp) == -1)
300 printf("audio_init: SNDCTL_DSP_SETFRAGMENT: %s\n",
301 strerror(errno));
302 }
303 # endif /* SNDCTL_DSP_SETFRAGMENT */
304
305 # ifdef AIOGFMT
306 if (ioctl(fd, AIOGFMT, &s_c_p) == -1)
307 printf("audio_init: AIOGFMT: %s\n", strerror(errno));
308 else
309 printf("audio_init: play_rate %lu, rec_rate %lu, play_format %#lx, rec_format %#lx\n",
310 s_c_p.play_rate, s_c_p.rec_rate, s_c_p.play_format, s_c_p.rec_format);
311 # endif
312
313 /* Grab the device and record masks */
314
315 if (ioctl(ctl_fd, SOUND_MIXER_READ_DEVMASK, &devmask) == -1)
316 printf("SOUND_MIXER_READ_DEVMASK: %s\n", strerror(errno));
317 if (ioctl(ctl_fd, SOUND_MIXER_READ_RECMASK, &recmask) == -1)
318 printf("SOUND_MIXER_READ_RECMASK: %s\n", strerror(errno));
319
320 /* validate and set any specified config file stuff */
321 if (cf_agc[0] != '\0') {
322 int i;
323
324 i = mixer_name(cf_agc, devmask);
325 if (i >= 0)
326 agc = MIXER_WRITE(i);
327 else
328 printf("input %s not in recmask %#x\n",
329 cf_agc, recmask);
330 }
331
332 if (cf_monitor[0] != '\0') {
333 int i;
334
335 /* devmask */
336 i = mixer_name(cf_monitor, devmask);
337 if (i >= 0)
338 monitor = MIXER_WRITE(i);
339 else
340 printf("monitor %s not in devmask %#x\n",
341 cf_monitor, devmask);
342 }
343
344 #else /* not PCM_STYLE_SOUND */
345 AUDIO_INITINFO(&info);
346 info.play.gain = AUDIO_MAX_GAIN;
347 info.play.port = AUDIO_SPEAKER;
348 # ifdef HAVE_SYS_AUDIOIO_H
349 info.record.buffer_size = bufsiz;
350 # endif /* HAVE_SYS_AUDIOIO_H */
351 rval = ioctl(ctl_fd, (int)AUDIO_SETINFO, (char *)&info);
352 if (rval < 0) {
353 msyslog(LOG_ERR, "audio: invalid control device parameters\n");
354 close(ctl_fd);
355 close(fd);
356 return(rval);
357 }
358 rval = fd;
359 #endif /* not PCM_STYLE_SOUND */
360 return (rval);
361 }
362
363
364 /*
365 * audio_gain - adjust codec gains and port
366 */
367 int
368 audio_gain(
369 int gain, /* volume level (gain) 0-255 */
370 int mongain, /* input to output mix (monitor gain) 0-255 */
371 int port /* selected I/O port: 1 mic/2 line in */
372 )
373 {
374 int rval;
375 static int o_mongain = -1;
376 static int o_port = -1;
377
378 #ifdef PCM_STYLE_SOUND
379 int l, r;
380
381 rval = 0;
382
383 r = l = 100 * gain / 255; /* Normalize to 0-100 */
384 # ifdef DEBUG
385 if (debug > 1)
386 printf("audio_gain: gain %d/%d\n", gain, l);
387 # endif
388 #if 0 /* not a good idea to do this; connector wiring dependency */
389 /* figure out what channel(s) to use. just nuke right for now. */
390 r = 0 ; /* setting to zero nicely mutes the channel */
391 #endif
392 l |= r << 8;
393 if (cf_agc[0] != '\0')
394 rval = ioctl(ctl_fd, agc, &l);
395 else
396 if (2 == port)
397 rval = ioctl(ctl_fd, SOUND_MIXER_WRITE_LINE, &l);
398 else
399 rval = ioctl(ctl_fd, SOUND_MIXER_WRITE_MIC, &l);
400 if (-1 == rval) {
401 printf("audio_gain: agc write: %s\n", strerror(errno));
402 return rval;
403 }
404
405 if (o_mongain != mongain) {
406 r = l = 100 * mongain / 255; /* Normalize to 0-100 */
407 # ifdef DEBUG
408 if (debug > 1)
409 printf("audio_gain: mongain %d/%d\n", mongain, l);
410 # endif
411 l |= r << 8;
412 if (cf_monitor[0] != '\0')
413 rval = ioctl(ctl_fd, monitor, &l );
414 else
415 rval = ioctl(ctl_fd, SOUND_MIXER_WRITE_VOLUME,
416 &l);
417 if (-1 == rval) {
418 printf("audio_gain: mongain write: %s\n",
419 strerror(errno));
420 return (rval);
421 }
422 o_mongain = mongain;
423 }
424
425 if (o_port != port) {
426 # ifdef DEBUG
427 if (debug > 1)
428 printf("audio_gain: port %d\n", port);
429 # endif
430 l = (1 << ((port == 2) ? SOUND_MIXER_LINE : SOUND_MIXER_MIC));
431 rval = ioctl(ctl_fd, SOUND_MIXER_WRITE_RECSRC, &l);
432 if (rval == -1) {
433 printf("SOUND_MIXER_WRITE_RECSRC: %s\n",
434 strerror(errno));
435 return (rval);
436 }
437 # ifdef DEBUG
438 if (debug > 1) {
439 if (ioctl(ctl_fd, SOUND_MIXER_READ_RECSRC, &l) == -1)
440 printf("SOUND_MIXER_WRITE_RECSRC: %s\n",
441 strerror(errno));
442 else
443 printf("audio_gain: recsrc is %d\n", l);
444 }
445 # endif
446 o_port = port;
447 }
448 #else /* not PCM_STYLE_SOUND */
449 ioctl(ctl_fd, (int)AUDIO_GETINFO, (char *)&info);
450 info.record.encoding = AUDIO_ENCODING_ULAW;
451 info.record.error = 0;
452 info.record.gain = gain;
453 if (o_mongain != mongain)
454 o_mongain = info.monitor_gain = mongain;
455 if (o_port != port)
456 o_port = info.record.port = port;
457 rval = ioctl(ctl_fd, (int)AUDIO_SETINFO, (char *)&info);
458 if (rval < 0) {
459 msyslog(LOG_ERR, "audio_gain: %m");
460 return (rval);
461 }
462 rval = info.record.error;
463 #endif /* not PCM_STYLE_SOUND */
464 return (rval);
465 }
466
467
468 /*
469 * audio_show - display audio parameters
470 *
471 * This code doesn't really do anything, except satisfy curiousity and
472 * verify the ioctl's work.
473 */
474 void
475 audio_show(void)
476 {
477 #ifdef PCM_STYLE_SOUND
478 int recsrc = 0;
479
480 printf("audio_show: ctl_fd %d\n", ctl_fd);
481 if (ioctl(ctl_fd, SOUND_MIXER_READ_RECSRC, &recsrc) == -1)
482 printf("SOUND_MIXER_READ_RECSRC: %s\n", strerror(errno));
483
484 #else /* not PCM_STYLE_SOUND */
485 # ifdef HAVE_SYS_AUDIOIO_H
486 ioctl(ctl_fd, (int)AUDIO_GETDEV, &device);
487 printf("audio: name %s, version %s, config %s\n",
488 device.name, device.version, device.config);
489 # endif /* HAVE_SYS_AUDIOIO_H */
490 ioctl(ctl_fd, (int)AUDIO_GETINFO, (char *)&info);
491 printf(
492 "audio: rate %d, chan %d, prec %d, code %d, gain %d, mon %d, port %d\n",
493 info.record.sample_rate, info.record.channels,
494 info.record.precision, info.record.encoding,
495 info.record.gain, info.monitor_gain, info.record.port);
496 printf(
497 "audio: samples %d, eof %d, pause %d, error %d, waiting %d, balance %d\n",
498 info.record.samples, info.record.eof,
499 info.record.pause, info.record.error,
500 info.record.waiting, info.record.balance);
501 #endif /* not PCM_STYLE_SOUND */
502 }
503 #else
504 int audio_bs;
505 #endif /* HAVE_{SYS_AUDIOIO,SUN_AUDIOIO,MACHINE_SOUNDCARD,SYS_SOUNDCARD}_H */
506