| 1 | |
| 2 | // Nes_Snd_Emu 0.1.7. http://www.slack.net/~ant/libs/ |
| 3 | |
| 4 | #include "Nes_Apu.h" |
| 5 | |
| 6 | /* Copyright (C) 2003-2005 Shay Green. This module is free software; you |
| 7 | can redistribute it and/or modify it under the terms of the GNU Lesser |
| 8 | General Public License as published by the Free Software Foundation; either |
| 9 | version 2.1 of the License, or (at your option) any later version. This |
| 10 | module is distributed in the hope that it will be useful, but WITHOUT ANY |
| 11 | WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS |
| 12 | FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for |
| 13 | more details. You should have received a copy of the GNU Lesser General |
| 14 | Public License along with this module; if not, write to the Free Software |
| 15 | Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ |
| 16 | |
| 17 | #include BLARGG_SOURCE_BEGIN |
| 18 | |
| 19 | Nes_Apu::Nes_Apu() |
| 20 | { |
| 21 | dmc.apu = this; |
| 22 | dmc.rom_reader = NULL; |
| 23 | square1.synth = &square_synth; |
| 24 | square2.synth = &square_synth; |
| 25 | irq_notifier_ = NULL; |
| 26 | |
| 27 | oscs [0] = &square1; |
| 28 | oscs [1] = &square2; |
| 29 | oscs [2] = ▵ |
| 30 | oscs [3] = &noise; |
| 31 | oscs [4] = &dmc; |
| 32 | |
| 33 | output( NULL ); |
| 34 | volume( 1.0 ); |
| 35 | reset( false ); |
| 36 | } |
| 37 | |
| 38 | Nes_Apu::~Nes_Apu() |
| 39 | { |
| 40 | } |
| 41 | |
| 42 | void Nes_Apu::treble_eq( const blip_eq_t& eq ) |
| 43 | { |
| 44 | square_synth.treble_eq( eq ); |
| 45 | triangle.synth.treble_eq( eq ); |
| 46 | noise.synth.treble_eq( eq ); |
| 47 | dmc.synth.treble_eq( eq ); |
| 48 | } |
| 49 | |
| 50 | void Nes_Apu::buffer_cleared() |
| 51 | { |
| 52 | square1.last_amp = 0; |
| 53 | square2.last_amp = 0; |
| 54 | triangle.last_amp = 0; |
| 55 | noise.last_amp = 0; |
| 56 | dmc.last_amp = 0; |
| 57 | } |
| 58 | |
| 59 | void Nes_Apu::enable_nonlinear( double v ) |
| 60 | { |
| 61 | dmc.nonlinear = true; |
| 62 | square_synth.volume( 1.3 * 0.25751258 / 0.742467605 * 0.25 * v ); |
| 63 | |
| 64 | const double tnd = 0.75 / 202 * 0.48; |
| 65 | triangle.synth.volume_unit( 3 * tnd ); |
| 66 | noise.synth.volume_unit( 2 * tnd ); |
| 67 | dmc.synth.volume_unit( tnd ); |
| 68 | |
| 69 | buffer_cleared(); |
| 70 | } |
| 71 | |
| 72 | void Nes_Apu::volume( double v ) |
| 73 | { |
| 74 | dmc.nonlinear = false; |
| 75 | square_synth.volume( 0.1128 * v ); |
| 76 | triangle.synth.volume( 0.12765 * v ); |
| 77 | noise.synth.volume( 0.0741 * v ); |
| 78 | dmc.synth.volume( 0.42545 * v ); |
| 79 | } |
| 80 | |
| 81 | void Nes_Apu::output( Blip_Buffer* buffer ) |
| 82 | { |
| 83 | for ( int i = 0; i < osc_count; i++ ) |
| 84 | osc_output( i, buffer ); |
| 85 | } |
| 86 | |
| 87 | void Nes_Apu::reset( bool pal_mode, int initial_dmc_dac ) |
| 88 | { |
| 89 | // to do: time pal frame periods exactly |
| 90 | frame_period = pal_mode ? 8314 : 7458; |
| 91 | dmc.pal_mode = pal_mode; |
| 92 | |
| 93 | square1.reset(); |
| 94 | square2.reset(); |
| 95 | triangle.reset(); |
| 96 | noise.reset(); |
| 97 | dmc.reset(); |
| 98 | |
| 99 | last_time = 0; |
| 100 | osc_enables = 0; |
| 101 | irq_flag = false; |
| 102 | earliest_irq_ = no_irq; |
| 103 | frame_delay = 1; |
| 104 | write_register( 0, 0x4017, 0x00 ); |
| 105 | write_register( 0, 0x4015, 0x00 ); |
| 106 | |
| 107 | for ( cpu_addr_t addr = start_addr; addr <= 0x4013; addr++ ) |
| 108 | write_register( 0, addr, (addr & 3) ? 0x00 : 0x10 ); |
| 109 | |
| 110 | dmc.dac = initial_dmc_dac; |
| 111 | if ( !dmc.nonlinear ) |
| 112 | dmc.last_amp = initial_dmc_dac; // prevent output transition |
| 113 | } |
| 114 | |
| 115 | void Nes_Apu::irq_changed() |
| 116 | { |
| 117 | cpu_time_t new_irq = dmc.next_irq; |
| 118 | if ( dmc.irq_flag | irq_flag ) { |
| 119 | new_irq = 0; |
| 120 | } |
| 121 | else if ( new_irq > next_irq ) { |
| 122 | new_irq = next_irq; |
| 123 | } |
| 124 | |
| 125 | if ( new_irq != earliest_irq_ ) { |
| 126 | earliest_irq_ = new_irq; |
| 127 | if ( irq_notifier_ ) |
| 128 | irq_notifier_( irq_data ); |
| 129 | } |
| 130 | } |
| 131 | |
| 132 | // frames |
| 133 | |
| 134 | void Nes_Apu::run_until( cpu_time_t end_time ) |
| 135 | { |
| 136 | require( end_time >= last_time ); |
| 137 | |
| 138 | if ( end_time == last_time ) |
| 139 | return; |
| 140 | |
| 141 | while ( true ) |
| 142 | { |
| 143 | // earlier of next frame time or end time |
| 144 | cpu_time_t time = last_time + frame_delay; |
| 145 | if ( time > end_time ) |
| 146 | time = end_time; |
| 147 | frame_delay -= time - last_time; |
| 148 | |
| 149 | // run oscs to present |
| 150 | square1.run( last_time, time ); |
| 151 | square2.run( last_time, time ); |
| 152 | triangle.run( last_time, time ); |
| 153 | noise.run( last_time, time ); |
| 154 | dmc.run( last_time, time ); |
| 155 | last_time = time; |
| 156 | |
| 157 | if ( time == end_time ) |
| 158 | break; // no more frames to run |
| 159 | |
| 160 | // take frame-specific actions |
| 161 | frame_delay = frame_period; |
| 162 | switch ( frame++ ) |
| 163 | { |
| 164 | case 0: |
| 165 | if ( !(frame_mode & 0xc0) ) { |
| 166 | next_irq = time + frame_period * 4 + 1; |
| 167 | irq_flag = true; |
| 168 | } |
| 169 | // fall through |
| 170 | case 2: |
| 171 | // clock length and sweep on frames 0 and 2 |
| 172 | square1.clock_length( 0x20 ); |
| 173 | square2.clock_length( 0x20 ); |
| 174 | noise.clock_length( 0x20 ); |
| 175 | triangle.clock_length( 0x80 ); // different bit for halt flag on triangle |
| 176 | |
| 177 | square1.clock_sweep( -1 ); |
| 178 | square2.clock_sweep( 0 ); |
| 179 | break; |
| 180 | |
| 181 | case 1: |
| 182 | // frame 1 is slightly shorter |
| 183 | frame_delay -= 2; |
| 184 | break; |
| 185 | |
| 186 | case 3: |
| 187 | frame = 0; |
| 188 | |
| 189 | // frame 3 is almost twice as long in mode 1 |
| 190 | if ( frame_mode & 0x80 ) |
| 191 | frame_delay += frame_period - 6; |
| 192 | break; |
| 193 | } |
| 194 | |
| 195 | // clock envelopes and linear counter every frame |
| 196 | triangle.clock_linear_counter(); |
| 197 | square1.clock_envelope(); |
| 198 | square2.clock_envelope(); |
| 199 | noise.clock_envelope(); |
| 200 | } |
| 201 | } |
| 202 | |
| 203 | void Nes_Apu::end_frame( cpu_time_t end_time ) |
| 204 | { |
| 205 | if ( end_time > last_time ) |
| 206 | run_until( end_time ); |
| 207 | |
| 208 | // make times relative to new frame |
| 209 | last_time -= end_time; |
| 210 | require( last_time >= 0 ); |
| 211 | |
| 212 | if ( next_irq != no_irq ) { |
| 213 | next_irq -= end_time; |
| 214 | assert( next_irq >= 0 ); |
| 215 | } |
| 216 | if ( dmc.next_irq != no_irq ) { |
| 217 | dmc.next_irq -= end_time; |
| 218 | assert( dmc.next_irq >= 0 ); |
| 219 | } |
| 220 | if ( earliest_irq_ != no_irq ) { |
| 221 | earliest_irq_ -= end_time; |
| 222 | if ( earliest_irq_ < 0 ) |
| 223 | earliest_irq_ = 0; |
| 224 | } |
| 225 | } |
| 226 | |
| 227 | // registers |
| 228 | |
| 229 | static const unsigned char length_table [0x20] = { |
| 230 | 0x0A, 0xFE, 0x14, 0x02, 0x28, 0x04, 0x50, 0x06, |
| 231 | 0xA0, 0x08, 0x3C, 0x0A, 0x0E, 0x0C, 0x1A, 0x0E, |
| 232 | 0x0C, 0x10, 0x18, 0x12, 0x30, 0x14, 0x60, 0x16, |
| 233 | 0xC0, 0x18, 0x48, 0x1A, 0x10, 0x1C, 0x20, 0x1E |
| 234 | }; |
| 235 | |
| 236 | void Nes_Apu::write_register( cpu_time_t time, cpu_addr_t addr, int data ) |
| 237 | { |
| 238 | require( addr > 0x20 ); // addr must be actual address (i.e. 0x40xx) |
| 239 | require( (unsigned) data <= 0xff ); |
| 240 | |
| 241 | // Ignore addresses outside range |
| 242 | if ( addr < start_addr || end_addr < addr ) |
| 243 | return; |
| 244 | |
| 245 | run_until( time ); |
| 246 | |
| 247 | if ( addr < 0x4014 ) |
| 248 | { |
| 249 | // Write to channel |
| 250 | int osc_index = (addr - start_addr) >> 2; |
| 251 | Nes_Osc* osc = oscs [osc_index]; |
| 252 | |
| 253 | int reg = addr & 3; |
| 254 | osc->regs [reg] = data; |
| 255 | osc->reg_written [reg] = true; |
| 256 | |
| 257 | if ( osc_index == 4 ) |
| 258 | { |
| 259 | // handle DMC specially |
| 260 | dmc.write_register( reg, data ); |
| 261 | } |
| 262 | else if ( reg == 3 ) |
| 263 | { |
| 264 | // load length counter |
| 265 | if ( (osc_enables >> osc_index) & 1 ) |
| 266 | osc->length_counter = length_table [(data >> 3) & 0x1f]; |
| 267 | |
| 268 | // reset square phase |
| 269 | if ( osc_index < 2 ) |
| 270 | ((Nes_Square*) osc)->phase = Nes_Square::phase_range - 1; |
| 271 | } |
| 272 | } |
| 273 | else if ( addr == 0x4015 ) |
| 274 | { |
| 275 | // Channel enables |
| 276 | for ( int i = osc_count; i--; ) |
| 277 | if ( !((data >> i) & 1) ) |
| 278 | oscs [i]->length_counter = 0; |
| 279 | |
| 280 | bool recalc_irq = dmc.irq_flag; |
| 281 | dmc.irq_flag = false; |
| 282 | |
| 283 | int old_enables = osc_enables; |
| 284 | osc_enables = data; |
| 285 | if ( !(data & 0x10) ) { |
| 286 | dmc.next_irq = no_irq; |
| 287 | recalc_irq = true; |
| 288 | } |
| 289 | else if ( !(old_enables & 0x10) ) { |
| 290 | dmc.start(); // dmc just enabled |
| 291 | } |
| 292 | |
| 293 | if ( recalc_irq ) |
| 294 | irq_changed(); |
| 295 | } |
| 296 | else if ( addr == 0x4017 ) |
| 297 | { |
| 298 | // Frame mode |
| 299 | frame_mode = data; |
| 300 | |
| 301 | bool irq_enabled = !(data & 0x40); |
| 302 | irq_flag &= irq_enabled; |
| 303 | next_irq = no_irq; |
| 304 | |
| 305 | // mode 1 |
| 306 | frame_delay = (frame_delay & 1); |
| 307 | frame = 0; |
| 308 | |
| 309 | if ( !(data & 0x80) ) |
| 310 | { |
| 311 | // mode 0 |
| 312 | frame = 1; |
| 313 | frame_delay += frame_period; |
| 314 | if ( irq_enabled ) |
| 315 | next_irq = time + frame_delay + frame_period * 3; |
| 316 | } |
| 317 | |
| 318 | irq_changed(); |
| 319 | } |
| 320 | } |
| 321 | |
| 322 | int Nes_Apu::read_status( cpu_time_t time ) |
| 323 | { |
| 324 | run_until( time - 1 ); |
| 325 | |
| 326 | int result = (dmc.irq_flag << 7) | (irq_flag << 6); |
| 327 | |
| 328 | for ( int i = 0; i < osc_count; i++ ) |
| 329 | if ( oscs [i]->length_counter ) |
| 330 | result |= 1 << i; |
| 331 | |
| 332 | run_until( time ); |
| 333 | |
| 334 | if ( irq_flag ) { |
| 335 | irq_flag = false; |
| 336 | irq_changed(); |
| 337 | } |
| 338 | |
| 339 | return result; |
| 340 | } |
| 341 | |
| 342 | |