git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@1108 c046a42c-6fe2-441c-8c8c-71466251a162
		
			
				
	
	
		
			979 lines
		
	
	
		
			21 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			979 lines
		
	
	
		
			21 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * QEMU OSS Audio output driver
 | 
						|
 * 
 | 
						|
 * Copyright (c) 2003 Vassili Karpov (malc)
 | 
						|
 * 
 | 
						|
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 | 
						|
 * of this software and associated documentation files (the "Software"), to deal
 | 
						|
 * in the Software without restriction, including without limitation the rights
 | 
						|
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 | 
						|
 * copies of the Software, and to permit persons to whom the Software is
 | 
						|
 * furnished to do so, subject to the following conditions:
 | 
						|
 *
 | 
						|
 * The above copyright notice and this permission notice shall be included in
 | 
						|
 * all copies or substantial portions of the Software.
 | 
						|
 *
 | 
						|
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 | 
						|
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 | 
						|
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 | 
						|
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 | 
						|
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 | 
						|
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 | 
						|
 * THE SOFTWARE.
 | 
						|
 */
 | 
						|
#include "vl.h"
 | 
						|
 | 
						|
#include <stdio.h>
 | 
						|
#include <limits.h>
 | 
						|
#include <stdlib.h>
 | 
						|
#include <string.h>
 | 
						|
 | 
						|
/* TODO: Graceful error handling */
 | 
						|
 | 
						|
#if defined(_WIN32)
 | 
						|
#define USE_SDL_AUDIO
 | 
						|
#endif
 | 
						|
 | 
						|
#define MIN(a, b) ((a)>(b)?(b):(a))
 | 
						|
#define MAX(a, b) ((a)<(b)?(b):(a))
 | 
						|
 | 
						|
#define DEREF(x) (void)x
 | 
						|
#define dolog(...) fprintf (stderr, "audio: " __VA_ARGS__)
 | 
						|
#define ERRFail(...) do {                                               \
 | 
						|
    int _errno = errno;                                                 \
 | 
						|
    fprintf (stderr, "audio: " __VA_ARGS__);                            \
 | 
						|
    fprintf (stderr, "\nsystem error: %s\n", strerror (_errno));        \
 | 
						|
    abort ();                                                           \
 | 
						|
} while (0)
 | 
						|
#define Fail(...) do {                          \
 | 
						|
    fprintf (stderr, "audio: " __VA_ARGS__);    \
 | 
						|
    fprintf (stderr, "\n");                     \
 | 
						|
    abort ();                                   \
 | 
						|
} while (0)
 | 
						|
 | 
						|
#ifdef DEBUG_AUDIO
 | 
						|
#define lwarn(...) fprintf (stderr, "audio: " __VA_ARGS__)
 | 
						|
#define linfo(...) fprintf (stderr, "audio: " __VA_ARGS__)
 | 
						|
#define ldebug(...) fprintf (stderr, "audio: " __VA_ARGS__)
 | 
						|
#else
 | 
						|
#define lwarn(...)
 | 
						|
#define linfo(...)
 | 
						|
#define ldebug(...)
 | 
						|
#endif
 | 
						|
 | 
						|
static int get_conf_val (const char *key, int defval)
 | 
						|
{
 | 
						|
    int val = defval;
 | 
						|
    char *strval;
 | 
						|
 | 
						|
    strval = getenv (key);
 | 
						|
    if (strval) {
 | 
						|
        val = atoi (strval);
 | 
						|
    }
 | 
						|
 | 
						|
    return val;
 | 
						|
}
 | 
						|
 | 
						|
static void copy_no_conversion (void *dst, void *src, int size)
 | 
						|
{
 | 
						|
    memcpy (dst, src, size);
 | 
						|
}
 | 
						|
 | 
						|
static void copy_u16_to_s16 (void *dst, void *src, int size)
 | 
						|
{
 | 
						|
    int i;
 | 
						|
    uint16_t *out, *in;
 | 
						|
 | 
						|
    out = dst;
 | 
						|
    in = src;
 | 
						|
 | 
						|
    for (i = 0; i < size / 2; i++) {
 | 
						|
        out[i] = in[i] + 0x8000;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
#ifdef USE_SDL_AUDIO
 | 
						|
#include <SDL/SDL.h>
 | 
						|
#include <SDL/SDL_thread.h>
 | 
						|
 | 
						|
static struct {
 | 
						|
    int samples;
 | 
						|
} conf = {
 | 
						|
    .samples = 4096
 | 
						|
};
 | 
						|
 | 
						|
typedef struct AudioState {
 | 
						|
    int freq;
 | 
						|
    int bits16;
 | 
						|
    int nchannels;
 | 
						|
    int rpos;
 | 
						|
    int wpos;
 | 
						|
    volatile int live;
 | 
						|
    volatile int exit;
 | 
						|
    int bytes_per_second;
 | 
						|
    Uint8 *buf;
 | 
						|
    int bufsize;
 | 
						|
    int leftover;
 | 
						|
    uint64_t old_ticks;
 | 
						|
    SDL_AudioSpec spec;
 | 
						|
    SDL_mutex *mutex;
 | 
						|
    SDL_sem *sem;
 | 
						|
    void (*copy_fn)(void *, void *, int);
 | 
						|
} AudioState;
 | 
						|
 | 
						|
static AudioState sdl_audio;
 | 
						|
 | 
						|
void AUD_run (void)
 | 
						|
{
 | 
						|
}
 | 
						|
 | 
						|
static void own (AudioState *s)
 | 
						|
{
 | 
						|
    /* SDL_LockAudio (); */
 | 
						|
    if (SDL_mutexP (s->mutex))
 | 
						|
        dolog ("SDL_mutexP: %s\n", SDL_GetError ());
 | 
						|
}
 | 
						|
 | 
						|
static void disown (AudioState *s)
 | 
						|
{
 | 
						|
    /* SDL_UnlockAudio (); */
 | 
						|
    if (SDL_mutexV (s->mutex))
 | 
						|
        dolog ("SDL_mutexV: %s\n", SDL_GetError ());
 | 
						|
}
 | 
						|
 | 
						|
static void sem_wait (AudioState *s)
 | 
						|
{
 | 
						|
    if (SDL_SemWait (s->sem))
 | 
						|
        dolog ("SDL_SemWait: %s\n", SDL_GetError ());
 | 
						|
}
 | 
						|
 | 
						|
static void sem_post (AudioState *s)
 | 
						|
{
 | 
						|
    if (SDL_SemPost (s->sem))
 | 
						|
        dolog ("SDL_SemPost: %s\n", SDL_GetError ());
 | 
						|
}
 | 
						|
 | 
						|
static void audio_callback (void *data, Uint8 *stream, int len)
 | 
						|
{
 | 
						|
    int to_mix;
 | 
						|
    AudioState *s = data;
 | 
						|
 | 
						|
    if (s->exit) return;
 | 
						|
    while (len) {
 | 
						|
        sem_wait (s);
 | 
						|
        if (s->exit) return;
 | 
						|
        own (s);
 | 
						|
        to_mix = MIN (len, s->live);
 | 
						|
        len -= to_mix;
 | 
						|
        /* printf ("to_mix=%d len=%d live=%d\n", to_mix, len, s->live); */
 | 
						|
        while (to_mix) {
 | 
						|
            int chunk = MIN (to_mix, s->bufsize - s->rpos);
 | 
						|
            /* SDL_MixAudio (stream, buf, chunk, SDL_MIX_MAXVOLUME); */
 | 
						|
            memcpy (stream, s->buf + s->rpos, chunk);
 | 
						|
 | 
						|
            s->rpos += chunk;
 | 
						|
            s->live -= chunk;
 | 
						|
 | 
						|
            stream += chunk;
 | 
						|
            to_mix -= chunk;
 | 
						|
 | 
						|
            if (s->rpos == s->bufsize) s->rpos = 0;
 | 
						|
        }
 | 
						|
        disown (s);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void sem_zero (AudioState *s)
 | 
						|
{
 | 
						|
    int res;
 | 
						|
 | 
						|
    do {
 | 
						|
        res = SDL_SemTryWait (s->sem);
 | 
						|
        if (res < 0) {
 | 
						|
            dolog ("SDL_SemTryWait: %s\n", SDL_GetError ());
 | 
						|
            return;
 | 
						|
        }
 | 
						|
    } while (res != SDL_MUTEX_TIMEDOUT);
 | 
						|
}
 | 
						|
 | 
						|
static void do_open (AudioState *s)
 | 
						|
{
 | 
						|
    int status;
 | 
						|
    SDL_AudioSpec obtained;
 | 
						|
 | 
						|
    SDL_PauseAudio (1);
 | 
						|
    if (s->buf) {
 | 
						|
        s->exit = 1;
 | 
						|
        sem_post (s);
 | 
						|
        SDL_CloseAudio ();
 | 
						|
        s->exit = 0;
 | 
						|
        qemu_free (s->buf);
 | 
						|
        s->buf = NULL;
 | 
						|
        sem_zero (s);
 | 
						|
    }
 | 
						|
 | 
						|
    s->bytes_per_second = (s->spec.freq << (s->spec.channels >> 1)) << s->bits16;
 | 
						|
    s->spec.samples = conf.samples;
 | 
						|
    s->spec.userdata = s;
 | 
						|
    s->spec.callback = audio_callback;
 | 
						|
 | 
						|
    status = SDL_OpenAudio (&s->spec, &obtained);
 | 
						|
    if (status < 0) {
 | 
						|
        dolog ("SDL_OpenAudio: %s\n", SDL_GetError ());
 | 
						|
        goto exit;
 | 
						|
    }
 | 
						|
 | 
						|
    if (obtained.freq != s->spec.freq ||
 | 
						|
        obtained.channels != s->spec.channels ||
 | 
						|
        obtained.format != s->spec.format) {
 | 
						|
        dolog ("Audio spec mismatch requested obtained\n"
 | 
						|
               "freq                %5d    %5d\n"
 | 
						|
               "channels            %5d    %5d\n"
 | 
						|
               "fmt                 %5d    %5d\n",
 | 
						|
               s->spec.freq, obtained.freq,
 | 
						|
               s->spec.channels, obtained.channels,
 | 
						|
               s->spec.format, obtained.format
 | 
						|
            );
 | 
						|
    }
 | 
						|
 | 
						|
    s->bufsize = obtained.size;
 | 
						|
    s->buf = qemu_mallocz (s->bufsize);
 | 
						|
    if (!s->buf) {
 | 
						|
        dolog ("qemu_mallocz(%d)\n", s->bufsize);
 | 
						|
        goto exit;
 | 
						|
    }
 | 
						|
    SDL_PauseAudio (0);
 | 
						|
 | 
						|
exit:
 | 
						|
    s->rpos = 0;
 | 
						|
    s->wpos = 0;
 | 
						|
    s->live = 0;
 | 
						|
}
 | 
						|
 | 
						|
int AUD_write (void *in_buf, int size)
 | 
						|
{
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
    int to_copy, temp;
 | 
						|
    uint8_t *in, *out;
 | 
						|
 | 
						|
    own (s);
 | 
						|
    to_copy = MIN (s->bufsize - s->live, size);
 | 
						|
 | 
						|
    temp = to_copy;
 | 
						|
 | 
						|
    in = in_buf;
 | 
						|
    out = s->buf;
 | 
						|
 | 
						|
    while (temp) {
 | 
						|
        int copy;
 | 
						|
 | 
						|
        copy = MIN (temp, s->bufsize - s->wpos);
 | 
						|
        s->copy_fn (out + s->wpos, in, copy);
 | 
						|
 | 
						|
        s->wpos += copy;
 | 
						|
        if (s->wpos == s->bufsize) {
 | 
						|
            s->wpos = 0;
 | 
						|
        }
 | 
						|
 | 
						|
        temp -= copy;
 | 
						|
        in += copy;
 | 
						|
        s->live += copy;
 | 
						|
    }
 | 
						|
 | 
						|
    disown (s);
 | 
						|
    sem_post (s);
 | 
						|
    return to_copy;
 | 
						|
}
 | 
						|
 | 
						|
static void maybe_open (AudioState *s, int req_freq, int req_nchannels,
 | 
						|
                        audfmt_e req_fmt, int force_open)
 | 
						|
{
 | 
						|
    int sdl_fmt, bits16;
 | 
						|
 | 
						|
    switch (req_fmt) {
 | 
						|
    case AUD_FMT_U8:
 | 
						|
        bits16 = 0;
 | 
						|
        sdl_fmt = AUDIO_U8;
 | 
						|
        s->copy_fn = copy_no_conversion;
 | 
						|
        break;
 | 
						|
 | 
						|
    case AUD_FMT_S8:
 | 
						|
        fprintf (stderr, "audio: can not play 8bit signed\n");
 | 
						|
        return;
 | 
						|
 | 
						|
    case AUD_FMT_S16:
 | 
						|
        bits16 = 1;
 | 
						|
        sdl_fmt = AUDIO_S16;
 | 
						|
        s->copy_fn = copy_no_conversion;
 | 
						|
        break;
 | 
						|
 | 
						|
    case AUD_FMT_U16:
 | 
						|
        bits16 = 1;
 | 
						|
        sdl_fmt = AUDIO_S16;
 | 
						|
        s->copy_fn = copy_u16_to_s16;
 | 
						|
        break;
 | 
						|
 | 
						|
    default:
 | 
						|
        abort ();
 | 
						|
    }
 | 
						|
 | 
						|
    if (force_open
 | 
						|
        || (NULL == s->buf)
 | 
						|
        || (sdl_fmt != s->spec.format)
 | 
						|
        || (req_nchannels != s->spec.channels)
 | 
						|
        || (req_freq != s->spec.freq)
 | 
						|
        || (bits16 != s->bits16)) {
 | 
						|
 | 
						|
        s->spec.format = sdl_fmt;
 | 
						|
        s->spec.channels = req_nchannels;
 | 
						|
        s->spec.freq = req_freq;
 | 
						|
        s->bits16 = bits16;
 | 
						|
        do_open (s);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void AUD_reset (int req_freq, int req_nchannels, audfmt_e req_fmt)
 | 
						|
{
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
    own (s);
 | 
						|
    maybe_open (s, req_freq, req_nchannels, req_fmt, 0);
 | 
						|
    disown (s);
 | 
						|
}
 | 
						|
 | 
						|
void AUD_open (int req_freq, int req_nchannels, audfmt_e req_fmt)
 | 
						|
{
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
    own (s);
 | 
						|
    maybe_open (s, req_freq, req_nchannels, req_fmt, 1);
 | 
						|
    disown (s);
 | 
						|
}
 | 
						|
 | 
						|
void AUD_adjust_estimate (int leftover)
 | 
						|
{
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
    own (s);
 | 
						|
    s->leftover = leftover;
 | 
						|
    disown (s);
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_free (void)
 | 
						|
{
 | 
						|
    int free, elapsed;
 | 
						|
    uint64_t ticks, delta;
 | 
						|
    uint64_t ua_elapsed;
 | 
						|
    uint64_t al_elapsed;
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
 | 
						|
    own (s);
 | 
						|
    free = s->bufsize - s->live;
 | 
						|
 | 
						|
    if (0 == free) {
 | 
						|
        disown (s);
 | 
						|
        return 0;
 | 
						|
    }
 | 
						|
 | 
						|
    elapsed = free;
 | 
						|
    ticks = qemu_get_clock(rt_clock);
 | 
						|
    delta = ticks - s->old_ticks;
 | 
						|
    s->old_ticks = ticks;
 | 
						|
 | 
						|
    ua_elapsed = (delta * s->bytes_per_second) / 1000;
 | 
						|
    al_elapsed = ua_elapsed & ~3ULL;
 | 
						|
 | 
						|
    ldebug ("tid elapsed %llu bytes\n", ua_elapsed);
 | 
						|
 | 
						|
    if (al_elapsed > (uint64_t) INT_MAX)
 | 
						|
        elapsed = INT_MAX;
 | 
						|
    else
 | 
						|
        elapsed = al_elapsed;
 | 
						|
 | 
						|
    elapsed += s->leftover;
 | 
						|
    disown (s);
 | 
						|
 | 
						|
    if (elapsed > free) {
 | 
						|
        lwarn ("audio can not keep up elapsed %d free %d\n", elapsed, free);
 | 
						|
        return free;
 | 
						|
    }
 | 
						|
    else {
 | 
						|
        return elapsed;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_live (void)
 | 
						|
{
 | 
						|
    int live;
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
 | 
						|
    own (s);
 | 
						|
    live = s->live;
 | 
						|
    disown (s);
 | 
						|
    return live;
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_buffer_size (void)
 | 
						|
{
 | 
						|
    int bufsize;
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
 | 
						|
    own (s);
 | 
						|
    bufsize = s->bufsize;
 | 
						|
    disown (s);
 | 
						|
    return bufsize;
 | 
						|
}
 | 
						|
 | 
						|
#define QC_SDL_NSAMPLES "QEMU_SDL_NSAMPLES"
 | 
						|
 | 
						|
static void cleanup (void)
 | 
						|
{
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
    own (s);
 | 
						|
    s->exit = 1;
 | 
						|
    sem_post (s);
 | 
						|
    disown (s);
 | 
						|
}
 | 
						|
 | 
						|
void AUD_init (void)
 | 
						|
{
 | 
						|
    AudioState *s = &sdl_audio;
 | 
						|
 | 
						|
    atexit (cleanup);
 | 
						|
    SDL_InitSubSystem (SDL_INIT_AUDIO);
 | 
						|
    s->mutex = SDL_CreateMutex ();
 | 
						|
    if (!s->mutex) {
 | 
						|
        dolog ("SDL_CreateMutex: %s\n", SDL_GetError ());
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    s->sem = SDL_CreateSemaphore (0);
 | 
						|
    if (!s->sem) {
 | 
						|
        dolog ("SDL_CreateSemaphore: %s\n", SDL_GetError ());
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    conf.samples = get_conf_val (QC_SDL_NSAMPLES, conf.samples);
 | 
						|
}
 | 
						|
 | 
						|
#elif !defined(_WIN32) && !defined(__APPLE__)
 | 
						|
 | 
						|
#include <fcntl.h>
 | 
						|
#include <errno.h>
 | 
						|
#include <unistd.h>
 | 
						|
#include <sys/mman.h>
 | 
						|
#include <sys/types.h>
 | 
						|
#include <sys/ioctl.h>
 | 
						|
#include <sys/soundcard.h>
 | 
						|
 | 
						|
/* http://www.df.lth.se/~john_e/gems/gem002d.html */
 | 
						|
/* http://www.multi-platforms.com/Tips/PopCount.htm */
 | 
						|
static inline uint32_t popcount (uint32_t u)
 | 
						|
{
 | 
						|
  u = ((u&0x55555555) + ((u>>1)&0x55555555));
 | 
						|
  u = ((u&0x33333333) + ((u>>2)&0x33333333));
 | 
						|
  u = ((u&0x0f0f0f0f) + ((u>>4)&0x0f0f0f0f));
 | 
						|
  u = ((u&0x00ff00ff) + ((u>>8)&0x00ff00ff));
 | 
						|
  u = ( u&0x0000ffff) + (u>>16);
 | 
						|
  return u;
 | 
						|
}
 | 
						|
 | 
						|
static inline uint32_t lsbindex (uint32_t u)
 | 
						|
{
 | 
						|
  return popcount ((u&-u)-1);
 | 
						|
}
 | 
						|
 | 
						|
#define IOCTL(args) do {                        \
 | 
						|
  int ret = ioctl args;                         \
 | 
						|
  if (-1 == ret) {                              \
 | 
						|
    ERRFail (#args);                            \
 | 
						|
  }                                             \
 | 
						|
  ldebug ("ioctl " #args " = %d\n", ret);       \
 | 
						|
} while (0)
 | 
						|
 | 
						|
typedef struct AudioState {
 | 
						|
    int fd;
 | 
						|
    int freq;
 | 
						|
    int bits16;
 | 
						|
    int nchannels;
 | 
						|
    int rpos;
 | 
						|
    int wpos;
 | 
						|
    int live;
 | 
						|
    int oss_fmt;
 | 
						|
    int bytes_per_second;
 | 
						|
    int is_mapped;
 | 
						|
    void *buf;
 | 
						|
    int bufsize;
 | 
						|
    int nfrags;
 | 
						|
    int fragsize;
 | 
						|
    int old_optr;
 | 
						|
    int leftover;
 | 
						|
    uint64_t old_ticks;
 | 
						|
    void (*copy_fn)(void *, void *, int);
 | 
						|
} AudioState;
 | 
						|
 | 
						|
static AudioState oss_audio = { .fd = -1 };
 | 
						|
 | 
						|
static struct {
 | 
						|
    int try_mmap;
 | 
						|
    int nfrags;
 | 
						|
    int fragsize;
 | 
						|
} conf = {
 | 
						|
    .try_mmap = 0,
 | 
						|
    .nfrags = 4,
 | 
						|
    .fragsize = 4096
 | 
						|
};
 | 
						|
 | 
						|
static enum {DONT, DSP, TID} est = DONT;
 | 
						|
 | 
						|
static void pab (AudioState *s, struct audio_buf_info *abinfo)
 | 
						|
{
 | 
						|
    DEREF (abinfo);
 | 
						|
 | 
						|
    ldebug ("fragments %d, fragstotal %d, fragsize %d, bytes %d\n"
 | 
						|
            "rpos %d, wpos %d, live %d\n",
 | 
						|
            abinfo->fragments,
 | 
						|
            abinfo->fragstotal,
 | 
						|
            abinfo->fragsize,
 | 
						|
            abinfo->bytes,
 | 
						|
            s->rpos, s->wpos, s->live);
 | 
						|
}
 | 
						|
 | 
						|
static void do_open (AudioState *s)
 | 
						|
{
 | 
						|
    int mmmmssss;
 | 
						|
    audio_buf_info abinfo;
 | 
						|
    int fmt, freq, nchannels;
 | 
						|
 | 
						|
    if (s->buf) {
 | 
						|
        if (s->is_mapped) {
 | 
						|
            if (-1 == munmap (s->buf, s->bufsize)) {
 | 
						|
            ERRFail ("failed to unmap audio buffer %p %d",
 | 
						|
                         s->buf, s->bufsize);
 | 
						|
        }
 | 
						|
        }
 | 
						|
        else {
 | 
						|
            qemu_free (s->buf);
 | 
						|
        }
 | 
						|
        s->buf = NULL;
 | 
						|
    }
 | 
						|
 | 
						|
    if (-1 != s->fd)
 | 
						|
        close (s->fd);
 | 
						|
 | 
						|
    s->fd = open ("/dev/dsp", O_RDWR | O_NONBLOCK);
 | 
						|
    if (-1 == s->fd) {
 | 
						|
        ERRFail ("can not open /dev/dsp");
 | 
						|
    }
 | 
						|
 | 
						|
    fmt = s->oss_fmt;
 | 
						|
    freq = s->freq;
 | 
						|
    nchannels = s->nchannels;
 | 
						|
 | 
						|
    IOCTL ((s->fd, SNDCTL_DSP_RESET, 1));
 | 
						|
    IOCTL ((s->fd, SNDCTL_DSP_SAMPLESIZE, &fmt));
 | 
						|
    IOCTL ((s->fd, SNDCTL_DSP_CHANNELS, &nchannels));
 | 
						|
    IOCTL ((s->fd, SNDCTL_DSP_SPEED, &freq));
 | 
						|
    IOCTL ((s->fd, SNDCTL_DSP_NONBLOCK));
 | 
						|
 | 
						|
    mmmmssss = (conf.nfrags << 16) | conf.fragsize;
 | 
						|
    IOCTL ((s->fd, SNDCTL_DSP_SETFRAGMENT, &mmmmssss));
 | 
						|
 | 
						|
    if ((s->oss_fmt != fmt)
 | 
						|
        || (s->nchannels != nchannels)
 | 
						|
        || (s->freq != freq)) {
 | 
						|
        Fail ("failed to set audio parameters\n"
 | 
						|
              "parameter | requested value | obtained value\n"
 | 
						|
              "format    |      %10d |     %10d\n"
 | 
						|
              "channels  |      %10d |     %10d\n"
 | 
						|
              "frequency |      %10d |     %10d\n",
 | 
						|
              s->oss_fmt, fmt,
 | 
						|
              s->nchannels, nchannels,
 | 
						|
              s->freq, freq);
 | 
						|
    }
 | 
						|
 | 
						|
    IOCTL ((s->fd, SNDCTL_DSP_GETOSPACE, &abinfo));
 | 
						|
 | 
						|
    s->nfrags = abinfo.fragstotal;
 | 
						|
    s->fragsize = abinfo.fragsize;
 | 
						|
    s->bufsize = s->nfrags * s->fragsize;
 | 
						|
    s->old_optr = 0;
 | 
						|
 | 
						|
    s->bytes_per_second = (freq << (nchannels >> 1)) << s->bits16;
 | 
						|
 | 
						|
    linfo ("bytes per second %d\n", s->bytes_per_second);
 | 
						|
 | 
						|
    linfo ("fragments %d, fragstotal %d, fragsize %d, bytes %d, bufsize %d\n",
 | 
						|
           abinfo.fragments,
 | 
						|
           abinfo.fragstotal,
 | 
						|
           abinfo.fragsize,
 | 
						|
           abinfo.bytes,
 | 
						|
           s->bufsize);
 | 
						|
 | 
						|
    s->buf = MAP_FAILED;
 | 
						|
    s->is_mapped = 0;
 | 
						|
 | 
						|
    if (conf.try_mmap) {
 | 
						|
        s->buf = mmap (NULL, s->bufsize, PROT_WRITE, MAP_SHARED, s->fd, 0);
 | 
						|
        if (MAP_FAILED == s->buf) {
 | 
						|
            int err;
 | 
						|
 | 
						|
            err = errno;
 | 
						|
            dolog ("failed to mmap audio, size %d, fd %d\n"
 | 
						|
                 "syserr: %s\n",
 | 
						|
                   s->bufsize, s->fd, strerror (err));
 | 
						|
        }
 | 
						|
    else {
 | 
						|
            est = TID;
 | 
						|
            s->is_mapped = 1;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if (MAP_FAILED == s->buf) {
 | 
						|
        est = TID;
 | 
						|
        s->buf = qemu_mallocz (s->bufsize);
 | 
						|
        if (!s->buf) {
 | 
						|
            ERRFail ("audio buf malloc failed, size %d", s->bufsize);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    s->rpos = 0;
 | 
						|
    s->wpos = 0;
 | 
						|
    s->live = 0;
 | 
						|
 | 
						|
    if (s->is_mapped) {
 | 
						|
        int trig;
 | 
						|
 | 
						|
        trig = 0;
 | 
						|
        IOCTL ((s->fd, SNDCTL_DSP_SETTRIGGER, &trig));
 | 
						|
        trig = PCM_ENABLE_OUTPUT;
 | 
						|
        IOCTL ((s->fd, SNDCTL_DSP_SETTRIGGER, &trig));
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void maybe_open (AudioState *s, int req_freq, int req_nchannels,
 | 
						|
                        audfmt_e req_fmt, int force_open)
 | 
						|
{
 | 
						|
    int oss_fmt, bits16;
 | 
						|
 | 
						|
    switch (req_fmt) {
 | 
						|
    case AUD_FMT_U8:
 | 
						|
        bits16 = 0;
 | 
						|
        oss_fmt = AFMT_U8;
 | 
						|
        s->copy_fn = copy_no_conversion;
 | 
						|
        break;
 | 
						|
 | 
						|
    case AUD_FMT_S8:
 | 
						|
        Fail ("can not play 8bit signed");
 | 
						|
 | 
						|
    case AUD_FMT_S16:
 | 
						|
        bits16 = 1;
 | 
						|
        oss_fmt = AFMT_S16_LE;
 | 
						|
        s->copy_fn = copy_no_conversion;
 | 
						|
        break;
 | 
						|
 | 
						|
    case AUD_FMT_U16:
 | 
						|
        bits16 = 1;
 | 
						|
        oss_fmt = AFMT_S16_LE;
 | 
						|
        s->copy_fn = copy_u16_to_s16;
 | 
						|
        break;
 | 
						|
 | 
						|
    default:
 | 
						|
        abort ();
 | 
						|
    }
 | 
						|
 | 
						|
    if (force_open
 | 
						|
        || (-1 == s->fd)
 | 
						|
        || (oss_fmt != s->oss_fmt)
 | 
						|
        || (req_nchannels != s->nchannels)
 | 
						|
        || (req_freq != s->freq)
 | 
						|
        || (bits16 != s->bits16)) {
 | 
						|
        s->oss_fmt = oss_fmt;
 | 
						|
        s->nchannels = req_nchannels;
 | 
						|
        s->freq = req_freq;
 | 
						|
        s->bits16 = bits16;
 | 
						|
        do_open (s);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void AUD_reset (int req_freq, int req_nchannels, audfmt_e req_fmt)
 | 
						|
{
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
    maybe_open (s, req_freq, req_nchannels, req_fmt, 0);
 | 
						|
}
 | 
						|
 | 
						|
void AUD_open (int req_freq, int req_nchannels, audfmt_e req_fmt)
 | 
						|
{
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
    maybe_open (s, req_freq, req_nchannels, req_fmt, 1);
 | 
						|
}
 | 
						|
 | 
						|
int AUD_write (void *in_buf, int size)
 | 
						|
{
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
    int to_copy, temp;
 | 
						|
    uint8_t *in, *out;
 | 
						|
 | 
						|
    to_copy = MIN (s->bufsize - s->live, size);
 | 
						|
 | 
						|
    temp = to_copy;
 | 
						|
 | 
						|
    in = in_buf;
 | 
						|
    out = s->buf;
 | 
						|
 | 
						|
    while (temp) {
 | 
						|
        int copy;
 | 
						|
 | 
						|
        copy = MIN (temp, s->bufsize - s->wpos);
 | 
						|
        s->copy_fn (out + s->wpos, in, copy);
 | 
						|
 | 
						|
        s->wpos += copy;
 | 
						|
        if (s->wpos == s->bufsize) {
 | 
						|
            s->wpos = 0;
 | 
						|
        }
 | 
						|
 | 
						|
        temp -= copy;
 | 
						|
        in += copy;
 | 
						|
        s->live += copy;
 | 
						|
    }
 | 
						|
 | 
						|
    return to_copy;
 | 
						|
}
 | 
						|
 | 
						|
void AUD_run (void)
 | 
						|
{
 | 
						|
    int res;
 | 
						|
    int bytes;
 | 
						|
    struct audio_buf_info abinfo;
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
 | 
						|
    if (0 == s->live)
 | 
						|
        return;
 | 
						|
 | 
						|
    if (s->is_mapped) {
 | 
						|
        count_info info;
 | 
						|
 | 
						|
        res = ioctl (s->fd, SNDCTL_DSP_GETOPTR, &info);
 | 
						|
        if (res < 0) {
 | 
						|
            int err;
 | 
						|
 | 
						|
            err = errno;
 | 
						|
            lwarn ("SNDCTL_DSP_GETOPTR failed with %s\n", strerror (err));
 | 
						|
            return;
 | 
						|
        }
 | 
						|
 | 
						|
        if (info.ptr > s->old_optr) {
 | 
						|
            bytes = info.ptr - s->old_optr;
 | 
						|
        }
 | 
						|
        else {
 | 
						|
            bytes = s->bufsize + info.ptr - s->old_optr;
 | 
						|
        }
 | 
						|
 | 
						|
        s->old_optr = info.ptr;
 | 
						|
        s->live -= bytes;
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    res = ioctl (s->fd, SNDCTL_DSP_GETOSPACE, &abinfo);
 | 
						|
 | 
						|
    if (res < 0) {
 | 
						|
        int err;
 | 
						|
 | 
						|
        err = errno;
 | 
						|
        lwarn ("SNDCTL_DSP_GETOSPACE failed with %s\n", strerror (err));
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    bytes = abinfo.bytes;
 | 
						|
    bytes = MIN (s->live, bytes);
 | 
						|
#if 0
 | 
						|
    bytes = (bytes / fragsize) * fragsize;
 | 
						|
#endif
 | 
						|
 | 
						|
    while (bytes) {
 | 
						|
        int left, play, written;
 | 
						|
 | 
						|
        left = s->bufsize - s->rpos;
 | 
						|
        play = MIN (left, bytes);
 | 
						|
        written = write (s->fd, (uint8_t *)s->buf + s->rpos, play);
 | 
						|
 | 
						|
        if (-1 == written) {
 | 
						|
            if (EAGAIN == errno || EINTR == errno) {
 | 
						|
                return;
 | 
						|
            }
 | 
						|
            else {
 | 
						|
                ERRFail ("write audio");
 | 
						|
            }
 | 
						|
        }
 | 
						|
 | 
						|
        play = written;
 | 
						|
        s->live -= play;
 | 
						|
        s->rpos += play;
 | 
						|
        bytes -= play;
 | 
						|
 | 
						|
        if (s->rpos == s->bufsize) {
 | 
						|
            s->rpos = 0;
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static int get_dsp_bytes (void)
 | 
						|
{
 | 
						|
    int res;
 | 
						|
    struct count_info info;
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
 | 
						|
    res = ioctl (s->fd, SNDCTL_DSP_GETOPTR, &info);
 | 
						|
    if (-1 == res) {
 | 
						|
        int err;
 | 
						|
 | 
						|
        err = errno;
 | 
						|
        lwarn ("SNDCTL_DSP_GETOPTR failed with %s\n", strerror (err));
 | 
						|
        return -1;
 | 
						|
    }
 | 
						|
    else {
 | 
						|
        ldebug ("bytes %d\n", info.bytes);
 | 
						|
        return info.bytes;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void AUD_adjust_estimate (int leftover)
 | 
						|
{
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
    s->leftover = leftover;
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_free (void)
 | 
						|
{
 | 
						|
    int free, elapsed;
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
 | 
						|
    free = s->bufsize - s->live;
 | 
						|
 | 
						|
    if (free <= 0)
 | 
						|
        return 0;
 | 
						|
 | 
						|
    elapsed = free;
 | 
						|
    switch (est) {
 | 
						|
    case DONT:
 | 
						|
        break;
 | 
						|
 | 
						|
    case DSP:
 | 
						|
        {
 | 
						|
            static int old_bytes;
 | 
						|
            int bytes;
 | 
						|
 | 
						|
            bytes = get_dsp_bytes ();
 | 
						|
            if (bytes <= 0)
 | 
						|
                return free;
 | 
						|
 | 
						|
            elapsed = bytes - old_bytes;
 | 
						|
            old_bytes = bytes;
 | 
						|
            ldebug ("dsp elapsed %d bytes\n", elapsed);
 | 
						|
            break;
 | 
						|
        }
 | 
						|
 | 
						|
    case TID:
 | 
						|
        {
 | 
						|
            uint64_t ticks, delta;
 | 
						|
            uint64_t ua_elapsed;
 | 
						|
            uint64_t al_elapsed;
 | 
						|
 | 
						|
            ticks = qemu_get_clock(rt_clock);
 | 
						|
            delta = ticks - s->old_ticks;
 | 
						|
            s->old_ticks = ticks;
 | 
						|
 | 
						|
            ua_elapsed = (delta * s->bytes_per_second) / 1000;
 | 
						|
            al_elapsed = ua_elapsed & ~3ULL;
 | 
						|
 | 
						|
            ldebug ("tid elapsed %llu bytes\n", ua_elapsed);
 | 
						|
 | 
						|
            if (al_elapsed > (uint64_t) INT_MAX)
 | 
						|
                elapsed = INT_MAX;
 | 
						|
            else
 | 
						|
                elapsed = al_elapsed;
 | 
						|
 | 
						|
            elapsed += s->leftover;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if (elapsed > free) {
 | 
						|
        lwarn ("audio can not keep up elapsed %d free %d\n", elapsed, free);
 | 
						|
        return free;
 | 
						|
    }
 | 
						|
    else {
 | 
						|
        return elapsed;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_live (void)
 | 
						|
{
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
    return s->live;
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_buffer_size (void)
 | 
						|
{
 | 
						|
    AudioState *s = &oss_audio;
 | 
						|
    return s->bufsize;
 | 
						|
}
 | 
						|
 | 
						|
#define QC_OSS_FRAGSIZE "QEMU_OSS_FRAGSIZE"
 | 
						|
#define QC_OSS_NFRAGS "QEMU_OSS_NFRAGS"
 | 
						|
#define QC_OSS_MMAP "QEMU_OSS_MMAP"
 | 
						|
 | 
						|
void AUD_init (void)
 | 
						|
{
 | 
						|
    int fsp;
 | 
						|
 | 
						|
    DEREF (pab);
 | 
						|
 | 
						|
    conf.fragsize = get_conf_val (QC_OSS_FRAGSIZE, conf.fragsize);
 | 
						|
    conf.nfrags = get_conf_val (QC_OSS_NFRAGS, conf.nfrags);
 | 
						|
    conf.try_mmap = get_conf_val (QC_OSS_MMAP, conf.try_mmap);
 | 
						|
 | 
						|
    fsp = conf.fragsize;
 | 
						|
    if (0 != (fsp & (fsp - 1))) {
 | 
						|
        Fail ("fragment size %d is not power of 2", fsp);
 | 
						|
    }
 | 
						|
 | 
						|
    conf.fragsize = lsbindex (fsp);
 | 
						|
}
 | 
						|
 | 
						|
#else
 | 
						|
 | 
						|
void AUD_run (void)
 | 
						|
{
 | 
						|
}
 | 
						|
 | 
						|
int AUD_write (void *in_buf, int size)
 | 
						|
{
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
void AUD_reset (int rfreq, int rnchannels, audfmt_e rfmt)
 | 
						|
{
 | 
						|
}
 | 
						|
 | 
						|
void AUD_adjust_estimate (int _leftover)
 | 
						|
{
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_free (void)
 | 
						|
{
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_live (void)
 | 
						|
{
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
int AUD_get_buffer_size (void)
 | 
						|
{
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
void AUD_init (void)
 | 
						|
{
 | 
						|
}
 | 
						|
 | 
						|
#endif
 |