#include "defs.h" #include "pcm.h" #include "sound.h" #include "cpu.h" #include "hw.h" #include "regs.h" #include "rc.h" #include "noise.h" const static byte dmgwave[16] = { 0xac, 0xdd, 0xda, 0x48, 0x36, 0x02, 0xcf, 0x16, 0x2c, 0x04, 0xe5, 0x2c, 0xac, 0xdd, 0xda, 0x48 }; const static byte cgbwave[16] = { 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, }; const static byte sqwave[4][8] = { { 0, 0,-1, 0, 0, 0, 0, 0 }, { 0,-1,-1, 0, 0, 0, 0, 0 }, { -1,-1,-1,-1, 0, 0, 0, 0 }, { -1, 0, 0,-1,-1,-1,-1,-1 } }; const static int freqtab[8] = { (1<<14)*2, (1<<14), (1<<14)/2, (1<<14)/3, (1<<14)/4, (1<<14)/5, (1<<14)/6, (1<<14)/7 }; struct snd snd; #define RATE (snd.rate) #define WAVE (snd.wave) /* ram.hi+0x30 */ #define S1 (snd.ch[0]) #define S2 (snd.ch[1]) #define S3 (snd.ch[2]) #define S4 (snd.ch[3]) rcvar_t sound_exports[] = { RCV_END }; static void s1_freq_d(int d) { if (RATE > (d<<4)) S1.freq = 0; else S1.freq = (RATE << 17)/d; } static void s1_freq() { s1_freq_d(2048 - (((R_NR14&7)<<8) + R_NR13)); } static void s2_freq() { int d = 2048 - (((R_NR24&7)<<8) + R_NR23); if (RATE > (d<<4)) S2.freq = 0; else S2.freq = (RATE << 17)/d; } static void s3_freq() { int d = 2048 - (((R_NR34&7)<<8) + R_NR33); if (RATE > (d<<3)) S3.freq = 0; else S3.freq = (RATE << 21)/d; } static void s4_freq() { S4.freq = (freqtab[R_NR43&7] >> (R_NR43 >> 4)) * RATE; if (S4.freq >> 18) S4.freq = 1<<18; } void sound_dirty() { S1.swlen = ((R_NR10>>4) & 7) << 14; S1.len = (64-(R_NR11&63)) << 13; S1.envol = R_NR12 >> 4; S1.endir = (R_NR12>>3) & 1; S1.endir |= S1.endir - 1; S1.enlen = (R_NR12 & 7) << 15; s1_freq(); S2.len = (64-(R_NR21&63)) << 13; S2.envol = R_NR22 >> 4; S2.endir = (R_NR22>>3) & 1; S2.endir |= S2.endir - 1; S2.enlen = (R_NR22 & 7) << 15; s2_freq(); S3.len = (256-R_NR31) << 20; s3_freq(); S4.len = (64-(R_NR41&63)) << 13; S4.envol = R_NR42 >> 4; S4.endir = (R_NR42>>3) & 1; S4.endir |= S4.endir - 1; S4.enlen = (R_NR42 & 7) << 15; s4_freq(); } void sound_off() { memset(&S1, 0, sizeof S1); memset(&S2, 0, sizeof S2); memset(&S3, 0, sizeof S3); memset(&S4, 0, sizeof S4); R_NR10 = 0x80; R_NR11 = 0xBF; R_NR12 = 0xF3; R_NR14 = 0xBF; R_NR21 = 0x3F; R_NR22 = 0x00; R_NR24 = 0xBF; R_NR30 = 0x7F; R_NR31 = 0xFF; R_NR32 = 0x9F; R_NR33 = 0xBF; R_NR41 = 0xFF; R_NR42 = 0x00; R_NR43 = 0x00; R_NR44 = 0xBF; R_NR50 = 0x77; R_NR51 = 0xF3; R_NR52 = 0xF1; sound_dirty(); } void sound_reset() { memset(&snd, 0, sizeof snd); if (pcm.hz) snd.rate = (1<<21) / pcm.hz; else snd.rate = 0; memcpy(WAVE, hw.cgb ? cgbwave : dmgwave, 16); memcpy(ram.hi+0x30, WAVE, 16); sound_off(); } void sound_mix() { int s, l, r, f, n; if (!RATE || cpu.snd < RATE) return; for (; cpu.snd >= RATE; cpu.snd -= RATE) { l = r = 0; if (S1.on) { s = sqwave[R_NR11>>6][(S1.pos>>18)&7] & S1.envol; S1.pos += S1.freq; if ((R_NR14 & 64) && ((S1.cnt += RATE) >= S1.len)) S1.on = 0; if (S1.enlen && (S1.encnt += RATE) >= S1.enlen) { S1.encnt -= S1.enlen; S1.envol += S1.endir; if (S1.envol < 0) S1.envol = 0; if (S1.envol > 15) S1.envol = 15; } if (S1.swlen && (S1.swcnt += RATE) >= S1.swlen) { S1.swcnt -= S1.swlen; f = S1.swfreq; n = (R_NR10 & 7); if (R_NR10 & 8) f -= (f >> n); else f += (f >> n); if (f > 2047) S1.on = 0; else { S1.swfreq = f; R_NR13 = f; R_NR14 = (R_NR14 & 0xF8) | (f>>8); s1_freq_d(2048 - f); } } s <<= 2; if (R_NR51 & 1) r += s; if (R_NR51 & 16) l += s; } if (S2.on) { s = sqwave[R_NR21>>6][(S2.pos>>18)&7] & S2.envol; S2.pos += S2.freq; if ((R_NR24 & 64) && ((S2.cnt += RATE) >= S2.len)) S2.on = 0; if (S2.enlen && (S2.encnt += RATE) >= S2.enlen) { S2.encnt -= S2.enlen; S2.envol += S2.endir; if (S2.envol < 0) S2.envol = 0; if (S2.envol > 15) S2.envol = 15; } s <<= 2; if (R_NR51 & 2) r += s; if (R_NR51 & 32) l += s; } if (S3.on) { s = WAVE[(S3.pos>>22) & 15]; if (S3.pos & (1<<21)) s &= 15; else s >>= 4; s -= 8; S3.pos += S3.freq; if ((R_NR34 & 64) && ((S3.cnt += RATE) >= S3.len)) S3.on = 0; if (R_NR32 & 96) s <<= (3 - ((R_NR32>>5)&3)); else s = 0; if (R_NR51 & 4) r += s; if (R_NR51 & 64) l += s; } if (S4.on) { if (R_NR43 & 8) s = 1 & (noise7[ (S4.pos>>20)&15] >> (7-((S4.pos>>17)&7))); else s = 1 & (noise15[ (S4.pos>>20)&4095] >> (7-((S4.pos>>17)&7))); s = (-s) & S4.envol; S4.pos += S4.freq; if ((R_NR44 & 64) && ((S4.cnt += RATE) >= S4.len)) S4.on = 0; if (S4.enlen && (S4.encnt += RATE) >= S4.enlen) { S4.encnt -= S4.enlen; S4.envol += S4.endir; if (S4.envol < 0) S4.envol = 0; if (S4.envol > 15) S4.envol = 15; } s += s << 1; if (R_NR51 & 8) r += s; if (R_NR51 & 128) l += s; } l *= (R_NR50 & 0x07); r *= ((R_NR50 & 0x70)>>4); l >>= 4; r >>= 4; if (l > 127) l = 127; else if (l < -128) l = -128; if (r > 127) r = 127; else if (r < -128) r = -128; if (pcm.buf) { if (pcm.pos >= pcm.len) pcm_submit(); if (pcm.stereo) { pcm.buf[pcm.pos++] = l+128; pcm.buf[pcm.pos++] = r+128; } else pcm.buf[pcm.pos++] = ((l+r)>>1)+128; } } R_NR52 = (R_NR52&0xf0) | S1.on | (S2.on<<1) | (S3.on<<2) | (S4.on<<3); } byte sound_read(byte r) { sound_mix(); /* printf("read %02X: %02X\n", r, REG(r)); */ return REG(r); } void s1_init() { S1.swcnt = 0; S1.swfreq = ((R_NR14&7)<<8) + R_NR13; S1.envol = R_NR12 >> 4; S1.endir = (R_NR12>>3) & 1; S1.endir |= S1.endir - 1; S1.enlen = (R_NR12 & 7) << 15; if (!S1.on) S1.pos = 0; S1.on = 1; S1.cnt = 0; S1.encnt = 0; } void s2_init() { S2.envol = R_NR22 >> 4; S2.endir = (R_NR22>>3) & 1; S2.endir |= S2.endir - 1; S2.enlen = (R_NR22 & 7) << 15; if (!S2.on) S2.pos = 0; S2.on = 1; S2.cnt = 0; S2.encnt = 0; } void s3_init() { int i; if (!S3.on) S3.pos = 0; S3.cnt = 0; S3.on = R_NR30 >> 7; if (S3.on) for (i = 0; i < 16; i++) ram.hi[i+0x30] = 0x13 ^ ram.hi[i+0x31]; } void s4_init() { S4.envol = R_NR42 >> 4; S4.endir = (R_NR42>>3) & 1; S4.endir |= S4.endir - 1; S4.enlen = (R_NR42 & 7) << 15; S4.on = 1; S4.pos = 0; S4.cnt = 0; S4.encnt = 0; } void sound_write(byte r, byte b) { #if 0 static void *timer; if (!timer) timer = sys_timer(); printf("write %02X: %02X @ %d\n", r, b, sys_elapsed(timer)); #endif if (!(R_NR52 & 128) && r != RI_NR52) return; if ((r & 0xF0) == 0x30) { if (S3.on) sound_mix(); if (!S3.on) WAVE[r-0x30] = ram.hi[r] = b; return; } sound_mix(); switch (r) { case RI_NR10: R_NR10 = b; S1.swlen = ((R_NR10>>4) & 7) << 14; S1.swfreq = ((R_NR14&7)<<8) + R_NR13; break; case RI_NR11: R_NR11 = b; S1.len = (64-(R_NR11&63)) << 13; break; case RI_NR12: R_NR12 = b; S1.envol = R_NR12 >> 4; S1.endir = (R_NR12>>3) & 1; S1.endir |= S1.endir - 1; S1.enlen = (R_NR12 & 7) << 15; break; case RI_NR13: R_NR13 = b; s1_freq(); break; case RI_NR14: R_NR14 = b; s1_freq(); if (b & 128) s1_init(); break; case RI_NR21: R_NR21 = b; S2.len = (64-(R_NR21&63)) << 13; break; case RI_NR22: R_NR22 = b; S2.envol = R_NR22 >> 4; S2.endir = (R_NR22>>3) & 1; S2.endir |= S2.endir - 1; S2.enlen = (R_NR22 & 7) << 15; break; case RI_NR23: R_NR23 = b; s2_freq(); break; case RI_NR24: R_NR24 = b; s2_freq(); if (b & 128) s2_init(); break; case RI_NR30: R_NR30 = b; if (!(b & 128)) S3.on = 0; break; case RI_NR31: R_NR31 = b; S3.len = (256-R_NR31) << 13; break; case RI_NR32: R_NR32 = b; break; case RI_NR33: R_NR33 = b; s3_freq(); break; case RI_NR34: R_NR34 = b; s3_freq(); if (b & 128) s3_init(); break; case RI_NR41: R_NR41 = b; S4.len = (64-(R_NR41&63)) << 13; break; case RI_NR42: R_NR42 = b; S4.envol = R_NR42 >> 4; S4.endir = (R_NR42>>3) & 1; S4.endir |= S4.endir - 1; S4.enlen = (R_NR42 & 7) << 15; break; case RI_NR43: R_NR43 = b; s4_freq(); break; case RI_NR44: R_NR44 = b; if (b & 128) s4_init(); break; case RI_NR50: R_NR50 = b; break; case RI_NR51: R_NR51 = b; break; case RI_NR52: R_NR52 = b; if (!(R_NR52 & 128)) sound_off(); break; default: return; } }