ref: 9ad77e42f45c23eb0ce722df7c5cd45b882a57d5
dir: /psx/dev/spu.c/
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include "spu.h"
#include "../log.h"
#define CLAMP(v, l, h) ((v <= l) ? l : ((v >= h) ? h : v))
#define MAX(a, b) ((a) > (b) ? (a) : (b))
#define VOICE_COUNT 24
static const int g_spu_pos_adpcm_table[] = {
0, +60, +115, +98, +122
};
static const int g_spu_neg_adpcm_table[] = {
0, 0, -52, -55, -60
};
static const int16_t g_spu_gauss_table[] = {
-0x001, -0x001, -0x001, -0x001, -0x001, -0x001, -0x001, -0x001,
-0x001, -0x001, -0x001, -0x001, -0x001, -0x001, -0x001, -0x001,
0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0001,
0x0001, 0x0001, 0x0001, 0x0002, 0x0002, 0x0002, 0x0003, 0x0003,
0x0003, 0x0004, 0x0004, 0x0005, 0x0005, 0x0006, 0x0007, 0x0007,
0x0008, 0x0009, 0x0009, 0x000A, 0x000B, 0x000C, 0x000D, 0x000E,
0x000F, 0x0010, 0x0011, 0x0012, 0x0013, 0x0015, 0x0016, 0x0018,
0x0019, 0x001B, 0x001C, 0x001E, 0x0020, 0x0021, 0x0023, 0x0025,
0x0027, 0x0029, 0x002C, 0x002E, 0x0030, 0x0033, 0x0035, 0x0038,
0x003A, 0x003D, 0x0040, 0x0043, 0x0046, 0x0049, 0x004D, 0x0050,
0x0054, 0x0057, 0x005B, 0x005F, 0x0063, 0x0067, 0x006B, 0x006F,
0x0074, 0x0078, 0x007D, 0x0082, 0x0087, 0x008C, 0x0091, 0x0096,
0x009C, 0x00A1, 0x00A7, 0x00AD, 0x00B3, 0x00BA, 0x00C0, 0x00C7,
0x00CD, 0x00D4, 0x00DB, 0x00E3, 0x00EA, 0x00F2, 0x00FA, 0x0101,
0x010A, 0x0112, 0x011B, 0x0123, 0x012C, 0x0135, 0x013F, 0x0148,
0x0152, 0x015C, 0x0166, 0x0171, 0x017B, 0x0186, 0x0191, 0x019C,
0x01A8, 0x01B4, 0x01C0, 0x01CC, 0x01D9, 0x01E5, 0x01F2, 0x0200,
0x020D, 0x021B, 0x0229, 0x0237, 0x0246, 0x0255, 0x0264, 0x0273,
0x0283, 0x0293, 0x02A3, 0x02B4, 0x02C4, 0x02D6, 0x02E7, 0x02F9,
0x030B, 0x031D, 0x0330, 0x0343, 0x0356, 0x036A, 0x037E, 0x0392,
0x03A7, 0x03BC, 0x03D1, 0x03E7, 0x03FC, 0x0413, 0x042A, 0x0441,
0x0458, 0x0470, 0x0488, 0x04A0, 0x04B9, 0x04D2, 0x04EC, 0x0506,
0x0520, 0x053B, 0x0556, 0x0572, 0x058E, 0x05AA, 0x05C7, 0x05E4,
0x0601, 0x061F, 0x063E, 0x065C, 0x067C, 0x069B, 0x06BB, 0x06DC,
0x06FD, 0x071E, 0x0740, 0x0762, 0x0784, 0x07A7, 0x07CB, 0x07EF,
0x0813, 0x0838, 0x085D, 0x0883, 0x08A9, 0x08D0, 0x08F7, 0x091E,
0x0946, 0x096F, 0x0998, 0x09C1, 0x09EB, 0x0A16, 0x0A40, 0x0A6C,
0x0A98, 0x0AC4, 0x0AF1, 0x0B1E, 0x0B4C, 0x0B7A, 0x0BA9, 0x0BD8,
0x0C07, 0x0C38, 0x0C68, 0x0C99, 0x0CCB, 0x0CFD, 0x0D30, 0x0D63,
0x0D97, 0x0DCB, 0x0E00, 0x0E35, 0x0E6B, 0x0EA1, 0x0ED7, 0x0F0F,
0x0F46, 0x0F7F, 0x0FB7, 0x0FF1, 0x102A, 0x1065, 0x109F, 0x10DB,
0x1116, 0x1153, 0x118F, 0x11CD, 0x120B, 0x1249, 0x1288, 0x12C7,
0x1307, 0x1347, 0x1388, 0x13C9, 0x140B, 0x144D, 0x1490, 0x14D4,
0x1517, 0x155C, 0x15A0, 0x15E6, 0x162C, 0x1672, 0x16B9, 0x1700,
0x1747, 0x1790, 0x17D8, 0x1821, 0x186B, 0x18B5, 0x1900, 0x194B,
0x1996, 0x19E2, 0x1A2E, 0x1A7B, 0x1AC8, 0x1B16, 0x1B64, 0x1BB3,
0x1C02, 0x1C51, 0x1CA1, 0x1CF1, 0x1D42, 0x1D93, 0x1DE5, 0x1E37,
0x1E89, 0x1EDC, 0x1F2F, 0x1F82, 0x1FD6, 0x202A, 0x207F, 0x20D4,
0x2129, 0x217F, 0x21D5, 0x222C, 0x2282, 0x22DA, 0x2331, 0x2389,
0x23E1, 0x2439, 0x2492, 0x24EB, 0x2545, 0x259E, 0x25F8, 0x2653,
0x26AD, 0x2708, 0x2763, 0x27BE, 0x281A, 0x2876, 0x28D2, 0x292E,
0x298B, 0x29E7, 0x2A44, 0x2AA1, 0x2AFF, 0x2B5C, 0x2BBA, 0x2C18,
0x2C76, 0x2CD4, 0x2D33, 0x2D91, 0x2DF0, 0x2E4F, 0x2EAE, 0x2F0D,
0x2F6C, 0x2FCC, 0x302B, 0x308B, 0x30EA, 0x314A, 0x31AA, 0x3209,
0x3269, 0x32C9, 0x3329, 0x3389, 0x33E9, 0x3449, 0x34A9, 0x3509,
0x3569, 0x35C9, 0x3629, 0x3689, 0x36E8, 0x3748, 0x37A8, 0x3807,
0x3867, 0x38C6, 0x3926, 0x3985, 0x39E4, 0x3A43, 0x3AA2, 0x3B00,
0x3B5F, 0x3BBD, 0x3C1B, 0x3C79, 0x3CD7, 0x3D35, 0x3D92, 0x3DEF,
0x3E4C, 0x3EA9, 0x3F05, 0x3F62, 0x3FBD, 0x4019, 0x4074, 0x40D0,
0x412A, 0x4185, 0x41DF, 0x4239, 0x4292, 0x42EB, 0x4344, 0x439C,
0x43F4, 0x444C, 0x44A3, 0x44FA, 0x4550, 0x45A6, 0x45FC, 0x4651,
0x46A6, 0x46FA, 0x474E, 0x47A1, 0x47F4, 0x4846, 0x4898, 0x48E9,
0x493A, 0x498A, 0x49D9, 0x4A29, 0x4A77, 0x4AC5, 0x4B13, 0x4B5F,
0x4BAC, 0x4BF7, 0x4C42, 0x4C8D, 0x4CD7, 0x4D20, 0x4D68, 0x4DB0,
0x4DF7, 0x4E3E, 0x4E84, 0x4EC9, 0x4F0E, 0x4F52, 0x4F95, 0x4FD7,
0x5019, 0x505A, 0x509A, 0x50DA, 0x5118, 0x5156, 0x5194, 0x51D0,
0x520C, 0x5247, 0x5281, 0x52BA, 0x52F3, 0x532A, 0x5361, 0x5397,
0x53CC, 0x5401, 0x5434, 0x5467, 0x5499, 0x54CA, 0x54FA, 0x5529,
0x5558, 0x5585, 0x55B2, 0x55DE, 0x5609, 0x5632, 0x565B, 0x5684,
0x56AB, 0x56D1, 0x56F6, 0x571B, 0x573E, 0x5761, 0x5782, 0x57A3,
0x57C3, 0x57E2, 0x57FF, 0x581C, 0x5838, 0x5853, 0x586D, 0x5886,
0x589E, 0x58B5, 0x58CB, 0x58E0, 0x58F4, 0x5907, 0x5919, 0x592A,
0x593A, 0x5949, 0x5958, 0x5965, 0x5971, 0x597C, 0x5986, 0x598F,
0x5997, 0x599E, 0x59A4, 0x59A9, 0x59AD, 0x59B0, 0x59B2, 0x59B3
};
psx_spu_t* psx_spu_create() {
return (psx_spu_t*)malloc(sizeof(psx_spu_t));
}
void psx_spu_init(psx_spu_t* spu) {
memset(spu, 0, sizeof(psx_spu_t));
spu->io_base = PSX_SPU_BEGIN;
spu->io_size = PSX_SPU_SIZE;
spu->ram = (uint8_t*)malloc(SPU_RAM_SIZE);
memset(spu->ram, 0, SPU_RAM_SIZE);
// Mute all voices
spu->endx = 0x00ffffff;
}
uint32_t psx_spu_read32(psx_spu_t* spu, uint32_t offset) {
const uint8_t* ptr = (uint8_t*)&spu->voice[0].volumel;
return *((uint32_t*)(ptr + offset));
}
uint16_t psx_spu_read16(psx_spu_t* spu, uint32_t offset) {
if (offset == SPUR_TFIFO) {
uint16_t data = *(uint16_t*)(&spu->ram[spu->taddr]);
spu->taddr += 2;
return data;
}
const uint8_t* ptr = (uint8_t*)&spu->voice[0].volumel;
return *((uint16_t*)(ptr + offset));
}
uint8_t psx_spu_read8(psx_spu_t* spu, uint32_t offset) {
log_fatal("Unhandled 8-bit SPU read at offset %08x", offset);
return 0x0;
}
void spu_read_block(psx_spu_t* spu, int v) {
uint32_t addr = spu->data[v].current_addr;
uint8_t hdr = spu->ram[addr];
spu->data[v].block_flags = spu->ram[addr + 1];
unsigned shift = 12 - (hdr & 0x0f);
unsigned filter = (hdr >> 4) & 7;
int32_t f0 = g_spu_pos_adpcm_table[filter];
int32_t f1 = g_spu_neg_adpcm_table[filter];
for (int j = 0; j < 28; j++) {
uint16_t n = (spu->ram[addr + 2 + (j >> 1)] >> ((j & 1) * 4)) & 0xf;
// Sign extend t
int16_t t = (int16_t)(n << 12) >> 12;
int16_t s = (t << shift) + (((spu->data[v].h[0] * f0) + (spu->data[v].h[1] * f1) + 32) / 64);
s = (s < INT16_MIN) ? INT16_MIN : ((s > INT16_MAX) ? INT16_MAX : s);
spu->data[v].h[1] = spu->data[v].h[0];
spu->data[v].h[0] = s;
spu->data[v].buf[j] = s;
}
}
#define PHASE spu->data[v].adsr_phase
#define CYCLES spu->data[v].adsr_cycles
#define EXPONENTIAL spu->data[v].adsr_mode
#define DECREASE spu->data[v].adsr_dir
#define SHIFT spu->data[v].adsr_shift
#define STEP spu->data[v].adsr_step
#define LEVEL_STEP spu->data[v].adsr_pending_step
#define LEVEL spu->data[v].cvol
/*
____lower 16bit (at 1F801C08h+N*10h)___________________________________
15 Attack Mode (0=Linear, 1=Exponential)
- Attack Direction (Fixed, always Increase) (until Level 7FFFh)
14-10 Attack Shift (0..1Fh = Fast..Slow)
9-8 Attack Step (0..3 = "+7,+6,+5,+4")
- Decay Mode (Fixed, always Exponential)
- Decay Direction (Fixed, always Decrease) (until Sustain Level)
7-4 Decay Shift (0..0Fh = Fast..Slow)
- Decay Step (Fixed, always "-8")
3-0 Sustain Level (0..0Fh) ;Level=(N+1)*800h
____upper 16bit (at 1F801C0Ah+N*10h)___________________________________
31 Sustain Mode (0=Linear, 1=Exponential)
30 Sustain Direction (0=Increase, 1=Decrease) (until Key OFF flag)
29 Not used? (should be zero)
28-24 Sustain Shift (0..1Fh = Fast..Slow)
23-22 Sustain Step (0..3 = "+7,+6,+5,+4" or "-8,-7,-6,-5") (inc/dec)
21 Release Mode (0=Linear, 1=Exponential)
- Release Direction (Fixed, always Decrease) (until Level 0000h)
20-16 Release Shift (0..1Fh = Fast..Slow)
- Release Step (Fixed, always "-8")
*/
enum {
ADSR_ATTACK,
ADSR_DECAY,
ADSR_SUSTAIN,
ADSR_RELEASE,
ADSR_END
};
void adsr_calculate_values(psx_spu_t* spu, int v) {
CYCLES = 1 << MAX(0, SHIFT - 11);
LEVEL_STEP = STEP << MAX(0, 11 - SHIFT);
if (EXPONENTIAL && (LEVEL > 0x6000) && !DECREASE)
CYCLES *= 4;
if (EXPONENTIAL && DECREASE)
LEVEL_STEP = (LEVEL_STEP * LEVEL) >> 15;
spu->data[v].adsr_cycles_reload = CYCLES;
}
void adsr_load_attack(psx_spu_t* spu, int v) {
EXPONENTIAL = spu->data[v].envctl >> 15;
DECREASE = 0;
SHIFT = (spu->data[v].envctl >> 10) & 0x1f;
STEP = 7 - ((spu->data[v].envctl >> 8) & 3);
LEVEL = 0;
PHASE = ADSR_ATTACK;
adsr_calculate_values(spu, v);
}
void adsr_load_decay(psx_spu_t* spu, int v) {
EXPONENTIAL = 1;
DECREASE = 1;
SHIFT = (spu->data[v].envctl >> 4) & 0xf;
STEP = -8;
LEVEL = 0x7fff;
PHASE = ADSR_DECAY;
adsr_calculate_values(spu, v);
}
void adsr_load_sustain(psx_spu_t* spu, int v) {
EXPONENTIAL = spu->data[v].envctl >> 31;
DECREASE = (spu->data[v].envctl >> 30) & 1;
SHIFT = (spu->data[v].envctl >> 24) & 0x1f;
STEP = (spu->data[v].envctl >> 22) & 3;
LEVEL = spu->data[v].adsr_sustain_level;
STEP = DECREASE ? (-8 + STEP) : (7 - STEP);
PHASE = ADSR_SUSTAIN;
adsr_calculate_values(spu, v);
}
void adsr_load_release(psx_spu_t* spu, int v) {
EXPONENTIAL = (spu->data[v].envctl >> 21) & 1;
DECREASE = 1;
SHIFT = (spu->data[v].envctl >> 16) & 0x1f;
STEP = -8;
PHASE = ADSR_RELEASE;
spu->endx |= 1 << v;
adsr_calculate_values(spu, v);
}
void spu_handle_adsr(psx_spu_t* spu, int v) {
if (CYCLES) {
CYCLES -= 1;
return;
}
adsr_calculate_values(spu, v);
LEVEL += LEVEL_STEP;
switch (spu->data[v].adsr_phase) {
case ADSR_ATTACK: {
LEVEL = CLAMP(LEVEL, 0x0000, 0x7fff);
if (LEVEL == 0x7fff)
adsr_load_decay(spu, v);
} break;
case ADSR_DECAY: {
LEVEL = CLAMP(LEVEL, 0x0000, 0x7fff);
if (LEVEL <= spu->data[v].adsr_sustain_level)
adsr_load_sustain(spu, v);
} break;
case ADSR_SUSTAIN: {
LEVEL = CLAMP(LEVEL, 0x0000, 0x7fff);
/* Not stopped automatically, need to KOFF */
} break;
case ADSR_RELEASE: {
LEVEL = CLAMP(LEVEL, 0x0000, 0x7fff);
if (!LEVEL) {
PHASE = ADSR_END;
CYCLES = 0;
LEVEL_STEP = 0;
spu->data[v].playing = 0;
}
} break;
case ADSR_END: {
spu->data[v].playing = 0;
} break;
}
spu->voice[v].envcvol = spu->data[v].cvol;
CYCLES = spu->data[v].adsr_cycles_reload;
}
#undef PHASE
#undef CYCLES
#undef MODE
#undef DIR
#undef SHIFT
#undef STEP
#undef PENDING_STEP
void spu_kon(psx_spu_t* spu, uint32_t value) {
for (int i = 0; i < VOICE_COUNT; i++) {
if ((value & (1 << i))) {
spu->data[i].playing = 1;
spu->data[i].current_addr = spu->voice[i].adsaddr << 3;
spu->data[i].repeat_addr = spu->voice[i].adraddr << 3;
spu->data[i].lvol = ((float)(spu->voice[i].volumel) / 32767.0f) * 2.0f;
spu->data[i].rvol = ((float)(spu->voice[i].volumer) / 32767.0f) * 2.0f;
spu->data[i].adsr_sustain_level = ((spu->voice[i].envctl1 & 0xf) + 1) * 0x800;
spu->data[i].envctl = (((uint32_t)spu->voice[i].envctl2) << 16) |
(uint32_t)spu->voice[i].envctl1;
adsr_load_attack(spu, i);
spu_read_block(spu, i);
}
}
spu->kon |= value & 0x00ffffff;
spu->endx &= ~(value & 0x00ffffff);
}
void spu_koff(psx_spu_t* spu, uint32_t value) {
for (int i = 0; i < VOICE_COUNT; i++)
if (value & (1 << i))
adsr_load_release(spu, i);
spu->koff |= value & 0x00ffffff;
}
int spu_handle_write(psx_spu_t* spu, uint32_t offset, uint32_t value) {
switch (offset) {
case SPUR_KONL: case SPUR_KONH: {
int high = (offset & 2) != 0;
if (!value)
return 1;
spu_kon(spu, value << (16 * high));
} return 1;
case SPUR_KOFFL: case SPUR_KOFFH: {
int high = (offset & 2) != 0;
if (!value)
return 1;
spu_koff(spu, value << (16 * high));
} return 1;
case SPUR_TADDR: {
spu->ramdta = value;
spu->taddr = value << 3;
} return 1;
case SPUR_TFIFO: {
spu->ramdtf = value;
spu->tfifo[spu->tfifo_index++] = value;
if (spu->tfifo_index == 32) {
if (((spu->spucnt >> 4) & 3) == 2) {
for (int i = 0; i < spu->tfifo_index; i++) {
spu->ram[spu->taddr++] = spu->tfifo[i] & 0xff;
spu->ram[spu->taddr++] = spu->tfifo[i] >> 8;
}
spu->tfifo_index = 0;
}
}
} return 1;
case SPUR_SPUCNT: {
spu->spucnt = value;
spu->spustat &= 0xffc0;
spu->spustat |= value & 0x3f;
if ((value >> 4) & 3) {
for (int i = 0; i < spu->tfifo_index; i++) {
spu->ram[spu->taddr++] = spu->tfifo[i] & 0xff;
spu->ram[spu->taddr++] = spu->tfifo[i] >> 8;
}
spu->tfifo_index = 0;
}
} return 1;
case SPUR_MBASE: {
spu->mbase = value;
spu->revbaddr = spu->mbase << 3;
} return 1;
}
return 0;
}
void psx_spu_write32(psx_spu_t* spu, uint32_t offset, uint32_t value) {
// Handle special cases first
if (spu_handle_write(spu, offset, value))
return;
const uint8_t* ptr = (uint8_t*)&spu->voice[0];
*((uint32_t*)(ptr + offset)) = value;
}
void psx_spu_write16(psx_spu_t* spu, uint32_t offset, uint16_t value) {
// Handle special cases first
if (spu_handle_write(spu, offset, value))
return;
const uint8_t* ptr = (uint8_t*)&spu->voice[0].volumel;
if (offset != 0x0c)
*((uint16_t*)(ptr + offset)) = value;
}
void psx_spu_write8(psx_spu_t* spu, uint32_t offset, uint8_t value) {
printf("Unhandled 8-bit SPU write at offset %08x (%02x)\n", offset, value);
}
void psx_spu_destroy(psx_spu_t* spu) {
free(spu->ram);
free(spu);
}
// To-do: Optimize reverb
int16_t spu_read_reverb(psx_spu_t* spu, uint32_t addr) {
uint32_t mbase = spu->mbase << 3;
uint32_t relative = (addr + spu->revbaddr - mbase) % (0x80000 - mbase);
uint32_t wrapped = (mbase + relative) & 0x7fffe;
return *(int16_t*)(spu->ram + wrapped);
}
void spu_write_reverb(psx_spu_t* spu, uint32_t addr, int16_t value) {
uint32_t mbase = spu->mbase << 3;
uint32_t relative = (addr + spu->revbaddr - mbase) % (0x80000 - mbase);
uint32_t wrapped = (mbase + relative) & 0x7fffe;
*(int16_t*)(spu->ram + wrapped) = value;
}
#define R16(addr) (spu_read_reverb(spu, addr))
#define W16(addr, value) spu_write_reverb(spu, addr, value)
void spu_get_reverb_sample(psx_spu_t* spu, int inl, int inr, int* outl, int* outr) {
uint32_t mbase = spu->mbase << 3;
uint32_t dapf1 = spu->dapf1 << 3;
uint32_t dapf2 = spu->dapf2 << 3;
uint32_t mlsame = spu->mlsame << 3;
uint32_t mrsame = spu->mrsame << 3;
uint32_t dlsame = spu->dlsame << 3;
uint32_t drsame = spu->drsame << 3;
uint32_t mldiff = spu->mldiff << 3;
uint32_t mrdiff = spu->mrdiff << 3;
uint32_t dldiff = spu->dldiff << 3;
uint32_t drdiff = spu->drdiff << 3;
uint32_t mlcomb1 = spu->mlcomb1 << 3;
uint32_t mlcomb2 = spu->mlcomb2 << 3;
uint32_t mlcomb3 = spu->mlcomb3 << 3;
uint32_t mlcomb4 = spu->mlcomb4 << 3;
uint32_t mrcomb1 = spu->mrcomb1 << 3;
uint32_t mrcomb2 = spu->mrcomb2 << 3;
uint32_t mrcomb3 = spu->mrcomb3 << 3;
uint32_t mrcomb4 = spu->mrcomb4 << 3;
uint32_t mlapf1 = spu->mlapf1 << 3;
uint32_t mlapf2 = spu->mlapf2 << 3;
uint32_t mrapf1 = spu->mrapf1 << 3;
uint32_t mrapf2 = spu->mrapf2 << 3;
float vlin = (float)spu->vlin / 32767.0f;
float vrin = (float)spu->vrin / 32767.0f;
float viir = (float)spu->viir / 32767.0f;
float vwall = (float)spu->vwall / 32767.0f;
float vcomb1 = (float)spu->vcomb1 / 32767.0f;
float vcomb2 = (float)spu->vcomb2 / 32767.0f;
float vcomb3 = (float)spu->vcomb3 / 32767.0f;
float vcomb4 = (float)spu->vcomb4 / 32767.0f;
float vapf1 = (float)spu->vapf1 / 32767.0f;
float vapf2 = (float)spu->vapf2 / 32767.0f;
float vlout = (float)spu->vlout / 32767.0f;
float vrout = (float)spu->vrout / 32767.0f;
int lin = ((float)inl * 0.5f) * vlin;
int rin = ((float)inr * 0.5f) * vrin;
int mlsamev = (lin + R16(dlsame)*vwall - R16(mlsame-2))*viir + R16(mlsame-2);
int mrsamev = (rin + R16(drsame)*vwall - R16(mrsame-2))*viir + R16(mrsame-2);
int mldiffv = (lin + R16(drdiff)*vwall - R16(mldiff-2))*viir + R16(mldiff-2);
int mrdiffv = (rin + R16(dldiff)*vwall - R16(mrdiff-2))*viir + R16(mrdiff-2);
W16(mlsame, CLAMP(mlsamev, -0x8000, 0x7fff));
W16(mrsame, CLAMP(mrsamev, -0x8000, 0x7fff));
W16(mldiff, CLAMP(mldiffv, -0x8000, 0x7fff));
W16(mrdiff, CLAMP(mrdiffv, -0x8000, 0x7fff));
int lout=vcomb1*R16(mlcomb1)+vcomb2*R16(mlcomb2)+vcomb3*R16(mlcomb3)+vcomb4*R16(mlcomb4);
int rout=vcomb1*R16(mrcomb1)+vcomb2*R16(mrcomb2)+vcomb3*R16(mrcomb3)+vcomb4*R16(mrcomb4);
lout = CLAMP(lout, -0x8000, 0x7fff);
rout = CLAMP(rout, -0x8000, 0x7fff);
lout-=CLAMP(vapf1*R16(mlapf1 - dapf1), -0x8000, 0x7fff); W16(mlapf1, lout); lout*=vapf1+((float)R16(mlapf1 - dapf1) / 32767.0f);
rout-=CLAMP(vapf1*R16(mrapf1 - dapf1), -0x8000, 0x7fff); W16(mrapf1, rout); rout*=vapf1+((float)R16(mrapf1 - dapf1) / 32767.0f);
lout-=CLAMP(vapf2*R16(mlapf2 - dapf2), -0x8000, 0x7fff); W16(mlapf2, lout); lout*=vapf2+((float)R16(mlapf2 - dapf2) / 32767.0f);
rout-=CLAMP(vapf2*R16(mrapf2 - dapf2), -0x8000, 0x7fff); W16(mrapf2, rout); rout*=vapf2+((float)R16(mrapf2 - dapf2) / 32767.0f);
*outl = lout * vlout;
*outr = rout * vrout;
spu->revbaddr = MAX(mbase, (spu->revbaddr + 2) & 0x7fffe);
}
#undef R16
#undef W16
uint32_t psx_spu_get_sample(psx_spu_t* spu) {
spu->even_cycle ^= 1;
int active_voice_count = 0;
int left = 0;
int right = 0;
int revl = 0;
int revr = 0;
spu->koff = 0;
spu->kon = 0;
for (int v = 0; v < VOICE_COUNT; v++) {
if (!spu->data[v].playing)
continue;
spu_handle_adsr(spu, v);
++active_voice_count;
// Shift 3 older samples around
spu->data[v].s[3] = spu->data[v].s[2];
spu->data[v].s[2] = spu->data[v].s[1];
spu->data[v].s[1] = spu->data[v].s[0];
uint32_t sample_index = spu->data[v].counter >> 12;
if (sample_index > 27) {
sample_index -= 28;
spu->data[v].counter &= 0xfff;
spu->data[v].counter |= sample_index << 12;
switch (spu->data[v].block_flags & 3) {
case 0: case 2: {
spu->data[v].current_addr += 0x10;
} break;
case 1: {
spu->data[v].current_addr = spu->data[v].repeat_addr;
spu->data[v].playing = 0;
spu->voice[v].envcvol = 0;
adsr_load_release(spu, v);
} break;
case 3: {
spu->endx |= 1 << v;
spu->data[v].current_addr = spu->data[v].repeat_addr;
} break;
}
if (spu->data[v].block_flags & 4)
spu->data[v].repeat_addr = spu->data[v].current_addr;
spu_read_block(spu, v);
}
// Fetch ADPCM sample
spu->data[v].s[0] = spu->data[v].buf[sample_index];
// Apply 4-point Gaussian interpolation
uint8_t gauss_index = (spu->data[v].counter >> 4) & 0xff;
int16_t g0 = g_spu_gauss_table[0x0ff - gauss_index];
int16_t g1 = g_spu_gauss_table[0x1ff - gauss_index];
int16_t g2 = g_spu_gauss_table[0x100 + gauss_index];
int16_t g3 = g_spu_gauss_table[0x000 + gauss_index];
int16_t out;
out = (g0 * spu->data[v].s[3]) >> 15;
out += (g1 * spu->data[v].s[2]) >> 15;
out += (g2 * spu->data[v].s[1]) >> 15;
out += (g3 * spu->data[v].s[0]) >> 15;
float adsr_vol = (float)spu->voice[v].envcvol / 32767.0f;
float samplel = (out * spu->data[v].lvol) * adsr_vol * (float)spu->mainlvol / 32767.0f;
float sampler = (out * spu->data[v].rvol) * adsr_vol * (float)spu->mainrvol / 32767.0f;
left += samplel;
right += sampler;
if (spu->eon & (1 << v)) {
revl += samplel;
revr += sampler;
}
uint16_t step = spu->voice[v].adsampr;
/* To-do: Do pitch modulation here */
spu->data[v].counter += step;
}
if (!active_voice_count)
return 0x00000000;
int16_t clamprl = CLAMP(revl, INT16_MIN, INT16_MAX);
int16_t clamprr = CLAMP(revr, INT16_MIN, INT16_MAX);
int16_t clampsl = CLAMP(left, INT16_MIN, INT16_MAX);
int16_t clampsr = CLAMP(right, INT16_MIN, INT16_MAX);
if ((spu->spucnt & 0x0080) && spu->even_cycle)
spu_get_reverb_sample(spu, clamprl, clamprr, &spu->lrsl, &spu->lrsr);
uint16_t clampl = CLAMP(clampsl + spu->lrsl, INT16_MIN, INT16_MAX);
uint16_t clampr = CLAMP(clampsr + spu->lrsr, INT16_MIN, INT16_MAX);
return clampl | (((uint32_t)clampr) << 16);
}
void psx_spu_update_cdda_buffer(psx_spu_t* spu, void* buf) {
int16_t* ptr = buf;
int16_t* ram = (int16_t*)spu->ram;
for (int i = 0; i < 0x400;) {
ram[i] = ptr[i];
++i;
ram[i + 0x400] = ptr[i];
++i;
}
}
#undef CLAMP
#undef MAX