346 lines
7.3 KiB
C
346 lines
7.3 KiB
C
#include "sound.h"
|
|
#include "resources.h"
|
|
#include <stdlib.h>
|
|
#include "log.h"
|
|
#include "string.h"
|
|
#include "math.h"
|
|
#include "limits.h"
|
|
#include "time.h"
|
|
#include "music.h"
|
|
#include "stb_vorbis.h"
|
|
|
|
#include "samplerate.h"
|
|
|
|
#include "stb_ds.h"
|
|
|
|
#include "mix.h"
|
|
#include "dsp.h"
|
|
|
|
#define DR_WAV_IMPLEMENTATION
|
|
#include "dr_wav.h"
|
|
|
|
#define DR_MP3_IMPLEMENTATION
|
|
#include "dr_mp3.h"
|
|
|
|
#include "portaudio.h"
|
|
|
|
#include "circbuf.h"
|
|
|
|
#define TSF_IMPLEMENTATION
|
|
#include "tsf.h"
|
|
|
|
#define TML_IMPLEMENTATION
|
|
#include "tml.h"
|
|
|
|
static struct {
|
|
char *key;
|
|
struct wav *value;
|
|
} *wavhash = NULL;
|
|
|
|
static struct wav change_channels(struct wav w, int ch)
|
|
{
|
|
short *data = w.data;
|
|
int samples = ch * w.frames;
|
|
short *new = malloc(sizeof(short)*samples);
|
|
|
|
if (ch > w.ch) {
|
|
/* Sets all new channels equal to the first one */
|
|
for (int i = 0; i < w.frames; i++) {
|
|
for (int j = 0; j < ch; j++)
|
|
new[i*ch+j] = data[i];
|
|
}
|
|
} else {
|
|
/* Simple method; just use first N channels present in wav */
|
|
for (int i = 0; i < w.frames; i++)
|
|
for (int j = 0; j < ch; j++)
|
|
new[i*ch+j] = data[i*ch+j];
|
|
}
|
|
|
|
free (w.data);
|
|
w.data = new;
|
|
return w;
|
|
}
|
|
|
|
static struct wav change_samplerate(struct wav w, int rate)
|
|
{
|
|
float ratio = (float)rate/w.samplerate;
|
|
int outframes = w.frames * ratio;
|
|
SRC_DATA ssrc;
|
|
float floatdata[w.frames*w.ch];
|
|
src_short_to_float_array(w.data, floatdata, w.frames*w.ch);
|
|
float resampled[w.ch*outframes];
|
|
|
|
ssrc.data_in = floatdata;
|
|
ssrc.data_out = resampled;
|
|
ssrc.input_frames = w.frames;
|
|
ssrc.output_frames = outframes;
|
|
ssrc.src_ratio = ratio;
|
|
|
|
src_simple(&ssrc, SRC_SINC_BEST_QUALITY, w.ch);
|
|
|
|
short *newdata = malloc(sizeof(short)*outframes*w.ch);
|
|
src_float_to_short_array(resampled, newdata, outframes*w.ch);
|
|
|
|
free(w.data);
|
|
w.data = newdata;
|
|
w.samplerate = rate;
|
|
|
|
return w;
|
|
}
|
|
|
|
static int patestCallback(const void *inputBuffer, void *outputBuffer, unsigned long framesPerBuffer, const PaStreamCallbackTimeInfo *timeInfo, PaStreamCallbackFlags statusFlags, void *userData)
|
|
{
|
|
bus_fill_buffers(outputBuffer, framesPerBuffer);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void check_pa_err(PaError e)
|
|
{
|
|
if (e != paNoError) {
|
|
YughError("PA Error: %s", Pa_GetErrorText(e));
|
|
exit(1);
|
|
}
|
|
}
|
|
|
|
static PaStream *stream_def;
|
|
|
|
void wav_norm_gain(struct wav *w, double lv)
|
|
{
|
|
short tarmax = db2short(lv);
|
|
short max = 0;
|
|
short *s = w->data;
|
|
for (int i = 0; i < w->frames; i++) {
|
|
for (int j = 0; j < w->ch; j++) {
|
|
max = (abs(s[i*w->ch + j]) > max) ? abs(s[i*w->ch + j]) : max;
|
|
}
|
|
}
|
|
|
|
float mult = (float)max / tarmax;
|
|
|
|
for (int i = 0; i < w->frames; i++) {
|
|
for (int j = 0; j < w->ch; j++) {
|
|
s[i*w->ch + j] *= mult;
|
|
}
|
|
}
|
|
}
|
|
|
|
void print_devices()
|
|
{
|
|
int numDevices = Pa_GetDeviceCount();
|
|
const PaDeviceInfo *deviceInfo;
|
|
|
|
for (int i = 0; i < numDevices; i++) {
|
|
deviceInfo = Pa_GetDeviceInfo(i);
|
|
|
|
YughInfo("Device %i: channels %i, sample rate %f, name %s\n", i, deviceInfo->maxOutputChannels, deviceInfo->defaultSampleRate, deviceInfo->name);
|
|
}
|
|
}
|
|
|
|
void sound_init()
|
|
{
|
|
mixer_init();
|
|
PaError err = Pa_Initialize();
|
|
check_pa_err(err);
|
|
|
|
err = Pa_OpenDefaultStream(&stream_def, 0, CHANNELS, paInt16, SAMPLERATE, BUF_FRAMES, patestCallback, NULL);
|
|
check_pa_err(err);
|
|
|
|
err = Pa_StartStream(stream_def);
|
|
check_pa_err(err);
|
|
}
|
|
|
|
struct wav *make_sound(const char *wav)
|
|
{
|
|
int index = shgeti(wavhash, wav);
|
|
if (index != -1) return wavhash[index].value;
|
|
|
|
struct wav mwav;
|
|
mwav.data = drwav_open_file_and_read_pcm_frames_s16(wav, &mwav.ch, &mwav.samplerate, &mwav.frames, NULL);
|
|
|
|
if (mwav.samplerate != SAMPLERATE) {
|
|
YughInfo("Changing samplerate of %s from %d to %d.", wav, mwav.samplerate, SAMPLERATE);
|
|
// mwav = change_samplerate(mwav, SAMPLERATE);
|
|
}
|
|
|
|
if (mwav.ch != CHANNELS) {
|
|
YughInfo("Changing channels of %s from %d to %d.", wav, mwav.ch, CHANNELS);
|
|
mwav = change_channels(mwav, CHANNELS);
|
|
}
|
|
|
|
mwav.gain = 1.f;
|
|
|
|
struct wav *newwav = malloc(sizeof(*newwav));
|
|
*newwav = mwav;
|
|
|
|
if (shlen(wavhash) == 0) sh_new_arena(wavhash);
|
|
|
|
shput(wavhash, wav, newwav);
|
|
|
|
return newwav;
|
|
}
|
|
|
|
void free_sound(const char *wav)
|
|
{
|
|
struct wav *w = shget(wavhash, wav);
|
|
if (w == NULL) return;
|
|
|
|
free(w->data);
|
|
free(w);
|
|
shdel(wavhash, wav);
|
|
}
|
|
|
|
struct soundstream *soundstream_make()
|
|
{
|
|
struct soundstream *new = malloc(sizeof(*new));
|
|
new->buf = circbuf_make(sizeof(short), BUF_FRAMES*CHANNELS*2);
|
|
return new;
|
|
}
|
|
|
|
void kill_oneshot(struct sound *s)
|
|
{
|
|
free(s);
|
|
}
|
|
|
|
void play_oneshot(struct wav *wav) {
|
|
struct sound *new = malloc(sizeof(*new));
|
|
new->data = wav;
|
|
new->bus = first_free_bus(dsp_filter(new, sound_fillbuf));
|
|
YughInfo("Playing sound ...");
|
|
YughInfo("Bus is on? %d", new->bus->on);
|
|
new->playing=1;
|
|
new->loop=0;
|
|
new->frame = 0;
|
|
new->endcb = kill_oneshot;
|
|
}
|
|
|
|
struct sound *play_sound(struct wav *wav)
|
|
{
|
|
struct sound *new = calloc(1, sizeof(*new));
|
|
new->data = wav;
|
|
|
|
new->bus = first_free_bus(dsp_filter(new, sound_fillbuf));
|
|
new->playing = 1;
|
|
|
|
return new;
|
|
}
|
|
|
|
int sound_playing(const struct sound *s)
|
|
{
|
|
return s->playing;
|
|
}
|
|
|
|
int sound_paused(const struct sound *s)
|
|
{
|
|
return (!s->playing && s->frame < s->data->frames);
|
|
}
|
|
void sound_pause(struct sound *s)
|
|
{
|
|
s->playing = 0;
|
|
bus_free(s->bus);
|
|
}
|
|
|
|
void sound_resume(struct sound *s)
|
|
{
|
|
s->playing = 1;
|
|
s->bus = first_free_bus(dsp_filter(s, sound_fillbuf));
|
|
}
|
|
|
|
void sound_stop(struct sound *s)
|
|
{
|
|
s->playing = 0;
|
|
s->frame = 0;
|
|
bus_free(s->bus);
|
|
}
|
|
|
|
int sound_finished(const struct sound *s)
|
|
{
|
|
return !s->playing && s->frame == s->data->frames;
|
|
}
|
|
|
|
int sound_stopped(const struct sound *s)
|
|
{
|
|
return !s->playing && s->frame == 0;
|
|
}
|
|
|
|
struct mp3 make_music(const char *mp3)
|
|
{
|
|
drmp3 new;
|
|
if (!drmp3_init_file(&new, mp3, NULL)) {
|
|
YughError("Could not open mp3 file %s.", mp3);
|
|
}
|
|
|
|
struct mp3 newmp3 = {};
|
|
return newmp3;
|
|
}
|
|
|
|
void close_audio_device(int device)
|
|
{
|
|
}
|
|
|
|
int open_device(const char *adriver)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
void sound_fillbuf(struct sound *s, short *buf, int n)
|
|
{
|
|
float gainmult = pct2mult(s->data->gain);
|
|
|
|
short *in = s->data->data;
|
|
for (int i = 0; i < n; i++) {
|
|
for (int j = 0; j < CHANNELS; j++) buf[i*CHANNELS+j] = in[s->frame+j] * gainmult;
|
|
s->frame++;
|
|
if (s->frame == s->data->frames) {
|
|
|
|
bus_free(s->bus);
|
|
s->bus = NULL;
|
|
s->endcb(s);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
void mp3_fillbuf(struct sound *s, short *buf, int n)
|
|
{
|
|
|
|
}
|
|
|
|
void soundstream_fillbuf(struct soundstream *s, short *buf, int n)
|
|
{
|
|
int max = s->buf->write - s->buf->read;
|
|
int lim = (max < n*CHANNELS) ? max : n*CHANNELS;
|
|
for (int i = 0; i < lim; i++) {
|
|
buf[i] = cbuf_shift(s->buf);
|
|
}
|
|
}
|
|
|
|
float short2db(short val)
|
|
{
|
|
return 20*log10(abs(val) / SHRT_MAX);
|
|
}
|
|
|
|
short db2short(float db)
|
|
{
|
|
return pow(10, db/20.f) * SHRT_MAX;
|
|
}
|
|
|
|
short short_gain(short val, float db)
|
|
{
|
|
return (short)(pow(10, db/20.f) * val);
|
|
}
|
|
|
|
float pct2db(float pct)
|
|
{
|
|
if (pct <= 0) return -72.f;
|
|
|
|
return 10*log2(pct);
|
|
}
|
|
|
|
float pct2mult(float pct)
|
|
{
|
|
if (pct <= 0) return 0.f;
|
|
|
|
return pow(10, 0.5*log2(pct));
|
|
}
|