line draw deferment implemented
[picodrive.git] / Pico / sound / ym2612.c
index 4b74826..56c363a 100644 (file)
@@ -381,7 +381,7 @@ static const UINT8 dt_tab[4 * 32]={
        5, 6, 6, 7, 8, 8, 9,10,11,12,13,14,16,16,16,16,\r
 /* FD=3 */\r
        2, 2, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7,\r
-       8 , 8, 9,10,11,12,13,14,16,17,19,20,22,22,22,22\r
+       8 ,8, 9,10,11,12,13,14,16,17,19,20,22,22,22,22\r
 };\r
 \r
 \r
@@ -889,7 +889,7 @@ static void chan_render_loop(chan_rend_context *ct, int *buffer, int length)
                {\r
                        int out = 0;\r
 \r
-                       if (ct->pack&0xf000) out = ((ct->op1_out>>16) + (ct->op1_out<<16>>16)) << ((ct->pack&0xf000)>>12); /* op1_out0 + op1_out1 */\r
+                       if (ct->pack&0xf000) out = ((ct->op1_out>>16) + ((ct->op1_out<<16)>>16)) << ((ct->pack&0xf000)>>12); /* op1_out0 + op1_out1 */\r
                        ct->op1_out <<= 16;\r
                        ct->op1_out |= (unsigned short)op_calc1(ct->phase1, eg_out, out);\r
                } else {\r
@@ -1087,12 +1087,25 @@ void chan_render_loop(chan_rend_context *ct, int *buffer, unsigned short length)
 \r
 static chan_rend_context crct;\r
 \r
+static void chan_render_prep(void)\r
+{\r
+       crct.eg_timer_add = ym2612.OPN.eg_timer_add;\r
+       crct.lfo_inc = ym2612.OPN.lfo_inc;\r
+}\r
+\r
+static void chan_render_finish(void)\r
+{\r
+       ym2612.OPN.eg_cnt = crct.eg_cnt;\r
+       ym2612.OPN.eg_timer = crct.eg_timer;\r
+       g_lfo_ampm = crct.pack >> 16; // need_save\r
+       ym2612.OPN.lfo_cnt = crct.lfo_cnt;\r
+}\r
+\r
 static int chan_render(int *buffer, int length, int c, UINT32 flags) // flags: stereo, ?, disabled, ?, pan_r, pan_l\r
 {\r
        crct.CH = &ym2612.CH[c];\r
        crct.mem = crct.CH->mem_value;          /* one sample delay memory */\r
        crct.lfo_cnt = ym2612.OPN.lfo_cnt;\r
-       crct.lfo_inc = ym2612.OPN.lfo_inc;\r
 \r
        flags &= 0x35;\r
 \r
@@ -1109,7 +1122,6 @@ static int chan_render(int *buffer, int length, int c, UINT32 flags) // flags: s
 \r
        crct.eg_cnt = ym2612.OPN.eg_cnt;                        /* envelope generator counter */\r
        crct.eg_timer = ym2612.OPN.eg_timer;\r
-       crct.eg_timer_add = ym2612.OPN.eg_timer_add;\r
 \r
        /* precalculate phase modulation incr */\r
        crct.phase1 = crct.CH->SLOT[SLOT1].phase;\r
@@ -1140,9 +1152,9 @@ static int chan_render(int *buffer, int length, int c, UINT32 flags) // flags: s
                        UINT32 fn;\r
                        int kc,fc;\r
 \r
+                       blk = block_fnum >> 11;\r
                        block_fnum = block_fnum*2 + lfo_fn_table_index_offset;\r
 \r
-                       blk = (block_fnum&0x7000) >> 12;\r
                        fn  = block_fnum & 0xfff;\r
 \r
                        /* keyscale code */\r
@@ -1185,25 +1197,20 @@ static int chan_render(int *buffer, int length, int c, UINT32 flags) // flags: s
        else\r
                ym2612.slot_mask &= ~(0xf << (c*4));\r
 \r
-       // if this the last call, write back persistent stuff:\r
-       if ((ym2612.slot_mask >> ((c+1)*4)) == 0)\r
-       {\r
-               ym2612.OPN.eg_cnt = crct.eg_cnt;\r
-               ym2612.OPN.eg_timer = crct.eg_timer;\r
-               g_lfo_ampm = crct.pack >> 16;\r
-               ym2612.OPN.lfo_cnt = crct.lfo_cnt;\r
-       }\r
-\r
        return (crct.algo & 8) >> 3; // had output\r
 }\r
 \r
 /* update phase increment and envelope generator */\r
 INLINE void refresh_fc_eg_slot(FM_SLOT *SLOT, int fc, int kc)\r
 {\r
-       int ksr;\r
+       int ksr, fdt;\r
 \r
        /* (frequency) phase increment counter */\r
-       SLOT->Incr = ((fc+SLOT->DT[kc])*SLOT->mul) >> 1;\r
+       fdt = fc+SLOT->DT[kc];\r
+       /* detect overflow */\r
+//     if (fdt < 0) fdt += fn_table[0x7ff*2] >> (7-blk-1);\r
+       if (fdt < 0) fdt += fn_table[0x7ff*2] >> 2;\r
+       SLOT->Incr = fdt*SLOT->mul >> 1;\r
 \r
        ksr = kc >> SLOT->KSR;\r
        if( SLOT->ksr != ksr )\r
@@ -1212,10 +1219,10 @@ INLINE void refresh_fc_eg_slot(FM_SLOT *SLOT, int fc, int kc)
                SLOT->ksr = ksr;\r
 \r
                /* calculate envelope generator rates */\r
-               if ((SLOT->ar + SLOT->ksr) < 32+62)\r
+               if ((SLOT->ar + ksr) < 32+62)\r
                {\r
-                       eg_sh  = eg_rate_shift [SLOT->ar  + SLOT->ksr ];\r
-                       eg_sel = eg_rate_select[SLOT->ar  + SLOT->ksr ];\r
+                       eg_sh  = eg_rate_shift [SLOT->ar  + ksr ];\r
+                       eg_sel = eg_rate_select[SLOT->ar  + ksr ];\r
                }\r
                else\r
                {\r
@@ -1225,18 +1232,18 @@ INLINE void refresh_fc_eg_slot(FM_SLOT *SLOT, int fc, int kc)
 \r
                SLOT->eg_pack_ar = eg_inc_pack[eg_sel] | (eg_sh<<24);\r
 \r
-               eg_sh  = eg_rate_shift [SLOT->d1r + SLOT->ksr];\r
-               eg_sel = eg_rate_select[SLOT->d1r + SLOT->ksr];\r
+               eg_sh  = eg_rate_shift [SLOT->d1r + ksr];\r
+               eg_sel = eg_rate_select[SLOT->d1r + ksr];\r
 \r
                SLOT->eg_pack_d1r = eg_inc_pack[eg_sel] | (eg_sh<<24);\r
 \r
-               eg_sh  = eg_rate_shift [SLOT->d2r + SLOT->ksr];\r
-               eg_sel = eg_rate_select[SLOT->d2r + SLOT->ksr];\r
+               eg_sh  = eg_rate_shift [SLOT->d2r + ksr];\r
+               eg_sel = eg_rate_select[SLOT->d2r + ksr];\r
 \r
                SLOT->eg_pack_d2r = eg_inc_pack[eg_sel] | (eg_sh<<24);\r
 \r
-               eg_sh  = eg_rate_shift [SLOT->rr  + SLOT->ksr];\r
-               eg_sel = eg_rate_select[SLOT->rr  + SLOT->ksr];\r
+               eg_sh  = eg_rate_shift [SLOT->rr  + ksr];\r
+               eg_sel = eg_rate_select[SLOT->rr  + ksr];\r
 \r
                SLOT->eg_pack_rr = eg_inc_pack[eg_sel] | (eg_sh<<24);\r
        }\r
@@ -1255,6 +1262,17 @@ INLINE void refresh_fc_eg_chan(FM_CH *CH)
        }\r
 }\r
 \r
+INLINE void refresh_fc_eg_chan_sl3(void)\r
+{\r
+       if( ym2612.CH[2].SLOT[SLOT1].Incr==-1)\r
+       {\r
+               refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT1], ym2612.OPN.SL3.fc[1], ym2612.OPN.SL3.kcode[1] );\r
+               refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT2], ym2612.OPN.SL3.fc[2], ym2612.OPN.SL3.kcode[2] );\r
+               refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT3], ym2612.OPN.SL3.fc[0], ym2612.OPN.SL3.kcode[0] );\r
+               refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT4], ym2612.CH[2].fc , ym2612.CH[2].kcode );\r
+       }\r
+}\r
+\r
 /* initialize time tables */\r
 static void init_timetables(const UINT8 *dttable)\r
 {\r
@@ -1290,6 +1308,7 @@ static void reset_channels(FM_CH *CH)
                        CH[c].SLOT[s].state= EG_OFF;\r
                        CH[c].SLOT[s].volume = MAX_ATT_INDEX;\r
                }\r
+               CH[c].mem_value = CH[c].op1_out = 0;\r
        }\r
        ym2612.slot_mask = 0;\r
 }\r
@@ -1424,7 +1443,6 @@ static void OPNSetPres(int pres)
 \r
        ym2612.OPN.eg_timer_add  = (1<<EG_SH) * ym2612.OPN.ST.freqbase;\r
 \r
-\r
        /* make time tables */\r
        init_timetables( dt_tab );\r
 \r
@@ -1478,17 +1496,17 @@ static int OPNWriteReg(int r, int v)
                set_ar_ksr(CH,SLOT,v);\r
                break;\r
 \r
-       case 0x60:      /* bit7 = AM ENABLE, DR */\r
+       case 0x60:      /* bit7 = AM ENABLE, DR | depends on ksr */\r
                set_dr(SLOT,v);\r
                if(v&0x80) CH->AMmasks |=   1<<OPN_SLOT(r);\r
                else       CH->AMmasks &= ~(1<<OPN_SLOT(r));\r
                break;\r
 \r
-       case 0x70:      /*     SR */\r
+       case 0x70:      /*     SR | depends on ksr */\r
                set_sr(SLOT,v);\r
                break;\r
 \r
-       case 0x80:      /* SL, RR */\r
+       case 0x80:      /* SL, RR | depends on ksr */\r
                set_sl_rr(SLOT,v);\r
                break;\r
 \r
@@ -1499,10 +1517,10 @@ static int OPNWriteReg(int r, int v)
 \r
        case 0xa0:\r
                switch( OPN_SLOT(r) ){\r
-               case 0:         /* 0xa0-0xa2 : FNUM1 */\r
+               case 0:         /* 0xa0-0xa2 : FNUM1 | depends on fn_h (below) */\r
                        {\r
-                               UINT32 fn = (((UINT32)( (ym2612.OPN.ST.fn_h)&7))<<8) + v;\r
-                               UINT8 blk = ym2612.OPN.ST.fn_h>>3;\r
+                               UINT32 fn = (((UINT32)( (CH->fn_h)&7))<<8) + v;\r
+                               UINT8 blk = CH->fn_h>>3;\r
                                /* keyscale code */\r
                                CH->kcode = (blk<<2) | opn_fktable[fn >> 7];\r
                                /* phase increment counter */\r
@@ -1515,7 +1533,7 @@ static int OPNWriteReg(int r, int v)
                        }\r
                        break;\r
                case 1:         /* 0xa4-0xa6 : FNUM2,BLK */\r
-                       ym2612.OPN.ST.fn_h = v&0x3f;\r
+                       CH->fn_h = v&0x3f;\r
                        ret = 0;\r
                        break;\r
                case 2:         /* 0xa8-0xaa : 3CH FNUM1 */\r
@@ -1527,7 +1545,7 @@ static int OPNWriteReg(int r, int v)
                                ym2612.OPN.SL3.kcode[c]= (blk<<2) | opn_fktable[fn >> 7];\r
                                /* phase increment counter */\r
                                ym2612.OPN.SL3.fc[c] = fn_table[fn*2]>>(7-blk);\r
-                               ym2612.OPN.SL3.block_fnum[c] = fn;\r
+                               ym2612.OPN.SL3.block_fnum[c] = (blk<<11) | fn;\r
                                ym2612.CH[2].SLOT[SLOT1].Incr=-1;\r
                        }\r
                        break;\r
@@ -1615,16 +1633,10 @@ int YM2612UpdateOne_(int *buffer, int length, int stereo, int is_buf_empty)
        refresh_fc_eg_chan( &ym2612.CH[0] );\r
        refresh_fc_eg_chan( &ym2612.CH[1] );\r
        if( (ym2612.OPN.ST.mode & 0xc0) )\r
-       {\r
                /* 3SLOT MODE */\r
-               if( ym2612.CH[2].SLOT[SLOT1].Incr==-1)\r
-               {\r
-                       refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT1], ym2612.OPN.SL3.fc[1], ym2612.OPN.SL3.kcode[1] );\r
-                       refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT2], ym2612.OPN.SL3.fc[2], ym2612.OPN.SL3.kcode[2] );\r
-                       refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT3], ym2612.OPN.SL3.fc[0], ym2612.OPN.SL3.kcode[0] );\r
-                       refresh_fc_eg_slot(&ym2612.CH[2].SLOT[SLOT4], ym2612.CH[2].fc , ym2612.CH[2].kcode );\r
-               }\r
-       } else refresh_fc_eg_chan( &ym2612.CH[2] );\r
+               refresh_fc_eg_chan_sl3();\r
+       else\r
+               refresh_fc_eg_chan( &ym2612.CH[2] );\r
        refresh_fc_eg_chan( &ym2612.CH[3] );\r
        refresh_fc_eg_chan( &ym2612.CH[4] );\r
        refresh_fc_eg_chan( &ym2612.CH[5] );\r
@@ -1634,12 +1646,14 @@ int YM2612UpdateOne_(int *buffer, int length, int stereo, int is_buf_empty)
 \r
        /* mix to 32bit dest */\r
        // flags: stereo, ?, disabled, ?, pan_r, pan_l\r
+       chan_render_prep();\r
        if (ym2612.slot_mask & 0x00000f) active_chs |= chan_render(buffer, length, 0, stereo|((pan&0x003)<<4)) << 0;\r
        if (ym2612.slot_mask & 0x0000f0) active_chs |= chan_render(buffer, length, 1, stereo|((pan&0x00c)<<2)) << 1;\r
        if (ym2612.slot_mask & 0x000f00) active_chs |= chan_render(buffer, length, 2, stereo|((pan&0x030)   )) << 2;\r
        if (ym2612.slot_mask & 0x00f000) active_chs |= chan_render(buffer, length, 3, stereo|((pan&0x0c0)>>2)) << 3;\r
        if (ym2612.slot_mask & 0x0f0000) active_chs |= chan_render(buffer, length, 4, stereo|((pan&0x300)>>4)) << 4;\r
        if (ym2612.slot_mask & 0xf00000) active_chs |= chan_render(buffer, length, 5, stereo|((pan&0xc00)>>6)|(ym2612.dacen<<2)) << 5;\r
+       chan_render_finish();\r
 \r
        return active_chs; // 1 if buffer updated\r
 }\r
@@ -1765,11 +1779,11 @@ int YM2612Write_(unsigned int a, unsigned int v)
                                }\r
                                ret=0;\r
                                break;\r
+#endif\r
                        case 0x27:      /* mode, timer control */\r
                                set_timers( v );\r
                                ret=0;\r
                                break;\r
-#endif\r
                        case 0x28:      /* key on / off */\r
                                {\r
                                        UINT8 c;\r
@@ -1783,7 +1797,6 @@ int YM2612Write_(unsigned int a, unsigned int v)
                                        if(v&0x80) FM_KEYON(c,SLOT4); else FM_KEYOFF(c,SLOT4);\r
                                        break;\r
                                }\r
-#if 0\r
                        case 0x2a:      /* DAC data (YM2612) */\r
                                ym2612.dacout = ((int)v - 0x80) << 6;   /* level unknown (notaz: 8 seems to be too much) */\r
                                ret=0;\r
@@ -1793,7 +1806,6 @@ int YM2612Write_(unsigned int a, unsigned int v)
                                ym2612.dacen = v & 0x80;\r
                                ret=0;\r
                                break;\r
-#endif\r
                        default:\r
                                break;\r
                        }\r
@@ -1821,12 +1833,7 @@ int YM2612Write_(unsigned int a, unsigned int v)
                ret = OPNWriteReg(addr, v);\r
                break;\r
        }\r
-/*\r
-       if(ret) {\r
-               extern int Scanline;\r
-               dprintf("ymw [%i]", Scanline);\r
-       }\r
-*/\r
+\r
        return ret;\r
 }\r
 \r
@@ -1864,6 +1871,181 @@ int YM2612PicoTick_(int n)
 void YM2612PicoStateLoad_(void)\r
 {\r
        reset_channels( &ym2612.CH[0] );\r
+       ym2612.slot_mask = 0xffffff;\r
+}\r
+\r
+/* rather stupid design because I wanted to fit in unused register "space" */\r
+typedef struct\r
+{\r
+       UINT32  state_phase;\r
+       INT16   volume;\r
+} ym_save_addon_slot;\r
+\r
+typedef struct\r
+{\r
+       UINT32  magic;\r
+       UINT8   address;\r
+       UINT8   status;\r
+       UINT8   addr_A1;\r
+       UINT8   unused;\r
+       int     TAT;\r
+       int     TBT;\r
+       UINT32  eg_cnt;         // 10\r
+       UINT32  eg_timer;\r
+       UINT32  lfo_cnt;\r
+       UINT16  lfo_ampm;\r
+       UINT16  unused2;\r
+       UINT32  keyon_field;    // 20\r
+       UINT32  kcode_fc_sl3_3;\r
+       UINT32  reserved[2];\r
+} ym_save_addon;\r
+\r
+typedef struct\r
+{\r
+       UINT16  block_fnum[6];\r
+       UINT16  block_fnum_sl3[3];\r
+       UINT16  reserved[7];\r
+} ym_save_addon2;\r
+\r
+\r
+void YM2612PicoStateSave2(int tat, int tbt)\r
+{\r
+       ym_save_addon_slot ss;\r
+       ym_save_addon2 sa2;\r
+       ym_save_addon sa;\r
+       unsigned char *ptr;\r
+       int c, s;\r
+\r
+       memset(&sa, 0, sizeof(sa));\r
+       memset(&sa2, 0, sizeof(sa2));\r
+\r
+       // chans 1,2,3\r
+       ptr = &ym2612.REGS[0x0b8];\r
+       for (c = 0; c < 3; c++)\r
+       {\r
+               for (s = 0; s < 4; s++) {\r
+                       ss.state_phase = (ym2612.CH[c].SLOT[s].state << 29) | (ym2612.CH[c].SLOT[s].phase >> 3);\r
+                       ss.volume = ym2612.CH[c].SLOT[s].volume;\r
+                       if (ym2612.CH[c].SLOT[s].key)\r
+                               sa.keyon_field |= 1 << (c*4 + s);\r
+                       memcpy(ptr, &ss, 6);\r
+                       ptr += 6;\r
+               }\r
+               sa2.block_fnum[c] = ym2612.CH[c].block_fnum;\r
+       }\r
+       // chans 4,5,6\r
+       ptr = &ym2612.REGS[0x1b8];\r
+       for (; c < 6; c++)\r
+       {\r
+               for (s = 0; s < 4; s++) {\r
+                       ss.state_phase = (ym2612.CH[c].SLOT[s].state << 29) | (ym2612.CH[c].SLOT[s].phase >> 3);\r
+                       ss.volume = ym2612.CH[c].SLOT[s].volume;\r
+                       if (ym2612.CH[c].SLOT[s].key)\r
+                               sa.keyon_field |= 1 << (c*4 + s);\r
+                       memcpy(ptr, &ss, 6);\r
+                       ptr += 6;\r
+               }\r
+               sa2.block_fnum[c] = ym2612.CH[c].block_fnum;\r
+       }\r
+       for (c = 0; c < 3; c++)\r
+       {\r
+               sa2.block_fnum_sl3[c] = ym2612.OPN.SL3.block_fnum[c];\r
+       }\r
+\r
+       memcpy(&ym2612.REGS[0], &sa2, sizeof(sa2)); // 0x20 max\r
+\r
+       // other things\r
+       ptr = &ym2612.REGS[0x100];\r
+       sa.magic = 0x41534d59; // 'YMSA'\r
+       sa.address = ym2612.OPN.ST.address;\r
+       sa.status  = ym2612.OPN.ST.status;\r
+       sa.addr_A1 = ym2612.addr_A1;\r
+       sa.TAT     = tat;\r
+       sa.TBT     = tbt;\r
+       sa.eg_cnt  = ym2612.OPN.eg_cnt;\r
+       sa.eg_timer = ym2612.OPN.eg_timer;\r
+       sa.lfo_cnt  = ym2612.OPN.lfo_cnt;\r
+       sa.lfo_ampm = g_lfo_ampm;\r
+       memcpy(ptr, &sa, sizeof(sa)); // 0x30 max\r
+}\r
+\r
+int YM2612PicoStateLoad2(int *tat, int *tbt)\r
+{\r
+       ym_save_addon_slot ss;\r
+       ym_save_addon2 sa2;\r
+       ym_save_addon sa;\r
+       unsigned char *ptr;\r
+       UINT32 fn;\r
+       UINT8 blk;\r
+       int c, s;\r
+\r
+       ptr = &ym2612.REGS[0x100];\r
+       memcpy(&sa, ptr, sizeof(sa)); // 0x30 max\r
+       if (sa.magic != 0x41534d59) return -1;\r
+\r
+       ptr = &ym2612.REGS[0];\r
+       memcpy(&sa2, ptr, sizeof(sa2));\r
+\r
+       ym2612.OPN.ST.address = sa.address;\r
+       ym2612.OPN.ST.status = sa.status;\r
+       ym2612.addr_A1 = sa.addr_A1;\r
+       ym2612.OPN.eg_cnt = sa.eg_cnt;\r
+       ym2612.OPN.eg_timer = sa.eg_timer;\r
+       ym2612.OPN.lfo_cnt = sa.lfo_cnt;\r
+       g_lfo_ampm = sa.lfo_ampm;\r
+       if (tat != NULL) *tat = sa.TAT;\r
+       if (tbt != NULL) *tbt = sa.TBT;\r
+\r
+       // chans 1,2,3\r
+       ptr = &ym2612.REGS[0x0b8];\r
+       for (c = 0; c < 3; c++)\r
+       {\r
+               for (s = 0; s < 4; s++) {\r
+                       memcpy(&ss, ptr, 6);\r
+                       ym2612.CH[c].SLOT[s].state = ss.state_phase >> 29;\r
+                       ym2612.CH[c].SLOT[s].phase = ss.state_phase << 3;\r
+                       ym2612.CH[c].SLOT[s].volume = ss.volume;\r
+                       ym2612.CH[c].SLOT[s].key = (sa.keyon_field & (1 << (c*4 + s))) ? 1 : 0;\r
+                       ym2612.CH[c].SLOT[s].ksr = (UINT8)-1;\r
+                       ptr += 6;\r
+               }\r
+               ym2612.CH[c].SLOT[SLOT1].Incr=-1;\r
+               ym2612.CH[c].block_fnum = sa2.block_fnum[c];\r
+               fn = ym2612.CH[c].block_fnum & 0x7ff;\r
+               blk = ym2612.CH[c].block_fnum >> 11;\r
+               ym2612.CH[c].kcode= (blk<<2) | opn_fktable[fn >> 7];\r
+               ym2612.CH[c].fc = fn_table[fn*2]>>(7-blk);\r
+       }\r
+       // chans 4,5,6\r
+       ptr = &ym2612.REGS[0x1b8];\r
+       for (; c < 6; c++)\r
+       {\r
+               for (s = 0; s < 4; s++) {\r
+                       memcpy(&ss, ptr, 6);\r
+                       ym2612.CH[c].SLOT[s].state = ss.state_phase >> 29;\r
+                       ym2612.CH[c].SLOT[s].phase = ss.state_phase << 3;\r
+                       ym2612.CH[c].SLOT[s].volume = ss.volume;\r
+                       ym2612.CH[c].SLOT[s].key = (sa.keyon_field & (1 << (c*4 + s))) ? 1 : 0;\r
+                       ym2612.CH[c].SLOT[s].ksr = (UINT8)-1;\r
+                       ptr += 6;\r
+               }\r
+               ym2612.CH[c].SLOT[SLOT1].Incr=-1;\r
+               ym2612.CH[c].block_fnum = sa2.block_fnum[c];\r
+               fn = ym2612.CH[c].block_fnum & 0x7ff;\r
+               blk = ym2612.CH[c].block_fnum >> 11;\r
+               ym2612.CH[c].kcode= (blk<<2) | opn_fktable[fn >> 7];\r
+               ym2612.CH[c].fc = fn_table[fn*2]>>(7-blk);\r
+       }\r
+       for (c = 0; c < 3; c++)\r
+       {\r
+               ym2612.OPN.SL3.block_fnum[c] = sa2.block_fnum_sl3[c];\r
+               fn = ym2612.OPN.SL3.block_fnum[c] & 0x7ff;\r
+               blk = ym2612.OPN.SL3.block_fnum[c] >> 11;\r
+               ym2612.OPN.SL3.kcode[c]= (blk<<2) | opn_fktable[fn >> 7];\r
+               ym2612.OPN.SL3.fc[c] = fn_table[fn*2]>>(7-blk);\r
+       }\r
+\r
+       return 0;\r
 }\r
 \r
 #ifndef EXTERNAL_YM2612\r