audio.c 8.17 KB
Newer Older
Fabrice Bellard's avatar
Fabrice Bellard committed
1 2
/*
 * Linux audio play and grab interface
3
 * Copyright (c) 2000, 2001 Fabrice Bellard.
Fabrice Bellard's avatar
Fabrice Bellard committed
4
 *
5 6 7 8
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
Fabrice Bellard's avatar
Fabrice Bellard committed
9
 *
10
 * This library is distributed in the hope that it will be useful,
Fabrice Bellard's avatar
Fabrice Bellard committed
11
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 13
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
Fabrice Bellard's avatar
Fabrice Bellard committed
14
 *
15 16 17
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
Fabrice Bellard's avatar
Fabrice Bellard committed
18
 */
Fabrice Bellard's avatar
Fabrice Bellard committed
19 20
#include "avformat.h"

Fabrice Bellard's avatar
Fabrice Bellard committed
21 22 23
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
24
#include <sys/soundcard.h>
Fabrice Bellard's avatar
Fabrice Bellard committed
25 26 27 28 29 30
#include <unistd.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <sys/time.h>

31 32
#define AUDIO_BLOCK_SIZE 4096

Fabrice Bellard's avatar
Fabrice Bellard committed
33 34
typedef struct {
    int fd;
35
    int sample_rate;
Fabrice Bellard's avatar
Fabrice Bellard committed
36
    int channels;
37 38
    int frame_size; /* in bytes ! */
    int codec_id;
39
    int flip_left : 1;
40
    uint8_t buffer[AUDIO_BLOCK_SIZE];
41
    int buffer_ptr;
Fabrice Bellard's avatar
Fabrice Bellard committed
42 43
} AudioData;

44
static int audio_open(AudioData *s, int is_output, const char *audio_device)
Fabrice Bellard's avatar
Fabrice Bellard committed
45
{
46
    int audio_fd;
Fabrice Bellard's avatar
Fabrice Bellard committed
47
    int tmp, err;
48
    char *flip = getenv("AUDIO_FLIP_LEFT");
Fabrice Bellard's avatar
Fabrice Bellard committed
49 50

    /* open linux audio device */
51 52 53
    if (!audio_device)
        audio_device = "/dev/dsp";

54 55
    if (is_output)
        audio_fd = open(audio_device, O_WRONLY);
Fabrice Bellard's avatar
Fabrice Bellard committed
56
    else
57
        audio_fd = open(audio_device, O_RDONLY);
Fabrice Bellard's avatar
Fabrice Bellard committed
58 59 60 61 62
    if (audio_fd < 0) {
        perror(audio_device);
        return -EIO;
    }

63 64 65 66
    if (flip && *flip == '1') {
        s->flip_left = 1;
    }

Fabrice Bellard's avatar
Fabrice Bellard committed
67
    /* non blocking mode */
68 69
    if (!is_output)
        fcntl(audio_fd, F_SETFL, O_NONBLOCK);
Fabrice Bellard's avatar
Fabrice Bellard committed
70

71
    s->frame_size = AUDIO_BLOCK_SIZE;
Fabrice Bellard's avatar
Fabrice Bellard committed
72
#if 0
73 74
    tmp = (NB_FRAGMENTS << 16) | FRAGMENT_BITS;
    err = ioctl(audio_fd, SNDCTL_DSP_SETFRAGMENT, &tmp);
Fabrice Bellard's avatar
Fabrice Bellard committed
75 76 77 78 79
    if (err < 0) {
        perror("SNDCTL_DSP_SETFRAGMENT");
    }
#endif

80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
    /* select format : favour native format */
    err = ioctl(audio_fd, SNDCTL_DSP_GETFMTS, &tmp);
    
#ifdef WORDS_BIGENDIAN
    if (tmp & AFMT_S16_BE) {
        tmp = AFMT_S16_BE;
    } else if (tmp & AFMT_S16_LE) {
        tmp = AFMT_S16_LE;
    } else {
        tmp = 0;
    }
#else
    if (tmp & AFMT_S16_LE) {
        tmp = AFMT_S16_LE;
    } else if (tmp & AFMT_S16_BE) {
        tmp = AFMT_S16_BE;
    } else {
        tmp = 0;
    }
#endif

    switch(tmp) {
    case AFMT_S16_LE:
        s->codec_id = CODEC_ID_PCM_S16LE;
        break;
    case AFMT_S16_BE:
        s->codec_id = CODEC_ID_PCM_S16BE;
        break;
    default:
109
        av_log(NULL, AV_LOG_ERROR, "Soundcard does not support 16 bit sample format\n");
110 111 112 113
        close(audio_fd);
        return -EIO;
    }
    err=ioctl(audio_fd, SNDCTL_DSP_SETFMT, &tmp);
Fabrice Bellard's avatar
Fabrice Bellard committed
114 115 116 117 118
    if (err < 0) {
        perror("SNDCTL_DSP_SETFMT");
        goto fail;
    }
    
119 120
    tmp = (s->channels == 2);
    err = ioctl(audio_fd, SNDCTL_DSP_STEREO, &tmp);
Fabrice Bellard's avatar
Fabrice Bellard committed
121 122 123 124
    if (err < 0) {
        perror("SNDCTL_DSP_STEREO");
        goto fail;
    }
125 126
    if (tmp)
        s->channels = 2;
Fabrice Bellard's avatar
Fabrice Bellard committed
127
    
128 129
    tmp = s->sample_rate;
    err = ioctl(audio_fd, SNDCTL_DSP_SPEED, &tmp);
Fabrice Bellard's avatar
Fabrice Bellard committed
130 131 132 133
    if (err < 0) {
        perror("SNDCTL_DSP_SPEED");
        goto fail;
    }
134
    s->sample_rate = tmp; /* store real sample rate */
Fabrice Bellard's avatar
Fabrice Bellard committed
135 136 137 138 139 140 141 142
    s->fd = audio_fd;

    return 0;
 fail:
    close(audio_fd);
    return -EIO;
}

143
static int audio_close(AudioData *s)
Fabrice Bellard's avatar
Fabrice Bellard committed
144 145
{
    close(s->fd);
146 147 148 149 150 151
    return 0;
}

/* sound output support */
static int audio_write_header(AVFormatContext *s1)
{
Fabrice Bellard's avatar
Fabrice Bellard committed
152
    AudioData *s = s1->priv_data;
153 154 155 156 157 158
    AVStream *st;
    int ret;

    st = s1->streams[0];
    s->sample_rate = st->codec.sample_rate;
    s->channels = st->codec.channels;
159
    ret = audio_open(s, 1, NULL);
160 161 162 163 164 165 166 167
    if (ret < 0) {
        return -EIO;
    } else {
        return 0;
    }
}

static int audio_write_packet(AVFormatContext *s1, int stream_index,
168
                              const uint8_t *buf, int size, int64_t pts)
169 170 171 172 173 174 175 176 177 178 179 180 181
{
    AudioData *s = s1->priv_data;
    int len, ret;

    while (size > 0) {
        len = AUDIO_BLOCK_SIZE - s->buffer_ptr;
        if (len > size)
            len = size;
        memcpy(s->buffer + s->buffer_ptr, buf, len);
        s->buffer_ptr += len;
        if (s->buffer_ptr >= AUDIO_BLOCK_SIZE) {
            for(;;) {
                ret = write(s->fd, s->buffer, AUDIO_BLOCK_SIZE);
182
                if (ret > 0)
183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199
                    break;
                if (ret < 0 && (errno != EAGAIN && errno != EINTR))
                    return -EIO;
            }
            s->buffer_ptr = 0;
        }
        buf += len;
        size -= len;
    }
    return 0;
}

static int audio_write_trailer(AVFormatContext *s1)
{
    AudioData *s = s1->priv_data;

    audio_close(s);
Fabrice Bellard's avatar
Fabrice Bellard committed
200 201 202
    return 0;
}

203 204 205 206
/* grab support */

static int audio_read_header(AVFormatContext *s1, AVFormatParameters *ap)
{
Fabrice Bellard's avatar
Fabrice Bellard committed
207
    AudioData *s = s1->priv_data;
208 209 210 211 212 213
    AVStream *st;
    int ret;

    if (!ap || ap->sample_rate <= 0 || ap->channels <= 0)
        return -1;

Fabrice Bellard's avatar
Fabrice Bellard committed
214
    st = av_new_stream(s1, 0);
215 216 217 218 219 220
    if (!st) {
        return -ENOMEM;
    }
    s->sample_rate = ap->sample_rate;
    s->channels = ap->channels;

221
    ret = audio_open(s, 0, ap->device);
222
    if (ret < 0) {
223
        av_free(st);
224 225
        return -EIO;
    }
226 227 228 229 230 231 232 233 234

    /* take real parameters */
    st->codec.codec_type = CODEC_TYPE_AUDIO;
    st->codec.codec_id = s->codec_id;
    st->codec.sample_rate = s->sample_rate;
    st->codec.channels = s->channels;

    av_set_pts_info(s1, 48, 1, 1000000);  /* 48 bits pts in us */
    return 0;
235 236 237 238 239
}

static int audio_read_packet(AVFormatContext *s1, AVPacket *pkt)
{
    AudioData *s = s1->priv_data;
240 241 242 243
    int ret, bdelay;
    int64_t cur_time;
    struct audio_buf_info abufi;
    
244 245 246
    if (av_new_packet(pkt, s->frame_size) < 0)
        return -EIO;
    for(;;) {
247 248 249 250 251 252 253 254 255 256 257 258
        struct timeval tv;
        fd_set fds;

        tv.tv_sec = 0;
        tv.tv_usec = 30 * 1000; /* 30 msecs -- a bit shorter than 1 frame at 30fps */

        FD_ZERO(&fds);
        FD_SET(s->fd, &fds);

        /* This will block until data is available or we get a timeout */
        (void) select(s->fd + 1, &fds, 0, 0, &tv);

259 260 261
        ret = read(s->fd, pkt->data, pkt->size);
        if (ret > 0)
            break;
262 263 264 265 266
        if (ret == -1 && (errno == EAGAIN || errno == EINTR)) {
            av_free_packet(pkt);
            pkt->size = 0;
            return 0;
        }
267 268 269 270 271 272
        if (!(ret == 0 || (ret == -1 && (errno == EAGAIN || errno == EINTR)))) {
            av_free_packet(pkt);
            return -EIO;
        }
    }
    pkt->size = ret;
273 274 275 276 277 278 279 280 281 282 283 284 285

    /* compute pts of the start of the packet */
    cur_time = av_gettime();
    bdelay = ret;
    if (ioctl(s->fd, SNDCTL_DSP_GETISPACE, &abufi) == 0) {
        bdelay += abufi.bytes;
    }
    /* substract time represented by the number of bytes in the audio fifo */
    cur_time -= (bdelay * 1000000LL) / (s->sample_rate * s->channels);

    /* convert to wanted units */
    pkt->pts = cur_time & ((1LL << 48) - 1);

286 287 288 289 290 291 292 293 294
    if (s->flip_left && s->channels == 2) {
        int i;
        short *p = (short *) pkt->data;

        for (i = 0; i < ret; i += 4) {
            *p = ~*p;
            p += 2;
        }
    }
295 296 297 298 299 300 301 302 303 304 305
    return 0;
}

static int audio_read_close(AVFormatContext *s1)
{
    AudioData *s = s1->priv_data;

    audio_close(s);
    return 0;
}

306
static AVInputFormat audio_in_format = {
Fabrice Bellard's avatar
Fabrice Bellard committed
307 308 309 310 311 312 313
    "audio_device",
    "audio grab and output",
    sizeof(AudioData),
    NULL,
    audio_read_header,
    audio_read_packet,
    audio_read_close,
314
    .flags = AVFMT_NOFILE,
Fabrice Bellard's avatar
Fabrice Bellard committed
315 316
};

317
static AVOutputFormat audio_out_format = {
318 319 320 321
    "audio_device",
    "audio grab and output",
    "",
    "",
Fabrice Bellard's avatar
Fabrice Bellard committed
322
    sizeof(AudioData),
323 324 325 326 327 328 329 330 331 332 333 334
    /* XXX: we make the assumption that the soundcard accepts this format */
    /* XXX: find better solution with "preinit" method, needed also in
       other formats */
#ifdef WORDS_BIGENDIAN
    CODEC_ID_PCM_S16BE,
#else
    CODEC_ID_PCM_S16LE,
#endif
    CODEC_ID_NONE,
    audio_write_header,
    audio_write_packet,
    audio_write_trailer,
335
    .flags = AVFMT_NOFILE,
Fabrice Bellard's avatar
Fabrice Bellard committed
336
};
Fabrice Bellard's avatar
Fabrice Bellard committed
337 338 339 340 341 342 343

int audio_init(void)
{
    av_register_input_format(&audio_in_format);
    av_register_output_format(&audio_out_format);
    return 0;
}