123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437 |
- #include <errno.h>
- #include <limits.h>
- #include <stdarg.h>
- #include <stddef.h>
- #include <stdint.h>
- #include <stdio.h>
- #include <string.h>
- #include <SDL.h>
- #include <SDL_audio.h>
- #include <SDL_events.h>
- #include <SDL_mutex.h>
- #include "au.h"
- #include "adev.h"
- #include "common.h"
- #ifndef SDL_BSIZE
- #define SDL_BSIZE 0x4000
- #endif
- enum {
- A_NULL,
- A_ENC,
- A_RATE,
- A_CHAN
- };
- struct adev {
- uint8_t buffer[SDL_BSIZE];
- SDL_AudioSpec spec;
- SDL_AudioDeviceID dev;
- SDL_mutex *mtx;
- SDL_cond *cond;
- SDL_cond *done;
- const char *device;
- size_t bcount;
- size_t waiting;
- Uint32 etype;
- uint32_t enc;
- int mode;
- int needopen;
- int isdone;
- };
- static int correct_audio(SDL_AudioSpec *, void *, size_t);
- static void sdl_callback(void *, uint8_t *, int);
- const struct a_lookup stab[] = {
- { "enc", A_ENC },
- { "encoding", A_ENC },
- { "rate", A_RATE },
- { "chan", A_CHAN },
- { "channel", A_CHAN },
- { "channels", A_CHAN },
- { NULL, A_NULL }
- };
- struct adev *
- ad_open(const char *dev, int mode)
- {
- struct adev *a;
- if (SDL_Init(SDL_INIT_AUDIO) != 0)
- return (NULL);
- if ((a = malloc(sizeof(struct adev))) == NULL) {
- SDL_Quit();
- return (NULL);
- }
- a->dev = 0;
- a->mtx = NULL;
- a->cond = NULL;
- a->done = NULL;
- memset(&a->spec, 0, sizeof(SDL_AudioSpec));
- a->spec.size = sizeof(a->buffer);
- a->spec.callback = &sdl_callback;
- a->spec.userdata = a;
- a->bcount = 0;
- a->waiting = 0;
- a->needopen = 1;
- a->isdone = 0;
- a->dev = 0;
- a->device = dev;
- a->enc = 0;
- a->mode = mode == A_READ;
- if ((a->etype = SDL_RegisterEvents(1)) == (Uint32)-1)
- goto err;
- if ((a->mtx = SDL_CreateMutex()) == NULL ||
- (a->cond = SDL_CreateCond()) == NULL ||
- (a->done = SDL_CreateCond()) == NULL)
- goto err;
- return (a);
- err:
- ad_close(a);
- return (NULL);
- }
- struct adev *
- ad_fpopen(FILE *fp, int mode)
- {
- ERR(EOPNOTSUPP, NULL);
- }
- void
- ad_close(struct adev *a)
- {
- if (a == NULL)
- return;
- a->isdone = 1;
- if (a->mtx != NULL)
- (void)SDL_LockMutex(a->mtx);
- while (a->waiting > 0) {
- (void)SDL_CondSignal(a->cond);
- (void)SDL_CondWait(a->done, a->mtx);
- }
- if (a->mtx != NULL)
- SDL_UnlockMutex(a->mtx);
- if (a->dev > 0)
- SDL_CloseAudioDevice(a->dev);
- if (a->mtx != NULL)
- SDL_DestroyMutex(a->mtx);
- if (a->cond != NULL)
- SDL_DestroyCond(a->cond);
- SDL_Quit();
- free(a);
- }
- int
- ad_limit(struct adev *a)
- {
- ERR(ENOSYS, -1);
- }
- int
- ad_get(struct adev *a, const char *s, ...)
- {
- va_list ap;
- ssize_t r;
- int n;
- int v;
- if (a == NULL || s == NULL)
- ERR(EINVAL, -1);
- (void)SDL_LockMutex(a->mtx);
- va_start(ap, s);
- for (n = 0; (r = a_lookup(stab, s, &v)) > 0; n++, s += r)
- switch (v) {
- case A_ENC:
- *va_arg(ap, uint32_t *) = a->enc;
- break;
- case A_RATE:
- *va_arg(ap, uint32_t *) = a->spec.freq;
- break;
- case A_CHAN:
- *va_arg(ap, uint32_t *) = a->spec.channels;
- break;
- default:
- goto err;
- }
- if (r == 0) {
- (void)SDL_UnlockMutex(a->mtx);
- va_end(ap);
- return (n);
- }
- err:
- (void)SDL_UnlockMutex(a->mtx);
- va_end(ap);
- ERR(EINVAL, n);
- }
- int
- ad_set(struct adev *a, const char *s, ...)
- {
- va_list ap;
- ssize_t r;
- int n;
- int v;
- if (a == NULL || s == NULL)
- ERR(EINVAL, -1);
- (void)SDL_LockMutex(a->mtx);
- if (a->dev > 0) {
- SDL_CloseAudioDevice(a->dev);
- a->dev = 0;
- }
- a->needopen = 1;
- va_start(ap, s);
- for (n = 0; (r = a_lookup(stab, s, &v)) > 0; n++, s += r)
- switch (v) {
- case A_ENC:
- switch ((a->enc = va_arg(ap, uint32_t))) {
- case AU_ULAW:
- a->enc = AU_PCM16;
- a->spec.format = AUDIO_S16MSB;
- goto err;
- case AU_PCM8:
- a->spec.format = AUDIO_S8;
- break;
- case AU_PCM16:
- a->spec.format = AUDIO_S16MSB;
- break;
- case AU_PCM24:
- a->enc = AU_PCM32;
- a->spec.format = AUDIO_S32MSB;
- goto err;
- case AU_PCM32:
- a->spec.format = AUDIO_S32MSB;
- break;
- case AU_FLOAT32:
- a->spec.format = AUDIO_F32MSB;
- break;
- case AU_FLOAT64:
- a->enc = AU_FLOAT32;
- a->spec.format = AUDIO_F32MSB;
- goto err;
- case AU_ALAW:
- a->enc = AU_PCM16;
- a->spec.format = AUDIO_S16MSB;
- goto err;
- default:
- goto err;
- }
- break;
- case A_RATE:
- a->spec.freq = va_arg(ap, uint32_t);
- break;
- case A_CHAN:
- a->spec.channels = va_arg(ap, uint32_t);
- break;
- default:
- goto err;
- }
- if (r == 0) {
- (void)SDL_UnlockMutex(a->mtx);
- va_end(ap);
- return (n);
- }
- err:
- (void)SDL_UnlockMutex(a->mtx);
- va_end(ap);
- ERR(EINVAL, n);
- }
- ssize_t
- ad_read(struct adev *a, void *b, size_t s)
- {
- SDL_Event e;
- size_t i;
- size_t n;
- if (a == NULL || b == NULL || !a->mode)
- ERR(EINVAL, -1);
- if (s > UINT32_MAX)
- ERR(ERANGE, -1);
- if (s == 0)
- return (0);
- (void)SDL_LockMutex(a->mtx);
- if (a->needopen) {
- if ((a->dev = SDL_OpenAudioDevice(a->device, a->mode,
- &a->spec, NULL, 0)) < 2)
- goto err;
- SDL_PauseAudioDevice(a->dev, 0);
- a->needopen = 0;
- }
- for (i = 0; i < s && !a->isdone;) {
- /* Wait for the buffer to have data */
- while (a->bcount == 0 && !a->isdone) {
- if (SDL_CondSignal(a->cond) != 0)
- goto err;
- (void)SDL_UnlockMutex(a->mtx);
- if (SDL_WaitEvent(&e) != 1)
- goto err;
- (void)SDL_LockMutex(a->mtx);
- if (e.type == SDL_AUDIODEVICEREMOVED &&
- e.adevice.which == a->dev)
- goto ret;
- if (e.type != a->etype)
- continue;
- }
- n = MIN(s - i, a->bcount);
- if (correct_audio(&a->spec, a->buffer, n) != 0)
- goto err;
- (void)memcpy((char *)b + i, a->buffer, n);
- if (a->bcount > n)
- (void)memmove(a->buffer, a->buffer + n,
- a->bcount - n);
- a->bcount -= n;
- i += n;
- }
- ret:
- (void)SDL_UnlockMutex(a->mtx);
- return (i);
- err:
- (void)SDL_UnlockMutex(a->mtx);
- return (-1);
- }
- ssize_t
- ad_write(struct adev *a, const void *b, size_t s)
- {
- SDL_Event e;
- size_t i;
- size_t n;
- if (a == NULL || b == NULL || a->mode)
- ERR(EINVAL, -1);
- if (s > UINT32_MAX)
- ERR(ERANGE, -1);
- if (s == 0)
- return (0);
- (void)SDL_LockMutex(a->mtx);
- if (a->needopen) {
- if ((a->dev = SDL_OpenAudioDevice(a->device, a->mode,
- &a->spec, NULL, 0)) < 2)
- goto err;
- SDL_PauseAudioDevice(a->dev, 0);
- a->needopen = 0;
- }
- for (i = 0; i < s && !a->isdone;) {
- /* Wait for the buffer to have free space */
- while (a->bcount >= sizeof(a->buffer) && !a->isdone) {
- if (SDL_CondSignal(a->cond) != 0)
- goto err;
- (void)SDL_UnlockMutex(a->mtx);
- if (SDL_WaitEvent(&e) != 1)
- goto err;
- (void)SDL_LockMutex(a->mtx);
- if (e.type == SDL_AUDIODEVICEREMOVED &&
- e.adevice.which == a->dev)
- goto ret;
- if (e.type != a->etype)
- continue;
- }
- n = MIN(s - i, sizeof(a->buffer) - a->bcount);
- (void)memcpy(a->buffer + a->bcount, (char *)b + i, n);
- if (correct_audio(&a->spec,
- a->buffer + a->bcount, n) != 0)
- goto err;
- i += n;
- a->bcount += n;
- }
- ret:
- (void)SDL_UnlockMutex(a->mtx);
- return (i);
- err:
- (void)SDL_UnlockMutex(a->mtx);
- return (-1);
- }
- void
- sdl_callback(void *ctx, uint8_t *b, int s)
- {
- struct adev *a = ctx;
- SDL_Event e;
- int i;
- int n;
- if (ctx == NULL || b == NULL || s <= 0)
- return;
- if (a->isdone)
- return;
- if (SDL_LockMutex(a->mtx) != 0) {
- a->isdone = 1;
- return;
- }
- e.type = a->etype;
- if (a->mode) { /* read */
- for (i = 0; i < s && !a->isdone;) {
- /* Wait for the buffer to have free space */
- a->waiting++;
- while (a->bcount >= sizeof(a->buffer) &&
- !a->isdone)
- if (SDL_PushEvent(&e) != 1 ||
- SDL_CondWait(a->cond, a->mtx) != 0)
- a->isdone = 1;
- a->waiting--;
- if (a->bcount < sizeof(a->buffer)) {
- n = MIN(sizeof(a->buffer) - a->bcount,
- s - i);
- (void)memcpy(a->buffer + a->bcount,
- b + i, n);
- i += n;
- a->bcount += n;
- }
- }
- if (a->bcount >= sizeof(a->buffer) && !a->isdone)
- (void)SDL_PushEvent(&e);
- } else { /* write */
- for (i = 0; i < s && !a->isdone;) {
- /* Wait for the buffer to have data */
- a->waiting++;
- while (a->bcount == 0 && !a->isdone)
- if (SDL_PushEvent(&e) != 1 ||
- SDL_CondWait(a->cond, a->mtx) != 0)
- a->isdone = 1;
- a->waiting--;
- n = MIN(s - i, a->bcount);
- (void)memcpy(b + i, a->buffer, n);
- if (a->bcount > s - i)
- (void)memmove(a->buffer, a->buffer + n,
- a->bcount - n);
- i += n;
- a->bcount -= n;
- }
- if (a->bcount == 0 && !a->isdone)
- (void)SDL_PushEvent(&e);
- }
- if (a->isdone) {
- (void)SDL_PushEvent(&e);
- (void)SDL_CondSignal(a->done);
- }
- (void)SDL_UnlockMutex(a->mtx);
- }
- int
- correct_audio(SDL_AudioSpec *spec, void *b, size_t s)
- {
- uint8_t *u;
- size_t i;
- unsigned bs;
- if (spec == NULL || b == NULL ||
- (bs = SDL_AUDIO_BITSIZE(spec->format)) > 32)
- ERR(EINVAL, -1);
- if (bs == 0)
- return (0);
- if (SDL_AUDIO_ISLITTLEENDIAN(spec->format))
- au_encbswap(AU_PCM8 + (bs - 1) / 8, b, s);
- if (SDL_AUDIO_ISUNSIGNED(spec->format))
- for (u = b, i = 0, bs = (bs + 7) / 8; i < s; i += bs)
- u[i] ^= 0x80;
- return (0);
- }
|