#include "fmdriver_fmp.h" #include "fmdriver_common.h" static uint8_t fmp_rand71(struct driver_fmp *fmp) { // on real PC-98, read from I/O port 0x71 (8253 Timer) uint8_t val = fmp->rand71; fmp->rand71 = (val>>1) | ((((val>>7)^(val>>5)^(val>>4)^(val>>3)^1)&1)<<7); return fmp->rand71; } static uint8_t fmp_part_cmdload(struct driver_fmp *fmp, struct fmp_part *part) { if (part->current_ptr >= fmp->datalen) { //exit(2); part->current_ptr = 0xffff; return 0x74; } return fmp->data[part->current_ptr++]; } static uint8_t fmp_part_cmdload_rhythm(struct driver_fmp *fmp, struct fmp_part *part) { if (part->current_ptr >= fmp->datalen) { part->current_ptr = 0xffff; return 0x93; } return fmp->data[part->current_ptr++]; } static uint16_t fmp_part_cmdload16(struct driver_fmp *fmp, struct fmp_part *part) { uint16_t val = fmp_part_cmdload(fmp, part); val |= fmp_part_cmdload(fmp, part) << 8; return val; } enum { OPNA_DTMUL = 0x30, OPNA_TL = 0x40, OPNA_KSAR = 0x50, OPNA_AMDR = 0x60, OPNA_SR = 0x70, OPNA_SLRR = 0x80, OPNA_SSGEG = 0x90, OPNA_FNUM1 = 0xa0, OPNA_BLKFNUM2 = 0xa4, OPNA_FBALG = 0xb0, OPNA_LRAMSPMS = 0xb4, }; static void fmp_part_fm_reg_write(struct fmdriver_work *work, struct fmp_part *part, uint8_t addr, uint8_t data) { uint16_t outaddr = part->opna_keyon_out & 0x3; if (part->opna_keyon_out & 0x4) outaddr += 0x100; outaddr += addr; work->opna_writereg(work, outaddr, data); } // 30ec static uint16_t fmp_fm_freq(uint8_t note) { // 3106 static const uint16_t freqtab[0xc] = { 0x026a, 0x028f, 0x02b6, 0x02df, 0x030b, 0x0339, 0x036a, 0x039e, 0x03d5, 0x0410, 0x044e, 0x048f, }; return freqtab[note%0xc] + ((note/0xc)<<(3+8)); } static uint8_t fmp_fm_freq2key(uint16_t freq) { int block = freq >> (8+3); int f_num = freq & ((1<<(8+3))-1); if (!f_num) return 0x00; while (!(f_num & (1<<(8+3-1)))) { f_num <<= 1; block--; } static const uint16_t freqtab[0xc] = { 0x042e, // < 9 (a) 0x046e, 0x04b1, 0x04f9, 0x0544, 0x0595, 0x05ea, 0x0644, 0x06a3, 0x0708, 0x0773, 0x07e4, }; int note = 0; for (; note < 12; note++) { if (f_num < freqtab[note]) break; } note += 9; block += (note/12); note %= 12; if (block < 0) return 0x00; if (block > 8) return 0x8b; return (block << 4) | note; } static uint8_t fmp_ssg_octave(uint8_t note) { return note/0xc; } static uint16_t fmp_ppz_freq(uint8_t note) { static const uint16_t freqtab[0xc] = { 0x8000, 0x87a6, 0x8fb3, 0x9838, 0xa146, 0xaade, 0xb4ff, 0xbfcc, 0xcb34, 0xd747, 0xe418, 0xf1a5, }; return freqtab[note%0xc]; } // 311e static uint16_t fmp_part_ssg_freq(struct fmp_part *part, uint8_t note) { // 315a static const uint16_t freqtab[0xc] = { 0x0ee8, 0x0e12, 0x0d48, 0x0c89, 0x0bd5, 0x0b2b, 0x0a8a, 0x09f3, 0x0964, 0x08dd, 0x085e, 0x07e6, }; uint16_t freq = part->u.ssg.env_f.ppz ? fmp_ppz_freq(note) : freqtab[note%0xc]; return part->detune + freq; } static uint8_t fmp_ssg_freq2key(uint16_t freq) { if (!freq) return 0x00; int octave = -5; while (!(freq & 0x8000)) { freq <<= 1; octave++; } // 7987200.0 / (64*440*(2**((i+2+0.5)/12))/(1<<8)) static const uint16_t freqtab[0xc] = { 0xf57f, // > 0 (c) 0xe7b8, 0xdab7, 0xce70, 0xc2da, 0xb7ea, 0xad98, 0xa3da, 0x9aa7, 0x91f9, 0x89c8, 0x820c, }; int note = 0; for (; note < 12; note++) { if (freq > freqtab[note]) break; } note += 11; octave += (note/12); note %= 12; if (octave < 0) return 0x00; if (octave > 8) return 0x8b; return (octave << 4) | note; } // 3172 static uint16_t fmp_adpcm_freq(uint8_t note) { static const uint16_t freqtab[4][0xc] = { { 0xdb22, 0xdd53, 0xdfa6, 0xe21c, 0xe4b7, 0xe777, 0xea65, 0xed7f, 0xf0c8, 0xf443, 0xf7f4, 0xfbdc }, { 0x0000, 0x0463, 0x0909, 0x0df6, 0x132d, 0x1864, 0x1e8a, 0x24bd, 0x2b4e, 0x3244, 0x39a3, 0x4173 }, { 0x49ba, 0x527e, 0x5bc8, 0x65a0, 0x700d, 0x7b19, 0x86cc, 0x9336, 0xa057, 0xae42, 0xbd01, 0xcca2 }, { 0xc8b4, 0xc9cc, 0xcaf5, 0xcc30, 0xcd7e, 0xcedf, 0xd056, 0xd1e3, 0xd387, 0xd544, 0xd71c, 0xd911 } }; uint16_t octave = note / 0xc; octave = (octave - 3) & 3; return freqtab[octave][note%0xc]; } static uint8_t fmp_pdzf_vol_clamp(uint8_t v, uint8_t ev) { int16_t ret = v + u8s16(ev); if (ret < 0) ret = 0; if (ret > 0xf) ret = 0xf; return ret; } static void fmp_part_pdzf_vol_update(struct fmdriver_work *work, struct fmp_part *part) { part->pdzf.vol = part->type.fm ? (0x7f-part->current_vol)&0xf : part->current_vol - 1; if (part->pdzf.mode) { uint8_t envvol = part->lfo_f.q ? part->pdzf.env_state.vol : 0; if (work->ppz8_functbl) { work->ppz8_functbl->channel_volume( work->ppz8, part->pdzf.ppz8_channel, fmp_pdzf_vol_clamp(part->pdzf.vol, envvol) ); } } } // 29e7 static void fmp_part_fm_vol(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { fmp_part_pdzf_vol_update(work, part); uint8_t pvol = part->actual_vol + fmp->fm_vol; if (pvol & 0x80) { if (fmp->fm_vol & 0x80) { pvol = 0; } else { pvol = 0x7f; } } for (int s = 0; s < 4; s++) { // 2a16 if (!(part->slot_vol_mask & (1<u.fm.slot_rel_vol[s]; if (svol & 0x80) { if (part->u.fm.slot_rel_vol[s] & 0x80) { svol = 0x7f; } else { svol = 0; } } // 2a31 if (fmp->data_version >= 6) { svol += part->u.fm.tone_tl[s]; if (svol & 0x80) svol = 0x7f; } if (!(part->u.fm.slot_mask & (1<opna_writereg(work, 0x27, fmp->timer_ch3 | 0x2a); } // 326a static void fmp_set_tempo(struct fmdriver_work *work, struct driver_fmp *fmp) { work->opna_writereg(work, 0x26, fmp->timerb); fmp_set_timer_ch3(work, fmp); } // 2979 static void fmp_part_keyoff_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { // 2979 uint8_t out = part->opna_keyon_out; if (part->type.fm_3) { fmp->fm3_slot_keyon &= (part->u.fm.slot_mask | 0x0f); out |= fmp->fm3_slot_keyon; } work->opna_writereg(work, 0x28, out); } // 2961 static void fmp_part_keyoff(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { part->ext_keyon = 0; part->status.tie_cont = false; if (part->type.adpcm) return; if (!part->type.ssg) { fmp_part_keyoff_fm(work, fmp, part); } else { // 29a9 part->u.ssg.curr_vol = 0xff; if (!part->u.ssg.env.release_rate) part->actual_vol = 0; part->u.ssg.env_f.portamento = true; part->u.ssg.env_f.attack = false; } if (part->pdzf.mode) { part->pdzf.keyon = false; if (part->lfo_f.q && part->pdzf.env_param.rr) { part->pdzf.env_state.status = PDZF_ENV_REL; part->pdzf.env_state.cnt = part->pdzf.env_param.rr; } else { part->pdzf.env_state.status = PDZF_ENV_OFF; if (work->ppz8_functbl) { work->ppz8_functbl->channel_stop( work->ppz8, part->pdzf.ppz8_channel ); } } } } // 1fc8 static bool fmp_cmd62_tempo(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t tempo = fmp_part_cmdload(fmp, part); fmp->timerb_bak = tempo; fmp->timerb = tempo; fmp_set_tempo(work, fmp); return true; } // 2067 static bool fmp_cmd63_vol_d_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t vol = fmp_part_cmdload(fmp, part); part->current_vol = vol; part->actual_vol = vol; fmp_part_fm_vol(work, fmp, part); return true; } static void fmp_ssg_ppz8_pdzf_mode_update(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t prev_mode = part->pdzf.mode; uint8_t mask = 9 << part->opna_keyon_out; if ((fmp->ssg_mix & mask) == mask) { part->u.ssg.env_f.ppz = true; part->pdzf.mode = 0; } else { part->u.ssg.env_f.ppz = false; if (fmp->pdzf.mode == 2) { part->pdzf.mode = (part->u.ssg.envbak.startvol || part->u.ssg.envbak.attack_rate) ? 0 : 2; } } if (prev_mode && !part->pdzf.mode) { part->pdzf.keyon = false; if (work->ppz8_functbl) { work->ppz8_functbl->channel_stop( work->ppz8, part->pdzf.ppz8_channel ); } } } // 23a2 static bool fmp_cmd63_mix_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t val = fmp_part_cmdload(fmp, part); if (val & 0x80) { // 23a6 fmp->ssg_mix &= val; //fmp->ssg_mix_se &= val; val = fmp_part_cmdload(fmp, part); fmp->ssg_mix |= val; //fmp->ssg_mix_se |= val; fmp_ssg_ppz8_pdzf_mode_update(work, fmp, part); // 23e4 work->opna_writereg(work, 0x07, fmp->ssg_mix); // 23ec } else { // 23f7 fmp_part_cmdload(fmp, part); fmp_part_cmdload16(fmp, part); // TODO: PPZ } return true; } // 2574 static bool fmp_cmd63_vol_d_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t vol = fmp_part_cmdload(fmp, part); part->current_vol = vol; part->actual_vol = vol; work->opna_writereg(work, 0x10b, vol); return true; } // 1fd9 static bool fmp_cmd64_loop(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t loop = fmp_part_cmdload(fmp, part); if (--loop) { ((uint8_t *)fmp->data)[part->current_ptr-1] = loop; uint16_t ptr_diff = fmp_part_cmdload16(fmp, part); part->current_ptr -= ptr_diff; } else { part->current_ptr += 3; if (part->current_ptr < fmp->datalen) { ((uint8_t *)fmp->data)[part->current_ptr-4] = fmp->data[part->current_ptr-1]; } } return true; } // 1fee static bool fmp_cmd65_loopend(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint16_t ptr_diff = fmp_part_cmdload16(fmp, part); if ((part->current_ptr+ptr_diff-4) >= fmp->datalen) { part->current_ptr = 0xffff; } else if (fmp->data[part->current_ptr+ptr_diff-4] == 1) { part->current_ptr += ptr_diff; ((uint8_t *)fmp->data)[part->current_ptr-4] = fmp->data[part->current_ptr-1]; } return true; } // 1fff static bool fmp_cmd66_tie(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; (void)fmp; part->status.tie = true; part->status.slur = false; return true; } // 200f static bool fmp_cmd67_q(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; //TODO if (fmp->datainfo.flags.q) { part->gate_cnt = fmp_part_cmdload(fmp, part); } else { part->gate_cmp = fmp_part_cmdload(fmp, part); } return true; } // 201e static bool fmp_cmd68_pitchbend(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t note = fmp_part_cmdload(fmp, part); note += part->note_diff; if (note > 0x60) note = 0; part->pit.target_note = note; uint16_t freq; if (!part->type.ssg) { freq = fmp_fm_freq(note); } else { freq = fmp_part_ssg_freq(part, note) >> fmp_ssg_octave(note); } part->pit.target_freq = freq; part->pit.delay = fmp_part_cmdload(fmp, part); part->pit.speed = fmp_part_cmdload(fmp, part); part->pit.speed_cnt = part->pit.speed; uint8_t rate = fmp_part_cmdload(fmp, part); if (!part->type.fm) rate = -rate; part->pit.rate = rate; part->status.pitchbend = true; return true; } // 25e3 static bool fmp_cmd68_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; fmp_part_cmdload(fmp, part); return true; } // 205d static bool fmp_cmd69_vol_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { static const uint8_t voltbl[16] = { 64, 59, 56, 52, 48, 42, 40, 37, 34, 32, 29, 26, 24, 21, 18, 16, }; uint8_t index = fmp_part_cmdload(fmp, part); uint8_t vol = (index < 16) ? voltbl[index] : 0x7f; part->current_vol = vol; part->actual_vol = vol; fmp_part_fm_vol(work, fmp, part); return true; } // 2362 static void fmp_part_ppz8_vol(struct fmdriver_work *work, struct fmp_part *part) { uint8_t vol = part->current_vol - 1; if (vol > 0xf) vol = 0xf; if (work->ppz8_functbl) { work->ppz8_functbl->channel_volume(work->ppz8, part->opna_keyon_out, vol); } } // 234d static void fmp_part_ssg_vol(struct fmdriver_work *work, struct fmp_part *part) { fmp_part_pdzf_vol_update(work, part); if (!part->u.ssg.env_f.ppz) { // 2353 uint8_t vol = part->current_vol; part->u.ssg.vol = ((unsigned)(vol-1) << 8)/vol; } else { fmp_part_ppz8_vol(work, part); } } // 2348 static bool fmp_cmd69_vol_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->current_vol = fmp_part_cmdload(fmp, part) + 1; // added to prevent zero division if (!part->current_vol) part->current_vol = 1; fmp_part_ssg_vol(work, part); return true; } static bool fmp_cmd69_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { // 205d: invalid command for adpcm part (void)work; fmp_part_cmdload(fmp, part); return true; } static void fmp_part_fm_relvol(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part, uint8_t vol) { uint8_t newvol = part->current_vol - vol; if (newvol & 0x80) { newvol = (vol & 0x80) ? 0x7f : 0; } part->current_vol = newvol; part->actual_vol = newvol; fmp_part_fm_vol(work, fmp, part); } // 2080 static bool fmp_cmd6a_voldec_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { fmp_part_fm_relvol(work, fmp, part, -3); return true; } // 2086 static bool fmp_cmd6b_volinc_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { fmp_part_fm_relvol(work, fmp, part, 3); return true; } // 238a static bool fmp_cmd6a_voldec_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)fmp; (void)work; if (part->current_vol > 1) part->current_vol--; if (!part->current_vol) part->current_vol = 1; fmp_part_ssg_vol(work, part); return true; } // 2396 static bool fmp_cmd6b_volinc_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)fmp; (void)work; if (part->current_vol < 0x10) part->current_vol++; fmp_part_ssg_vol(work, part); return true; } // 25f5 static void fmp_part_adpcm_relvol(struct fmdriver_work *work, struct fmp_part *part, uint8_t vol) { uint16_t relvol = vol; if (vol & 0x80) relvol |= 0xff00; uint16_t newvol = part->current_vol + relvol; if (newvol & 0x100) { newvol = (vol & 0x80) ? 0 : 0xff; } part->current_vol = newvol; part->actual_vol = newvol; work->opna_writereg(work, 0x10b, newvol); } // 259e static bool fmp_cmd6a_voldec_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)fmp; fmp_part_adpcm_relvol(work, part, -3); return true; } // 259e static bool fmp_cmd6b_volinc_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)fmp; fmp_part_adpcm_relvol(work, part, 3); return true; } // 208c static bool fmp_cmd6c_kondelay(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->keyon_delay = fmp_part_cmdload(fmp, part); return true; } // 2090 static bool fmp_cmd6d_detune(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint16_t detune = fmp_part_cmdload(fmp, part); if (detune & 0x80) detune |= 0xff00; part->detune = detune; return true; } // 2095 static bool fmp_cmd6e_poke(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint16_t port = fmp_part_cmdload(fmp, part); uint8_t data = fmp_part_cmdload(fmp, part); // 3222? if (part->opna_keyon_out & 0x04) port |= 0x100; work->opna_writereg(work, port, data); return true; } // 20b7 static void fmp_part_sync(struct fmp_part *part) { if (part->sync != 1) part->sync = 0; } // 209e static bool fmp_cmd6f_sync(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; // sync // command S{channels} uint8_t val = fmp_part_cmdload(fmp, part); if (!(val & 0x80)) { for (int i = 0; i < 3; i++) { if (val & (1<parts[FMP_PART_FM_1+i]); } for (int i = 0; i < 3; i++) { if (val & (1<<(i+3))) fmp_part_sync(&fmp->parts[FMP_PART_SSG_1+i]); } } else { for (int i = 0; i < 3; i++) { if (val & (1<parts[FMP_PART_FM_4+i]); } if (val & (1<<3)) fmp_part_sync(&fmp->parts[FMP_PART_ADPCM]); if (val & (1<<4)) { if (fmp->rhythm.sync != 1) fmp->rhythm.sync = 0; } } return true; } // 20eb static bool fmp_cmd70_wait(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; (void)fmp; // command W part->sync = 2; return false; } // 20f6 static bool fmp_cmd71_tone_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t tone = fmp_part_cmdload(fmp, part); part->tone = tone; for (int i = 0; i < 4; i++) { if (part->u.fm.slot_mask & (1<u.fm.slot_rel_vol[i] = 0; } // 211b uint16_t fmtoneptr = fmp->datainfo.fmtoneptr + (tone*25); for (int i = 0; i < 4; i++) { part->u.fm.tone_tl[i] = fmp->data[fmtoneptr+4+i]; } for (int p = 0; p < 6; p++) { for (int s = 0; s < 4; s++) { if (part->u.fm.slot_mask & (1<data[fmtoneptr+(p*4)+s]); } } uint8_t fbalg = fmp->data[fmtoneptr+0x18]; // 2160 if (part->type.fm_3) { if (part->u.fm.slot_mask & 1) { fbalg = (fbalg & 0x38) | (fmp->fm3_alg & 0x07); } } fmp_part_fm_reg_write(work, part, OPNA_FBALG, fbalg); if (part->type.fm_3) { fmp->fm3_alg = fbalg & 0x07; } uint8_t alg = fbalg & 0x7; static const uint8_t alg_vol_tbl[8] = { 0x8, 0x8, 0x8, 0x8, 0xc, 0xe, 0xe, 0xf, }; part->slot_vol_mask = alg_vol_tbl[alg]; fmp_part_fm_vol(work, fmp, part); return true; } // 2458 static void fmp_envreset_ssg(struct fmp_part *part) { part->u.ssg.env.startvol = part->u.ssg.envbak.startvol; part->u.ssg.env.attack_rate = part->u.ssg.envbak.attack_rate; part->u.ssg.env.decay_rate = part->u.ssg.envbak.decay_rate; part->u.ssg.env.sustain_lv = part->u.ssg.envbak.sustain_lv; part->u.ssg.env.sustain_rate = part->u.ssg.envbak.sustain_rate; part->u.ssg.env.release_rate = part->u.ssg.envbak.release_rate; } // 2458 static bool fmp_cmd71_envreset_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; fmp_part_cmdload(fmp, part); fmp_envreset_ssg(part); return true; } // 25a8 static bool fmp_cmd71_tone_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t tone = fmp_part_cmdload(fmp, part); part->tone = tone; if (!(tone & 0x80)) { // 25b4 uint16_t adpcmptr = fmp->datainfo.adpcmptr+6*tone; if (adpcmptr+6 <= fmp->datalen) { part->u.adpcm.startaddr = read16le(&fmp->data[adpcmptr+0]); part->u.adpcm.endaddr = read16le(&fmp->data[adpcmptr+2]); part->u.adpcm.deltat = read16le(&fmp->data[adpcmptr+4]); } } else { // 25cc tone &= 0x7f; part->u.adpcm.startaddr = fmp->adpcm_startaddr[tone]; part->u.adpcm.endaddr = fmp->adpcm_endaddr[tone]; part->u.adpcm.deltat = fmp->adpcm_deltat; } return true; } // 20f2 static bool fmp_cmd72_deflen(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->default_len = fmp_part_cmdload(fmp, part); return true; } // 1fac static bool fmp_cmd73_relvol_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { fmp_part_fm_relvol(work, fmp, part, fmp_part_cmdload(fmp, part)); return true; } // 2424 static bool fmp_cmd73_noise_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { // TODO: ignoring se flag uint8_t val = fmp_part_cmdload(fmp, part); part->u.ssg.env_f.noise = true; if (val & 0x80) { part->u.ssg.env_f.noise = false; } else { fmp->ssg_noise_freq = val; work->opna_writereg(work, 0x06, val); } return true; } // 25f5 static bool fmp_cmd73_relvol_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { fmp_part_adpcm_relvol(work, part, fmp_part_cmdload(fmp, part)); return true; } /* // ???? // 1b64 static void fmp() { } */ // 2466 static bool fmp_cmd74_loop(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; // TODO: se flag fmp->part_loop_bit &= ~part->part_bit; if (!fmp->part_loop_bit) { if (!--fmp->loop_dec) { fmp->status.looped = true; // al=2; 1b64(); } // 248c fmp->loop_cnt++; fmp->part_loop_bit = fmp->part_playing_bit; // al=2; 1b64(); } // 24a2 uint16_t ptr = part->loop_ptr; if (ptr != 0xffff) { part->current_ptr = ptr; return true; } else { fmp->part_loop_bit &= ~part->part_bit; fmp->part_playing_bit &= ~part->part_bit; if (!fmp->part_playing_bit) { // 24bc // 3e16(); fmp->status.stopped = true; fmp->status.looped = true; } // 24f0 if (!part->type.rhythm) { part->prev_note = 0x61; // rest part->status.off = true; if (part->type.ssg) { part->actual_vol = 0; // 0x6a? } fmp_part_keyoff(work, fmp, part); } else { // 2512 fmp->rhythm.status = 1; } return false; } } // 22e0 static bool fmp_cmd75_lfo(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t val = fmp_part_cmdload(fmp, part); if (val & 0x80) { // LFO on/off // MD/S command // 2313 bool set = val & 0x40; if (val & (1<<0)) part->lfo_f.e = set; if (val & (1<<1)) part->lfo_f.w = set; if (val & (1<<2)) part->lfo_f.a = set; if (val & (1<<3)) part->lfo_f.r = set; if (val & (1<<4)) part->lfo_f.q = set; if (val & (1<<5)) part->lfo_f.p = set; if (!set) { if (!part->type.fm) { part->actual_freq = fmp_part_ssg_freq(part, part->prev_note); part->prev_freq = 0; } else { part->actual_freq = fmp_fm_freq(part->prev_note); part->prev_freq = 0; } } else { if (part->lfo_f.e) part->lfo_f.a = false; } } else { // 22e4 // EON/EOFF (FM3) if (val & 0x40) { // 22f1 fmp->timer_ch3 |= 0x40; if (val & 0x20) { fmp->ch3_se_freqdiff[0] = u8s16(fmp_part_cmdload(fmp, part)); fmp->ch3_se_freqdiff[1] = u8s16(fmp_part_cmdload(fmp, part)); fmp->ch3_se_freqdiff[2] = u8s16(fmp_part_cmdload(fmp, part)); fmp->ch3_se_freqdiff[3] = u8s16(fmp_part_cmdload(fmp, part)); } } else { // 22e9 fmp->timer_ch3 &= 0x3f; } fmp_set_timer_ch3(work, fmp); } return true; } // 2fa2 static void fmp_init_lfo(struct fmp_lfo *lfo) { lfo->delay_cnt = lfo->delay; lfo->speed_cnt = 1; lfo->depth_cnt = lfo->depth >> 1; int16_t rate2 = u16s16(lfo->rate); if (lfo->waveform != FMP_LFOWF_TRIANGLE) { rate2 *= lfo->depth; // 2fc4 if (lfo->waveform == FMP_LFOWF_STAIRCASE) { rate2 >>= 1; lfo->depth_cnt = 1; } } // 2fd0 if (lfo->waveform == FMP_LFOWF_RANDOM) { rate2 = 0; } // 2fd8 lfo->rate2 = rate2; } // 2f84 static void fmp_part_init_lfo_pqr(struct fmp_part *part) { if (part->lfo_f.p) fmp_init_lfo(&part->lfo[FMP_LFO_P]); if (part->lfo_f.q) fmp_init_lfo(&part->lfo[FMP_LFO_Q]); if (part->lfo_f.r) fmp_init_lfo(&part->lfo[FMP_LFO_R]); } // 21a6 static void fmp_cmd_lfo(struct driver_fmp *fmp, struct fmp_part *part, struct fmp_lfo *lfo) { lfo->delay = fmp_part_cmdload(fmp, part); lfo->speed = fmp_part_cmdload(fmp, part); uint16_t rate = fmp_part_cmdload(fmp, part); if (rate & 0x80) rate |= 0xff00; lfo->rate = rate; lfo->rate2 = rate; lfo->depth = fmp_part_cmdload(fmp, part); lfo->waveform = fmp_part_cmdload(fmp, part); if (lfo->waveform == 6) { lfo->rate = (lfo->rate&0xff)*lfo->depth; } part->lfo_f.lfo = true; fmp_part_init_lfo_pqr(part); } // 21a1 static bool fmp_cmd76_lfo_p(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->lfo_f.p = true; fmp_cmd_lfo(fmp, part, &part->lfo[FMP_LFO_P]); return true; } // 21d0 static bool fmp_cmd77_lfo_q(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->lfo_f.q = true; struct fmp_lfo *lfo = &part->lfo[FMP_LFO_Q]; fmp_cmd_lfo(fmp, part, lfo); part->pdzf.env_param.rr = lfo->delay - 2; part->pdzf.env_param.sr = lfo->speed; part->pdzf.env_param.dd = u16s16(lfo->rate); part->pdzf.env_param.al = lfo->depth; return true; } // 21da static bool fmp_cmd78_lfo_r(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->lfo_f.r = true; struct fmp_lfo *lfo = &part->lfo[FMP_LFO_R]; fmp_cmd_lfo(fmp, part, lfo); if (part->pdzf.mode != 2 || lfo->depth == 0) { part->pdzf.voice = lfo->speed; if (part->pdzf.mode == 2 && (lfo->delay != 2)) { uint8_t upan = lfo->delay - 2; if (upan < 10) { part->pdzf.pan = upan - 5; } } else { int8_t pan = u8s16(lfo->rate); if (pan < -4) pan = -4; if (pan > 4) pan = 4; part->pdzf.pan = pan; } } return true; } static void fmp_pdzf_loop_freq(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part, uint8_t d0, uint8_t d1, uint8_t d2, uint8_t d3) { (void)fmp; if (!part->pdzf.mode) return; if (part->pdzf.mode != 2 || part->lfo[2].depth == 0) { uint32_t start = (d0 << 8) | d1; uint32_t end = (d2 << 8) | d3; if (start == 0xffff) start = (uint32_t)-1; if (end == 0xffff) end = (uint32_t)-1; if ((start != (uint32_t)-1) && (end != (uint32_t)-1)) { if (start >= end) { start = (uint32_t)-1; end = (uint32_t)-1; } } if (work->ppz8_functbl) { work->ppz8_functbl->channel_loopoffset( work->ppz8, part->pdzf.ppz8_channel, start, end ); } } if (part->pdzf.mode == 2) { if (part->lfo[2].depth == 1 || part->lfo[2].depth == 2) { uint32_t addr = ((uint32_t)d0) << 24; addr |= ((uint32_t)d1) << 16; addr |= ((uint32_t)d2) << 8; addr |= d3; if (part->lfo[2].depth == 1) { part->pdzf.loopstart32 = addr; } else { part->pdzf.loopend32 = addr; } if (work->ppz8_functbl) { work->ppz8_functbl->channel_loopoffset( work->ppz8, part->pdzf.ppz8_channel, part->pdzf.loopstart32, part->pdzf.loopend32 ); } } } } static bool fmp_cmd79_lfo_a_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->lfo_f.a = true; part->lfo_f.e = false; uint8_t v = fmp_part_cmdload(fmp, part); part->u.fm.alfo.delay = v; part->u.fm.alfo.delay_cnt = v; v = fmp_part_cmdload(fmp, part); part->u.fm.alfo.speed = v; part->u.fm.alfo.speed_cnt = v; v = fmp_part_cmdload(fmp, part); part->u.fm.alfo.rate = v; part->u.fm.alfo.rate_orig = v; v = fmp_part_cmdload(fmp, part); part->u.fm.alfo.depth = v; part->u.fm.alfo.depth_cnt = v; fmp_pdzf_loop_freq(work, fmp, part, part->u.fm.alfo.delay, part->u.fm.alfo.speed, part->u.fm.alfo.rate, part->u.fm.alfo.depth ); return true; } // 244f static bool fmp_cmd79_env_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->u.ssg.envbak.startvol = fmp_part_cmdload(fmp, part); part->u.ssg.envbak.attack_rate = fmp_part_cmdload(fmp, part); part->u.ssg.envbak.decay_rate = fmp_part_cmdload(fmp, part); part->u.ssg.envbak.sustain_lv = fmp_part_cmdload(fmp, part); part->u.ssg.envbak.sustain_rate = fmp_part_cmdload(fmp, part); part->u.ssg.envbak.release_rate = fmp_part_cmdload(fmp, part); fmp_envreset_ssg(part); fmp_ssg_ppz8_pdzf_mode_update(work, fmp, part); fmp_pdzf_loop_freq(work, fmp, part, part->u.ssg.envbak.decay_rate, part->u.ssg.envbak.sustain_lv, part->u.ssg.envbak.sustain_rate, part->u.ssg.envbak.release_rate ); return true; } // 2009 static bool fmp_cmd7a_tie(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; (void)fmp; part->status.tie = true; part->status.slur = true; return true; } // 1f9e static bool fmp_cmd7b_transpose(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t val = fmp_part_cmdload(fmp, part); if (val) part->note_diff += val; else part->note_diff = 0; return true; } // 2229 static void fmp_part_write_pan(struct fmdriver_work *work, struct fmp_part *part) { fmp_part_fm_reg_write(work, part, OPNA_LRAMSPMS, part->pan_ams_pms); } static void fmp_fm_pdzf_mode_update(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t prev_mode = part->pdzf.mode; part->pdzf.mode = (part->u.fm.slot_mask == 0xff) ? fmp->pdzf.mode : 0; if (prev_mode && !part->pdzf.mode) { part->pdzf.keyon = false; if (work->ppz8_functbl) { work->ppz8_functbl->channel_stop( work->ppz8, part->pdzf.ppz8_channel ); } } } // 2206 static bool fmp_cmd7c_lfo_pan_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t val1 = fmp_part_cmdload(fmp, part); if (val1 & 0x01) { uint8_t val2 = fmp_part_cmdload(fmp, part); uint8_t val3 = fmp_part_cmdload(fmp, part); if (val3 & 0x80) { if (val3 & 0x20) { // 229b // HLFO delay // 7c 01 val a0: DH part->u.fm.hlfo_delay = val2; } else { // 227c // HLFO on/off // 7c 01 00 c0: SH1/MDH1: HLFO ON // 7c 01 00 80: SH0/MDH0: HLFO OFF val3 &= 0x7f; val3 >>= 3; part->u.fm.hlfo_freq &= 0xf7; part->u.fm.hlfo_freq |= val3; work->opna_writereg(work, 0x22, part->u.fm.hlfo_freq); if (!val3) { part->pan_ams_pms &= 0xc0; fmp_part_write_pan(work, part); } } } else { // 226b // HLFO parameters // 7c 01 val2 val3 val4: MH part->u.fm.hlfo_delay = val2; part->u.fm.hlfo_freq = val3 | 0x08; part->u.fm.hlfo_apms = fmp_part_cmdload(fmp, part); } } else { // 220a if (val1 & 0x02) { // 229f // LFO W settings // 7c 02 xx xx xx xx xx: MW part->lfo_f.w = true; uint8_t val = fmp_part_cmdload(fmp, part); part->u.fm.wlfo.delay = val; part->u.fm.wlfo.delay_cnt = val; val = fmp_part_cmdload(fmp, part); part->u.fm.wlfo.speed = val; part->u.fm.wlfo.speed_cnt = val; val = fmp_part_cmdload(fmp, part); part->u.fm.wlfo.rate = val; part->u.fm.wlfo.rate_orig = val; part->u.fm.wlfo.rate_curr = 0; val = fmp_part_cmdload(fmp, part); part->u.fm.wlfo.depth = val; part->u.fm.wlfo.depth_cnt = val; val = fmp_part_cmdload(fmp, part); part->u.fm.wlfo.sync = val; int pdzf_i = (part - &fmp->parts[FMP_PART_FM_EX1]); if ((pdzf_i == 1) || (pdzf_i == 2)) { struct pdzf_rhythm *pr = &fmp->pdzf.rhythm[pdzf_i-1]; pr->voice[0] = part->u.fm.wlfo.delay; pr->voice[1] = part->u.fm.wlfo.speed; int16_t panpot = u8s16(part->u.fm.wlfo.rate); if (panpot < -4) panpot = -4; if (panpot > 4) panpot = 4; pr->pan = panpot; pr->note = part->u.fm.wlfo.depth; pr->enabled = true; } } else { // 2211 if (val1 & 0x04) { // 22c7 // mask slot // 7c 04 val: EX uint8_t val = fmp_part_cmdload(fmp, part); fmp->timer_ch3 |= 0x40; if (val == 0xff) { fmp_part_keyoff(work, fmp, part); fmp->timer_ch3 &= 0x3f; } part->u.fm.slot_mask = val; fmp_fm_pdzf_mode_update(work, fmp, part); } else { // 2218 // PAN // 7c val1: P part->pan_ams_pms &= 0x3f; part->pan_ams_pms |= val1; if (part->type.fm_3) { // 2236 fmp->parts[FMP_PART_FM_3].pan_ams_pms &= 0x3f; fmp->parts[FMP_PART_FM_3].pan_ams_pms |= val1; fmp->parts[FMP_PART_FM_EX1].pan_ams_pms &= 0x3f; fmp->parts[FMP_PART_FM_EX1].pan_ams_pms |= val1; fmp->parts[FMP_PART_FM_EX2].pan_ams_pms &= 0x3f; fmp->parts[FMP_PART_FM_EX2].pan_ams_pms |= val1; fmp->parts[FMP_PART_FM_EX3].pan_ams_pms &= 0x3f; fmp->parts[FMP_PART_FM_EX3].pan_ams_pms |= val1; } fmp_part_write_pan(work, part); } } } return true; } // 1f78 static bool fmp_cmd7c_tone_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; part->tone = fmp_part_cmdload(fmp, part); uint16_t toneptr = fmp->datainfo.ssgtoneptr + (part->tone*6); if ((fmp->datainfo.ssgtoneptr != 0xffff) && (fmp->datalen >= (toneptr+6))) { part->u.ssg.envbak.startvol = fmp->data[toneptr+0]; part->u.ssg.envbak.attack_rate = fmp->data[toneptr+1]; part->u.ssg.envbak.decay_rate = fmp->data[toneptr+2]; part->u.ssg.envbak.sustain_lv = fmp->data[toneptr+3]; part->u.ssg.envbak.sustain_rate = fmp->data[toneptr+4]; part->u.ssg.envbak.release_rate = fmp->data[toneptr+5]; } fmp_ssg_ppz8_pdzf_mode_update(work, fmp, part); fmp_pdzf_loop_freq(work, fmp, part, part->u.ssg.envbak.decay_rate, part->u.ssg.envbak.sustain_lv, part->u.ssg.envbak.sustain_rate, part->u.ssg.envbak.release_rate ); fmp_envreset_ssg(part); return true; } // 25e4 static void fmp_adpcm_pan(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part, uint8_t val) { val &= 0xc0; part->pan_ams_pms = val; work->opna_writereg(work, 0x101, val | fmp->adpcm_c1); } // 25e4 static bool fmp_cmd7c_pan_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { fmp_adpcm_pan(work, fmp, part, fmp_part_cmdload(fmp, part)); return true; } // 1f70 static bool fmp_cmd7d_sync(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; // unknown MML fmp->sync.data = fmp_part_cmdload(fmp, part); fmp->sync.cnt++; return true; } // 1f46 static bool fmp_cmd7e_loop_det(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t val1 = fmp_part_cmdload(fmp, part); if (val1) { fmp->loop_dec = val1; fmp->loop_times = val1; // Fadeout not implemented } else { // detune relative // DX int16_t det = u8s16(fmp_part_cmdload(fmp, part)); part->detune += det; } return true; } // 1f2c static bool fmp_cmd7f_lfo_delay(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)work; uint8_t val1 = fmp_part_cmdload(fmp, part); uint8_t delay = fmp_part_cmdload(fmp, part); if (val1 < 3) { part->lfo[val1].delay = delay; } else if (val1 == 3) { // 1f40 part->u.fm.alfo.delay = delay; } return true; } // 1eaf static void fmp_update_slot_rel_vol(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t pvol = part->actual_vol+fmp->fm_vol; if (pvol & 0x80) { pvol = (fmp->fm_vol & 0x80) ? 0 : 0x7f; } // 1ed4 for (int s = 0; s < 4; s++) { uint8_t svol; if (!(part->slot_vol_mask & (1<u.fm.tone_tl[s] - part->u.fm.slot_rel_vol[s]; if (svol & 0x80) { svol = (part->u.fm.slot_rel_vol[s] & 0x80) ? 0x7f : 0; } } else { // 1f00 svol = pvol - part->u.fm.slot_rel_vol[s]; if (svol & 0x80) { svol = (part->u.fm.slot_rel_vol[s] & 0x80) ? 0x7f : 0; } svol += part->u.fm.tone_tl[s]; if (svol & 0x80) svol = 0x7f; } if (!(part->u.fm.slot_mask & (1<u.fm.slot_rel_vol[i] = val; } } fmp_update_slot_rel_vol(work, fmp, part); return true; } // 1e7d static bool fmp_cmde3_slotrelvol_add_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { uint8_t val = fmp_part_cmdload(fmp, part); uint8_t mask = fmp_part_cmdload(fmp, part); for (int i = 0; i < 4; i++) { if (!(mask & (1<u.fm.slot_rel_vol[i] + val; if (svol > 0x7f) { svol = (val & 0x80) ? 0 : 0x7f; } part->u.fm.slot_rel_vol[i] = svol; } fmp_update_slot_rel_vol(work, fmp, part); return true; } // 2c5b static void fmp_part_lfo_calc(struct driver_fmp *fmp, struct fmp_part *part, int num) { struct fmp_lfo *lfo = &part->lfo[num]; uint8_t waveform = lfo->waveform; if (waveform > 6) waveform = 0; switch (waveform) { case FMP_LFOWF_TRIANGLE: case FMP_LFOWF_TRIANGLE2: // 2c7f if (!lfo->delay) return; if (--lfo->delay_cnt) return; lfo->delay_cnt = 1; if (--lfo->speed_cnt) return; lfo->speed_cnt = lfo->speed; part->actual_freq += lfo->rate2; if (--lfo->depth_cnt) return; lfo->depth_cnt = lfo->depth; lfo->rate2 = -lfo->rate2; return; case FMP_LFOWF_SAWTOOTH: // 2cae if (!lfo->delay) return; if (--lfo->delay_cnt) return; lfo->delay_cnt = 1; if (--lfo->speed_cnt) return; lfo->speed_cnt = lfo->speed; part->actual_freq += lfo->rate; if (--lfo->depth_cnt) return; lfo->depth_cnt = lfo->depth; part->actual_freq -= lfo->rate2; return; case FMP_LFOWF_SQUARE: // 2ce0 if (!lfo->delay) return; if (--lfo->delay_cnt) return; lfo->delay_cnt = 1; if (--lfo->speed_cnt) return; lfo->speed_cnt = lfo->speed; part->actual_freq += (lfo->rate2 >> (lfo->depth_cnt != 0)); if (lfo->depth_cnt) lfo->depth_cnt = 0; lfo->rate2 = -lfo->rate2; return; case FMP_LFOWF_LINEAR: // 2d10 if (!lfo->delay) return; if (!lfo->depth_cnt) return; if (--lfo->delay_cnt) return; lfo->delay_cnt = 1; if (--lfo->speed_cnt) return; lfo->speed_cnt = lfo->speed; part->actual_freq += lfo->rate; lfo->depth_cnt--; return; case FMP_LFOWF_STAIRCASE: // 2d3a if (!lfo->delay) return; if (--lfo->delay_cnt) return; lfo->delay_cnt = 1; if (--lfo->speed_cnt) return; lfo->speed_cnt = lfo->speed; part->actual_freq += lfo->rate2; if (--lfo->depth_cnt) return; lfo->depth_cnt = 2; lfo->rate2 = -lfo->rate2; return; case FMP_LFOWF_RANDOM: if (!lfo->delay) return; if (--lfo->delay_cnt) return; lfo->delay_cnt = 1; if (--lfo->speed_cnt) return; lfo->speed_cnt = lfo->speed; { uint8_t rand = fmp_rand71(fmp); uint16_t a = (lfo->rate>>1) - (rand*lfo->depth_cnt)%lfo->rate; lfo->depth_cnt = rand; part->actual_freq -= lfo->rate2; part->actual_freq += a; lfo->rate2 = a; return; } } } // 27c9 static void fmp_part_keyon_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (part->lfo_f.portamento) return; // 27df uint8_t out = part->opna_keyon_out; if (part->type.fm_3) { fmp->fm3_slot_keyon |= ((~part->u.fm.slot_mask)&0xf0); out |= fmp->fm3_slot_keyon; } else { // 27fb out |= 0xf0; } work->opna_writereg(work, 0x28, out); } // 2b1c-2b79 static void fmp_part_wlfo(struct fmdriver_work *work, struct fmp_part *part) { struct fmp_wlfo *wlfo = &part->u.fm.wlfo; // 2b1c if (!wlfo->delay) return; if (--wlfo->delay_cnt) return; wlfo->delay_cnt = 1; if (--wlfo->speed_cnt) return; wlfo->speed_cnt = wlfo->speed; // 2b36 wlfo->rate_curr += wlfo->rate; for (int i = 0; i < 4; i++) { // 2b4e if (!(wlfo->sync & (1<u.fm.tone_tl[i] + wlfo->rate_curr; if (tl & 0x80) { tl = (wlfo->rate_curr & 0x80) ? 0 : 0x7f; } fmp_part_fm_reg_write(work, part, OPNA_TL+4*i, tl); } if (!--wlfo->depth_cnt) { wlfo->depth_cnt = wlfo->depth; wlfo->rate = -wlfo->rate; } // 2b79 } // 2e0c static void fmp_part_freq_ppz8(struct fmdriver_work *work, struct fmp_part *part) { uint32_t freq = part->actual_freq; uint8_t octave = part->u.ssg.octave; if (!octave) return; if (octave != 4) { if (octave > 4) { // 2e22 freq <<= (octave-4); } else { freq >>= (4-octave); } } // 2e3b int32_t detune = u16s16(part->detune); freq += detune << 6; if (work->ppz8_functbl) { work->ppz8_functbl->channel_freq(work->ppz8, part->opna_keyon_out, freq); } } static uint32_t fmp_ppz8_note_freq(uint8_t note) { uint32_t freq = fmp_ppz_freq(note); uint8_t octave = note/0xc; if (octave > 4) { freq <<= (octave - 4); } else { freq >>= (4 - octave); } return freq; } static void fmp_part_keyon_pdzf(struct fmdriver_work *work, struct fmp_part *part) { uint8_t voice = part->pdzf.voice; uint8_t pan = part->pdzf.pan + 5; uint32_t freq = fmp_ppz8_note_freq(part->prev_note); freq += (u16s16(part->detune) << 3); if (!part->pdzf.keyon) { if (work->ppz8_functbl) { work->ppz8_functbl->channel_play( work->ppz8, part->pdzf.ppz8_channel, voice ); } part->pdzf.env_state.status = PDZF_ENV_ATT; part->pdzf.env_state.vol = 0; part->pdzf.env_state.cnt = part->pdzf.env_param.al; part->pdzf.keyon = true; } if (work->ppz8_functbl) { work->ppz8_functbl->channel_pan( work->ppz8, part->pdzf.ppz8_channel, pan ); work->ppz8_functbl->channel_freq( work->ppz8, part->pdzf.ppz8_channel, freq ); work->ppz8_functbl->channel_volume( work->ppz8, part->pdzf.ppz8_channel, fmp_pdzf_vol_clamp(part->pdzf.vol, part->pdzf.env_state.vol) ); } } // 27a3 static void fmp_part_keyon(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { part->ext_keyon = 0xffff; part->status.keyon = false; if (part->pdzf.mode) { fmp_part_keyon_pdzf(work, part); } if (!part->type.ssg) { if (part->lfo_f.lfo) { part->actual_freq = fmp_fm_freq(part->prev_note); part->prev_freq = 0; part->lfo_f.lfo = false; } fmp_part_keyon_fm(work, fmp, part); } else { // 2805 if (part->lfo_f.lfo) { uint8_t note = part->prev_note; part->u.ssg.octave = fmp_ssg_octave(note); part->actual_freq = fmp_part_ssg_freq(part, note); part->prev_freq = 0; part->lfo_f.lfo = false; } // 281e if (part->lfo_f.portamento) { part->u.ssg.env_f.attack = false; part->u.ssg.env_f.portamento = true; return; } // 2823 if (part->u.ssg.env_f.ppz) { if (work->ppz8_functbl) { work->ppz8_functbl->channel_play( work->ppz8, part->opna_keyon_out, part->tone ); } fmp_part_ppz8_vol(work, part); fmp_part_freq_ppz8(work, part); return; } part->u.ssg.env_f.attack = true; } } // 30b1 static void fmp_part_init_wlfo(struct fmdriver_work *work, struct fmp_part *part) { if (!(part->u.fm.wlfo.sync & 0x80)) return; for (int s = 0; s < 4; s++) { if (!(part->u.fm.wlfo.sync & (1<u.fm.tone_tl[s]); } // 30d5 part->u.fm.wlfo.delay_cnt = part->u.fm.wlfo.delay; part->u.fm.wlfo.depth_cnt = part->u.fm.wlfo.depth; part->u.fm.wlfo.rate_curr = 0; part->u.fm.wlfo.rate = part->u.fm.wlfo.rate_orig; } // 309b static void fmp_part_hlfo(struct fmdriver_work *work, struct fmp_part *part) { work->opna_writereg(work, 0x22, part->u.fm.hlfo_freq); part->pan_ams_pms &= 0xc0; part->pan_ams_pms |= part->u.fm.hlfo_apms; fmp_part_write_pan(work, part); } // 2fdc static void fmp_part_init_lfo_awe(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (part->lfo_f.w) { fmp_part_init_wlfo(work, part); } if (part->lfo_f.a || part->lfo_f.e || (part->current_vol != part->actual_vol)) { part->actual_vol = part->current_vol; uint8_t pvol = part->actual_vol + fmp->fm_vol; if (pvol & 0x80) { pvol = (fmp->fm_vol & 0x80) ? 0 : 0x7f; } for (int s = 0; s < 4; s++) { if (!(part->slot_vol_mask & (1<u.fm.tone_tl[s]; vol -= part->u.fm.slot_rel_vol[s]; if (vol & 0x80) { vol = (part->u.fm.slot_rel_vol[s] & 0x80) ? 0x7f : 0x00; } // 3039 if (!(part->u.fm.slot_mask & (1<data_version >= 0x06) { svol -= part->u.fm.slot_rel_vol[s]; if (svol & 0x80) { svol = (part->u.fm.slot_rel_vol[s] & 0x80) ? 0x7f : 0x00; } // 305c svol += part->u.fm.tone_tl[s]; if (svol & 0x80) svol = 0x7f; } // 3062 if (!(part->u.fm.slot_mask & (1<u.fm.alfo.delay_cnt = part->u.fm.alfo.delay; part->u.fm.alfo.depth_cnt = part->u.fm.alfo.depth; part->u.fm.alfo.rate = part->u.fm.alfo.rate_orig; if (part->u.fm.hlfo_freq & 0x80) { work->opna_writereg(work, 0x22, 0x00); part->u.fm.hlfo_delay_cnt = part->u.fm.hlfo_delay; if (!part->u.fm.hlfo_delay_cnt) { // 309b work->opna_writereg(work, 0x22, part->u.fm.hlfo_freq); part->pan_ams_pms &= 0xc0; part->pan_ams_pms |= part->u.fm.hlfo_apms; fmp_part_write_pan(work, part); } } // 30b0 } static void fmp_part_pdzf_env(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { (void)fmp; switch (part->pdzf.env_state.status) { case PDZF_ENV_ATT: if (!part->pdzf.env_state.cnt--) { part->pdzf.env_state.vol = part->pdzf.env_param.dd; part->pdzf.env_state.status = PDZF_ENV_DEC; if (part->pdzf.env_state.vol > PDZF_ENV_VOL_MIN) { part->pdzf.env_state.cnt = part->pdzf.env_param.sr; if (work->ppz8_functbl) { work->ppz8_functbl->channel_volume( work->ppz8, part->pdzf.ppz8_channel, fmp_pdzf_vol_clamp(part->pdzf.vol, part->pdzf.env_state.vol) ); } } else { part->pdzf.env_state.vol = PDZF_ENV_VOL_MIN; part->pdzf.env_state.status = PDZF_ENV_OFF; if (work->ppz8_functbl) { work->ppz8_functbl->channel_stop( work->ppz8, part->pdzf.ppz8_channel ); } } } break; case PDZF_ENV_DEC: if (!part->pdzf.env_param.sr) { //part->pdzf.env_state.vol = PDZF_ENV_VOL_MIN; } else if (!--part->pdzf.env_state.cnt) { part->pdzf.env_state.vol--; if (part->pdzf.env_state.vol > PDZF_ENV_VOL_MIN) { part->pdzf.env_state.cnt = part->pdzf.env_param.sr; if (work->ppz8_functbl) { work->ppz8_functbl->channel_volume( work->ppz8, part->pdzf.ppz8_channel, fmp_pdzf_vol_clamp(part->pdzf.vol, part->pdzf.env_state.vol) ); } } } if (part->pdzf.env_state.vol <= PDZF_ENV_VOL_MIN) { part->pdzf.env_state.vol = PDZF_ENV_VOL_MIN; part->pdzf.env_state.status = PDZF_ENV_OFF; if (work->ppz8_functbl) { work->ppz8_functbl->channel_stop( work->ppz8, part->pdzf.ppz8_channel ); } } break; case PDZF_ENV_REL: if (!--part->pdzf.env_state.cnt) { part->pdzf.env_state.vol--; if (part->pdzf.env_state.vol > PDZF_ENV_VOL_MIN) { part->pdzf.env_state.cnt = part->pdzf.env_param.rr; if (work->ppz8_functbl) { work->ppz8_functbl->channel_volume( work->ppz8, part->pdzf.ppz8_channel, fmp_pdzf_vol_clamp(part->pdzf.vol, part->pdzf.env_state.vol) ); } } else { part->pdzf.env_state.vol = PDZF_ENV_VOL_MIN; part->pdzf.env_state.status = PDZF_ENV_OFF; if (work->ppz8_functbl) { work->ppz8_functbl->channel_stop( work->ppz8, part->pdzf.ppz8_channel ); } } } break; case PDZF_ENV_OFF: break; } } // 2ad9 static void fmp_part_lfo(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { // 2ad9 if (part->lfo_f.p) fmp_part_lfo_calc(fmp, part, 0); if (part->lfo_f.q) fmp_part_lfo_calc(fmp, part, 1); if (part->lfo_f.r) fmp_part_lfo_calc(fmp, part, 2); if (part->type.fm) { // 2b03 if ((part->u.fm.hlfo_freq & 0x04) && part->u.fm.hlfo_delay_cnt) { if (!--part->u.fm.hlfo_delay_cnt) { fmp_part_hlfo(work, part); } } // 2b17 if (part->lfo_f.w) { fmp_part_wlfo(work, part); } // 2b79 if (part->lfo_f.a || part->lfo_f.e) { // 2b7e if (!part->u.fm.alfo.delay) return; if (--part->u.fm.alfo.delay_cnt) return; part->u.fm.alfo.delay_cnt = 1; if (--part->u.fm.alfo.speed_cnt) return; part->u.fm.alfo.speed_cnt = part->u.fm.alfo.speed; uint8_t vol = part->actual_vol + part->u.fm.alfo.rate; if (vol & 0x80) { vol = (part->u.fm.alfo.rate & 0x80) ? 0x00 : 0x7f; } part->actual_vol = vol; if (!part->lfo_f.e) { // 2bb3 fmp_part_fm_vol(work, fmp, part); if (--part->u.fm.alfo.depth_cnt) return; part->u.fm.alfo.depth_cnt = part->u.fm.alfo.depth; part->u.fm.alfo.rate = -part->u.fm.alfo.rate; } else { // 2bc5 fmp_part_keyoff_fm(work, fmp, part); fmp_part_fm_vol(work, fmp, part); fmp_part_keyon_fm(work, fmp, part); part->u.fm.alfo.speed_cnt = part->u.fm.alfo.depth_cnt; if (part->u.fm.alfo.speed == part->u.fm.alfo.speed_cnt) { part->u.fm.alfo.depth_cnt = part->u.fm.alfo.depth; } else { part->u.fm.alfo.depth_cnt = part->u.fm.alfo.speed; } } } } } // 2a51 static void fmp_part_fm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (part->status.lfo_sync) { fmp_part_init_lfo_pqr(part); fmp_part_init_lfo_awe(work, fmp, part); part->actual_freq = fmp_fm_freq(part->prev_note); part->status.lfo_sync = false; } // 2a6a if (part->status.pitchbend || fmp->datainfo.flags.lfo_octave_fix) { uint16_t fnum = part->actual_freq & 0x7ff; if (fnum > 0x4d3u) { part->actual_freq += 0x800; part->actual_freq -= 0x269; } else if (fnum < 0x26au) { part->actual_freq -= 0x800; part->actual_freq += 0x269; if (part->actual_freq & 0x8000) { part->actual_freq = 0x200; } } } // 2aa3 if ((part->actual_freq + part->detune) != part->prev_freq) { part->prev_freq = part->actual_freq + part->detune; if (part->type.fm_3 && (fmp->timer_ch3 & 0x40)) { // 2be7 static const uint8_t ch3_fnum_addr[] = { 0xad, 0xac, 0xae, 0xa6 }; static const uint8_t ch3_index[] = { 0, 2, 1, 3 }; for (int i = 0; i < 4; i++) { if (part->u.fm.slot_mask & (1<prev_freq + fmp->ch3_se_freqdiff[ch3_index[i]]; work->opna_writereg(work, ch3_fnum_addr[i], freq>>8); work->opna_writereg(work, ch3_fnum_addr[i]-4, freq&0xff); } } else { fmp_part_fm_reg_write(work, part, OPNA_BLKFNUM2, part->prev_freq>>8); fmp_part_fm_reg_write(work, part, OPNA_FNUM1, part->prev_freq&0xff); } } // 2ad0 if (part->status.keyon) { fmp_part_keyon(work, fmp, part); } fmp_part_lfo(work, fmp, part); } // 2e80-2ed6 static void fmp_part_ssg_env_adsr(struct fmp_part *part) { // 2e80 if (!part->u.ssg.env_f.decay) { unsigned newvol = part->actual_vol + part->u.ssg.env.attack_rate; if (!(newvol & 0x100) && (part->u.ssg.vol > newvol)) { part->actual_vol = newvol; return; } // 2e96 part->actual_vol = part->u.ssg.vol; part->u.ssg.env_f.decay = true; } // 2e9d if (!part->u.ssg.env_f.sustain) { unsigned newvol = part->actual_vol - part->u.ssg.env.decay_rate; if (!(newvol & 0x100) && (part->u.ssg.env.sustain_lv < newvol)) { part->actual_vol = newvol; return; } // 2eb3 part->actual_vol = part->u.ssg.env.sustain_lv; part->u.ssg.env_f.sustain = true; } // 2eba if (part->u.ssg.env_f.release) return; unsigned newvol = part->actual_vol - part->u.ssg.env.sustain_rate; if (!(newvol & 0x100)) { part->actual_vol = newvol; return; } // 2ec8 part->actual_vol = 0; part->u.ssg.env_f.release = true; part->u.ssg.env_f.attack = false; } // 2e7a static void fmp_part_ssg_env(struct fmdriver_work *work, struct fmp_part *part) { if (part->u.ssg.env_f.attack) { fmp_part_ssg_env_adsr(part); } else { // 2ed6 if (!part->u.ssg.env_f.portamento) { //part->u.ssg.curr_vol = dh return; } else { // 2edc if (!part->u.ssg.env_f.release) { // 2ee2 unsigned newvol = part->actual_vol - part->u.ssg.env.release_rate; if (!(newvol & 0x100)) { part->actual_vol = newvol; } else { part->actual_vol = 0; part->u.ssg.env_f.release = true; part->u.ssg.env_f.portamento = false; } } } } // 2ef6 uint8_t outvol = ((part->actual_vol * part->current_vol) >> 8); if (outvol == part->u.ssg.curr_vol) { //part->u.ssg.curr_vol = dh return; } // 2f03 work->opna_writereg(work, 0x8+part->opna_keyon_out, outvol); } // 2db0 static void fmp_part_ssg(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (part->status.lfo_sync) { fmp_part_init_lfo_pqr(part); part->u.ssg.octave = fmp_ssg_octave(part->prev_note); part->actual_freq = fmp_part_ssg_freq(part, part->prev_note); part->status.lfo_sync = false; } // 2dc9 if (part->status.keyon) { fmp_part_keyon(work, fmp, part); } // 2dd2 if (part->u.ssg.env_f.ppz) return; fmp_part_ssg_env(work, part); uint16_t freq = part->actual_freq >> part->u.ssg.octave; if (freq == part->prev_freq) { // 2ad0 if (part->status.keyon) { fmp_part_keyon(work, fmp, part); } } else { part->prev_freq = freq; if (!part->eff_chan) { // 2df8 unsigned reg = part->opna_keyon_out*2; work->opna_writereg(work, reg, freq&0xff); work->opna_writereg(work, reg|1, freq>>8); } } fmp_part_lfo(work, fmp, part); } // 2f61 static void fmp_part_ssg_env_reset(struct fmp_part *part) { part->u.ssg.env_f.decay = false; part->u.ssg.env_f.sustain = false; part->u.ssg.env_f.release = false; uint8_t vol = part->u.ssg.env.startvol; if (vol >= part->u.ssg.vol) { part->u.ssg.env_f.decay = true; vol = part->u.ssg.vol; } part->actual_vol = vol; if (part->u.ssg.env.sustain_lv >= part->u.ssg.vol) { part->u.ssg.env_f.sustain = true; } } // 28b3 static void fmp_adpcm_addr_set(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (part->lfo_f.portamento) return; work->opna_writereg(work, 0x100, 0x00); work->opna_writereg(work, 0x100, 0x01); //work->opna_writereg(work, 0x110, 0x08); //work->opna_writereg(work, 0x110, 0x80); work->opna_writereg(work, 0x101, part->pan_ams_pms | fmp->adpcm_c1); work->opna_writereg(work, 0x102, part->u.adpcm.startaddr & 0xff); work->opna_writereg(work, 0x103, part->u.adpcm.startaddr >> 8); work->opna_writereg(work, 0x104, part->u.adpcm.endaddr & 0xff); work->opna_writereg(work, 0x105, part->u.adpcm.endaddr >> 8); } // 2853 static void fmp_part_adpcm(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (!part->status.keyon) return; part->ext_keyon = 0xffff; part->status.keyon = false; if (part->status.tie_cont) return; fmp_adpcm_addr_set(work, fmp, part); part->actual_freq = fmp_adpcm_freq(part->prev_note); uint16_t freq = part->actual_freq; // why does the detune byte has to be swapped?? freq += (part->detune >> 8) | ((part->detune << 8) & 0xff00); freq += part->u.adpcm.deltat; work->opna_writereg(work, 0x109, freq & 0xff); work->opna_writereg(work, 0x10a, freq >> 8); work->opna_writereg(work, 0x100, 0xa0); } // 2750 static void fmp_part_keyon_pre(struct driver_fmp *fmp, struct fmp_part *part) { // TODO: seproc if (fmp->datainfo.flags.q) { // 275e uint8_t tonelen = part->tonelen_cnt; unsigned shift = 0; if (tonelen < 0x10) shift = 3; tonelen <<= shift; tonelen >>= 3; tonelen *= part->gate_cnt; tonelen >>= shift; part->gate_cmp = part->tonelen_cnt - tonelen; } // 277f part->status.keyon = true; if (part->type.ssg && !part->status.tie_cont && !part->u.ssg.env_f.ppz) { part->u.ssg.env_f.portamento = false; if (!part->lfo_f.portamento) { fmp_part_ssg_env_reset(part); } } } // 1cde static void fmp_part_pit_end_ssg(struct fmp_part *part) { part->u.ssg.octave = fmp_ssg_octave(part->pit.target_note); part->actual_freq = fmp_part_ssg_freq(part, part->pit.target_note); part->pit.rate = 0; part->status.pitchbend = false; part->prev_note = part->pit.target_note; } // 1cc4 static void fmp_part_pit_end_fm(struct fmp_part *part) { uint8_t p_delay_cnt = part->lfo[0].delay_cnt; uint8_t q_delay_cnt = part->lfo[1].delay_cnt; uint8_t r_delay_cnt = part->lfo[2].delay_cnt; fmp_part_init_lfo_pqr(part); part->lfo[0].delay_cnt = p_delay_cnt; part->lfo[1].delay_cnt = q_delay_cnt; part->lfo[2].delay_cnt = r_delay_cnt; // 1cdb part->actual_freq = part->pit.target_freq; part->pit.rate = 0; part->status.pitchbend = false; part->prev_note = part->pit.target_note; } // 1c4b static void fmp_part_pit(struct fmp_part *part) { if (part->type.adpcm) return; if (--part->pit.delay) return; part->pit.delay = 1; if (--part->pit.speed_cnt) return; part->pit.speed_cnt = part->pit.speed; uint16_t rate = part->pit.rate; if (rate & 0x80) rate |= 0xff00; if (!rate) return; // 1c77 uint16_t freq = part->actual_freq + rate; if (!(rate & 0x8000)) { // rate positive // 1c79 if (!part->type.fm) { // 1c83 if ((freq >> part->u.ssg.octave) <= part->pit.target_freq) { part->actual_freq = freq; } else { fmp_part_pit_end_ssg(part); } } else { // 1c93 if (freq < part->pit.target_freq) { part->actual_freq = freq; } else { fmp_part_pit_end_fm(part); } } } else { // rate negative // 1ca5 if (!part->type.fm) { if ((freq >> part->u.ssg.octave) >= part->pit.target_freq) { part->actual_freq = freq; } else { fmp_part_pit_end_ssg(part); } } else { // 1cbf if (freq > part->pit.target_freq) { part->actual_freq = freq; } else { fmp_part_pit_end_fm(part); } } } // 1cef } // 1d81 static bool fmp_part_cmd_exec(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part, uint8_t cmd) { enum { JMPTBL_LEN = 0x80-0x62 }; typedef bool (*cmdfunc_t)(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part); static const cmdfunc_t fm_jmptbl[JMPTBL_LEN] = { fmp_cmd62_tempo, fmp_cmd63_vol_d_fm, fmp_cmd64_loop, fmp_cmd65_loopend, fmp_cmd66_tie, fmp_cmd67_q, fmp_cmd68_pitchbend, fmp_cmd69_vol_fm, fmp_cmd6a_voldec_fm, fmp_cmd6b_volinc_fm, fmp_cmd6c_kondelay, fmp_cmd6d_detune, fmp_cmd6e_poke, fmp_cmd6f_sync, fmp_cmd70_wait, fmp_cmd71_tone_fm, fmp_cmd72_deflen, fmp_cmd73_relvol_fm, fmp_cmd74_loop, fmp_cmd75_lfo, fmp_cmd76_lfo_p, fmp_cmd77_lfo_q, fmp_cmd78_lfo_r, fmp_cmd79_lfo_a_fm, fmp_cmd7a_tie, fmp_cmd7b_transpose, fmp_cmd7c_lfo_pan_fm, fmp_cmd7d_sync, fmp_cmd7e_loop_det, fmp_cmd7f_lfo_delay }; static const cmdfunc_t ssg_jmptbl[JMPTBL_LEN] = { fmp_cmd62_tempo, fmp_cmd63_mix_ssg, fmp_cmd64_loop, fmp_cmd65_loopend, fmp_cmd66_tie, fmp_cmd67_q, fmp_cmd68_pitchbend, fmp_cmd69_vol_ssg, fmp_cmd6a_voldec_ssg, fmp_cmd6b_volinc_ssg, fmp_cmd6c_kondelay, fmp_cmd6d_detune, fmp_cmd6e_poke, fmp_cmd6f_sync, fmp_cmd70_wait, fmp_cmd71_envreset_ssg, fmp_cmd72_deflen, fmp_cmd73_noise_ssg, fmp_cmd74_loop, fmp_cmd75_lfo, fmp_cmd76_lfo_p, fmp_cmd77_lfo_q, fmp_cmd78_lfo_r, fmp_cmd79_env_ssg, fmp_cmd7a_tie, fmp_cmd7b_transpose, fmp_cmd7c_tone_ssg, fmp_cmd7d_sync, fmp_cmd7e_loop_det, fmp_cmd7f_lfo_delay }; static const cmdfunc_t adpcm_jmptbl[JMPTBL_LEN] = { fmp_cmd62_tempo, fmp_cmd63_vol_d_adpcm, fmp_cmd64_loop, fmp_cmd65_loopend, fmp_cmd66_tie, fmp_cmd67_q, fmp_cmd68_adpcm, fmp_cmd69_adpcm, fmp_cmd6a_voldec_adpcm, fmp_cmd6b_volinc_adpcm, fmp_cmd6c_kondelay, fmp_cmd6d_detune, fmp_cmd6e_poke, fmp_cmd6f_sync, fmp_cmd70_wait, fmp_cmd71_tone_adpcm, fmp_cmd72_deflen, fmp_cmd73_relvol_adpcm, fmp_cmd74_loop, fmp_cmd75_lfo, fmp_cmd76_lfo_p, fmp_cmd77_lfo_q, fmp_cmd78_lfo_r, fmp_cmd79_lfo_a_fm, fmp_cmd7a_tie, fmp_cmd7b_transpose, fmp_cmd7c_pan_adpcm, fmp_cmd7d_sync, fmp_cmd7e_loop_det, fmp_cmd7f_lfo_delay }; const cmdfunc_t *functable; if (part->type.adpcm) { functable = adpcm_jmptbl; } else { functable = part->type.ssg ? ssg_jmptbl : fm_jmptbl; } return functable[cmd-0x62](work, fmp, part); } static bool fmp_part_cmd_exec2(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part, uint8_t cmd) { if (!part->type.fm || (cmd > 0xe3)) { part->current_ptr = 0xffff; return false; } typedef bool (*cmdfunc_t)(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part); static const cmdfunc_t fm_jmptbl2[2] = { fmp_cmde2_slotrelvol_set_fm, fmp_cmde3_slotrelvol_add_fm, }; return fm_jmptbl2[cmd-0xe2](work, fmp, part); } // 2936 static void fmp_part_keyoff_q(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (part->type.adpcm) { part->ext_keyon = 0; part->status.tie_cont = false; work->opna_writereg(work, 0x100, 0x00); work->opna_writereg(work, 0x100, 0x01); return; } if (part->type.fm || !part->u.ssg.env_f.ppz) { // 2961 part->ext_keyon = 0; part->status.tie_cont = false; if (part->type.adpcm) return; if (!part->type.ssg) { // 2979 uint8_t keyon = part->opna_keyon_out; if (part->type.fm_3) { // 2994 fmp->fm3_slot_keyon &= (part->u.fm.slot_mask | 0x0f); keyon |= fmp->fm3_slot_keyon; } work->opna_writereg(work, 0x28, keyon); // 29a2 } else { // 29a9 part->u.ssg.curr_vol = 0xff; if (part->u.ssg.env.release_rate == 0) { part->actual_vol = 0; } part->u.ssg.env_f.portamento = true; part->u.ssg.env_f.attack = false; } } else { // 294d if (work->ppz8_functbl) { work->ppz8_functbl->channel_volume( work->ppz8, part->opna_keyon_out, 0 ); } } if (part->pdzf.mode) { part->pdzf.keyon = false; if (part->lfo_f.q && part->pdzf.env_param.rr) { part->pdzf.env_state.status = PDZF_ENV_REL; part->pdzf.env_state.cnt = part->pdzf.env_param.rr; } else { part->pdzf.env_state.status = PDZF_ENV_OFF; if (work->ppz8_functbl) { work->ppz8_functbl->channel_stop( work->ppz8, part->pdzf.ppz8_channel ); } } } } // 1c0d static void fmp_part_cmd(struct fmdriver_work *work, struct driver_fmp *fmp, struct fmp_part *part) { if (part->sync > 1) return; if (part->sync == 1) { // 1c19 if (part->keyon_delay_cnt) { if (!--part->keyon_delay_cnt) { fmp_part_keyon_pre(fmp, part); } } // 1c27 if ((!part->status.tie) && (!part->status.rest)) { if (part->tonelen_cnt && (part->tonelen_cnt == part->gate_cmp)) { fmp_part_keyoff_q(work, fmp, part); } } // 1c42 if (part->status.pitchbend) { fmp_part_pit(part); } // 1cef if (--part->tonelen_cnt) return; // 1cf5 if (!part->status.tie) { fmp_part_keyoff(work, fmp, part); part->status.pitchbend = false; } else { // 1d04 part->status.slur = false; part->status.tie = false; part->status.tie_cont = true; } } // 1d0c part->sync = 1; // 1d10 for (;;) { uint8_t cmd = fmp_part_cmdload(fmp, part); uint8_t len; if (!(cmd & 0x80)) { // 1d1a if (cmd >= 0x62) { if (!fmp_part_cmd_exec(work, fmp, part, cmd)) return; continue; } else { // 1d23 len = fmp_part_cmdload(fmp, part); } } else { // 1d26 cmd &= 0x7f; if (cmd >= 0x62) { if (!fmp_part_cmd_exec2(work, fmp, part, cmd | 0x80)) return; continue; } else { // 1d33 len = part->default_len; } } // 1d36 // note part->tonelen_cnt = len; part->tonelen = len; if (cmd == 0x61) { // 1d3e part->status.tie = false; part->status.pitchbend = false; part->status.tie_cont = false; part->status.rest = true; fmp_part_keyoff(work, fmp, part); break; } else { // 1d4d cmd += part->note_diff; part->status.rest = false; part->keyon_delay_cnt = part->keyon_delay; if (!part->keyon_delay) { fmp_part_keyon_pre(fmp, part); } // 1d61 if (!part->status.tie_cont || cmd != part->prev_note) { // 1d6c part->status.lfo_sync = true; part->status.tie_cont = false; if (part->status.slur) { fmp_part_keyoff(work, fmp, part); } } // 1d7d part->prev_note = cmd; break; } } } // 269b static void fmp_part_pan_vol_rhythm(struct fmdriver_work *work, struct fmp_rhythm *rhythm, int part) { work->opna_writereg(work, 0x18+part, rhythm->pans[part] | rhythm->volumes[part]); } // 2619 static void fmp_part_cmd_rhythm(struct fmdriver_work *work, struct driver_fmp *fmp) { struct fmp_rhythm *rhythm = &fmp->rhythm; struct fmp_part *part = &rhythm->part; if (rhythm->sync > 1) return; if (rhythm->sync == 1) { // 2623 if (--rhythm->len_cnt) return; } // 262a for (;;) { rhythm->sync = 1; uint8_t cmd = fmp_part_cmdload_rhythm(fmp, part); if (cmd & 0x80) { if (cmd & 0x40) { // 26a5 rhythm->tl_volume = cmd & 0x3f; work->opna_writereg(work, 0x11, rhythm->tl_volume); } else if (cmd & 0x20) { // 26be int pan = (cmd & 0x18) << 3; rhythm->pans[cmd&0x07] = pan; fmp_part_pan_vol_rhythm(work, rhythm, cmd&0x7); } else if (cmd == 0x90) { // 26d4 rhythm->default_len = fmp_part_cmdload(fmp, part); } else if (cmd == 0x91) { // 26db fmp_cmd64_loop(work, fmp, part); } else if (cmd == 0x92) { // 26e2 fmp_cmd65_loopend(work, fmp, part); } else if (cmd == 0x93) { // 26e9 if (!fmp_cmd74_loop(work, fmp, part)) return; } else if (cmd == 0x94) { // 26ef if (rhythm->tl_volume < 0x3f) { rhythm->tl_volume++; work->opna_writereg(work, 0x11, rhythm->tl_volume); } } else if (cmd == 0x95) { // 26fb if (rhythm->tl_volume) { rhythm->tl_volume--; work->opna_writereg(work, 0x11, rhythm->tl_volume); } } else { switch (cmd & 0xf8) { case 0x80: default: // 268b rhythm->volumes[cmd&0x7] = fmp_part_cmdload(fmp, part); fmp_part_pan_vol_rhythm(work, rhythm, cmd&0x7); break; case 0x88: // 2707 { uint8_t vol = rhythm->volumes[cmd&0x7] + 1; if (vol & 0xe0) vol = 0x1f; rhythm->volumes[cmd&0x7] = vol; } fmp_part_pan_vol_rhythm(work, rhythm, cmd&0x7); break; case 0x98: // 2719 { uint8_t vol = rhythm->volumes[cmd&0x7] - 1; if (vol & 0xe0) vol = 0; rhythm->volumes[cmd&0x7] = vol; } fmp_part_pan_vol_rhythm(work, rhythm, cmd&0x7); break; } } } else { work->opna_writereg(work, 0x10, cmd & rhythm->mask); if (fmp->pdzf.mode == 2) { uint8_t pdzf_keyon = (cmd & 0x3f) & rhythm->mask; bool do_keyon = false; int p; for (p = 0; p < 6; p++) { if ((pdzf_keyon & (1<pans[p]) && fmp->pdzf.rhythm[p&1].enabled) { do_keyon = true; break; } } if (do_keyon) { if (work->ppz8_functbl) { uint8_t volume = rhythm->volumes[p] & 0x0f; uint8_t voice = fmp->pdzf.rhythm[p&1].voice[((rhythm->volumes[p] & 0x10) >> 4)]; uint8_t pan = fmp->pdzf.rhythm[p&1].pan + 5; uint32_t freq = fmp_ppz8_note_freq(fmp->pdzf.rhythm[p&1].note); uint8_t channel = 6; work->ppz8_functbl->channel_play( work->ppz8, channel, voice ); work->ppz8_functbl->channel_volume( work->ppz8, channel, volume ); work->ppz8_functbl->channel_pan( work->ppz8, channel, pan ); work->ppz8_functbl->channel_freq( work->ppz8, channel, freq ); } } } rhythm->len_cnt = (cmd & 0x40) ? rhythm->default_len : fmp_part_cmdload(fmp, part); return; } } } static uint8_t fmp_note2key(uint8_t note) { uint8_t octave = note / 0xc; uint8_t key = note % 0xc; key |= octave << 4; return key; } static void fmp_work_status_init(struct fmdriver_work *work, const struct driver_fmp *fmp) { static const uint8_t fmp_track_map[FMDRIVER_TRACK_NUM] = { FMP_PART_FM_1, FMP_PART_FM_2, FMP_PART_FM_3, FMP_PART_FM_4, FMP_PART_FM_5, FMP_PART_FM_6, FMP_PART_SSG_1, FMP_PART_SSG_2, FMP_PART_SSG_3, FMP_PART_ADPCM, }; for (int t = 0; t < FMDRIVER_TRACK_NUM; t++) { struct fmdriver_track_status *track = &work->track_status[t]; const struct fmp_part *part = &fmp->parts[fmp_track_map[t]]; track->playing = !part->status.off; track->num = (part->pdzf.mode ? part->pdzf.ppz8_channel : part->opna_keyon_out)+1; track->info = FMDRIVER_TRACK_INFO_NORMAL; if (part->type.adpcm) { track->type = FMDRIVER_TRACK_ADPCM; } else if (part->type.ssg) { track->type = FMDRIVER_TRACK_SSG; } else { track->type = FMDRIVER_TRACK_FM; } if (part->type.fm && part->opna_keyon_out > 3) { track->num--; } } } static void fmp_work_status_update(struct fmdriver_work *work, const struct driver_fmp *fmp) { static const uint8_t fmp_track_map[FMDRIVER_TRACK_NUM] = { FMP_PART_FM_1, FMP_PART_FM_2, FMP_PART_FM_3, FMP_PART_FM_4, FMP_PART_FM_5, FMP_PART_FM_6, FMP_PART_SSG_1, FMP_PART_SSG_2, FMP_PART_SSG_3, FMP_PART_ADPCM, }; for (int t = 0; t < FMDRIVER_TRACK_NUM; t++) { struct fmdriver_track_status *track = &work->track_status[t]; const struct fmp_part *part = &fmp->parts[fmp_track_map[t]]; track->playing = !part->status.off; track->num = (part->pdzf.mode ? part->pdzf.ppz8_channel : part->opna_keyon_out)+1; track->info = FMDRIVER_TRACK_INFO_NORMAL; if (part->type.adpcm) { track->actual_key = 0xff; } else if (part->type.ssg) { if (part->u.ssg.env_f.ppz || part->pdzf.mode) { track->info = FMDRIVER_TRACK_INFO_PPZ8; track->actual_key = 0xff; } else { track->actual_key = part->status.rest ? 0xff : fmp_ssg_freq2key(part->prev_freq); } } else { if (part->pdzf.mode) { track->info = FMDRIVER_TRACK_INFO_PPZ8; track->actual_key = 0xff; } else { track->actual_key = part->status.rest ? 0xff : fmp_fm_freq2key(part->prev_freq); } } if (part->type.fm && part->opna_keyon_out > 3) { track->num--; } track->ticks = part->status.off ? 0 : part->tonelen-1; track->ticks_left = part->tonelen_cnt; track->key = part->status.rest ? 0xff : fmp_note2key(part->prev_note); } } // 17f8-1903 static void fmp_timerb(struct fmdriver_work *work, struct driver_fmp *fmp) { // 1805 fmp_set_tempo(work, fmp); // 1813 if (fmp->status.stopped) { // TODO: stopped // jmp 18c7 } // 1829 if (!--fmp->clock_divider) { fmp->total_clocks++; fmp->clock_divider = 10; } // 1840 for (int p = 0; p < 6; p++) { struct fmp_part *part = &fmp->parts[FMP_PART_FM_1+p]; if (part->status.off) continue; fmp_part_cmd(work, fmp, part); fmp_part_fm(work, fmp, part); } { struct fmp_part *part = &fmp->parts[FMP_PART_ADPCM]; if (!part->status.off) { fmp_part_cmd(work, fmp, part); fmp_part_adpcm(work, fmp, part); } } for (int p = 0; p < 3; p++) { struct fmp_part *part = &fmp->parts[FMP_PART_SSG_1+p]; if (part->status.off) continue; fmp_part_cmd(work, fmp, part); fmp_part_ssg(work, fmp, part); if (part->pdzf.mode && part->lfo_f.q) { fmp_part_pdzf_env(work, fmp, part); } } // 187d for (int p = 0; p < 3; p++) { struct fmp_part *part = &fmp->parts[FMP_PART_FM_EX1+p]; if (part->status.off) continue; fmp_part_cmd(work, fmp, part); if (part->status.off) continue; fmp_part_fm(work, fmp, part); if (part->pdzf.mode && part->lfo_f.q) { fmp_part_pdzf_env(work, fmp, part); } } if (!fmp->rhythm.status) { fmp_part_cmd_rhythm(work, fmp); } fmp_work_status_update(work, fmp); } static void fmp_init_parts(struct fmdriver_work *work, struct driver_fmp *fmp) { const uint8_t deflen = fmp->datainfo.bar >> 2; // 3ae7 // FM1, 2, 3, SSG1, 2, 3 for (int i = 0; i < 3; i++) { struct fmp_part *fpart = &fmp->parts[FMP_PART_FM_1+i]; struct fmp_part *spart = &fmp->parts[FMP_PART_SSG_1+i]; spart->default_len = deflen; fpart->default_len = deflen; spart->gate_cmp = 1; fpart->gate_cmp = 1; spart->gate_cnt = 8; fpart->gate_cnt = 8; spart->u.ssg.env.startvol = 0xff; spart->u.ssg.env.attack_rate = 0xff; spart->u.ssg.env.decay_rate = 0xff; spart->u.ssg.env.sustain_lv = 0xff; spart->u.ssg.env.release_rate = 0x0a; fpart->current_vol = 0x1a; fpart->actual_vol = 0x1a; spart->current_vol = 0x0e; } // FM4, 5, 6, ADPCM for (int i = 0; i < 4; i++) { struct fmp_part *part = &fmp->parts[FMP_PART_FM_4+i]; part->default_len = deflen; part->gate_cmp = 1; part->gate_cnt = 8; part->current_vol = 0x1a; part->actual_vol = 0x1a; } { struct fmp_part *part = &fmp->parts[FMP_PART_ADPCM]; part->default_len = deflen; part->gate_cmp = 1; part->gate_cnt = 8; part->current_vol = 0x1a; part->actual_vol = 0x1a; } // FMEX1, 2, 3 for (int i = 0; i < 3; i++) { struct fmp_part *part = &fmp->parts[FMP_PART_FM_EX1+i]; part->default_len = deflen; part->gate_cmp = 1; part->gate_cnt = 8; part->current_vol = 0x1a; part->actual_vol = 0x1a; part->u.fm.slot_mask = 0xff; part->pan_ams_pms = 0xc0; } // 3b5f fmp->rhythm.status = false; fmp->rhythm.len_cnt = 1; fmp->rhythm.default_len = deflen; //fmp->rhythm.loop_now fmp->rhythm.mask = 0x3f; fmp->rhythm.tl_volume = 0x3c; for (int i = 0; i < 6; i++) { fmp->rhythm.volumes[i] = 0x1c; fmp->rhythm.pans[i] = 0xc0; } // couldn't find where this is written, // but this must be necessary work->opna_writereg(work, 0x11, fmp->rhythm.tl_volume); for (int i = 0; i < 6; i++) { fmp_part_pan_vol_rhythm(work, &fmp->rhythm, i); } { // 3b86 struct fmp_part *part = &fmp->parts[FMP_PART_ADPCM]; part->current_vol = 0x80; part->actual_vol = 0x80; part->gate_cmp = 0; work->opna_writereg(work, 0x10b, 0x80); fmp_adpcm_pan(work, fmp, part, 0xc0); } // opna flag mask, reset // work->opna_writereg(work, 0x110, 0x1c); // work->opna_writereg(work, 0x110, 0x80); fmp->timerb = 0xca; fmp->timerb_bak = 0xca; // 3c79 for (int i = 0; i < 6; i++) { fmp->parts[FMP_PART_FM_1+i].current_ptr = fmp->datainfo.partptr[FMP_DATA_FM_1+i]; fmp->parts[FMP_PART_FM_1+i].loop_ptr = fmp->datainfo.loopptr[FMP_DATA_FM_1+i]; } // 3ca3 for (int i = 0; i < 3; i++) { fmp->parts[FMP_PART_SSG_1+i].current_ptr = fmp->datainfo.partptr[FMP_DATA_SSG_1+i]; fmp->parts[FMP_PART_SSG_1+i].loop_ptr = fmp->datainfo.loopptr[FMP_DATA_SSG_1+i]; } fmp->rhythm.part.current_ptr = fmp->datainfo.partptr[FMP_DATA_RHYTHM]; fmp->rhythm.part.loop_ptr = fmp->datainfo.loopptr[FMP_DATA_RHYTHM]; fmp->parts[FMP_PART_ADPCM].current_ptr = fmp->datainfo.partptr[FMP_DATA_ADPCM]; fmp->parts[FMP_PART_ADPCM].loop_ptr = fmp->datainfo.loopptr[FMP_DATA_ADPCM]; // 3d06 for (int i = 0; i < 3; i++) { fmp->parts[FMP_PART_FM_EX1+i].current_ptr = fmp->datainfo.partptr[FMP_DATA_FM_EX1+i]; fmp->parts[FMP_PART_FM_EX1+i].loop_ptr = fmp->datainfo.loopptr[FMP_DATA_FM_EX1+i]; } // 3d2d fmp->part_playing_bit = 0x07ff; fmp->part_loop_bit = 0x07ff; // TODO: other status bit fmp->status.looped = false; fmp->status.stopped = false; fmp->total_clocks = 0; fmp->clock_divider = 10; // 1b64 // 3c36 /* if (work->ppz8_functbl) { work->ppz8_functbl->total_volume(work->ppz8, } */ fmp_fm_pdzf_mode_update(work, fmp, &fmp->parts[FMP_PART_FM_EX1]); fmp_fm_pdzf_mode_update(work, fmp, &fmp->parts[FMP_PART_FM_EX2]); fmp_fm_pdzf_mode_update(work, fmp, &fmp->parts[FMP_PART_FM_EX3]); fmp_ssg_ppz8_pdzf_mode_update(work, fmp, &fmp->parts[FMP_PART_SSG_1]); fmp_ssg_ppz8_pdzf_mode_update(work, fmp, &fmp->parts[FMP_PART_SSG_2]); fmp_ssg_ppz8_pdzf_mode_update(work, fmp, &fmp->parts[FMP_PART_SSG_3]); } static void fmp_struct_init(struct fmdriver_work *work, struct driver_fmp *fmp) { // TODO //fmp->pdzf.mode = 2; // 4e87 fmp->ssg_mix = 0x38; // 3bb7 work->opna_writereg(work, 0x07, fmp->ssg_mix); // 5373 // enable OPNA 4-6 work->opna_writereg(work, 0x29, 0x83); // stop rhythm work->opna_writereg(work, 0x10, 0xbf); // reset ADPCM work->opna_writereg(work, 0x100, 0x21); work->opna_writereg(work, 0x101, 0x02); // fmp->adpcm_c1 = 0x02; // 5394 // on OPNA, increase volume by 8 // because OPNA's FM output is 6db lower than OPN fmp->fm_vol = -8; // 53ca // TODO: part at 0x1426 // 5408 fmp->parts[FMP_PART_SSG_1].type.ssg = true; fmp->parts[FMP_PART_SSG_2].type.ssg = true; fmp->parts[FMP_PART_SSG_3].type.ssg = true; fmp->parts[FMP_PART_SSG_1].opna_keyon_out = 0; fmp->parts[FMP_PART_SSG_2].opna_keyon_out = 1; fmp->parts[FMP_PART_SSG_3].opna_keyon_out = 2; fmp->parts[FMP_PART_SSG_1].part_bit = 0x0040; fmp->parts[FMP_PART_SSG_2].part_bit = 0x0080; fmp->parts[FMP_PART_SSG_3].part_bit = 0x0100; // 5479 fmp->parts[FMP_PART_FM_1].type.fm = true; fmp->parts[FMP_PART_FM_2].type.fm = true; fmp->parts[FMP_PART_FM_3].type.fm = true; fmp->parts[FMP_PART_FM_3].type.fm_3 = true; fmp->parts[FMP_PART_FM_4].type.fm = true; fmp->parts[FMP_PART_FM_5].type.fm = true; fmp->parts[FMP_PART_FM_6].type.fm = true; fmp->parts[FMP_PART_FM_1].opna_keyon_out = 0x00; fmp->parts[FMP_PART_FM_2].opna_keyon_out = 0x01; fmp->parts[FMP_PART_FM_3].opna_keyon_out = 0x02; fmp->parts[FMP_PART_FM_4].opna_keyon_out = 0x04; fmp->parts[FMP_PART_FM_5].opna_keyon_out = 0x05; fmp->parts[FMP_PART_FM_6].opna_keyon_out = 0x06; fmp->parts[FMP_PART_FM_1].part_bit = 0x0001; fmp->parts[FMP_PART_FM_2].part_bit = 0x0002; fmp->parts[FMP_PART_FM_3].part_bit = 0x0004; fmp->parts[FMP_PART_FM_4].part_bit = 0x0008; fmp->parts[FMP_PART_FM_5].part_bit = 0x0010; fmp->parts[FMP_PART_FM_6].part_bit = 0x0020; // 5502 fmp->parts[FMP_PART_ADPCM].type.adpcm = true; fmp->parts[FMP_PART_ADPCM].part_bit = 0x400; fmp->parts[FMP_PART_FM_EX1].type.fm = true; fmp->parts[FMP_PART_FM_EX1].type.fm_3 = true; fmp->parts[FMP_PART_FM_EX2].type.fm = true; fmp->parts[FMP_PART_FM_EX2].type.fm_3 = true; fmp->parts[FMP_PART_FM_EX3].type.fm = true; fmp->parts[FMP_PART_FM_EX3].type.fm_3 = true; fmp->parts[FMP_PART_FM_EX1].opna_keyon_out = 0x02; fmp->parts[FMP_PART_FM_EX2].opna_keyon_out = 0x02; fmp->parts[FMP_PART_FM_EX3].opna_keyon_out = 0x02; fmp->parts[FMP_PART_FM_EX1].part_bit = 0x0800; fmp->parts[FMP_PART_FM_EX2].part_bit = 0x1000; fmp->parts[FMP_PART_FM_EX3].part_bit = 0x2000; fmp->rhythm.part.type.rhythm = true; fmp->rhythm.part.part_bit = 0x0200; // 5625 work->opna_writereg(work, 0x27, 0x30); // pdzf fmp->parts[FMP_PART_SSG_1].pdzf.ppz8_channel = 0; fmp->parts[FMP_PART_SSG_1].pdzf.loopstart32 = -1; fmp->parts[FMP_PART_SSG_1].pdzf.loopend32 = -1; fmp->parts[FMP_PART_SSG_2].pdzf.ppz8_channel = 1; fmp->parts[FMP_PART_SSG_2].pdzf.loopstart32 = -1; fmp->parts[FMP_PART_SSG_2].pdzf.loopend32 = -1; fmp->parts[FMP_PART_SSG_3].pdzf.ppz8_channel = 2; fmp->parts[FMP_PART_SSG_3].pdzf.loopstart32 = -1; fmp->parts[FMP_PART_SSG_3].pdzf.loopend32 = -1; fmp->parts[FMP_PART_FM_EX1].pdzf.ppz8_channel = 3; fmp->parts[FMP_PART_FM_EX1].pdzf.loopstart32 = -1; fmp->parts[FMP_PART_FM_EX1].pdzf.loopend32 = -1; fmp->parts[FMP_PART_FM_EX2].pdzf.ppz8_channel = 4; fmp->parts[FMP_PART_FM_EX2].pdzf.loopstart32 = -1; fmp->parts[FMP_PART_FM_EX2].pdzf.loopend32 = -1; fmp->parts[FMP_PART_FM_EX3].pdzf.ppz8_channel = 5; fmp->parts[FMP_PART_FM_EX3].pdzf.loopstart32 = -1; fmp->parts[FMP_PART_FM_EX3].pdzf.loopend32 = -1; } // 1774 static void fmp_opna_interrupt(struct fmdriver_work *work) { struct driver_fmp *fmp = (struct driver_fmp *)work->driver; if (work->opna_status(work, 0) & 0x02) { fmp_timerb(work, fmp); } } // copy title string (CP932) to fmdriver_work struct, // and detect which PDZF(/Z8X) mode to use static void fmp_title(struct fmdriver_work *work, struct driver_fmp *fmp, uint16_t offset) { int l = 0; int i = 0; static const uint8_t pdzf_str[] = "using PDZF"; const uint8_t *data = fmp->data; uint16_t datalen = fmp->datalen; const uint8_t *pdzf_ptr = pdzf_str; fmp->pdzf.mode = 0; enum { STATE_NORMAL, STATE_ESC, STATE_CSI, STATE_SYNC, } esc_state = STATE_NORMAL; for (int si = 0; ; si++) { if ((offset + i) >= datalen) { work->comment[l][0] = 0; return; } if (i > (FMDRIVER_TITLE_BUFLEN-1)) { return; } uint8_t c = data[offset+si]; if (l >= 3) { if (c) { if (!fmp->pdzf.mode) { fmp->pdzf.mode = 1; } } return; } if (!c) return; switch (esc_state) { case STATE_SYNC: esc_state = STATE_NORMAL; continue; case STATE_ESC: if (c == '[') { esc_state = STATE_CSI; } else if (c == '!') { esc_state = STATE_SYNC; } else { esc_state = STATE_NORMAL; } continue; case STATE_CSI: if (('0' <= c && c <= '9') || c == ';') { continue; } else { esc_state = STATE_NORMAL; continue; } default: break; } // pdzf detection if (c == *pdzf_ptr++) { if (!*pdzf_ptr) { fmp->pdzf.mode = 2; } } else { pdzf_ptr = pdzf_str; } work->comment[l][i] = c; switch (c) { case 0: return; case '\r': break; case '\n': work->comment[l][i] = 0; l++; i = 0; break; case 0x1b: esc_state = STATE_ESC; break; default: i++; break; } } } bool fmp_load(struct driver_fmp *fmp, uint8_t *data, uint16_t datalen) { uint16_t offset = read16le(data); if ((offset+4) > datalen) { FMDRIVER_DEBUG("invalid offset value\n"); return false; } uint8_t dataflags; bool pviname_valid; if ((data[offset] == 'F') && (data[offset+1] == 'M') && (data[offset+2] == 'C')) { FMDRIVER_DEBUG("FMP data\n"); uint8_t dataver = data[offset+3]; fmp->data_version = dataver & 0x0f; if ((dataver & 0xf) >= 0x8) { FMDRIVER_DEBUG("call word 4152\n"); } if (dataver <= 0x29) { FMDRIVER_DEBUG("format:1\n"); if (datalen < 0x1au) { FMDRIVER_DEBUG("file length shorter than header\n"); return false; } fmp->datainfo.partptr[FMP_DATA_FM_1] = read16le(&data[0x02]); fmp->datainfo.partptr[FMP_DATA_FM_2] = read16le(&data[0x04]); fmp->datainfo.partptr[FMP_DATA_FM_3] = read16le(&data[0x06]); fmp->datainfo.partptr[FMP_DATA_FM_4] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_5] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_6] = 0xffff; fmp->datainfo.partptr[FMP_DATA_SSG_1] = read16le(&data[0x08]); fmp->datainfo.partptr[FMP_DATA_SSG_2] = read16le(&data[0x0a]); fmp->datainfo.partptr[FMP_DATA_SSG_3] = read16le(&data[0x0c]); fmp->datainfo.partptr[FMP_DATA_RHYTHM] = 0xffff; fmp->datainfo.partptr[FMP_DATA_ADPCM] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX1] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX2] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX3] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_1] = read16le(&data[0x0e]); fmp->datainfo.loopptr[FMP_DATA_FM_2] = read16le(&data[0x10]); fmp->datainfo.loopptr[FMP_DATA_FM_3] = read16le(&data[0x12]); fmp->datainfo.loopptr[FMP_DATA_FM_4] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_5] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_6] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_SSG_1] = read16le(&data[0x14]); fmp->datainfo.loopptr[FMP_DATA_SSG_2] = read16le(&data[0x16]); fmp->datainfo.loopptr[FMP_DATA_SSG_3] = read16le(&data[0x18]); fmp->datainfo.loopptr[FMP_DATA_RHYTHM] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_ADPCM] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX1] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX2] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX3] = 0xffff; fmp->datainfo.bar = data[0x1a]; dataflags = data[0x1b]; fmp->datainfo.adpcmptr = 0xffff; fmp->datainfo.fmtoneptr = 0x1c; pviname_valid = false; } else if (dataver <= 0x49) { FMDRIVER_DEBUG("format:2\n"); if (datalen < 0x2eu) { FMDRIVER_DEBUG("file length shorter than header\n"); return false; } fmp->datainfo.partptr[FMP_DATA_FM_1] = read16le(&data[0x02]); fmp->datainfo.partptr[FMP_DATA_FM_2] = read16le(&data[0x04]); fmp->datainfo.partptr[FMP_DATA_FM_3] = read16le(&data[0x06]); fmp->datainfo.partptr[FMP_DATA_FM_4] = read16le(&data[0x08]); fmp->datainfo.partptr[FMP_DATA_FM_5] = read16le(&data[0x0a]); fmp->datainfo.partptr[FMP_DATA_FM_6] = read16le(&data[0x0c]); fmp->datainfo.partptr[FMP_DATA_SSG_1] = read16le(&data[0x0e]); fmp->datainfo.partptr[FMP_DATA_SSG_2] = read16le(&data[0x10]); fmp->datainfo.partptr[FMP_DATA_SSG_3] = read16le(&data[0x12]); fmp->datainfo.partptr[FMP_DATA_RHYTHM] = read16le(&data[0x14]); fmp->datainfo.partptr[FMP_DATA_ADPCM] = read16le(&data[0x16]); fmp->datainfo.partptr[FMP_DATA_FM_EX1] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX2] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX3] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_1] = read16le(&data[0x18]); fmp->datainfo.loopptr[FMP_DATA_FM_2] = read16le(&data[0x1a]); fmp->datainfo.loopptr[FMP_DATA_FM_3] = read16le(&data[0x1c]); fmp->datainfo.loopptr[FMP_DATA_FM_4] = read16le(&data[0x1e]); fmp->datainfo.loopptr[FMP_DATA_FM_5] = read16le(&data[0x20]); fmp->datainfo.loopptr[FMP_DATA_FM_6] = read16le(&data[0x22]); fmp->datainfo.loopptr[FMP_DATA_SSG_1] = read16le(&data[0x24]); fmp->datainfo.loopptr[FMP_DATA_SSG_2] = read16le(&data[0x26]); fmp->datainfo.loopptr[FMP_DATA_SSG_3] = read16le(&data[0x28]); fmp->datainfo.loopptr[FMP_DATA_RHYTHM] = read16le(&data[0x2a]); fmp->datainfo.loopptr[FMP_DATA_ADPCM] = read16le(&data[0x2c]); fmp->datainfo.loopptr[FMP_DATA_FM_EX1] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX2] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX3] = 0xffff; fmp->datainfo.bar = data[0x2e]; dataflags = data[0x2f]; fmp->datainfo.adpcmptr = read16le(&data[0x30]); fmp->datainfo.fmtoneptr = 0x32; pviname_valid = true; } else if (dataver <= 0x69) { FMDRIVER_DEBUG("format:3\n"); if (datalen < 0x5eu) { FMDRIVER_DEBUG("file length shorter than header\n"); return false; } fmp->datainfo.partptr[FMP_DATA_FM_1] = read16le(&data[0x02]); fmp->datainfo.partptr[FMP_DATA_FM_2] = read16le(&data[0x04]); fmp->datainfo.partptr[FMP_DATA_FM_3] = read16le(&data[0x06]); fmp->datainfo.partptr[FMP_DATA_FM_4] = read16le(&data[0x08]); fmp->datainfo.partptr[FMP_DATA_FM_5] = read16le(&data[0x0a]); fmp->datainfo.partptr[FMP_DATA_FM_6] = read16le(&data[0x0c]); fmp->datainfo.partptr[FMP_DATA_SSG_1] = read16le(&data[0x0e]); fmp->datainfo.partptr[FMP_DATA_SSG_2] = read16le(&data[0x10]); fmp->datainfo.partptr[FMP_DATA_SSG_3] = read16le(&data[0x12]); fmp->datainfo.partptr[FMP_DATA_RHYTHM] = read16le(&data[0x14]); fmp->datainfo.partptr[FMP_DATA_ADPCM] = read16le(&data[0x16]); fmp->datainfo.partptr[FMP_DATA_FM_EX1] = read16le(&data[0x18]); fmp->datainfo.partptr[FMP_DATA_FM_EX2] = read16le(&data[0x1a]); fmp->datainfo.partptr[FMP_DATA_FM_EX3] = read16le(&data[0x1c]); fmp->datainfo.loopptr[FMP_DATA_FM_1] = read16le(&data[0x30]); fmp->datainfo.loopptr[FMP_DATA_FM_2] = read16le(&data[0x32]); fmp->datainfo.loopptr[FMP_DATA_FM_3] = read16le(&data[0x34]); fmp->datainfo.loopptr[FMP_DATA_FM_4] = read16le(&data[0x36]); fmp->datainfo.loopptr[FMP_DATA_FM_5] = read16le(&data[0x38]); fmp->datainfo.loopptr[FMP_DATA_FM_6] = read16le(&data[0x3a]); fmp->datainfo.loopptr[FMP_DATA_SSG_1] = read16le(&data[0x3c]); fmp->datainfo.loopptr[FMP_DATA_SSG_2] = read16le(&data[0x3e]); fmp->datainfo.loopptr[FMP_DATA_SSG_3] = read16le(&data[0x40]); fmp->datainfo.loopptr[FMP_DATA_RHYTHM] = read16le(&data[0x42]); fmp->datainfo.loopptr[FMP_DATA_ADPCM] = read16le(&data[0x44]); fmp->datainfo.loopptr[FMP_DATA_FM_EX1] = read16le(&data[0x46]); fmp->datainfo.loopptr[FMP_DATA_FM_EX2] = read16le(&data[0x48]); fmp->datainfo.loopptr[FMP_DATA_FM_EX3] = read16le(&data[0x4a]); fmp->datainfo.bar = data[0x5e]; dataflags = data[0x5f]; fmp->datainfo.adpcmptr = read16le(&data[0x60]); fmp->datainfo.fmtoneptr = 0x66; pviname_valid = true; } else { FMDRIVER_DEBUG("invalid format information\n"); return false; } } else if ((data[offset] == 'E') && (data[offset+1] == 'L') && (data[offset+2] == 'F')) { FMDRIVER_DEBUG("PLAY6 data\n"); if (datalen < 0x2au) { FMDRIVER_DEBUG("file length shorter than header\n"); return false; } fmp->data_version = 0x07; fmp->datainfo.partptr[FMP_DATA_FM_1] = read16le(&data[0x02]); fmp->datainfo.partptr[FMP_DATA_FM_2] = read16le(&data[0x04]); fmp->datainfo.partptr[FMP_DATA_FM_3] = read16le(&data[0x06]); fmp->datainfo.partptr[FMP_DATA_FM_4] = read16le(&data[0x08]); fmp->datainfo.partptr[FMP_DATA_FM_5] = read16le(&data[0x0a]); fmp->datainfo.partptr[FMP_DATA_FM_6] = read16le(&data[0x0c]); fmp->datainfo.partptr[FMP_DATA_SSG_1] = read16le(&data[0x0e]); fmp->datainfo.partptr[FMP_DATA_SSG_2] = read16le(&data[0x10]); fmp->datainfo.partptr[FMP_DATA_SSG_3] = read16le(&data[0x12]); fmp->datainfo.partptr[FMP_DATA_RHYTHM] = read16le(&data[0x14]); fmp->datainfo.partptr[FMP_DATA_ADPCM] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX1] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX2] = 0xffff; fmp->datainfo.partptr[FMP_DATA_FM_EX3] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_1] = read16le(&data[0x16]); fmp->datainfo.loopptr[FMP_DATA_FM_2] = read16le(&data[0x18]); fmp->datainfo.loopptr[FMP_DATA_FM_3] = read16le(&data[0x1a]); fmp->datainfo.loopptr[FMP_DATA_FM_4] = read16le(&data[0x1c]); fmp->datainfo.loopptr[FMP_DATA_FM_5] = read16le(&data[0x1e]); fmp->datainfo.loopptr[FMP_DATA_FM_6] = read16le(&data[0x20]); fmp->datainfo.loopptr[FMP_DATA_SSG_1] = read16le(&data[0x22]); fmp->datainfo.loopptr[FMP_DATA_SSG_2] = read16le(&data[0x24]); fmp->datainfo.loopptr[FMP_DATA_SSG_3] = read16le(&data[0x26]); fmp->datainfo.loopptr[FMP_DATA_RHYTHM] = read16le(&data[0x28]); fmp->datainfo.loopptr[FMP_DATA_ADPCM] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX1] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX2] = 0xffff; fmp->datainfo.loopptr[FMP_DATA_FM_EX3] = 0xffff; fmp->datainfo.bar = data[0x2a]; dataflags = data[0x2b]; fmp->datainfo.adpcmptr = 0xffff; fmp->datainfo.fmtoneptr = 0x2e; pviname_valid = false; } else { return false; } fmp->datainfo.flags.q = dataflags & 0x01; fmp->datainfo.flags.ppz = dataflags & 0x02; fmp->datainfo.flags.lfo_octave_fix = dataflags & 0x04; { uint16_t ptr = read16le(&data[0x00]) - 2; fmp->datainfo.ssgtoneptr = ((ptr+2) > datalen) ? 0xffff : read16le(&data[ptr]); } // 3a70 //zero reset part struct FMDRIVER_DEBUG("bar: %d\n", fmp->datainfo.bar); for (int i = 0; i < 6; i++) { FMDRIVER_DEBUG(" FM#%d: %04X %04X\n", i+1, fmp->datainfo.partptr[i], fmp->datainfo.loopptr[i]); } for (int i = 0; i < 3; i++) { FMDRIVER_DEBUG(" SSG#%d: %04X %04X\n", i+1, fmp->datainfo.partptr[FMP_DATA_SSG_1+i], fmp->datainfo.loopptr[FMP_DATA_SSG_1+i]); } FMDRIVER_DEBUG(" RHYTHM: %04X %04X\n", fmp->datainfo.partptr[FMP_DATA_RHYTHM], fmp->datainfo.loopptr[FMP_DATA_RHYTHM]); FMDRIVER_DEBUG(" ADPCM: %04X %04X\n", fmp->datainfo.partptr[FMP_DATA_ADPCM], fmp->datainfo.loopptr[FMP_DATA_ADPCM]); for (int i = 0; i < 3; i++) { FMDRIVER_DEBUG(" FMEX#%d: %04X %04X\n", i+1, fmp->datainfo.partptr[FMP_DATA_FM_EX1+i], fmp->datainfo.loopptr[FMP_DATA_FM_EX1+i]); } FMDRIVER_DEBUG(" FMTONEPTR: %04X\n", fmp->datainfo.fmtoneptr); FMDRIVER_DEBUG(" SSGTONEPTR: %04X\n", fmp->datainfo.ssgtoneptr); FMDRIVER_DEBUG(" data version: 0x%01X\n", fmp->data_version); uint16_t pcmptr = read16le(data)-0x12; if (pcmptr <= datalen && (pcmptr+16) < datalen) { for (int i = 0; i < 8; i++) { if (pviname_valid) { fmp->pvi_name[i] = data[pcmptr+8+i]; } if (pviname_valid && fmp->datainfo.flags.ppz) { fmp->ppz_name[i] = data[pcmptr+0+i]; } } } fmp->bar_tickcnt = fmp->datainfo.bar; fmp->data = data; fmp->datalen = datalen; return true; } void fmp_init(struct fmdriver_work *work, struct driver_fmp *fmp) { fmp_title(work, fmp, read16le(fmp->data)+4); fmp_struct_init(work, fmp); fmp_init_parts(work, fmp); uint16_t fmtoneptr = fmp->datainfo.fmtoneptr; FMDRIVER_DEBUG(" 000 %03d %03d\n", fmp->data[fmtoneptr+0x18]&0x7, (fmp->data[fmtoneptr+0x18]>>3)&0x7 ); fmp_set_tempo(work, fmp); work->driver = fmp; work->driver_opna_interrupt = fmp_opna_interrupt; fmp_work_status_init(work, fmp); } // 4235 bool fmp_adpcm_load(struct fmdriver_work *work, uint8_t *data, size_t datalen) { if (datalen < 0x210) return false; if (datalen > (0x210+(1<<18))) return false; struct driver_fmp *fmp = (struct driver_fmp *)work->driver; fmp->adpcm_deltat = read16le(&data[0x8]); // fmp->adpcm_c1 = data[0x0a]; for (int i = 0; i < 0x80; i++) { fmp->adpcm_startaddr[i] = read16le(&data[0x10+i*4+0]); fmp->adpcm_endaddr[i] = read16le(&data[0x10+i*4+2]); } work->opna_writereg(work, 0x100, 0x01); work->opna_writereg(work, 0x110, 0x13); work->opna_writereg(work, 0x110, 0x80); work->opna_writereg(work, 0x100, 0x60); work->opna_writereg(work, 0x101, fmp->adpcm_c1); work->opna_writereg(work, 0x102, 0x00); work->opna_writereg(work, 0x103, 0x00); work->opna_writereg(work, 0x104, 0xff); work->opna_writereg(work, 0x105, 0xff); work->opna_writereg(work, 0x10c, 0xff); work->opna_writereg(work, 0x10d, 0xff); // 42ca for (uint32_t i = 0x210; i < datalen; i++) { work->opna_writereg(work, 0x108, data[i]); } work->opna_writereg(work, 0x110, 0x0c); work->opna_writereg(work, 0x100, 0x01); return true; }