mirror of https://github.com/dcoredump/dexed.git
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
287 lines
9.8 KiB
287 lines
9.8 KiB
/*
|
|
==============================================================================
|
|
|
|
EngineMkI.cpp
|
|
Created: 25 Aug 2014 12:08:00am
|
|
Author: Pascal Gauthier
|
|
|
|
==============================================================================
|
|
*/
|
|
|
|
#include "EngineMkI.h"
|
|
|
|
#include <math.h>
|
|
#include <cstdlib>
|
|
|
|
#include "sin.h"
|
|
|
|
|
|
void EngineMkI::compute(int32_t *output, FmOpParams *params, int algorithm,
|
|
int32_t *fb_buf, int feedback_shift, const Controllers *controllers) {
|
|
const int kLevelThresh = 1120;
|
|
const FmAlgorithm alg = algorithms[algorithm];
|
|
bool has_contents[3] = { true, false, false };
|
|
|
|
for (int op = 0; op < 6; op++) {
|
|
int flags = alg.ops[op];
|
|
bool add = (flags & OUT_BUS_ADD) != 0;
|
|
FmOpParams ¶m = params[op];
|
|
int inbus = (flags >> 4) & 3;
|
|
int outbus = flags & 3;
|
|
int32_t *outptr = (outbus == 0) ? output : buf_[outbus - 1].get();
|
|
int32_t gain1 = param.gain[0];
|
|
int32_t gain2 = param.gain[1];
|
|
/*
|
|
if (gain1 >= kLevelThresh || gain2 >= kLevelThresh) {
|
|
|
|
if (!has_contents[outbus]) {
|
|
add = false;
|
|
}
|
|
|
|
if (inbus == 0 || !has_contents[inbus]) {
|
|
// PG: this is my 'dirty' implementation of FB for 2 and 3 operators...
|
|
// still needs some tuning...
|
|
if ((flags & 0xc0) == 0xc0 && feedback_shift < 16) {
|
|
switch ( algorithm ) {
|
|
// two operator feedback, process exception for ALGO 6
|
|
case 5 :
|
|
FmOpKernel::compute_fb2(outptr, params, fb_buf, feedback_shift);
|
|
param.phase += param.freq << LG_N;
|
|
params[1].phase += param.freq + params[1].freq << LG_N; // yuk, hack, we already processed op-5
|
|
op++; // ignore next operator;
|
|
break;
|
|
// three operator feedback, process exception for ALGO 4
|
|
case 3 :
|
|
FmOpKernel::compute_fb3(outptr, params, fb_buf, feedback_shift);
|
|
param.phase += param.freq << LG_N;
|
|
params[1].phase += param.freq + params[1].freq << LG_N; // hack, we already processed op-5 - op-4
|
|
params[2].phase += param.freq + params[1].freq + params[2].freq << LG_N; // yuk yuk
|
|
op += 2; // ignore the 2 other operators
|
|
break;
|
|
default:
|
|
// one operator feedback, normal proces
|
|
//cout << "\t" << op << " fb " << inbus << outbus << add << endl;
|
|
FmOpKernel::compute_fb(outptr, param.phase, param.freq,gain1, gain2, fb_buf, feedback_shift, add);
|
|
param.phase += param.freq << LG_N;
|
|
break;
|
|
}
|
|
has_contents[outbus] = true;
|
|
continue;
|
|
} else {
|
|
// cout << op << " pure " << inbus << outbus << add << endl;
|
|
FmOpKernel::compute_pure(outptr, param.phase, param.freq, gain1, gain2, add);
|
|
}
|
|
|
|
} else {
|
|
|
|
// cout << op << " normal " << inbus << outbus << " " << param.freq << add << endl;
|
|
FmOpKernel::compute(outptr, buf_[inbus - 1].get(),
|
|
param.phase, param.freq, gain1, gain2, add);
|
|
}
|
|
|
|
has_contents[outbus] = true;
|
|
|
|
} else if (!add) {
|
|
has_contents[outbus] = false;
|
|
|
|
}*/
|
|
param.phase += param.freq << LG_N;
|
|
}
|
|
}
|
|
/*
|
|
void FmOpKernel::compute(int32_t *output, const int32_t *input,
|
|
int32_t phase0, int32_t freq,
|
|
int32_t gain1, int32_t gain2, bool add, const Controllers *controllers) {
|
|
int32_t dgain = (gain2 - gain1 + (N >> 1)) >> LG_N;
|
|
int32_t gain = gain1;
|
|
int32_t phase = phase0;
|
|
if (hasNeon()) {
|
|
#ifdef HAVE_NEON
|
|
neon_fm_kernel(input, add ? output : zeros, output, N,
|
|
phase0, freq, gain, dgain);
|
|
#endif
|
|
} else {
|
|
if (add) {
|
|
for (int i = 0; i < N; i++) {
|
|
gain += dgain;
|
|
int32_t y = Sin::lookup(phase + input[i]);
|
|
y &= controllers->sinBitFilter;
|
|
int32_t y1 = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] += y1;
|
|
phase += freq;
|
|
}
|
|
} else {
|
|
for (int i = 0; i < N; i++) {
|
|
gain += dgain;
|
|
int32_t y = Sin::lookup(phase + input[i]);
|
|
y &= controllers->sinBitFilter;
|
|
int32_t y1 = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] = y1;
|
|
phase += freq;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void FmOpKernel::compute_pure(int32_t *output, int32_t phase0, int32_t freq,
|
|
int32_t gain1, int32_t gain2, bool add, const Controllers *controllers) {
|
|
int32_t dgain = (gain2 - gain1 + (N >> 1)) >> LG_N;
|
|
int32_t gain = gain1;
|
|
int32_t phase = phase0;
|
|
if (hasNeon()) {
|
|
#ifdef HAVE_NEON
|
|
neon_fm_kernel(zeros, add ? output : zeros, output, N,
|
|
phase0, freq, gain, dgain);
|
|
#endif
|
|
} else {
|
|
if (add) {
|
|
for (int i = 0; i < N; i++) {
|
|
gain += dgain;
|
|
int32_t y = Sin::lookup(phase);
|
|
y &= controllers->sinBitFilter;
|
|
int32_t y1 = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] += y1;
|
|
phase += freq;
|
|
}
|
|
} else {
|
|
for (int i = 0; i < N; i++) {
|
|
gain += dgain;
|
|
int32_t y = Sin::lookup(phase);
|
|
y &= controllers->sinBitFilter;
|
|
int32_t y1 = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] = y1;
|
|
phase += freq;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
#define noDOUBLE_ACCURACY
|
|
#define HIGH_ACCURACY
|
|
|
|
void FmOpKernel::compute_fb(int32_t *output, int32_t phase0, int32_t freq,
|
|
int32_t gain1, int32_t gain2,
|
|
int32_t *fb_buf, int fb_shift, bool add, const Controllers *controllers) {
|
|
int32_t dgain = (gain2 - gain1 + (N >> 1)) >> LG_N;
|
|
int32_t gain = gain1;
|
|
int32_t phase = phase0;
|
|
int32_t y0 = fb_buf[0];
|
|
int32_t y = fb_buf[1];
|
|
if (add) {
|
|
for (int i = 0; i < N; i++) {
|
|
gain += dgain;
|
|
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1);
|
|
y0 = y;
|
|
y = Sin::lookup(phase + scaled_fb);
|
|
y &= controllers->sinBitFilter;
|
|
y = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] += y;
|
|
phase += freq;
|
|
}
|
|
} else {
|
|
for (int i = 0; i < N; i++) {
|
|
gain += dgain;
|
|
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1);
|
|
y0 = y;
|
|
y = Sin::lookup(phase + scaled_fb);
|
|
y &= controllers->sinBitFilter;
|
|
y = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] = y;
|
|
phase += freq;
|
|
}
|
|
}
|
|
fb_buf[0] = y0;
|
|
fb_buf[1] = y;
|
|
}
|
|
|
|
|
|
// exclusively used for ALGO 6 with feedback
|
|
void FmOpKernel::compute_fb2(int32_t *output, FmOpParams *parms, int32_t *fb_buf, int fb_shift, const Controllers *cont) {
|
|
int32_t dgain[2];
|
|
int32_t gain[2];
|
|
int32_t phase[2];
|
|
int32_t y0 = fb_buf[0];
|
|
int32_t y = fb_buf[1];
|
|
|
|
phase[0] = parms[0].phase;
|
|
phase[1] = parms[1].phase;
|
|
|
|
dgain[0] = (parms[0].gain[1] - parms[0].gain[0] + (N >> 1)) >> LG_N;
|
|
dgain[1] = (parms[1].gain[1] - parms[1].gain[0] + (N >> 1)) >> LG_N;
|
|
|
|
gain[0] = parms[0].gain[0];
|
|
gain[1] = parms[1].gain[1];
|
|
|
|
for (int i = 0; i < N; i++) {
|
|
// op 0
|
|
gain[0] += dgain[0];
|
|
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1);
|
|
y0 = y;
|
|
y = Sin::lookup(phase[0] + scaled_fb);
|
|
y = ((int64_t)y * (int64_t)gain) >> 24;
|
|
phase[0] += parms[0].freq;
|
|
|
|
// op 1
|
|
gain[1] += dgain[1];
|
|
scaled_fb = (y0 + y) >> (fb_shift + 1);
|
|
y0 = y;
|
|
y = Sin::lookup(phase[1] + scaled_fb + y);
|
|
y = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] = y;
|
|
phase[1] += parms[1].freq;
|
|
}
|
|
fb_buf[0] = y0;
|
|
fb_buf[1] = y;
|
|
}
|
|
|
|
// exclusively used for ALGO 4 with feedback
|
|
void FmOpKernel::compute_fb3(int32_t *output, FmOpParams *parms, int32_t *fb_buf, int fb_shift, const Controllers *conts) {
|
|
int32_t dgain[3];
|
|
int32_t gain[3];
|
|
int32_t phase[3];
|
|
int32_t y0 = fb_buf[0];
|
|
int32_t y = fb_buf[1];
|
|
|
|
phase[0] = parms[0].phase;
|
|
phase[1] = parms[1].phase;
|
|
phase[2] = parms[2].phase;
|
|
|
|
dgain[0] = (parms[0].gain[1] - parms[0].gain[0] + (N >> 1)) >> LG_N;
|
|
dgain[1] = (parms[1].gain[1] - parms[1].gain[0] + (N >> 1)) >> LG_N;
|
|
dgain[2] = (parms[2].gain[1] - parms[2].gain[0] + (N >> 1)) >> LG_N;
|
|
|
|
gain[0] = parms[0].gain[0];
|
|
gain[1] = parms[1].gain[0];
|
|
gain[2] = parms[2].gain[0];
|
|
|
|
for (int i = 0; i < N; i++) {
|
|
// op 0
|
|
gain[0] += dgain[0];
|
|
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1);
|
|
y0 = y;
|
|
y = Sin::lookup(phase[0] + scaled_fb);
|
|
y = ((int64_t)y * (int64_t)gain) >> 24;
|
|
phase[0] += parms[0].freq;
|
|
|
|
// op 1
|
|
gain[1] += dgain[1];
|
|
scaled_fb = (y0 + y) >> (fb_shift + 1);
|
|
y0 = y;
|
|
y = Sin::lookup(phase[1] + scaled_fb + y);
|
|
y = ((int64_t)y * (int64_t)gain) >> 24;
|
|
phase[1] += parms[1].freq;
|
|
|
|
// op 2
|
|
gain[2] += dgain[2];
|
|
scaled_fb = (y0 + y) >> (fb_shift + 1);
|
|
y0 = y;
|
|
y = Sin::lookup(phase[2] + scaled_fb + y);
|
|
y = ((int64_t)y * (int64_t)gain) >> 24;
|
|
output[i] = y;
|
|
phase[2] += parms[2].freq;
|
|
}
|
|
fb_buf[0] = y0;
|
|
fb_buf[1] = y;
|
|
}
|
|
|
|
*/ |