X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=Pico%2Fsound%2Fym2612.c;h=294d621931e37098bb8c5fe454d6d1a505810c81;hb=db49317be10622fc8d2e766831483c7db2e17e0e;hp=8e081b4fa6eef103fb098fc2952151ea3bf412e0;hpb=b542be4686241c9e0722ff8e452980f9ac2b4d7c;p=picodrive.git diff --git a/Pico/sound/ym2612.c b/Pico/sound/ym2612.c index 8e081b4..294d621 100644 --- a/Pico/sound/ym2612.c +++ b/Pico/sound/ym2612.c @@ -116,7 +116,7 @@ #ifndef EXTERNAL_YM2612 #include // let it be 1 global to simplify things -static YM2612 ym2612; +YM2612 ym2612; #else extern YM2612 *ym2612_940; @@ -889,7 +889,7 @@ static void chan_render_loop(chan_rend_context *ct, int *buffer, int length) { int out = 0; - if (ct->pack&0xf000) out = ((ct->op1_out>>16) + (ct->op1_out<<16>>16)) << ((ct->pack&0xf000)>>12); /* op1_out0 + op1_out1 */ + if (ct->pack&0xf000) out = ((ct->op1_out>>16) + ((ct->op1_out<<16)>>16)) << ((ct->pack&0xf000)>>12); /* op1_out0 + op1_out1 */ ct->op1_out <<= 16; ct->op1_out |= (unsigned short)op_calc1(ct->phase1, eg_out, out); } else { @@ -1085,14 +1085,27 @@ static void chan_render_loop(chan_rend_context *ct, int *buffer, int length) void chan_render_loop(chan_rend_context *ct, int *buffer, unsigned short length); #endif -static chan_rend_context __attribute__((aligned(64))) crct; +static chan_rend_context crct; + +static void chan_render_prep(void) +{ + crct.eg_timer_add = ym2612.OPN.eg_timer_add; + crct.lfo_inc = ym2612.OPN.lfo_inc; +} + +static void chan_render_finish(void) +{ + ym2612.OPN.eg_cnt = crct.eg_cnt; + ym2612.OPN.eg_timer = crct.eg_timer; + g_lfo_ampm = crct.pack >> 16; // need_save + ym2612.OPN.lfo_cnt = crct.lfo_cnt; +} static int chan_render(int *buffer, int length, int c, UINT32 flags) // flags: stereo, ?, disabled, ?, pan_r, pan_l { crct.CH = &ym2612.CH[c]; crct.mem = crct.CH->mem_value; /* one sample delay memory */ crct.lfo_cnt = ym2612.OPN.lfo_cnt; - crct.lfo_inc = ym2612.OPN.lfo_inc; flags &= 0x35; @@ -1109,7 +1122,6 @@ static int chan_render(int *buffer, int length, int c, UINT32 flags) // flags: s crct.eg_cnt = ym2612.OPN.eg_cnt; /* envelope generator counter */ crct.eg_timer = ym2612.OPN.eg_timer; - crct.eg_timer_add = ym2612.OPN.eg_timer_add; /* precalculate phase modulation incr */ crct.phase1 = crct.CH->SLOT[SLOT1].phase; @@ -1185,15 +1197,6 @@ static int chan_render(int *buffer, int length, int c, UINT32 flags) // flags: s else ym2612.slot_mask &= ~(0xf << (c*4)); - // if this the last call, write back persistent stuff: - if ((ym2612.slot_mask >> ((c+1)*4)) == 0) - { - ym2612.OPN.eg_cnt = crct.eg_cnt; - ym2612.OPN.eg_timer = crct.eg_timer; - g_lfo_ampm = crct.pack >> 16; - ym2612.OPN.lfo_cnt = crct.lfo_cnt; - } - return (crct.algo & 8) >> 3; // had output } @@ -1212,10 +1215,10 @@ INLINE void refresh_fc_eg_slot(FM_SLOT *SLOT, int fc, int kc) SLOT->ksr = ksr; /* calculate envelope generator rates */ - if ((SLOT->ar + SLOT->ksr) < 32+62) + if ((SLOT->ar + ksr) < 32+62) { - eg_sh = eg_rate_shift [SLOT->ar + SLOT->ksr ]; - eg_sel = eg_rate_select[SLOT->ar + SLOT->ksr ]; + eg_sh = eg_rate_shift [SLOT->ar + ksr ]; + eg_sel = eg_rate_select[SLOT->ar + ksr ]; } else { @@ -1225,18 +1228,18 @@ INLINE void refresh_fc_eg_slot(FM_SLOT *SLOT, int fc, int kc) SLOT->eg_pack_ar = eg_inc_pack[eg_sel] | (eg_sh<<24); - eg_sh = eg_rate_shift [SLOT->d1r + SLOT->ksr]; - eg_sel = eg_rate_select[SLOT->d1r + SLOT->ksr]; + eg_sh = eg_rate_shift [SLOT->d1r + ksr]; + eg_sel = eg_rate_select[SLOT->d1r + ksr]; SLOT->eg_pack_d1r = eg_inc_pack[eg_sel] | (eg_sh<<24); - eg_sh = eg_rate_shift [SLOT->d2r + SLOT->ksr]; - eg_sel = eg_rate_select[SLOT->d2r + SLOT->ksr]; + eg_sh = eg_rate_shift [SLOT->d2r + ksr]; + eg_sel = eg_rate_select[SLOT->d2r + ksr]; SLOT->eg_pack_d2r = eg_inc_pack[eg_sel] | (eg_sh<<24); - eg_sh = eg_rate_shift [SLOT->rr + SLOT->ksr]; - eg_sel = eg_rate_select[SLOT->rr + SLOT->ksr]; + eg_sh = eg_rate_shift [SLOT->rr + ksr]; + eg_sel = eg_rate_select[SLOT->rr + ksr]; SLOT->eg_pack_rr = eg_inc_pack[eg_sel] | (eg_sh<<24); } @@ -1290,6 +1293,7 @@ static void reset_channels(FM_CH *CH) CH[c].SLOT[s].state= EG_OFF; CH[c].SLOT[s].volume = MAX_ATT_INDEX; } + CH[c].mem_value = CH[c].op1_out = 0; } ym2612.slot_mask = 0; } @@ -1478,17 +1482,17 @@ static int OPNWriteReg(int r, int v) set_ar_ksr(CH,SLOT,v); break; - case 0x60: /* bit7 = AM ENABLE, DR */ + case 0x60: /* bit7 = AM ENABLE, DR | depends on ksr */ set_dr(SLOT,v); if(v&0x80) CH->AMmasks |= 1<AMmasks &= ~(1<>3; @@ -1527,7 +1531,7 @@ static int OPNWriteReg(int r, int v) ym2612.OPN.SL3.kcode[c]= (blk<<2) | opn_fktable[fn >> 7]; /* phase increment counter */ ym2612.OPN.SL3.fc[c] = fn_table[fn*2]>>(7-blk); - ym2612.OPN.SL3.block_fnum[c] = fn; + ym2612.OPN.SL3.block_fnum[c] = (blk<<11) | fn; ym2612.CH[2].SLOT[SLOT1].Incr=-1; } break; @@ -1584,11 +1588,6 @@ static int OPNWriteReg(int r, int v) /* YM2612 local section */ /*******************************************************************************/ -int *ym2612_dacen; -INT32 *ym2612_dacout; -FM_ST *ym2612_st; - - /* Generate samples for YM2612 */ int YM2612UpdateOne_(int *buffer, int length, int stereo, int is_buf_empty) { @@ -1639,12 +1638,14 @@ int YM2612UpdateOne_(int *buffer, int length, int stereo, int is_buf_empty) /* mix to 32bit dest */ // flags: stereo, ?, disabled, ?, pan_r, pan_l + chan_render_prep(); if (ym2612.slot_mask & 0x00000f) active_chs |= chan_render(buffer, length, 0, stereo|((pan&0x003)<<4)) << 0; if (ym2612.slot_mask & 0x0000f0) active_chs |= chan_render(buffer, length, 1, stereo|((pan&0x00c)<<2)) << 1; if (ym2612.slot_mask & 0x000f00) active_chs |= chan_render(buffer, length, 2, stereo|((pan&0x030) )) << 2; if (ym2612.slot_mask & 0x00f000) active_chs |= chan_render(buffer, length, 3, stereo|((pan&0x0c0)>>2)) << 3; if (ym2612.slot_mask & 0x0f0000) active_chs |= chan_render(buffer, length, 4, stereo|((pan&0x300)>>4)) << 4; if (ym2612.slot_mask & 0xf00000) active_chs |= chan_render(buffer, length, 5, stereo|((pan&0xc00)>>6)|(ym2612.dacen<<2)) << 5; + chan_render_finish(); return active_chs; // 1 if buffer updated } @@ -1653,11 +1654,6 @@ int YM2612UpdateOne_(int *buffer, int length, int stereo, int is_buf_empty) /* initialize YM2612 emulator */ void YM2612Init_(int clock, int rate) { - // notaz - ym2612_dacen = &ym2612.dacen; - ym2612_dacout = &ym2612.dacout; - ym2612_st = &ym2612.OPN.ST; - memset(&ym2612, 0, sizeof(ym2612)); init_tables(); @@ -1728,9 +1724,6 @@ int YM2612Write_(unsigned int a, unsigned int v) } addr = ym2612.OPN.ST.address; -#ifndef EXTERNAL_YM2612 - ym2612.REGS[addr] = v; -#endif switch( addr & 0xf0 ) { @@ -1747,6 +1740,7 @@ int YM2612Write_(unsigned int a, unsigned int v) ym2612.OPN.lfo_inc = 0; } break; +#if 0 // handled elsewhere case 0x24: { // timer A High 8 int TAnew = (ym2612.OPN.ST.TA & 0x03)|(((int)v)<<2); if(ym2612.OPN.ST.TA != TAnew) { @@ -1781,6 +1775,7 @@ int YM2612Write_(unsigned int a, unsigned int v) set_timers( v ); ret=0; break; +#endif case 0x28: /* key on / off */ { UINT8 c; @@ -1794,6 +1789,7 @@ int YM2612Write_(unsigned int a, unsigned int v) if(v&0x80) FM_KEYON(c,SLOT4); else FM_KEYOFF(c,SLOT4); break; } +#if 0 case 0x2a: /* DAC data (YM2612) */ ym2612.dacout = ((int)v - 0x80) << 6; /* level unknown (notaz: 8 seems to be too much) */ ret=0; @@ -1803,6 +1799,7 @@ int YM2612Write_(unsigned int a, unsigned int v) ym2612.dacen = v & 0x80; ret=0; break; +#endif default: break; } @@ -1826,9 +1823,6 @@ int YM2612Write_(unsigned int a, unsigned int v) } addr = ym2612.OPN.ST.address | 0x100; -#ifndef EXTERNAL_YM2612 - ym2612.REGS[addr] = v; -#endif ret = OPNWriteReg(addr, v); break; @@ -1875,26 +1869,264 @@ int YM2612PicoTick_(int n) void YM2612PicoStateLoad_(void) { -#ifndef EXTERNAL_YM2612 - int i, real_A1 = ym2612.addr_A1; - reset_channels( &ym2612.CH[0] ); + ym2612.slot_mask = 0xffffff; +} + +/* rather stupid design because I wanted to fit in unused register "space" */ +typedef struct +{ + UINT32 state_phase; + INT16 volume; +} ym_save_addon_slot; + +typedef struct +{ + UINT32 magic; + UINT8 address; + UINT8 status; + UINT8 addr_A1; + UINT8 unused; + int TAT; + int TBT; + UINT32 eg_cnt; // 10 + UINT32 eg_timer; + UINT32 lfo_cnt; + UINT16 lfo_ampm; + UINT8 fn_h; + UINT8 fn_h_sl3; + UINT32 keyon_field; // 20 + UINT32 kcode_fc_sl3_3; +} ym_save_addon; + +typedef struct +{ + UINT16 block_fnum[6]; + UINT16 block_fnum_sl3[3]; + UINT16 unused; +} ym_save_addon2; + + +//static YM2612 check_ym; + +void YM2612PicoStateSave2(int tat, int tbt) +{ + ym_save_addon_slot ss; + ym_save_addon2 sa2; + ym_save_addon sa; + unsigned char *ptr; + int c, s; + + refresh_fc_eg_chan( &ym2612.CH[0] ); + refresh_fc_eg_chan( &ym2612.CH[1] ); + if( (ym2612.OPN.ST.mode & 0xc0) ) + { + /* 3SLOT MODE */ + if( ym2612.CH[2].SLOT[SLOT1].Incr==-1) + { + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT1], ym2612.OPN.SL3.fc[1], ym2612.OPN.SL3.kcode[1] ); + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT2], ym2612.OPN.SL3.fc[2], ym2612.OPN.SL3.kcode[2] ); + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT3], ym2612.OPN.SL3.fc[0], ym2612.OPN.SL3.kcode[0] ); + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT4], ym2612.CH[2].fc , ym2612.CH[2].kcode ); + } + } else refresh_fc_eg_chan( &ym2612.CH[2] ); + refresh_fc_eg_chan( &ym2612.CH[3] ); + refresh_fc_eg_chan( &ym2612.CH[4] ); + refresh_fc_eg_chan( &ym2612.CH[5] ); + + memset(&sa, 0, sizeof(sa)); +//memcpy(&check_ym, &ym2612, sizeof(ym2612)); - // feed all the registers and update internal state - for(i = 0; i < 0x100; i++) { - YM2612Write_(0, i); - YM2612Write_(1, ym2612.REGS[i]); + // chans 1,2,3 + ptr = &ym2612.REGS[0x0b8]; + for (c = 0; c < 3; c++) + { + for (s = 0; s < 4; s++) { + ss.state_phase = (ym2612.CH[c].SLOT[s].state << 29) | (ym2612.CH[c].SLOT[s].phase >> 3); + ss.volume = ym2612.CH[c].SLOT[s].volume; + if (ym2612.CH[c].SLOT[s].key) + sa.keyon_field |= 1 << (c*4 + s); + memcpy(ptr, &ss, 6); + ptr += 6; + } + sa2.block_fnum[c] = ym2612.CH[c].block_fnum; + } + // chans 4,5,6 + ptr = &ym2612.REGS[0x1b8]; + for (; c < 6; c++) + { + for (s = 0; s < 4; s++) { + ss.state_phase = (ym2612.CH[c].SLOT[s].state << 29) | (ym2612.CH[c].SLOT[s].phase >> 3); + ss.volume = ym2612.CH[c].SLOT[s].volume; + if (ym2612.CH[c].SLOT[s].key) + sa.keyon_field |= 1 << (c*4 + s); + memcpy(ptr, &ss, 6); + ptr += 6; + } + sa2.block_fnum[c] = ym2612.CH[c].block_fnum; + } + for (c = 0; c < 3; c++) + { + sa2.block_fnum_sl3[c] = ym2612.OPN.SL3.block_fnum[c]; } - for(i = 0; i < 0x100; i++) { - YM2612Write_(2, i); - YM2612Write_(3, ym2612.REGS[i|0x100]); + memcpy(&ym2612.REGS[0], &sa2, sizeof(sa2)); // 0x20 max + + // other things + ptr = &ym2612.REGS[0x100]; + sa.magic = 0x41534d59; // 'YMSA' + sa.address = ym2612.OPN.ST.address; + sa.status = ym2612.OPN.ST.status; + sa.addr_A1 = ym2612.addr_A1; + sa.unused = 0; + sa.TAT = tat; + sa.TBT = tbt; + sa.eg_cnt = ym2612.OPN.eg_cnt; + sa.eg_timer = ym2612.OPN.eg_timer; + sa.lfo_cnt = ym2612.OPN.lfo_cnt; + sa.lfo_ampm = g_lfo_ampm; + sa.fn_h = ym2612.REGS[0xa4] = ym2612.OPN.ST.fn_h; + sa.fn_h_sl3 = ym2612.REGS[0xac] = ym2612.OPN.SL3.fn_h; + memcpy(ptr, &sa, sizeof(sa)); // 0x30 max +} + +int YM2612PicoStateLoad2(int *tat, int *tbt) +{ + ym_save_addon_slot ss; + ym_save_addon2 sa2; + ym_save_addon sa; + unsigned char *ptr; + UINT32 fn; + UINT8 blk; + int c, s; + + ptr = &ym2612.REGS[0x100]; + memcpy(&sa, ptr, sizeof(sa)); // 0x30 max + if (sa.magic != 0x41534d59) return -1; + + ptr = &ym2612.REGS[0]; + memcpy(&sa2, ptr, sizeof(sa2)); + + ym2612.OPN.ST.address = sa.address; + ym2612.OPN.ST.status = sa.status; + ym2612.addr_A1 = sa.addr_A1; + ym2612.OPN.eg_cnt = sa.eg_cnt; + ym2612.OPN.eg_timer = sa.eg_timer; + ym2612.OPN.lfo_cnt = sa.lfo_cnt; + g_lfo_ampm = sa.lfo_ampm; + if (tat != NULL) *tat = sa.TAT; + if (tbt != NULL) *tbt = sa.TBT; + + // chans 1,2,3 + ptr = &ym2612.REGS[0x0b8]; + for (c = 0; c < 3; c++) + { + for (s = 0; s < 4; s++) { + memcpy(&ss, ptr, 6); + ym2612.CH[c].SLOT[s].state = ss.state_phase >> 29; + ym2612.CH[c].SLOT[s].phase = ss.state_phase << 3; + ym2612.CH[c].SLOT[s].volume = ss.volume; + ym2612.CH[c].SLOT[s].key = (sa.keyon_field & (1 << (c*4 + s))) ? 1 : 0; + ym2612.CH[c].SLOT[s].ksr = (UINT8)-1; +//ym2612.CH[c].SLOT[s].Incr = check_ym.CH[c].SLOT[s].Incr; + ptr += 6; + } + ym2612.CH[c].SLOT[SLOT1].Incr=-1; + ym2612.CH[c].block_fnum = sa2.block_fnum[c]; + fn = ym2612.CH[c].block_fnum & 0x7ff; + blk = ym2612.CH[c].block_fnum >> 11; + ym2612.CH[c].kcode= (blk<<2) | opn_fktable[fn >> 7]; + ym2612.CH[c].fc = fn_table[fn*2]>>(7-blk); + } + // chans 4,5,6 + ptr = &ym2612.REGS[0x1b8]; + for (; c < 6; c++) + { + for (s = 0; s < 4; s++) { + memcpy(&ss, ptr, 6); + ym2612.CH[c].SLOT[s].state = ss.state_phase >> 29; + ym2612.CH[c].SLOT[s].phase = ss.state_phase << 3; + ym2612.CH[c].SLOT[s].volume = ss.volume; + ym2612.CH[c].SLOT[s].key = (sa.keyon_field & (1 << (c*4 + s))) ? 1 : 0; + ym2612.CH[c].SLOT[s].ksr = (UINT8)-1; +//ym2612.CH[c].SLOT[s].Incr = check_ym.CH[c].SLOT[s].Incr; + ptr += 6; + } + ym2612.CH[c].SLOT[SLOT1].Incr=-1; + ym2612.CH[c].block_fnum = sa2.block_fnum[c]; + fn = ym2612.CH[c].block_fnum & 0x7ff; + blk = ym2612.CH[c].block_fnum >> 11; + ym2612.CH[c].kcode= (blk<<2) | opn_fktable[fn >> 7]; + ym2612.CH[c].fc = fn_table[fn*2]>>(7-blk); + } + for (c = 0; c < 3; c++) + { + ym2612.OPN.SL3.block_fnum[c] = sa2.block_fnum_sl3[c]; + fn = ym2612.OPN.SL3.block_fnum[c] & 0x7ff; + blk = ym2612.OPN.SL3.block_fnum[c] >> 11; + ym2612.OPN.SL3.kcode[c]= (blk<<2) | opn_fktable[fn >> 7]; + ym2612.OPN.SL3.fc[c] = fn_table[fn*2]>>(7-blk); } - ym2612.addr_A1 = real_A1; -#else - reset_channels( &ym2612.CH[0] ); +#if 0 + refresh_fc_eg_chan( &ym2612.CH[0] ); + refresh_fc_eg_chan( &ym2612.CH[1] ); + if( (ym2612.OPN.ST.mode & 0xc0) ) + { + /* 3SLOT MODE */ + if( ym2612.CH[2].SLOT[SLOT1].Incr==-1) + { + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT1], ym2612.OPN.SL3.fc[1], ym2612.OPN.SL3.kcode[1] ); + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT2], ym2612.OPN.SL3.fc[2], ym2612.OPN.SL3.kcode[2] ); + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT3], ym2612.OPN.SL3.fc[0], ym2612.OPN.SL3.kcode[0] ); + refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT4], ym2612.CH[2].fc , ym2612.CH[2].kcode ); + } + } else refresh_fc_eg_chan( &ym2612.CH[2] ); + refresh_fc_eg_chan( &ym2612.CH[3] ); + refresh_fc_eg_chan( &ym2612.CH[4] ); + refresh_fc_eg_chan( &ym2612.CH[5] ); + + for (c = 0; c < 6; c++) + { + for (s = 0; s < 4; s++) + { + int i; + unsigned char *chk = ((unsigned char *) &check_ym.CH[c].SLOT[s]); + unsigned char *res = ((unsigned char *) &ym2612.CH[c].SLOT[s]); + + for (i = 0; i < sizeof(check_ym.CH[0].SLOT[0]); i++) + { + if (i != 0x0c && chk[i] != res[i]) + printf("ch[%i].slot[%i].%03x: %02x vs %02x\n", c, s, i, chk[i], res[i]); + } + } + + { + int i; + unsigned char *chk = ((unsigned char *) &check_ym.CH[c].ALGO); + unsigned char *res = ((unsigned char *) &ym2612.CH[c].ALGO); + + for (i = 0; i < 8*4; i++) + { + if ((i < 4 || i > 0x0b) && chk[i] != res[i]) + printf("ch[%i].%03x: %02x vs %02x\n", c, i, chk[i], res[i]); + } + } + } + + for (c = 0; c < sizeof(ym2612.OPN); c++) + { + unsigned char *chk = ((unsigned char *) &check_ym.OPN); + unsigned char *res = ((unsigned char *) &ym2612.OPN); + + if (chk[c] != res[c]) + { + printf("OPN: %03x: %02x vs %02x\n", c, chk[c], res[c]); + } + } #endif + + return 0; } #ifndef EXTERNAL_YM2612