snes9x/common/audio/s9x_sound_driver_pulse.cpp

/*****************************************************************************\
     Snes9x - Portable Super Nintendo Entertainment System (TM) emulator.
                This file is licensed under the Snes9x License.
   For further information, consult the LICENSE file in the root directory.
\*****************************************************************************/

#include "s9x_sound_driver_pulse.hpp"

#include <cstring>
#include <cstdio>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/time.h>
#include "fmt/format.h"
#include "messages.h"
#include "snes9x.h"

S9xPulseSoundDriver::S9xPulseSoundDriver()
{
    init();
}

void S9xPulseSoundDriver::init()
{
    mainloop = {};
    context = {};
    stream = {};
    buffer_size = {};
}

void S9xPulseSoundDriver::deinit()
{
    if (mainloop)
        pa_threaded_mainloop_stop(mainloop);

    if (stream)
    {
        pa_stream_disconnect(stream);
        pa_stream_unref(stream);
    }

    if (context)
    {
        pa_context_disconnect(context);
        pa_context_unref(context);
    }

    if (mainloop)
    {
        pa_threaded_mainloop_free(mainloop);
    }
}

void S9xPulseSoundDriver::start()
{
}

void S9xPulseSoundDriver::stop()
{
}

void S9xPulseSoundDriver::lock()
{
    pa_threaded_mainloop_lock(mainloop);
}

void S9xPulseSoundDriver::unlock()
{
    pa_threaded_mainloop_unlock(mainloop);
}

void S9xPulseSoundDriver::wait()
{
    pa_threaded_mainloop_wait(mainloop);
}

static void context_state_cb(pa_context *c, void *userdata)
{
    S9xPulseSoundDriver *driver = (S9xPulseSoundDriver *)userdata;
    int state;

    state = pa_context_get_state(c);

    if (state == PA_CONTEXT_READY ||
        state == PA_CONTEXT_FAILED ||
        state == PA_CONTEXT_TERMINATED)
    {
        pa_threaded_mainloop_signal(driver->mainloop, 0);
    }
}

static void stream_state_callback(pa_stream *p, void *userdata)
{
    S9xPulseSoundDriver *driver = (S9xPulseSoundDriver *)userdata;
    int state;

    state = pa_stream_get_state(p);

    if (state == PA_STREAM_READY ||
        state == PA_STREAM_FAILED ||
        state == PA_STREAM_TERMINATED)
    {
        pa_threaded_mainloop_signal(driver->mainloop, 0);
    }
}

bool S9xPulseSoundDriver::open_device(int playback_rate, int buffer_size_ms)
{
    init();

    pa_sample_spec ss;
    ss.channels = 2;
    ss.format = PA_SAMPLE_S16NE;
    ss.rate = playback_rate;

    pa_buffer_attr buffer_attr;
    buffer_attr.tlength = 2 * pa_usec_to_bytes(buffer_size_ms * 1000, &ss);
    buffer_attr.maxlength = buffer_attr.tlength * 2;
    buffer_attr.minreq = pa_usec_to_bytes(3000, &ss);
    buffer_attr.prebuf = buffer_attr.tlength / 2;

    S9xMessage(S9X_INFO, S9X_NO_INFO, "Initializing PulseAudio sound driver…");

    S9xMessage(S9X_INFO, S9X_NO_INFO,
        fmt::format("    --> ({0:Ld} Hz, 16‑bit stereo, {1:Ld} ms)…",
            playback_rate,
            buffer_size_ms).c_str());

    int err = PA_ERR_UNKNOWN;
    mainloop = pa_threaded_mainloop_new();
    context = pa_context_new(pa_threaded_mainloop_get_api(mainloop), "Snes9x");
    pa_context_set_state_callback(context, context_state_cb, this);
    pa_context_connect(context, nullptr, PA_CONTEXT_NOFLAGS, nullptr);

    lock();
    pa_threaded_mainloop_start(mainloop);
    wait();

    if ((err = pa_context_get_state(context)) != PA_CONTEXT_READY)
        return false;

    stream = pa_stream_new(context, "Game", &ss, nullptr);

    pa_stream_set_state_callback(stream, stream_state_callback, this);

    if (pa_stream_connect_playback(stream,
                                   nullptr,
                                   &buffer_attr,
                                   PA_STREAM_EARLY_REQUESTS,
                                   nullptr,
                                   nullptr) < 0)
    {
        return false;
    }

    wait();

    if (pa_stream_get_state(stream) != PA_STREAM_READY)
        return false;

    auto actual_buffer_attr = pa_stream_get_buffer_attr(stream);
    unlock();

    buffer_size = actual_buffer_attr->tlength;

    S9xMessage(S9X_INFO, S9X_NO_INFO, "OK");

    return true;
}

int S9xPulseSoundDriver::space_free()
{
    lock();
    size_t bytes = pa_stream_writable_size(stream);
    unlock();
    return bytes / 2;
}

std::pair<int, int> S9xPulseSoundDriver::buffer_level()
{
    lock();
    size_t bytes = pa_stream_writable_size(stream);
    unlock();

    return { bytes, buffer_size };
}

bool S9xPulseSoundDriver::write_samples(int16_t *data, int samples)
{
    bool retval = true;

    lock();
    size_t bytes = pa_stream_writable_size(stream);
    unlock();

    if (draining)
    {
        if (bytes > (size_t)buffer_size / 2)
        {
            return false;
        }
        else
        {
            draining = false;
        }
    }

    if ((size_t)samples * 2 > bytes)
    {
        draining = true;
        return false;
    }

    if ((size_t)samples * 2 < bytes)
        bytes = samples * 2;

    if (bytes == 0)
        return false;

    lock();
    void *output_buffer;
    if (pa_stream_begin_write(stream, &output_buffer, &bytes) != 0)
    {
        pa_stream_flush(stream, nullptr, nullptr);
        unlock();
        return false;
    }

    if (bytes <= 0 || !output_buffer)
    {
        unlock();
        return false;
    }

    std::memcpy(output_buffer, data, bytes);
    pa_stream_write(stream, output_buffer, bytes, nullptr, 0, PA_SEEK_RELATIVE);
    unlock();

    return retval;
}