usbloadergx/source/libwiigui/gui_sound.cpp

/****************************************************************************
 * libwiigui
 *
 * Tantric 2009
 *
 * gui_sound.cpp
 *
 * decoder modification by ardi 2009
 *
 * GUI class definitions
 ***************************************************************************/

#include "gui.h"
#include <unistd.h>
#include "gecko.h"

#include "gui_sound_decoder.h"

#define BUFFER_SIZE 8192

/***************************************************************
 *
 * D E C O D E R <EFBFBD> L I S T
 *
 *
 ***************************************************************/

GuiSoundDecoder::DecoderListEntry *GuiSoundDecoder::DecoderList = NULL;
GuiSoundDecoder::DecoderListEntry &GuiSoundDecoder::RegisterDecoder(DecoderListEntry &Decoder,
        GuiSoundDecoderCreate fnc)
{
    if (Decoder.fnc != fnc)
    {
        Decoder.fnc = fnc;
        Decoder.next = DecoderList;
        DecoderList = &Decoder;
    }
    return Decoder;
}
GuiSoundDecoder *GuiSoundDecoder::GetDecoder(const u8 * snd, u32 len, bool snd_is_allocated)
{
    for (DecoderListEntry *de = DecoderList; de; de = de->next)
    {
        GuiSoundDecoder *d = NULL;
        try
        {
            d = de->fnc(snd, len, snd_is_allocated);
        }
        catch (const char *error)
        {
            gprintf("%s", error);
        }
        catch (...)
        {
        }
        if (d) return d;
    }
    return NULL;
}

/***************************************************************
 *
 * D E C O D E R <EFBFBD> T H R E A D
 *
 *
 ***************************************************************/

static GuiSound *GuiSoundPlayer[16] = { NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL,
        NULL, NULL, NULL };

static lwp_t GuiSoundDecoderThreadHandle = LWP_THREAD_NULL;
static bool GuiSoundDecoderThreadRunning = false;
static bool GuiSoundDecoderDataRquested = false;

void *GuiSoundDecoderThread(void *args)
{
    GuiSoundDecoderThreadRunning = true;
    do
    {
        if (GuiSoundDecoderDataRquested)
        {
            GuiSoundDecoderDataRquested = false;
            GuiSound **players = GuiSoundPlayer;
            for (int i = 0; i < 16; ++i, ++players)
            {
                GuiSound *player = *players;
                if (player) player->DecoderCallback();
            }
        }
        if (!GuiSoundDecoderDataRquested) usleep(50);
    } while (GuiSoundDecoderThreadRunning);
    return 0;
}

/***************************************************************
 *
 * A S N D <EFBFBD> C A L L B A C K
 *
 *
 ***************************************************************/

void GuiSoundPlayerCallback(s32 Voice)
{
    if (Voice >= 0 && Voice < 16 && GuiSoundPlayer[Voice])
    {
        GuiSoundPlayer[Voice]->PlayerCallback();
        GuiSoundDecoderDataRquested = true;
    }
}

/***************************************************************
 *
 *   R A W - D E C O D E R
 *   Decoder for Raw-PCM-Datas (16bit Stereo 48kHz)
 *
 ***************************************************************/
class GuiSoundDecoderRAW: public GuiSoundDecoder
{
    protected:
        GuiSoundDecoderRAW(const u8 * snd, u32 len, bool snd_is_allocated)
        {
            pcm_start = snd;
            is_allocated = snd_is_allocated;
            pcm_end = pcm_start + len;
            pos = pcm_start;
            is_running = false;

        }
    public:
        ~GuiSoundDecoderRAW()
        {
            while (is_running)
                usleep(50);
            if (is_allocated) delete[] pcm_start;
        }
        static GuiSoundDecoder *Create(const u8 * snd, u32 len, bool snd_is_allocated)
        {
            try
            {
                return new GuiSoundDecoderRAW(snd, len, snd_is_allocated);
            }
            catch (...)
            {
            }
            return NULL;
        }
        s32 GetFormat()
        {
            return VOICE_STEREO_16BIT;
        }
        s32 GetSampleRate()
        {
            return 48000;
        }
        /*  Read reads data from stream to buffer
         return: >0 = readed bytes;
         0 = EOF;
         <0 = Error;
         */
        int Read(u8 * buffer, int buffer_size)
        {
            if (pos >= pcm_end) return 0; // EOF

            is_running = true;
            if (pos + buffer_size > pcm_end) buffer_size = pcm_end - pos;
            memcpy(buffer, pos, buffer_size);
            pos += buffer_size;
            is_running = false;
            return buffer_size;
        }
        int Rewind()
        {
            pos = pcm_start;
            return 0;
        }
    private:
        const u8 *pcm_start;
        const u8 *pcm_end;
        bool is_allocated;
        const u8 *pos;
        bool is_running;

};

/***************************************************************
 *
 *   G u i S o u n d
 *
 *
 ***************************************************************/
#define GuiSoundBufferReady 0x01
#define GuiSoundBufferEOF   0x02
#define GuiSoundFinish      0x04
static int GuiSoundCount = 0;
/**
 * Constructor for the GuiSound class.
 */
GuiSound::GuiSound(const u8 *s, int l, int v/*=100*/, bool r/*=true*/, bool a/*=false*/)
{
    if (GuiSoundCount++ == 0 || GuiSoundDecoderThreadHandle == LWP_THREAD_NULL)
    {
        LWP_CreateThread(&GuiSoundDecoderThreadHandle, GuiSoundDecoderThread, NULL, NULL, 32768, 80);
    }
    voice = -1;
    play_buffer[0] = (u8*) memalign(32, BUFFER_SIZE * 3); // tripple-buffer first is played
    play_buffer[1] = play_buffer[0] + BUFFER_SIZE; //                      second is waiting
    play_buffer[2] = play_buffer[1] + BUFFER_SIZE; //                      third is decoding
    buffer_nr = 0; // current playbuffer
    buffer_pos = 0; // current idx to write in buffer
    buffer_ready = false;
    buffer_eof = false;
    loop = false; // play looped
    volume = v; // volume
    decoder = NULL;
    if (play_buffer[0]) // playbuffer ok
    Load(s, l, r, a);
}
bool GuiSound::Load(const u8 *s, int l, bool r/*=false*/, bool a/*=false*/)
{
    Stop();
    if (!play_buffer[0]) return false;
    GuiSoundDecoder *newDecoder = GuiSoundDecoder::GetDecoder(s, l, a);
    if (!newDecoder && r) newDecoder = GuiSoundDecoderRAW::Create(s, l, a);
    if (newDecoder)
    {
        delete decoder;
        decoder = newDecoder;
        return true;
    }
    else if (a) delete[] s;
    return false;
}
GuiSound::GuiSound(const char *p, int v/*=100*/)
{
    if (GuiSoundCount++ == 0 || GuiSoundDecoderThreadHandle == LWP_THREAD_NULL)
    {
        LWP_CreateThread(&GuiSoundDecoderThreadHandle, GuiSoundDecoderThread, NULL, NULL, 32 * 1024, 80);
    }
    voice = -1;
    play_buffer[0] = (u8*) memalign(32, BUFFER_SIZE * 3); // tripple-buffer first is played
    play_buffer[1] = play_buffer[0] + BUFFER_SIZE; //                      second is waiting
    play_buffer[2] = play_buffer[1] + BUFFER_SIZE; //                      third is decoding
    buffer_nr = 0; // current playbuffer
    buffer_pos = 0; // current idx to write in buffer
    buffer_ready = false;
    buffer_eof = false;
    loop = false; // play looped
    volume = v; // volume
    decoder = NULL;
    if (play_buffer[0]) // playbuffer ok
    Load(p);
}
bool GuiSound::Load(const char *p)
{
    Stop(); // stop playing
    if (!play_buffer[0]) return false;

    bool ret = false;
    voice = -2; // -2 marks loading from file
    u32 filesize = 0;
    u8 *buffer = NULL;
    size_t result;

    FILE * pFile = fopen(p, "rb");
    if (pFile)
    {
        // get file size:
        fseek(pFile, 0, SEEK_END);
        filesize = ftell(pFile);
        fseek(pFile, 0, SEEK_SET);

        // allocate memory to contain the whole file:
        buffer = new (std::nothrow) u8[filesize];
        if (buffer)
        {
            // copy the file into the buffer:
            result = fread(buffer, 1, filesize, pFile);
            if (result == filesize)
                ret = Load(buffer, filesize, false, true);
            else delete[] buffer;
        }
        fclose(pFile);
    }
    return ret;
}

/**
 * Destructor for the GuiSound class.
 */
GuiSound::~GuiSound()
{
    if (!loop) while (voice >= 0)
        usleep(50);
    Stop();
    if (--GuiSoundCount == 0 && GuiSoundDecoderThreadHandle != LWP_THREAD_NULL)
    {
        GuiSoundDecoderThreadRunning = false;
        LWP_JoinThread(GuiSoundDecoderThreadHandle, NULL);
        GuiSoundDecoderThreadHandle = LWP_THREAD_NULL;
    }
    delete decoder;
    free(play_buffer[0]);
}

void GuiSound::Play()
{
    Stop(); // stop playing if it played
    if (!play_buffer[0]) return;
    if (!decoder) return; // no decoder or no play_buffer -> no playing
    // initialize the buffer
    buffer_nr = 0; // allways starts with buffer 0
    buffer_pos = 0; // reset position
    buffer_ready = false;
    buffer_eof = false;
    decoder->Rewind(); // play from begin
    DecoderCallback(); // fill first buffer;
    if (!buffer_ready || buffer_eof) // if first buffer not ready -> no play
    return;
    voice = ASND_GetFirstUnusedVoice();
    if (voice >= 0)
    {
        s32 vol = (255 * volume) / 100;
        s32 format = decoder->GetFormat();
        s32 samplerate = decoder->GetSampleRate();
        s32 first_pos = buffer_pos;
        // switch to next buffer
        buffer_nr = 1;
        buffer_pos = 0;
        buffer_ready = false;
        buffer_eof = false;
        DecoderCallback(); // fill second buffer;
        GuiSoundPlayer[voice] = this; // activate Callbacks for this voice
        // Play the voice
        ASND_SetVoice(voice, format, samplerate, 0, play_buffer[0], first_pos, vol, vol, GuiSoundPlayerCallback);
    }
}
/*
 int GuiSound::PlayOggFile(char * path)
 {
 if(Load(path))
 Play();
 return 1;
 }
 */
void GuiSound::Stop()
{
    if (voice < 0) return;
    GuiSoundPlayer[voice] = NULL; // disable Callbacks
    SND_StopVoice(voice);
    voice = -1;
}

void GuiSound::Pause()
{
    if (voice < 0) return;
    ASND_PauseVoice(voice, 1);
}

void GuiSound::Resume()
{
    if (voice < 0) return;
    ASND_PauseVoice(voice, 0);
}

bool GuiSound::IsPlaying()
{
    return voice >= 0;
}

void GuiSound::SetVolume(int vol)
{
    volume = vol;
    if (voice < 0) return;
    int newvol = 255 * (volume / 100.0);
    ASND_ChangeVolumeVoice(voice, newvol, newvol);
}

void GuiSound::SetLoop(bool l)
{
    loop = l;
}

void GuiSound::DecoderCallback()
{
    if (buffer_ready || buffer_eof) // if buffer ready or EOF -> nothing
    return;
    bool error = false;
    while (buffer_pos < BUFFER_SIZE)
    {
        int ret = decoder->Read(&play_buffer[buffer_nr][buffer_pos], BUFFER_SIZE - buffer_pos);
        if (ret > 0)
            buffer_pos += ret; // ok -> fill the buffer more
        else if (ret == 0) // EOF from decoder
        {
            if (loop)
                decoder->Rewind(); // if loop -> rewind and fill the buffer more
            else if (buffer_pos)
                break; // has data in buffer -> play the buffer
            else buffer_eof = true; // no data in buffer -> return EOF
            return;
        }
        else if (ret < 0) // an ERROR
        {
            if (buffer_pos)
                break; // has data in buffer -> play the buffer
            else if (loop)
            {
                if (!error) // if no prev error
                {
                    decoder->Rewind(); // if loop -> rewind
                    error = true; // set error-state
                    continue; // and fill the buffer more
                }
                buffer_eof = true; // has prev error -> error in first block -> return EOF
                return;
            }
            else
            {
                buffer_eof = true; // no loop -> return EOF
                return;
            }
        }
        error = false; // clear error-state
    }
    buffer_ready = true;
}
void GuiSound::PlayerCallback()
{
    if (buffer_eof) // if EOF
    {
        if (ASND_TestPointer(voice, play_buffer[(buffer_nr + 2) % 3]) == 0) // test prev. Buffer
        Stop();
    }
    else if (buffer_ready) // if buffer ready
    {
        if (ASND_AddVoice(voice, play_buffer[buffer_nr], buffer_pos) == SND_OK) // add buffer
        {
            // next buffer
            buffer_nr = (buffer_nr + 1) % 3;
            buffer_pos = 0;
            buffer_ready = false;
            buffer_eof = false;
        }
    }
}