1 files changed, 644 insertions, 0 deletions

diff --git a/lib/rbcodec/codecs/libgme/hes_emu.c b/lib/rbcodec/codecs/libgme/hes_emu.c
new file mode 100644
index 0000000000..d6bafea334
--- /dev/null
+++ b/lib/rbcodec/codecs/libgme/hes_emu.c
@@ -0,0 +1,644 @@
+// Game_Music_Emu 0.5.2. http://www.slack.net/~ant/
+
+#include "hes_emu.h"
+
+#include "blargg_endian.h"
+#include "blargg_source.h"
+
+/* Copyright (C) 2006 Shay Green. This module is free software; you
+can redistribute it and/or modify it under the terms of the GNU Lesser
+General Public License as published by the Free Software Foundation; either
+version 2.1 of the License, or (at your option) any later version. This
+module is distributed in the hope that it will be useful, but WITHOUT ANY
+WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
+FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for more
+details. You should have received a copy of the GNU Lesser General Public
+License along with this module; if not, write to the Free Software Foundation,
+Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA */
+
+int const timer_mask  = 0x04;
+int const vdp_mask    = 0x02;
+int const i_flag_mask = 0x04;
+int const unmapped    = 0xFF;
+
+int const period_60hz = 262 * 455; // scanlines * clocks per scanline
+
+const char gme_wrong_file_type [] = "Wrong file type for this emulator";
+
+static void clear_track_vars( struct Hes_Emu* this )
+{
+        this->current_track_    = -1;
+        track_stop( &this->track_filter );
+}
+
+void Hes_init( struct Hes_Emu* this )
+{
+        this->sample_rate_ = 0;
+        this->mute_mask_   = 0;
+        this->tempo_       = (int)(FP_ONE_TEMPO);
+
+        // defaults
+        this->tfilter = *track_get_setup( &this->track_filter );
+        this->tfilter.max_initial = 2;
+        this->tfilter.lookahead   = 6;
+        this->track_filter.silence_ignored_ = false;
+
+        this->timer.raw_load = 0;
+        Sound_set_gain( this, (int)(FP_ONE_GAIN*1.11) );
+
+        Rom_init( &this->rom, 0x2000 );
+
+        Apu_init( &this->apu );
+        Adpcm_init( &this->adpcm );
+        Cpu_init( &this->cpu );
+
+        /* Set default track count */
+        this->track_count = 255;
+        
+        // clears fields
+        this->voice_count_ = 0;
+        this->voice_types_ = 0;
+        clear_track_vars( this );
+}
+
+static blargg_err_t check_hes_header( void const* header )
+{
+        if ( memcmp( header, "HESM", 4 ) )
+                return gme_wrong_file_type;
+        return 0;
+}
+
+// Setup
+
+blargg_err_t Hes_load_mem( struct Hes_Emu* this, void* data, long size )
+{
+        // Unload
+        this->voice_count_ = 0;
+        this->track_count = 255;
+        this->m3u.size = 0;
+        clear_track_vars( this );
+             
+        assert( offsetof (struct header_t,unused [4]) == header_size );
+        RETURN_ERR( Rom_load( &this->rom, data, size, header_size, &this->header, unmapped ) );
+        
+        RETURN_ERR( check_hes_header( this->header.tag ) );
+        
+        /* if ( header_.vers != 0 )
+                warning( "Unknown file version" );
+        
+        if ( memcmp( header_.data_tag, "DATA", 4 ) )
+                warning( "Data header missing" );
+        
+        if ( memcmp( header_.unused, "\0\0\0\0", 4 ) )
+                warning( "Unknown header data" ); */
+        
+        // File spec supports multiple blocks, but I haven't found any, and
+        // many files have bad sizes in the only block, so it's simpler to
+        // just try to load the damn data as best as possible.
+        
+        int addr = get_le32( this->header.addr );
+        /* int rom_size = get_le32( this->header.size ); */
+        int const rom_max = 0x100000;
+        if ( (unsigned) addr >= (unsigned) rom_max )
+        {
+                /* warning( "Invalid address" ); */
+                addr &= rom_max - 1;
+        }
+        /* if ( (unsigned) (addr + size) > (unsigned) rom_max )
+                warning( "Invalid size" );
+        
+        if ( rom_size != rom.file_size() )
+        {
+                if ( size <= rom.file_size() - 4 && !memcmp( rom.begin() + size, "DATA", 4 ) )
+                        warning( "Multiple DATA not supported" );
+                else if ( size < rom.file_size() )
+                        warning( "Extra file data" );
+                else
+                        warning( "Missing file data" );
+        } */
+        
+        Rom_set_addr( &this->rom, addr );
+        
+        this->voice_count_ = osc_count + adpcm_osc_count;
+        static int const types [osc_count + adpcm_osc_count] = {
+                wave_type+0, wave_type+1, wave_type+2, wave_type+3, mixed_type+0, mixed_type+1, mixed_type+2
+        };
+        this->voice_types_ = types;
+        
+        Apu_volume( &this->apu, this->gain_ );
+        Adpcm_volume( &this->adpcm, this->gain_ );
+
+    // Setup buffer     
+        this->clock_rate_ = 7159091;
+        Buffer_clock_rate( &this->stereo_buf, 7159091 );
+        RETURN_ERR( Buffer_set_channel_count( &this->stereo_buf, this->voice_count_, this->voice_types_ ) );
+        this->buf_changed_count = Buffer_channels_changed_count( &this->stereo_buf );
+        
+        Sound_set_tempo( this, this->tempo_ );
+        Sound_mute_voices( this, this->mute_mask_ );
+        
+        return 0;
+}
+
+// Emulation
+
+static void recalc_timer_load( struct Hes_Emu* this )
+{
+        this->timer.load = this->timer.raw_load * this->timer_base + 1;
+}
+
+// Hardware
+
+void run_until( struct Hes_Emu* this, hes_time_t present )
+{
+        while ( this->vdp.next_vbl < present )
+                this->vdp.next_vbl += this->play_period;
+        
+        hes_time_t elapsed = present - this->timer.last_time;
+        if ( elapsed > 0 )
+        {
+                if ( this->timer.enabled )
+                {
+                        this->timer.count -= elapsed;
+                        if ( this->timer.count <= 0 )
+                                this->timer.count += this->timer.load;
+                }
+                this->timer.last_time = present;
+        }
+}
+
+void write_vdp( struct Hes_Emu* this, int addr, int data )
+{
+        switch ( addr )
+        {
+        case 0:
+                this->vdp.latch = data & 0x1F;
+                break;
+        
+        case 2:
+                if ( this->vdp.latch == 5 )
+                {
+                        /* if ( data & 0x04 )
+                                warning( "Scanline interrupt unsupported" ); */
+                        run_until( this, Cpu_time( &this->cpu ) );
+                        this->vdp.control = data;
+                        irq_changed( this );
+                }
+                /* else
+                {
+                        dprintf( "VDP not supported: $%02X <- $%02X\n", vdp.latch, data );
+                } */
+                break;
+        
+        case 3:
+                /* dprintf( "VDP MSB not supported: $%02X <- $%02X\n", vdp.latch, data ); */
+                break;
+        }
+}
+
+void write_mem_( struct Hes_Emu* this, hes_addr_t addr, int data )
+{
+        hes_time_t time = Cpu_time( &this->cpu );
+        if ( (unsigned) (addr - apu_io_addr) < apu_io_size )
+        {
+                // Avoid going way past end when a long block xfer is writing to I/O space.
+                // Not a problem for other registers below because they don't write to
+                // Blip_Buffer.
+                hes_time_t t = min( time, Cpu_end_time( &this->cpu ) + 8 );
+                Apu_write_data( &this->apu, t, addr, data );
+                return;
+        }
+        if ( (unsigned) (addr - adpcm_io_addr) < adpcm_io_size )
+        {
+                hes_time_t t = min( time, Cpu_end_time( &this->cpu ) + 6 );
+                Adpcm_write_data( &this->adpcm, t, addr, data );
+                return;
+        }
+        
+        switch ( addr )
+        {
+        case 0x0000:
+        case 0x0002:
+        case 0x0003:
+                write_vdp( this, addr, data );
+                return;
+        
+        case 0x0C00: {
+                run_until( this, time );
+                this->timer.raw_load = (data & 0x7F) + 1;
+                recalc_timer_load( this );
+                this->timer.count = this->timer.load;
+                break;
+        }
+        
+        case 0x0C01:
+                data &= 1;
+                if ( this->timer.enabled == data )
+                        return;
+                run_until( this, time );
+                this->timer.enabled = data;
+                if ( data )
+                        this->timer.count = this->timer.load;
+                break;
+        
+        case 0x1402:
+                run_until( this, time );
+                this->irq.disables = data;
+                /* if ( (data & 0xF8) && (data & 0xF8) != 0xF8 ) // flag questionable values
+                        dprintf( "Int mask: $%02X\n", data ); */
+                break;
+        
+        case 0x1403:
+                run_until( this, time );
+                if ( this->timer.enabled )
+                        this->timer.count = this->timer.load;
+                this->timer.fired = false;
+                break;
+        
+#ifndef NDEBUG
+        case 0x1000: // I/O port
+        case 0x0402: // palette
+        case 0x0403:
+        case 0x0404:
+        case 0x0405:
+                return;
+                
+        default:
+                /* dprintf( "unmapped write $%04X <- $%02X\n", addr, data ); */
+                return;
+#endif
+        }
+        
+        irq_changed( this );
+}
+
+int read_mem_( struct Hes_Emu* this, hes_addr_t addr )
+{
+        hes_time_t time = Cpu_time( &this->cpu );
+        addr &= page_size - 1;
+        switch ( addr )
+        {
+        case 0x0000:
+                if ( this->irq.vdp > time )
+                        return 0;
+                this->irq.vdp = future_time;
+                run_until( this, time );
+                irq_changed( this );
+                return 0x20;
+                
+        /* case 0x0002:
+        case 0x0003:
+                dprintf( "VDP read not supported: %d\n", addr );
+                return 0; */
+        
+        case 0x0C01:
+                //return timer.enabled; // TODO: remove?
+        case 0x0C00:
+                run_until( this, time );
+                /* dprintf( "Timer count read\n" ); */
+                return (unsigned) (this->timer.count - 1) / this->timer_base;
+        
+        case 0x1402:
+                return this->irq.disables;
+        
+        case 0x1403:
+                {
+                        int status = 0;
+                        if ( this->irq.timer <= time ) status |= timer_mask;
+                        if ( this->irq.vdp   <= time ) status |= vdp_mask;
+                        return status;
+                }
+
+        case 0x180A:
+        case 0x180B:
+        case 0x180C:
+        case 0x180D:
+                return Adpcm_read_data( &this->adpcm, time, addr );
+                
+        #ifndef NDEBUG
+                case 0x1000: // I/O port
+                //case 0x180C: // CD-ROM
+                //case 0x180D:
+                        break;
+                
+                /* default:
+                        dprintf( "unmapped read  $%04X\n", addr ); */
+        #endif
+        }
+        
+        return unmapped;
+}
+
+void irq_changed( struct Hes_Emu* this )
+{
+        hes_time_t present = Cpu_time( &this->cpu );
+        
+        if ( this->irq.timer > present )
+        {
+                this->irq.timer = future_time;
+                if ( this->timer.enabled && !this->timer.fired )
+                        this->irq.timer = present + this->timer.count;
+        }
+        
+        if ( this->irq.vdp > present )
+        {
+                this->irq.vdp = future_time;
+                if ( this->vdp.control & 0x08 )
+                        this->irq.vdp = this->vdp.next_vbl;
+        }
+        
+        hes_time_t time = future_time;
+        if ( !(this->irq.disables & timer_mask) ) time = this->irq.timer;
+        if ( !(this->irq.disables &   vdp_mask) ) time = min( time, this->irq.vdp );
+        
+        Cpu_set_irq_time( &this->cpu, time );
+}
+
+int cpu_done( struct Hes_Emu* this )
+{
+        check( Cpu_time( &this->cpu ) >= Cpu_end_time( &this->cpu ) ||
+                        (!(this->cpu.r.flags & i_flag_mask) && Cpu_time( &this->cpu ) >= Cpu_irq_time( &this->cpu )) );
+        
+        if ( !(this->cpu.r.flags & i_flag_mask) )
+        {
+                hes_time_t present = Cpu_time( &this->cpu );
+                
+                if ( this->irq.timer <= present && !(this->irq.disables & timer_mask) )
+                {
+                        this->timer.fired = true;
+                        this->irq.timer = future_time;
+                        irq_changed( this ); // overkill, but not worth writing custom code
+                        return 0x0A;
+                }
+                
+                if ( this->irq.vdp <= present && !(this->irq.disables & vdp_mask) )
+                {
+                        // work around for bugs with music not acknowledging VDP
+                        //run_until( present );
+                        //irq.vdp = cpu.future_time;
+                        //irq_changed();
+                        return 0x08;
+                }
+        }
+        return -1;
+}
+
+static void adjust_time( hes_time_t* time, hes_time_t delta )
+{
+        if ( *time < future_time )
+        {
+                *time -= delta;
+                if ( *time < 0 )
+                        *time = 0;
+        }
+}
+
+static blargg_err_t end_frame( struct Hes_Emu* this, hes_time_t duration )
+{
+        /* if ( run_cpu( this, duration ) )
+                warning( "Emulation error (illegal instruction)" ); */
+        run_cpu( this, duration );
+        
+        check( Cpu_time( &this->cpu ) >= duration );
+        //check( time() - duration < 20 ); // Txx instruction could cause going way over
+        
+        run_until( this, duration );
+        
+        // end time frame
+        this->timer.last_time -= duration;
+        this->vdp.next_vbl    -= duration;
+        Cpu_end_frame( &this->cpu, duration );
+        adjust_time( &this->irq.timer, duration );
+        adjust_time( &this->irq.vdp,   duration );
+        Apu_end_frame( &this->apu, duration );
+        Adpcm_end_frame( &this->adpcm, duration );
+        
+        return 0;
+}
+
+static blargg_err_t run_clocks( struct Hes_Emu* this, blip_time_t* duration_ )
+{
+        return end_frame( this, *duration_ );
+}
+
+blargg_err_t play_( void *emu, int count, sample_t out [] )
+{
+        struct Hes_Emu* this = (struct Hes_Emu*) emu;
+        
+        int remain = count;
+        while ( remain )
+        {
+                Buffer_disable_immediate_removal( &this->stereo_buf );
+                remain -= Buffer_read_samples( &this->stereo_buf, &out [count - remain], remain );
+                if ( remain )
+                {
+                        if ( this->buf_changed_count != Buffer_channels_changed_count( &this->stereo_buf ) )
+                        {
+                                this->buf_changed_count = Buffer_channels_changed_count( &this->stereo_buf );
+                                
+                                // Remute voices
+                                Sound_mute_voices( this, this->mute_mask_ );
+                        }
+                        int msec = Buffer_length( &this->stereo_buf );
+                        blip_time_t clocks_emulated = msec * this->clock_rate_ / 1000 - 100;
+                        RETURN_ERR( run_clocks( this, &clocks_emulated ) );
+                        assert( clocks_emulated );
+                        Buffer_end_frame( &this->stereo_buf, clocks_emulated );
+                }
+        }
+        return 0;
+}
+
+// Music emu
+
+blargg_err_t Hes_set_sample_rate( struct Hes_Emu* this, int rate )
+{
+        require( !this->sample_rate_ ); // sample rate can't be changed once set
+        Buffer_init( &this->stereo_buf );
+        RETURN_ERR( Buffer_set_sample_rate( &this->stereo_buf, rate, 1000 / 20 ) );
+        
+        // Set bass frequency
+        Buffer_bass_freq( &this->stereo_buf, 60 );
+        
+        this->sample_rate_ = rate;
+        RETURN_ERR( track_init( &this->track_filter, this ) );
+        this->tfilter.max_silence = 6 * stereo * this->sample_rate_;
+        return 0;
+}
+
+void Sound_mute_voice( struct Hes_Emu* this, int index, bool mute )
+{
+        require( (unsigned) index < (unsigned) this->voice_count_ );
+        int bit = 1 << index;
+        int mask = this->mute_mask_ | bit;
+        if ( !mute )
+                mask ^= bit;
+        Sound_mute_voices( this, mask );
+}
+
+void Sound_mute_voices( struct Hes_Emu* this, int mask )
+{
+        require( this->sample_rate_ ); // sample rate must be set first
+        this->mute_mask_ = mask;
+
+        // Set adpcm voice
+        struct channel_t ch = Buffer_channel( &this->stereo_buf, this->voice_count_ );
+        if ( mask & (1 << this->voice_count_ ) )
+                Adpcm_set_output( &this->adpcm, 0, 0, 0, 0 );
+        else
+                Adpcm_set_output( &this->adpcm, 0, ch.center, ch.left, ch.right );
+        
+        // Set apu voices
+        int i = this->voice_count_ - 1;
+        for ( ; i--; )
+        {
+                if ( mask & (1 << i) )
+                {
+                        Apu_osc_output( &this->apu, i, 0, 0, 0 );
+                }
+                else
+                {
+                        struct channel_t ch = Buffer_channel( &this->stereo_buf, i );
+                        assert( (ch.center && ch.left && ch.right) ||
+                                        (!ch.center && !ch.left && !ch.right) ); // all or nothing
+                        Apu_osc_output( &this->apu, i, ch.center, ch.left, ch.right );
+                }
+        }
+}
+
+void Sound_set_tempo( struct Hes_Emu* this, int t )
+{
+        require( this->sample_rate_ ); // sample rate must be set first
+        int const min = (int)(FP_ONE_TEMPO*0.02);
+        int const max = (int)(FP_ONE_TEMPO*4.00);
+        if ( t < min ) t = min;
+        if ( t > max ) t = max;
+        this->play_period = (hes_time_t) ((period_60hz*FP_ONE_TEMPO) / t);
+        this->timer_base = (int) ((1024*FP_ONE_TEMPO) / t);
+        recalc_timer_load( this );
+        this->tempo_ = t;
+}
+
+blargg_err_t Hes_start_track( struct Hes_Emu* this, int track )
+{
+        clear_track_vars( this );
+        
+        // Remap track if playlist available
+        if ( this->m3u.size > 0 ) {
+                struct entry_t* e = &this->m3u.entries[track];
+                track = e->track;
+        }
+        
+        this->current_track_ = track;
+        
+        Buffer_clear( &this->stereo_buf );
+        
+        memset( this->ram, 0, sizeof this->ram ); // some HES music relies on zero fill
+        memset( this->sgx, 0, sizeof this->sgx );
+        
+        Apu_reset( &this->apu );
+        Adpcm_reset( &this->adpcm );
+        Cpu_reset( &this->cpu );
+        
+        unsigned i;
+        for ( i = 0; i < sizeof this->header.banks; i++ )
+                set_mmr( this, i, this->header.banks [i] );
+        set_mmr( this, page_count, 0xFF ); // unmapped beyond end of address space
+        
+        this->irq.disables  = timer_mask | vdp_mask;
+        this->irq.timer     = future_time;
+        this->irq.vdp       = future_time;
+        
+        this->timer.enabled = false;
+        this->timer.raw_load= 0x80;
+        this->timer.count   = this->timer.load;
+        this->timer.fired   = false;
+        this->timer.last_time = 0;
+        
+        this->vdp.latch     = 0;
+        this->vdp.control   = 0;
+        this->vdp.next_vbl  = 0;
+        
+        this->ram [0x1FF] = (idle_addr - 1) >> 8;
+        this->ram [0x1FE] = (idle_addr - 1) & 0xFF;
+        this->cpu.r.sp = 0xFD;
+        this->cpu.r.pc = get_le16( this->header.init_addr );
+        this->cpu.r.a  = track;
+        
+        recalc_timer_load( this );
+        
+        // convert filter times to samples
+        struct setup_t s = this->tfilter;
+        s.max_initial *= this->sample_rate_ * stereo;
+        #ifdef GME_DISABLE_SILENCE_LOOKAHEAD
+                s.lookahead = 1;
+        #endif
+        track_setup( &this->track_filter, &s );
+        
+        return track_start( &this->track_filter );
+}
+
+// Tell/Seek
+
+static int msec_to_samples( int msec, int sample_rate )
+{
+        int sec = msec / 1000;
+        msec -= sec * 1000;
+        return (sec * sample_rate + msec * sample_rate / 1000) * stereo;
+}
+
+int Track_tell( struct Hes_Emu* this )
+{
+        int rate = this->sample_rate_ * stereo;
+        int sec = track_sample_count( &this->track_filter ) / rate;
+        return sec * 1000 + (track_sample_count( &this->track_filter ) - sec * rate) * 1000 / rate;
+}
+
+blargg_err_t Track_seek( struct Hes_Emu* this, int msec )
+{
+        int time = msec_to_samples( msec, this->sample_rate_ );
+        if ( time < track_sample_count( &this->track_filter ) )
+        RETURN_ERR( Hes_start_track( this, this->current_track_ ) );
+        return Track_skip( this, time - track_sample_count( &this->track_filter ) );
+}
+
+blargg_err_t skip_( void* emu, int count )
+{
+        struct Hes_Emu* this = (struct Hes_Emu*) emu;
+        
+        // for long skip, mute sound
+        const int threshold = 32768;
+        if ( count > threshold )
+        {
+                int saved_mute = this->mute_mask_;
+                Sound_mute_voices( this, ~0 );
+
+                int n = count - threshold/2;
+                n &= ~(2048-1); // round to multiple of 2048
+                count -= n;
+                RETURN_ERR( skippy_( &this->track_filter, n ) );
+
+                Sound_mute_voices( this, saved_mute );
+        }
+
+        return skippy_( &this->track_filter, count );
+}
+
+blargg_err_t Track_skip( struct Hes_Emu* this, int count )
+{
+        require( this->current_track_ >= 0 ); // start_track() must have been called already
+        return track_skip( &this->track_filter, count );
+}
+
+void Track_set_fade( struct Hes_Emu* this, int start_msec, int length_msec )
+{
+        track_set_fade( &this->track_filter, msec_to_samples( start_msec, this->sample_rate_ ),
+                length_msec * this->sample_rate_ / (1000 / stereo) );
+}
+
+blargg_err_t Hes_play( struct Hes_Emu* this, int out_count, sample_t* out )
+{
+        require( this->current_track_ >= 0 );
+        require( out_count % stereo == 0 );
+        return track_play( &this->track_filter, out_count, out );
+}