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
55static 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"
59int agc =	SOUND_MIXER_WRITE_RECLEV; /* or IGAIN or LINE */
60int monitor =	SOUND_MIXER_WRITE_VOLUME; /* or OGAIN */
61int devmask = 0;
62int recmask = 0;
63char cf_c_dev[100], cf_i_dev[100], cf_agc[100], cf_monitor[100];
64
65const char *m_names[SOUND_MIXER_NRDEVICES] = SOUND_DEVICE_NAMES;
66#else /* not PCM_STYLE_SOUND */
67static struct audio_info info;	/* audio device info */
68#endif /* not PCM_STYLE_SOUND */
69static int ctl_fd;		/* audio control file descriptor */
70
71#ifdef PCM_STYLE_SOUND
72static void audio_config_read (int, char **, char **);
73static int  mixer_name (const char *, int);
74
75
76int
77mixer_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 */
116static void
117audio_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 */
213int
214audio_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 */
367int
368audio_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 */
474void
475audio_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
504int audio_bs;
505#endif /* HAVE_{SYS_AUDIOIO,SUN_AUDIOIO,MACHINE_SOUNDCARD,SYS_SOUNDCARD}_H */
506