012df14a5f
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@30274 a1c6a512-1295-4272-9138-f99709370657
877 lines
22 KiB
C
877 lines
22 KiB
C
// 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;
|
|
|
|
long const period_60hz = 262 * 455L; // scanlines * clocks per scanline
|
|
|
|
int const stereo = 2; // number of channels for stereo
|
|
int const silence_max = 6; // seconds
|
|
int const silence_threshold = 0x10;
|
|
long const fade_block_size = 512;
|
|
int const fade_shift = 8; // fade ends with gain at 1.0 / (1 << fade_shift)
|
|
|
|
const char gme_wrong_file_type [] ICONST_ATTR = "Wrong file type for this emulator";
|
|
|
|
void clear_track_vars( struct Hes_Emu* this )
|
|
{
|
|
this->current_track_ = -1;
|
|
this->out_time = 0;
|
|
this->emu_time = 0;
|
|
this->emu_track_ended_ = true;
|
|
this->track_ended = true;
|
|
this->fade_start = (blargg_long)(LONG_MAX / 2 + 1);
|
|
this->fade_step = 1;
|
|
this->silence_time = 0;
|
|
this->silence_count = 0;
|
|
this->buf_remain = 0;
|
|
}
|
|
|
|
void Hes_init( struct Hes_Emu* this )
|
|
{
|
|
this->sample_rate_ = 0;
|
|
this->mute_mask_ = 0;
|
|
this->tempo_ = (int)(FP_ONE_TEMPO);
|
|
|
|
// defaults
|
|
this->max_initial_silence = 2;
|
|
this->ignore_silence = false;
|
|
|
|
// Unload
|
|
this->voice_count_ = 0;
|
|
clear_track_vars( this );
|
|
|
|
this->timer.raw_load = 0;
|
|
this->silence_lookahead = 6;
|
|
Sound_set_gain( this, 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;
|
|
}
|
|
|
|
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( struct Hes_Emu* this, void* data, long size )
|
|
{
|
|
// Unload
|
|
this->voice_count_ = 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.
|
|
|
|
long addr = get_le32( this->header.addr );
|
|
/* long rom_size = get_le32( this->header.size ); */
|
|
long const rom_max = 0x100000;
|
|
if ( addr & ~(rom_max - 1) )
|
|
{
|
|
/* warning( "Invalid address" ); */
|
|
addr &= rom_max - 1;
|
|
}
|
|
/* if ( (unsigned long) (addr + size) > (unsigned long) 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;
|
|
|
|
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 );
|
|
this->buf_changed_count = Buffer_channels_changed_count( &this->stereo_buf );
|
|
|
|
Sound_set_tempo( this, this->tempo_ );
|
|
Sound_mute_voices( this, this->mute_mask_ );
|
|
|
|
// Reset track count
|
|
this->track_count = 255;
|
|
this->m3u.size = 0;
|
|
return 0;
|
|
}
|
|
|
|
|
|
// Emulation
|
|
|
|
void recalc_timer_load( struct Hes_Emu* this ) ICODE_ATTR;
|
|
void recalc_timer_load( struct Hes_Emu* this )
|
|
{
|
|
this->timer.load = this->timer.raw_load * this->timer_base + 1;
|
|
}
|
|
|
|
// Hardware
|
|
|
|
void irq_changed( struct Hes_Emu* this ) ICODE_ATTR;
|
|
void run_until( struct Hes_Emu* this, hes_time_t present ) ICODE_ATTR;
|
|
void Cpu_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", this->vdp.latch, data );
|
|
}
|
|
break;
|
|
|
|
case 3:
|
|
dprintf( "VDP MSB not supported: $%02X <- $%02X\n", this->vdp.latch, data );
|
|
break;
|
|
}
|
|
}
|
|
|
|
int Cpu_done( struct Hes_Emu* this )
|
|
{
|
|
check( time() >= end_time() ||
|
|
(!(r.status & i_flag_mask) && time() >= irq_time()) );
|
|
|
|
if ( !(this->cpu.r.status & 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 = (hes_time_t)future_hes_time;
|
|
irq_changed( this ); // overkill, but not worth writing custom code
|
|
#if defined (GME_FRAME_HOOK_DEFINED)
|
|
{
|
|
unsigned const threshold = period_60hz / 30;
|
|
unsigned long elapsed = present - last_frame_hook;
|
|
if ( elapsed - period_60hz + threshold / 2 < threshold )
|
|
{
|
|
last_frame_hook = present;
|
|
GME_FRAME_HOOK( this );
|
|
}
|
|
}
|
|
#endif
|
|
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 = future_hes_time;
|
|
//irq_changed();
|
|
#if defined(GME_FRAME_HOOK_DEFINED)
|
|
last_frame_hook = present;
|
|
GME_FRAME_HOOK( this );
|
|
#endif
|
|
return 0x08;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void Emu_cpu_write( struct Hes_Emu* this, hes_addr_t addr, int data )
|
|
{
|
|
hes_time_t time = Cpu_time( &this->cpu );
|
|
if ( (unsigned) (addr - start_addr) <= end_addr - start_addr )
|
|
{
|
|
GME_APU_HOOK( this, addr - apu.start_addr, data );
|
|
// avoid going way past end when a long block xfer is writing to I/O space
|
|
hes_time_t t = min( time, this->cpu.end_time + 8 );
|
|
Apu_write_data( &this->apu, t, addr, data );
|
|
return;
|
|
}
|
|
|
|
if ( (unsigned) (addr - io_addr) < io_size )
|
|
{
|
|
hes_time_t t = min( time, this->cpu.end_time + 6 );
|
|
Adpcm_write_data( &this->adpcm, t, addr, data );
|
|
return;
|
|
}
|
|
|
|
switch ( addr )
|
|
{
|
|
case 0x0000:
|
|
case 0x0002:
|
|
case 0x0003:
|
|
Cpu_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;
|
|
|
|
// flag questionable values
|
|
if ( (data & 0xF8) && (data & 0xF8) != 0xF8 ) {
|
|
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 Emu_cpu_read( 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 = (hes_time_t)future_hes_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;
|
|
}
|
|
|
|
// see hes_cpu_io.h for core read/write functions
|
|
|
|
// Emulation
|
|
|
|
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 irq_changed( struct Hes_Emu* this )
|
|
{
|
|
hes_time_t present = Cpu_time( &this->cpu );
|
|
|
|
if ( this->irq.timer > present )
|
|
{
|
|
this->irq.timer = (hes_time_t)future_hes_time;
|
|
if ( this->timer.enabled && !this->timer.fired )
|
|
this->irq.timer = present + this->timer.count;
|
|
}
|
|
|
|
if ( this->irq.vdp > present )
|
|
{
|
|
this->irq.vdp = (hes_time_t)future_hes_time;
|
|
if ( this->vdp.control & 0x08 )
|
|
this->irq.vdp = this->vdp.next_vbl;
|
|
}
|
|
|
|
hes_time_t time = (hes_time_t)future_hes_time;
|
|
if ( !(this->irq.disables & timer_mask) ) time = this->irq.timer;
|
|
if ( !(this->irq.disables & vdp_mask) ) time = min( time, this->irq.vdp );
|
|
|
|
// Set cpu irq time
|
|
this->cpu.state->time += Cpu_update_end_time( &this->cpu, this->cpu.r.status,
|
|
this->cpu.end_time, (this->cpu.irq_time = time) );
|
|
}
|
|
|
|
static void adjust_time( blargg_long* time, hes_time_t delta ) ICODE_ATTR;
|
|
static void adjust_time( blargg_long* time, hes_time_t delta )
|
|
{
|
|
if ( *time < (blargg_long)future_hes_time )
|
|
{
|
|
*time -= delta;
|
|
if ( *time < 0 )
|
|
*time = 0;
|
|
}
|
|
}
|
|
|
|
blargg_err_t run_clocks( struct Hes_Emu* this, blip_time_t* duration_ ) ICODE_ATTR;
|
|
blargg_err_t run_clocks( struct Hes_Emu* this, blip_time_t* duration_ )
|
|
{
|
|
blip_time_t duration = *duration_; // cache
|
|
|
|
Cpu_run( this, duration );
|
|
/* warning( "Emulation error (illegal instruction)" ); */
|
|
|
|
check( time() >= 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;
|
|
#if defined (GME_FRAME_HOOK_DEFINED)
|
|
last_frame_hook -= *duration;
|
|
#endif
|
|
|
|
// End cpu frame
|
|
this->cpu.state_.base -= duration;
|
|
if ( this->cpu.irq_time < (hes_time_t)future_hes_time ) this->cpu.irq_time -= duration;
|
|
if ( this->cpu.end_time < (hes_time_t)future_hes_time ) this->cpu.end_time -= 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;
|
|
}
|
|
|
|
blargg_err_t play_( struct Hes_Emu* this, long count, sample_t* out ) ICODE_ATTR;
|
|
blargg_err_t play_( struct Hes_Emu* this, long count, sample_t* out )
|
|
{
|
|
long remain = count;
|
|
while ( remain )
|
|
{
|
|
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 = (blargg_long) msec * this->clock_rate_ / 1000;
|
|
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, long 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 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 );
|
|
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
|
|
{
|
|
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;
|
|
}
|
|
|
|
void fill_buf( struct Hes_Emu* this ) ICODE_ATTR;
|
|
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->cpu.ram, 0, sizeof this->cpu.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++ )
|
|
Cpu_set_mmr( this, i, this->header.banks [i] );
|
|
Cpu_set_mmr( this, page_count, 0xFF ); // unmapped beyond end of address space
|
|
|
|
this->irq.disables = timer_mask | vdp_mask;
|
|
this->irq.timer = (hes_time_t)future_hes_time;
|
|
this->irq.vdp = (hes_time_t)future_hes_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->cpu.ram [0x1FF] = (idle_addr - 1) >> 8;
|
|
this->cpu.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 );
|
|
this->last_frame_hook = 0;
|
|
|
|
this->emu_track_ended_ = false;
|
|
this->track_ended = false;
|
|
|
|
if ( !this->ignore_silence )
|
|
{
|
|
// play until non-silence or end of track
|
|
long end;
|
|
for ( end =this-> max_initial_silence * stereo * this->sample_rate_; this->emu_time < end; )
|
|
{
|
|
fill_buf( this );
|
|
if ( this->buf_remain | (int) this->emu_track_ended_ )
|
|
break;
|
|
}
|
|
|
|
this->emu_time = this->buf_remain;
|
|
this->out_time = 0;
|
|
this->silence_time = 0;
|
|
this->silence_count = 0;
|
|
}
|
|
/* return track_ended() ? warning() : 0; */
|
|
return 0;
|
|
}
|
|
|
|
// Tell/Seek
|
|
|
|
blargg_long msec_to_samples( blargg_long msec, long sample_rate )
|
|
{
|
|
blargg_long sec = msec / 1000;
|
|
msec -= sec * 1000;
|
|
return (sec * sample_rate + msec * sample_rate / 1000) * stereo;
|
|
}
|
|
|
|
long Track_tell( struct Hes_Emu* this )
|
|
{
|
|
blargg_long rate = this->sample_rate_ * stereo;
|
|
blargg_long sec = this->out_time / rate;
|
|
return sec * 1000 + (this->out_time - sec * rate) * 1000 / rate;
|
|
}
|
|
|
|
blargg_err_t Track_seek( struct Hes_Emu* this, long msec )
|
|
{
|
|
blargg_long time = msec_to_samples( msec, this->sample_rate_ );
|
|
if ( time < this->out_time )
|
|
RETURN_ERR( Hes_start_track( this, this->current_track_ ) );
|
|
return Track_skip( this, time - this->out_time );
|
|
}
|
|
|
|
blargg_err_t skip_( struct Hes_Emu* this, long count ) ICODE_ATTR;
|
|
blargg_err_t skip_( struct Hes_Emu* this, long count )
|
|
{
|
|
// for long skip, mute sound
|
|
const long threshold = 30000;
|
|
if ( count > threshold )
|
|
{
|
|
int saved_mute = this->mute_mask_;
|
|
Sound_mute_voices( this, ~0 );
|
|
|
|
while ( count > threshold / 2 && !this->emu_track_ended_ )
|
|
{
|
|
RETURN_ERR( play_( this, buf_size, this->buf ) );
|
|
count -= buf_size;
|
|
}
|
|
|
|
Sound_mute_voices( this, saved_mute );
|
|
}
|
|
|
|
while ( count && !this->emu_track_ended_ )
|
|
{
|
|
long n = buf_size;
|
|
if ( n > count )
|
|
n = count;
|
|
count -= n;
|
|
RETURN_ERR( play_( this, n, this->buf ) );
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
blargg_err_t Track_skip( struct Hes_Emu* this, long count )
|
|
{
|
|
require( this->current_track_ >= 0 ); // start_track() must have been called already
|
|
this->out_time += count;
|
|
|
|
// remove from silence and buf first
|
|
{
|
|
long n = min( count, this->silence_count );
|
|
this->silence_count -= n;
|
|
count -= n;
|
|
|
|
n = min( count, this->buf_remain );
|
|
this->buf_remain -= n;
|
|
count -= n;
|
|
}
|
|
|
|
if ( count && !this->emu_track_ended_ )
|
|
{
|
|
this->emu_time += count;
|
|
|
|
// End track if error
|
|
if ( skip_( this, count ) )
|
|
this->emu_track_ended_ = true;
|
|
}
|
|
|
|
if ( !(this->silence_count | this->buf_remain) ) // caught up to emulator, so update track ended
|
|
this->track_ended |= this->emu_track_ended_;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
// Fading
|
|
|
|
void Track_set_fade( struct Hes_Emu* this, long start_msec, long length_msec )
|
|
{
|
|
this->fade_step = this->sample_rate_ * length_msec / (fade_block_size * fade_shift * 1000 / stereo);
|
|
this->fade_start = msec_to_samples( start_msec, this->sample_rate_ );
|
|
}
|
|
|
|
// unit / pow( 2.0, (double) x / step )
|
|
static int int_log( blargg_long x, int step, int unit ) ICODE_ATTR;
|
|
static int int_log( blargg_long x, int step, int unit )
|
|
{
|
|
int shift = x / step;
|
|
int fraction = (x - shift * step) * unit / step;
|
|
return ((unit - fraction) + (fraction >> 1)) >> shift;
|
|
}
|
|
|
|
void handle_fade( struct Hes_Emu* this, long out_count, sample_t* out ) ICODE_ATTR;
|
|
void handle_fade( struct Hes_Emu* this, long out_count, sample_t* out )
|
|
{
|
|
int i;
|
|
for ( i = 0; i < out_count; i += fade_block_size )
|
|
{
|
|
int const shift = 14;
|
|
int const unit = 1 << shift;
|
|
int gain = int_log( (this->out_time + i - this->fade_start) / fade_block_size,
|
|
this->fade_step, unit );
|
|
if ( gain < (unit >> fade_shift) )
|
|
this->track_ended = this->emu_track_ended_ = true;
|
|
|
|
sample_t* io = &out [i];
|
|
int count;
|
|
for ( count = min( fade_block_size, out_count - i ); count; --count )
|
|
{
|
|
*io = (sample_t) ((*io * gain) >> shift);
|
|
++io;
|
|
}
|
|
}
|
|
}
|
|
|
|
// Silence detection
|
|
|
|
void emu_play( struct Hes_Emu* this, long count, sample_t* out ) ICODE_ATTR;
|
|
void emu_play( struct Hes_Emu* this, long count, sample_t* out )
|
|
{
|
|
check( current_track_ >= 0 );
|
|
this->emu_time += count;
|
|
if ( this->current_track_ >= 0 && !this->emu_track_ended_ ) {
|
|
|
|
// End track if error
|
|
if ( play_( this, count, out ) )
|
|
this->emu_track_ended_ = true;
|
|
}
|
|
else
|
|
memset( out, 0, count * sizeof *out );
|
|
}
|
|
|
|
// number of consecutive silent samples at end
|
|
static long count_silence( sample_t* begin, long size ) ICODE_ATTR;
|
|
static long count_silence( sample_t* begin, long size )
|
|
{
|
|
sample_t first = *begin;
|
|
*begin = silence_threshold; // sentinel
|
|
sample_t* p = begin + size;
|
|
while ( (unsigned) (*--p + silence_threshold / 2) <= (unsigned) silence_threshold ) { }
|
|
*begin = first;
|
|
return size - (p - begin);
|
|
}
|
|
|
|
// fill internal buffer and check it for silence
|
|
void fill_buf( struct Hes_Emu* this )
|
|
{
|
|
assert( !this->buf_remain );
|
|
if ( !this->emu_track_ended_ )
|
|
{
|
|
emu_play( this, buf_size, this->buf );
|
|
long silence = count_silence( this->buf, buf_size );
|
|
if ( silence < buf_size )
|
|
{
|
|
this->silence_time = this->emu_time - silence;
|
|
this->buf_remain = buf_size;
|
|
return;
|
|
}
|
|
}
|
|
this->silence_count += buf_size;
|
|
}
|
|
|
|
blargg_err_t Hes_play( struct Hes_Emu* this, long out_count, sample_t* out )
|
|
{
|
|
if ( this->track_ended )
|
|
{
|
|
memset( out, 0, out_count * sizeof *out );
|
|
}
|
|
else
|
|
{
|
|
require( this->current_track_ >= 0 );
|
|
require( out_count % stereo == 0 );
|
|
|
|
assert( this->emu_time >= this->out_time );
|
|
|
|
// prints nifty graph of how far ahead we are when searching for silence
|
|
//dprintf( "%*s \n", int ((emu_time - out_time) * 7 / sample_rate()), "*" );
|
|
|
|
long pos = 0;
|
|
if ( this->silence_count )
|
|
{
|
|
// during a run of silence, run emulator at >=2x speed so it gets ahead
|
|
long ahead_time = this->silence_lookahead * (this->out_time + out_count - this->silence_time) + this->silence_time;
|
|
while ( this->emu_time < ahead_time && !(this->buf_remain | this->emu_track_ended_) )
|
|
fill_buf( this );
|
|
|
|
// fill with silence
|
|
pos = min( this->silence_count, out_count );
|
|
memset( out, 0, pos * sizeof *out );
|
|
this->silence_count -= pos;
|
|
|
|
if ( this->emu_time - this->silence_time > silence_max * stereo * this->sample_rate_ )
|
|
{
|
|
this->track_ended = this->emu_track_ended_ = true;
|
|
this->silence_count = 0;
|
|
this->buf_remain = 0;
|
|
}
|
|
}
|
|
|
|
if ( this->buf_remain )
|
|
{
|
|
// empty silence buf
|
|
long n = min( this->buf_remain, out_count - pos );
|
|
memcpy( &out [pos], this->buf + (buf_size - this->buf_remain), n * sizeof *out );
|
|
this->buf_remain -= n;
|
|
pos += n;
|
|
}
|
|
|
|
// generate remaining samples normally
|
|
long remain = out_count - pos;
|
|
if ( remain )
|
|
{
|
|
emu_play( this, remain, out + pos );
|
|
this->track_ended |= this->emu_track_ended_;
|
|
|
|
if ( !this->ignore_silence || this->out_time > this->fade_start )
|
|
{
|
|
// check end for a new run of silence
|
|
long silence = count_silence( out + pos, remain );
|
|
if ( silence < remain )
|
|
this->silence_time = this->emu_time - silence;
|
|
|
|
if ( this->emu_time - this->silence_time >= buf_size )
|
|
fill_buf( this ); // cause silence detection on next play()
|
|
}
|
|
}
|
|
|
|
if ( this->out_time > this->fade_start )
|
|
handle_fade( this, out_count, out );
|
|
}
|
|
this->out_time += out_count;
|
|
return 0;
|
|
}
|