NetBSD/usr.bin/audiocfg/audiodev.c

/* $NetBSD: audiodev.c,v 1.4 2010/09/03 19:20:37 jmcneill Exp $ */

/*
 * Copyright (c) 2010 Jared D. McNeill <jmcneill@invisible.ca>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/queue.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/drvctlio.h>

#include <fcntl.h>
#include <paths.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include "audiodev.h"
#include "drvctl.h"
#include "dtmf.h"

static TAILQ_HEAD(audiodevhead, audiodev) audiodevlist =
    TAILQ_HEAD_INITIALIZER(audiodevlist);

#define AUDIODEV_SAMPLE_RATE	44100

static unsigned int
audiodev_probe_pchans(struct audiodev *adev)
{
	audio_info_t info;
	unsigned int nchans = 0, n;
	int error;

	AUDIO_INITINFO(&info);
	info.play.sample_rate = AUDIODEV_SAMPLE_RATE;
	info.play.precision = 16;
	info.play.encoding = AUDIO_ENCODING_SLINEAR_LE;
	info.play.channels = 1;
	info.mode = AUMODE_PLAY;
	error = ioctl(adev->fd, AUDIO_SETINFO, &info);
	if (error == -1)
		return 0;
	nchans = 1;

	for (n = 2; n <= 16; n += 2) {
		info.play.channels = n;
		error = ioctl(adev->fd, AUDIO_SETINFO, &info);
		if (error == -1)
			break;
		nchans = info.play.channels;
	}

	return nchans;
}

static int
audiodev_getinfo(struct audiodev *adev)
{
	struct stat st;

	if (stat(adev->path, &st) == -1)
		return -1;
	adev->dev = st.st_rdev;

	if (stat(_PATH_AUDIO, &st) != -1 && st.st_rdev == adev->dev)
		adev->defaultdev = true;

	adev->fd = open(adev->path, O_RDWR);
	if (adev->fd == -1)
		return -1;
	if (ioctl(adev->fd, AUDIO_GETDEV, &adev->audio_device) == -1) {
		close(adev->fd);
		return -1;
	}

	adev->pchan = audiodev_probe_pchans(adev);

	return 0;
}

static int
audiodev_add(const char *pdev, const char *dev, unsigned int unit)
{
	struct audiodev *adev;

	adev = calloc(1, sizeof(*adev));
	if (adev == NULL) 
		return -1;

	strlcpy(adev->pxname, pdev, sizeof(adev->pxname));
	strlcpy(adev->xname, dev, sizeof(adev->xname));
	snprintf(adev->path, sizeof(adev->path) - 1, "/dev/%s", dev);
	adev->unit = unit;

	if (audiodev_getinfo(adev) == -1) {
		free(adev);
		return -1;
	}

#ifdef DEBUG
	printf("[%c] %s: %s\n", adev->defaultdev ? '*' : ' ',
	    adev->path, adev->audio_device.name);
#endif

	TAILQ_INSERT_TAIL(&audiodevlist, adev, next);

	return 0;
}

static void
audiodev_cb(void *args, const char *pdev, const char *dev, unsigned int unit)
{
	audiodev_add(pdev, dev, unit);
}

int
audiodev_refresh(void)
{
	struct audiodev *adev;
	int fd, error;

	fd = open(DRVCTLDEV, O_RDONLY);
	if (fd == -1) {
		perror("open " DRVCTLDEV);
		return -1;
	}

	while (!TAILQ_EMPTY(&audiodevlist)) {
		adev = TAILQ_FIRST(&audiodevlist);
		if (adev->fd != -1)
			close(adev->fd);
		TAILQ_REMOVE(&audiodevlist, adev, next);
		free(adev);
	}

	error = drvctl_foreach(fd, "audio", audiodev_cb, NULL);
	if (error == -1) {
		perror("drvctl");
		return -1;
	}

	close(fd);

	return 0;
}

unsigned int
audiodev_count(void)
{
	struct audiodev *adev;
	unsigned int n;

	n = 0;
	TAILQ_FOREACH(adev, &audiodevlist, next)
		++n;

	return n;
}

struct audiodev *
audiodev_get(unsigned int i)
{
	struct audiodev *adev;
	unsigned int n;

	n = 0;
	TAILQ_FOREACH(adev, &audiodevlist, next) {
		if (n == i)
			return adev;
		++n;
	}

	return NULL;
}

int
audiodev_set_default(struct audiodev *adev)
{
	char audiopath[PATH_MAX+1];
	char soundpath[PATH_MAX+1];
	char audioctlpath[PATH_MAX+1];
	char mixerpath[PATH_MAX+1];

	snprintf(audiopath, sizeof(audiopath) - 1,
	    _PATH_AUDIO "%u", adev->unit);
	snprintf(soundpath, sizeof(soundpath) - 1,
	    _PATH_SOUND "%u", adev->unit);
	snprintf(audioctlpath, sizeof(audioctlpath) - 1,
	    _PATH_AUDIOCTL "%u", adev->unit);
	snprintf(mixerpath, sizeof(mixerpath) - 1,
	    _PATH_MIXER "%u", adev->unit);

	unlink(_PATH_AUDIO);
	unlink(_PATH_SOUND);
	unlink(_PATH_AUDIOCTL);
	unlink(_PATH_MIXER);

	if (symlink(audiopath, _PATH_AUDIO) == -1) {
		perror("symlink " _PATH_AUDIO);
		return -1;
	}
	if (symlink(soundpath, _PATH_SOUND) == -1) {
		perror("symlink " _PATH_SOUND);
		return -1;
	}
	if (symlink(audioctlpath, _PATH_AUDIOCTL) == -1) {
		perror("symlink " _PATH_AUDIOCTL);
		return -1;
	}
	if (symlink(mixerpath, _PATH_MIXER) == -1) {
		perror("symlink " _PATH_MIXER);
		return -1;
	}

	return 0;
}

int
audiodev_test(struct audiodev *adev, unsigned int chanmask)
{
	audio_info_t info;
	int16_t *buf;
	size_t buflen;
	off_t off;
	int rv = 0;

	AUDIO_INITINFO(&info);
	info.play.sample_rate = AUDIODEV_SAMPLE_RATE;
	info.play.channels = adev->pchan;
	info.play.precision = 16;
	info.play.encoding = AUDIO_ENCODING_SLINEAR_LE;
	info.mode = AUMODE_PLAY;
	if (ioctl(adev->fd, AUDIO_SETINFO, &info) == -1) {
		perror("ioctl AUDIO_SETINFO");
		return -1;
	}
	if (ioctl(adev->fd, AUDIO_GETINFO, &info) == -1) {
		perror("ioctl AUDIO_GETINFO");
		return -1;
	}

	dtmf_new(&buf, &buflen, info.play.sample_rate, 2,
	    adev->pchan, chanmask, 350.0, 440.0);
	if (buf == NULL)
		return -1;

	off = 0;
	while (buflen > 0) {
		size_t wlen = info.play.buffer_size;
		if (wlen > buflen)
			wlen = buflen;
		wlen = write(adev->fd, (char *)buf + off, wlen);
		if (wlen == -1) {
			perror("write");
			rv = -1;
			goto done;
		}
		off += wlen;
		buflen -= wlen;
	}

	if (ioctl(adev->fd, AUDIO_DRAIN) == -1)
		perror("ioctl AUDIO_DRAIN");

done:
	free(buf);

	return rv;
}