forked from vampirefrog/mdxtools
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathfm_opm_driver.c
153 lines (123 loc) · 5.39 KB
/
fm_opm_driver.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
#include "fm_opm_driver.h"
static int mdx_note_to_opm(int note) {
uint8_t tbl[] = {
0x0, // D#
0x1, // E
0x2, // F
0x4, // F#
0x5, // G
0x6, // G#
0x8, // A
0x9, // A#
0xA, // B
0xC, // C
0xD, // C#
0xE, // D
};
return (note / 12) * 16 + tbl[note % 12];
}
static void fm_opm_driver_reset_key_sync(struct fm_driver *driver, int channel) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, 0x01, 0x02);
fm_opm_driver_write(fmdrv, 0x01, 0x00);
}
static void fm_opm_driver_set_pms_ams(struct fm_driver *driver, int channel, uint8_t pms_ams) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, 0x38 + channel, pms_ams);
}
static void fm_opm_driver_set_pitch(struct fm_driver *driver, int channel, int pitch) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, 0x28 + channel, mdx_note_to_opm(pitch >> 14));
fm_opm_driver_write(fmdrv, 0x30 + channel, (pitch >> 6) & 0xfc);
}
static void fm_opm_driver_set_tl(struct fm_driver *driver, int channel, uint8_t tl, uint8_t *v) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
const uint8_t con_masks[8] = {
0x08, 0x08, 0x08, 0x08, 0x0c, 0x0e, 0x0e, 0x0f,
};
int mask = 1;
for(int i = 0; i < 4; i++, mask <<= 1) {
int op_vol = v[7 + i];
if((con_masks[v[1] & 0x07] & mask) > 0) {
int vol = tl + op_vol;
if(vol > 0x7f) vol = 0x7f;
fm_opm_driver_write(fmdrv, 0x60 + i * 8 + channel, vol); // TL
} else {
fm_opm_driver_write(fmdrv, 0x60 + i * 8 + channel, op_vol); // TL
}
}
}
static void fm_opm_driver_note_on(struct fm_driver *driver, int channel, uint8_t op_mask, uint8_t *v) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, 0x08, ((op_mask & 0x0f) << 3) | (channel & 0x07)); // Key On
}
static void fm_opm_driver_note_off(struct fm_driver *driver, int channel) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, 0x08, channel & 0x07);
}
static void fm_opm_driver_write_opm_reg(struct fm_driver *driver, uint8_t reg, uint8_t data) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, reg, data);
}
static void fm_opm_driver_set_pan(struct fm_driver *driver, int channel, uint8_t pan, uint8_t *v) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, 0x20 + channel, (pan << 6) | v[1]); // PAN, FL, CON
}
static void fm_opm_driver_set_noise_freq(struct fm_driver *driver, int channel, int freq) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
// TODO is this correct? not writing NE flag
fm_opm_driver_write(fmdrv, 0x0F, freq & 0x1f);
}
static void fm_opm_driver_load_voice(struct fm_driver *driver, int channel, uint8_t *v, int opm_volume, int pan) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
for(int i = 0; i < 4; i++)
fm_opm_driver_write(fmdrv, 0x40 + i * 8 + channel, v[ 3 + i]); // DT1, MUL
fm_opm_driver_set_tl(driver, channel, opm_volume, v);
for(int i = 0; i < 4; i++)
fm_opm_driver_write(fmdrv, 0x80 + i * 8 + channel, v[11 + i]); // KS, AR
for(int i = 0; i < 4; i++)
fm_opm_driver_write(fmdrv, 0xa0 + i * 8 + channel, v[15 + i]); // AME, D1R
for(int i = 0; i < 4; i++)
fm_opm_driver_write(fmdrv, 0xc0 + i * 8 + channel, v[19 + i]); // DT2, D2R
for(int i = 0; i < 4; i++)
fm_opm_driver_write(fmdrv, 0xe0 + i * 8 + channel, v[23 + i]); // D1L, RR
fm_opm_driver_write(fmdrv, 0x20 + channel, (pan << 6) | v[1]); // PAN, FL, CON
}
static void fm_opm_driver_load_lfo(struct fm_driver *driver, int channel, uint8_t wave, uint8_t freq, uint8_t pmd, uint8_t amd) {
struct fm_opm_driver *fmdrv = (struct fm_opm_driver *)driver;
fm_opm_driver_write(fmdrv, 0x19, 0x00); // YM2151: LFO Amplitude Modul. Depth
fm_opm_driver_write(fmdrv, 0x1b, wave & 0x03); // YM2151: LFO Wave Select
fm_opm_driver_write(fmdrv, 0x18, freq); // YM2151: LFO Frequency
if(pmd & 0x7f) fm_opm_driver_write(fmdrv, 0x19, pmd); // YM2151: LFO Phase Modul. Depth
if(amd) fm_opm_driver_write(fmdrv, 0x19, amd); // YM2151: LFO Amplitude Modul. Depth
}
void fm_opm_driver_write(struct fm_opm_driver *driver, uint8_t reg, uint8_t val) {
if(driver->write)
driver->write(driver, reg, val);
}
void fm_opm_driver_init(struct fm_opm_driver *driver) {
fm_driver_init(&driver->fm_driver);
driver->fm_driver.reset_key_sync = fm_opm_driver_reset_key_sync;
driver->fm_driver.set_pms_ams = fm_opm_driver_set_pms_ams;
driver->fm_driver.set_pitch = fm_opm_driver_set_pitch;
driver->fm_driver.set_tl = fm_opm_driver_set_tl;
driver->fm_driver.note_on = fm_opm_driver_note_on;
driver->fm_driver.note_off = fm_opm_driver_note_off;
driver->fm_driver.write_opm_reg = fm_opm_driver_write_opm_reg;
driver->fm_driver.set_pan = fm_opm_driver_set_pan;
driver->fm_driver.set_noise_freq = fm_opm_driver_set_noise_freq;
driver->fm_driver.load_voice = fm_opm_driver_load_voice;
driver->fm_driver.load_lfo = fm_opm_driver_load_lfo;
// reset registers
for(int i = 0; i < 0x60; i++)
fm_opm_driver_write(driver, i, 0x00);
for(int i = 0x60; i < 0x80; i++)
fm_opm_driver_write(driver, i, 0x7f);
for(int i = 0x80; i < 0xe0; i++)
fm_opm_driver_write(driver, i, 0x00);
for(int i = 0xe0; i <= 0xff; i++)
fm_opm_driver_write(driver, i, 0x0f);
// Key off
for(int i = 0; i < 8; i++)
fm_opm_driver_write(driver, 0x08, i);
}