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
|
#include "opnatimer.h"
#include "opna.h"
#include "oscillo/oscillo.h"
enum {
TIMERA_BITS = 10,
TIMERB_SHIFT = 4,
TIMERB_BITS = 8 + TIMERB_SHIFT,
};
void opna_timer_reset(struct opna_timer *timer, struct opna *opna) {
timer->opna = opna;
timer->status = 0;
timer->interrupt_cb = 0;
timer->interrupt_userptr = 0;
timer->mix_cb = 0;
timer->mix_userptr = 0;
timer->timerb = 0;
timer->timerb_load = false;
timer->timerb_enable = false;
timer->timerb_cnt = 0;
}
uint8_t opna_timer_status(const struct opna_timer *timer) {
return timer->status;
}
void opna_timer_set_int_callback(struct opna_timer *timer, opna_timer_int_cb_t func, void *userptr) {
timer->interrupt_cb = func;
timer->interrupt_userptr = userptr;
}
void opna_timer_set_mix_callback(struct opna_timer *timer, opna_timer_mix_cb_t func, void *userptr) {
timer->mix_cb = func;
timer->mix_userptr = userptr;
}
void opna_timer_writereg(struct opna_timer *timer, unsigned reg, unsigned val) {
val &= 0xff;
opna_writereg(timer->opna, reg, val);
switch (reg) {
case 0x24:
timer->timera &= ~0xff;
timer->timera |= val;
break;
case 0x25:
timer->timera &= 0xff;
timer->timera |= ((val & 3) << 8);
break;
case 0x26:
timer->timerb = val;
timer->timerb_cnt = timer->timerb << TIMERB_SHIFT;
break;
case 0x27:
timer->timera_load = val & (1<<0);
timer->timera_enable = val & (1<<2);
timer->timerb_load = val & (1<<1);
timer->timerb_enable = val & (1<<3);
if (val & (1<<4)) {
timer->status &= ~(1<<0);
}
if (val & (1<<5)) {
//timer->timerb_cnt = timer->timerb << TIMERB_SHIFT;
timer->status &= ~(1<<1);
}
}
}
void opna_timer_mix(struct opna_timer *timer, int16_t *buf, unsigned samples) {
opna_timer_mix_oscillo(timer, buf, samples, 0);
}
void opna_timer_mix_oscillo(struct opna_timer *timer, int16_t *buf, unsigned samples, struct oscillodata *oscillo) {
do {
unsigned generate_samples = samples;
if (timer->timerb_enable && timer->timerb_load) {
unsigned timerb_samples = (1<<TIMERB_BITS) - timer->timerb_cnt;
if (timerb_samples < generate_samples) {
generate_samples = timerb_samples;
}
}
if (timer->timera_enable && timer->timera_load) {
unsigned timera_samples = (1<<TIMERA_BITS) - timer->timera;
if (timera_samples < generate_samples) {
generate_samples = timera_samples;
}
}
opna_mix_oscillo(timer->opna, buf, generate_samples, oscillo);
if (timer->mix_cb) {
timer->mix_cb(timer->mix_userptr, buf, generate_samples);
}
buf += generate_samples*2;
samples -= generate_samples;
if (timer->timera_load) {
timer->timera = (timer->timera + generate_samples) & ((1<<TIMERA_BITS)-1);
if (!timer->timera && timer->timera_enable) {
if (!(timer->status & (1<<0))) {
timer->status |= (1<<0);
timer->interrupt_cb(timer->interrupt_userptr);
}
}
timer->timera &= (1<<TIMERA_BITS)-1;
}
if (timer->timerb_load) {
timer->timerb_cnt = (timer->timerb_cnt + generate_samples) & ((1<<TIMERB_BITS)-1);
if (!timer->timerb_cnt && timer->timerb_enable) {
if (!(timer->status & (1<<1))) {
timer->status |= (1<<1);
timer->interrupt_cb(timer->interrupt_userptr);
}
}
}
} while (samples);
}
|
