Small fix for note refresh initialization of Dexed instances.dev
Holger Wirtz
2 years ago
parent
eaf7736830
commit
c5b3a4df5a
@ -1,88 +0,0 @@ |
||||
# ---> C++ |
||||
# Prerequisites |
||||
*.d |
||||
|
||||
# Compiled Object files |
||||
*.slo |
||||
*.lo |
||||
*.o |
||||
*.obj |
||||
|
||||
# Precompiled Headers |
||||
*.gch |
||||
*.pch |
||||
|
||||
# Compiled Dynamic libraries |
||||
*.so |
||||
*.dylib |
||||
*.dll |
||||
|
||||
# Fortran module files |
||||
*.mod |
||||
*.smod |
||||
|
||||
# Compiled Static libraries |
||||
*.lai |
||||
*.la |
||||
*.a |
||||
*.lib |
||||
|
||||
# Executables |
||||
*.exe |
||||
*.out |
||||
*.app |
||||
|
||||
# ---> C |
||||
# Prerequisites |
||||
*.d |
||||
|
||||
# Object files |
||||
*.o |
||||
*.ko |
||||
*.obj |
||||
*.elf |
||||
|
||||
# Linker output |
||||
*.ilk |
||||
*.map |
||||
*.exp |
||||
|
||||
# Precompiled Headers |
||||
*.gch |
||||
*.pch |
||||
|
||||
# Libraries |
||||
*.lib |
||||
*.a |
||||
*.la |
||||
*.lo |
||||
|
||||
# Shared objects (inc. Windows DLLs) |
||||
*.dll |
||||
*.so |
||||
*.so.* |
||||
*.dylib |
||||
|
||||
# Executables |
||||
*.exe |
||||
*.out |
||||
*.app |
||||
*.i*86 |
||||
*.x86_64 |
||||
*.hex |
||||
|
||||
# Debug files |
||||
*.dSYM/ |
||||
*.su |
||||
*.idb |
||||
*.pdb |
||||
|
||||
# Kernel Module Compile Results |
||||
*.mod* |
||||
*.cmd |
||||
.tmp_versions/ |
||||
modules.order |
||||
Module.symvers |
||||
Mkfile.old |
||||
dkms.conf |
||||
|
||||
@ -0,0 +1,68 @@ |
||||
#include <Audio.h> |
||||
#include "synth_dexed.h" |
||||
|
||||
uint8_t fmpiano_sysex[156] = { |
||||
95, 29, 20, 50, 99, 95, 00, 00, 41, 00, 19, 00, 00, 03, 00, 06, 79, 00, 01, 00, 14, // OP6 eg_rate_1-4, level_1-4, kbd_lev_scl_brk_pt, kbd_lev_scl_lft_depth, kbd_lev_scl_rht_depth, kbd_lev_scl_lft_curve, kbd_lev_scl_rht_curve, kbd_rate_scaling, amp_mod_sensitivity, key_vel_sensitivity, operator_output_level, osc_mode, osc_freq_coarse, osc_freq_fine, osc_detune
|
||||
95, 20, 20, 50, 99, 95, 00, 00, 00, 00, 00, 00, 00, 03, 00, 00, 99, 00, 01, 00, 00, // OP5
|
||||
95, 29, 20, 50, 99, 95, 00, 00, 00, 00, 00, 00, 00, 03, 00, 06, 89, 00, 01, 00, 07, // OP4
|
||||
95, 20, 20, 50, 99, 95, 00, 00, 00, 00, 00, 00, 00, 03, 00, 02, 99, 00, 01, 00, 07, // OP3
|
||||
95, 50, 35, 78, 99, 75, 00, 00, 00, 00, 00, 00, 00, 03, 00, 07, 58, 00, 14, 00, 07, // OP2
|
||||
96, 25, 25, 67, 99, 75, 00, 00, 00, 00, 00, 00, 00, 03, 00, 02, 99, 00, 01, 00, 10, // OP1
|
||||
94, 67, 95, 60, 50, 50, 50, 50, // 4 * pitch EG rates, 4 * pitch EG level
|
||||
04, 06, 00, // algorithm, feedback, osc sync
|
||||
34, 33, 00, 00, 00, 04, // lfo speed, lfo delay, lfo pitch_mod_depth, lfo_amp_mod_depth, lfo_sync, lfo_waveform
|
||||
03, 24, // pitch_mod_sensitivity, transpose
|
||||
70, 77, 45, 80, 73, 65, 78, 79, 00, 00 // 10 * char for name ("DEFAULT ")
|
||||
}; // FM-Piano
|
||||
|
||||
AudioSynthDexed dexed(4, SAMPLE_RATE); // 4 voices max
|
||||
AudioOutputI2S i2s1; |
||||
AudioControlSGTL5000 sgtl5000_1; |
||||
AudioConnection patchCord1(dexed, 0, i2s1, 0); |
||||
AudioConnection patchCord2(dexed, 0, i2s1, 1); |
||||
|
||||
void setup() { |
||||
AudioMemory(32); |
||||
|
||||
sgtl5000_1.enable(); |
||||
sgtl5000_1.lineOutLevel(29); |
||||
sgtl5000_1.dacVolumeRamp(); |
||||
sgtl5000_1.dacVolume(1.0); |
||||
sgtl5000_1.unmuteHeadphone(); |
||||
sgtl5000_1.unmuteLineout(); |
||||
sgtl5000_1.volume(0.8, 0.8); // Headphone volume
|
||||
} |
||||
|
||||
void loop() { |
||||
static uint8_t count; |
||||
static uint8_t engine_change; |
||||
|
||||
if (count % 2 == 0) { |
||||
dexed.loadInitVoice(); |
||||
} else { |
||||
dexed.loadVoiceParameters(fmpiano_sysex); |
||||
dexed.setTranspose(36); |
||||
} |
||||
|
||||
dexed.setEngineType(engine_change++ % 3); |
||||
Serial.printf("Engine changed to: %d at address 0x%8d\n", dexed.getEngineType(), dexed.getEngineAddress()); |
||||
|
||||
Serial.printf("Key-Down\n"); |
||||
dexed.keydown(48, 100); |
||||
delay(100); |
||||
dexed.keydown(52, 100); |
||||
delay(100); |
||||
dexed.keydown(55, 100); |
||||
delay(100); |
||||
dexed.keydown(60, 100); |
||||
delay(2000); |
||||
|
||||
Serial.printf("Key-Up\n"); |
||||
dexed.keyup(48); |
||||
dexed.keyup(52); |
||||
dexed.keyup(55); |
||||
dexed.keyup(60); |
||||
delay(2000); |
||||
|
||||
count++; |
||||
} |
||||
@ -0,0 +1,352 @@ |
||||
/*
|
||||
* Copyright (C) 2015-2017 Pascal Gauthier. |
||||
* |
||||
* This program is free software; you can redistribute it and/or modify |
||||
* it under the terms of the GNU General Public License as published by |
||||
* the Free Software Foundation; either version 3 of the License, or |
||||
* (at your option) any later version. |
||||
* |
||||
* This program is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
||||
* GNU General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU General Public License |
||||
* along with this program; if not, write to the Free Software Foundation, |
||||
* Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
* |
||||
* The code is based on ppplay https://github.com/stohrendorf/ppplay and opl3
|
||||
* math documentation : |
||||
* https://github.com/gtaylormb/opl3_fpga/blob/master/docs/opl3math/opl3math.pdf
|
||||
* |
||||
*/ |
||||
|
||||
#include "EngineMkI.h" |
||||
|
||||
#define _USE_MATH_DEFINES |
||||
#include <cmath> |
||||
#include <cstdlib> |
||||
|
||||
#include "sin.h" |
||||
#include "exp2.h" |
||||
|
||||
#ifdef DEBUG |
||||
#include "time.h" |
||||
//#define MKIDEBUG
|
||||
#endif |
||||
|
||||
const int32_t __attribute__ ((aligned(16))) zeros[_N_] = {0}; |
||||
|
||||
static const uint16_t NEGATIVE_BIT = 0x8000; |
||||
static const uint16_t ENV_BITDEPTH = 14; |
||||
|
||||
static const uint16_t SINLOG_BITDEPTH = 10; |
||||
static const uint16_t SINLOG_TABLESIZE = 1<<SINLOG_BITDEPTH; |
||||
static uint16_t sinLogTable[SINLOG_TABLESIZE]; |
||||
|
||||
static const uint16_t SINEXP_BITDEPTH = 10; |
||||
static const uint16_t SINEXP_TABLESIZE = 1<<SINEXP_BITDEPTH; |
||||
static uint16_t sinExpTable[SINEXP_TABLESIZE]; |
||||
|
||||
const uint16_t ENV_MAX = 1<<ENV_BITDEPTH; |
||||
|
||||
static inline uint16_t sinLog(uint16_t phi) { |
||||
const uint16_t SINLOG_TABLEFILTER = SINLOG_TABLESIZE-1; |
||||
const uint16_t index = (phi & SINLOG_TABLEFILTER); |
||||
|
||||
switch( ( phi & (SINLOG_TABLESIZE * 3) ) ) { |
||||
case 0: |
||||
return sinLogTable[index]; |
||||
case SINLOG_TABLESIZE: |
||||
return sinLogTable[index ^ SINLOG_TABLEFILTER]; |
||||
case SINLOG_TABLESIZE * 2 : |
||||
return sinLogTable[index] | NEGATIVE_BIT; |
||||
default: |
||||
return sinLogTable[index ^ SINLOG_TABLEFILTER] | NEGATIVE_BIT; |
||||
} |
||||
} |
||||
|
||||
EngineMkI::EngineMkI() { |
||||
float bitReso = SINLOG_TABLESIZE; |
||||
|
||||
for(int i=0;i<SINLOG_TABLESIZE;i++) { |
||||
float x1 = sin(((0.5+i)/bitReso) * M_PI/2.0); |
||||
sinLogTable[i] = round(-1024 * log2(x1)); |
||||
} |
||||
|
||||
bitReso = SINEXP_TABLESIZE; |
||||
for(int i=0;i<SINEXP_TABLESIZE;i++) { |
||||
float x1 = (pow(2, float(i)/bitReso)-1) * 4096; |
||||
sinExpTable[i] = round(x1); |
||||
} |
||||
|
||||
#ifdef MKIDEBUG |
||||
char buffer[4096]; |
||||
int pos = 0; |
||||
|
||||
TRACE("****************************************"); |
||||
for(int i=0;i<SINLOG_TABLESIZE;i++) { |
||||
pos += sprintf(buffer+pos, "%d ", sinLogTable[i]); |
||||
if ( pos > 90 ) { |
||||
TRACE("SINLOGTABLE: %s" ,buffer); |
||||
buffer[0] = 0; |
||||
pos = 0; |
||||
} |
||||
} |
||||
TRACE("SINLOGTABLE: %s", buffer); |
||||
buffer[0] = 0; |
||||
pos = 0; |
||||
TRACE("----------------------------------------");
|
||||
for(int i=0;i<SINEXP_TABLESIZE;i++) { |
||||
pos += sprintf(buffer+pos, "%d ", sinExpTable[i]); |
||||
if ( pos > 90 ) { |
||||
TRACE("SINEXTTABLE: %s" ,buffer); |
||||
buffer[0] = 0; |
||||
pos = 0; |
||||
} |
||||
} |
||||
TRACE("SINEXTTABLE: %s", buffer); |
||||
TRACE("****************************************"); |
||||
#endif |
||||
} |
||||
|
||||
inline int32_t mkiSin(int32_t phase, uint16_t env) { |
||||
uint16_t expVal = sinLog(phase >> (22 - SINLOG_BITDEPTH)) + (env); |
||||
//int16_t expValShow = expVal;
|
||||
|
||||
const bool isSigned = expVal & NEGATIVE_BIT; |
||||
expVal &= ~NEGATIVE_BIT; |
||||
|
||||
const uint16_t SINEXP_FILTER = 0x3FF; |
||||
uint16_t result = 4096 + sinExpTable[( expVal & SINEXP_FILTER ) ^ SINEXP_FILTER]; |
||||
|
||||
//uint16_t resultB4 = result;
|
||||
result >>= ( expVal >> 10 ); // exp
|
||||
|
||||
#ifdef MKIDEBUG |
||||
if ( ( time(NULL) % 5 ) == 0 ) { |
||||
if ( expValShow < 0 ) { |
||||
expValShow = (expValShow + 0x7FFF) * -1; |
||||
} |
||||
//TRACE(",%d,%d,%d,%d,%d,%d", phase >> (22 - SINLOG_BITDEPTH), env, expValShow, ( expVal & SINEXP_FILTER ) ^ SINEXP_FILTER, resultB4, result);
|
||||
} |
||||
#endif |
||||
|
||||
if( isSigned ) |
||||
return (-result - 1) << 13; |
||||
else |
||||
return result << 13; |
||||
} |
||||
|
||||
void EngineMkI::compute(int32_t *output, const int32_t *input, |
||||
int32_t phase0, int32_t freq, |
||||
int32_t gain1, int32_t gain2, bool add) { |
||||
int32_t dgain = (gain2 - gain1 + (_N_ >> 1)) >> LG_N; |
||||
int32_t gain = gain1; |
||||
int32_t phase = phase0; |
||||
const int32_t *adder = add ? output : zeros; |
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
gain += dgain; |
||||
int32_t y = mkiSin((phase+input[i]), gain); |
||||
output[i] = y + adder[i]; |
||||
phase += freq; |
||||
} |
||||
} |
||||
|
||||
void EngineMkI::compute_pure(int32_t *output, int32_t phase0, int32_t freq, |
||||
int32_t gain1, int32_t gain2, bool add) { |
||||
int32_t dgain = (gain2 - gain1 + (_N_ >> 1)) >> LG_N; |
||||
int32_t gain = gain1; |
||||
int32_t phase = phase0; |
||||
const int32_t *adder = add ? output : zeros; |
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
gain += dgain; |
||||
int32_t y = mkiSin(phase , gain); |
||||
output[i] = y + adder[i]; |
||||
phase += freq; |
||||
} |
||||
} |
||||
|
||||
void EngineMkI::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) { |
||||
int32_t dgain = (gain2 - gain1 + (_N_ >> 1)) >> LG_N; |
||||
int32_t gain = gain1; |
||||
int32_t phase = phase0; |
||||
const int32_t *adder = add ? output : zeros; |
||||
int32_t y0 = fb_buf[0]; |
||||
int32_t y = fb_buf[1]; |
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
gain += dgain; |
||||
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1); |
||||
y0 = y; |
||||
y = mkiSin((phase+scaled_fb), gain); |
||||
output[i] = y + adder[i]; |
||||
phase += freq; |
||||
} |
||||
|
||||
fb_buf[0] = y0; |
||||
fb_buf[1] = y; |
||||
} |
||||
|
||||
// exclusively used for ALGO 6 with feedback
|
||||
void EngineMkI::compute_fb2(int32_t *output, FmOpParams *parms, int32_t gain01, int32_t gain02, int32_t *fb_buf, int fb_shift) { |
||||
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; |
||||
|
||||
parms[1].gain_out = (ENV_MAX-(parms[1].level_in >> (28-ENV_BITDEPTH))); |
||||
|
||||
gain[0] = gain01; |
||||
gain[1] = parms[1].gain_out == 0 ? (ENV_MAX-1) : parms[1].gain_out; |
||||
|
||||
dgain[0] = (gain02 - gain01 + (_N_ >> 1)) >> LG_N; |
||||
dgain[1] = (parms[1].gain_out - (parms[1].gain_out == 0 ? (ENV_MAX-1) : parms[1].gain_out)); |
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1); |
||||
|
||||
// op 0
|
||||
gain[0] += dgain[0]; |
||||
y0 = y; |
||||
y = mkiSin(phase[0]+scaled_fb, gain[0]); |
||||
phase[0] += parms[0].freq; |
||||
|
||||
// op 1
|
||||
gain[1] += dgain[1]; |
||||
y = mkiSin(phase[1]+y, gain[1]); |
||||
phase[1] += parms[1].freq; |
||||
|
||||
output[i] = y; |
||||
} |
||||
fb_buf[0] = y0; |
||||
fb_buf[1] = y; |
||||
} |
||||
|
||||
// exclusively used for ALGO 4 with feedback
|
||||
void EngineMkI::compute_fb3(int32_t *output, FmOpParams *parms, int32_t gain01, int32_t gain02, int32_t *fb_buf, int fb_shift) { |
||||
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; |
||||
|
||||
parms[1].gain_out = (ENV_MAX-(parms[1].level_in >> (28-ENV_BITDEPTH))); |
||||
parms[2].gain_out = (ENV_MAX-(parms[2].level_in >> (28-ENV_BITDEPTH))); |
||||
|
||||
gain[0] = gain01; |
||||
gain[1] = parms[1].gain_out == 0 ? (ENV_MAX-1) : parms[1].gain_out; |
||||
gain[2] = parms[2].gain_out == 0 ? (ENV_MAX-1) : parms[2].gain_out; |
||||
|
||||
dgain[0] = (gain02 - gain01 + (_N_ >> 1)) >> LG_N; |
||||
dgain[1] = (parms[1].gain_out - (parms[1].gain_out == 0 ? (ENV_MAX-1) : parms[1].gain_out)); |
||||
dgain[2] = (parms[2].gain_out - (parms[2].gain_out == 0 ? (ENV_MAX-1) : parms[2].gain_out)); |
||||
|
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1); |
||||
|
||||
// op 0
|
||||
gain[0] += dgain[0]; |
||||
y0 = y; |
||||
y = mkiSin(phase[0]+scaled_fb, gain[0]); |
||||
phase[0] += parms[0].freq; |
||||
|
||||
// op 1
|
||||
gain[1] += dgain[1]; |
||||
y = mkiSin(phase[1]+y, gain[1]); |
||||
phase[1] += parms[1].freq; |
||||
|
||||
// op 2
|
||||
gain[2] += dgain[2]; |
||||
y = mkiSin(phase[2]+y, gain[2]); |
||||
phase[2] += parms[2].freq; |
||||
|
||||
output[i] = y; |
||||
} |
||||
fb_buf[0] = y0; |
||||
fb_buf[1] = y; |
||||
} |
||||
|
||||
void EngineMkI::render(int32_t *output, FmOpParams *params, int32_t algorithm, int32_t *fb_buf, int32_t feedback_shift) { |
||||
const int kLevelThresh = ENV_MAX-100; |
||||
FmAlgorithm alg = algorithms[algorithm]; |
||||
bool has_contents[3] = { true, false, false }; |
||||
bool fb_on = feedback_shift < 16; |
||||
|
||||
switch(algorithm) { |
||||
case 3 : case 5 : |
||||
if ( fb_on ) |
||||
alg.ops[0] = 0xc4; |
||||
} |
||||
|
||||
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_out == 0 ? (ENV_MAX-1) : param.gain_out; |
||||
int32_t gain2 = ENV_MAX-(param.level_in >> (28-ENV_BITDEPTH)); |
||||
param.gain_out = gain2; |
||||
|
||||
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...
|
||||
if ((flags & 0xc0) == 0xc0 && fb_on) { |
||||
switch ( algorithm ) { |
||||
// three operator feedback, process exception for ALGO 4
|
||||
case 3 : |
||||
compute_fb3(outptr, params, gain1, gain2, fb_buf, min((feedback_shift+2), (int32_t)16)); |
||||
params[1].phase += params[1].freq << LG_N; // hack, we already processed op-5 - op-4
|
||||
params[2].phase += params[2].freq << LG_N; // yuk yuk
|
||||
op += 2; // ignore the 2 other operators
|
||||
break; |
||||
// two operator feedback, process exception for ALGO 6
|
||||
case 5 : |
||||
compute_fb2(outptr, params, gain1, gain2, fb_buf, min((feedback_shift+2), (int32_t)16)); |
||||
params[1].phase += params[1].freq << LG_N; // yuk, hack, we already processed op-5
|
||||
op++; // ignore next operator;
|
||||
break; |
||||
case 31 : |
||||
// one operator feedback, process exception for ALGO 32
|
||||
compute_fb(outptr, param.phase, param.freq, gain1, gain2, fb_buf, min((feedback_shift+2), (int32_t)16), add); |
||||
break; |
||||
default: |
||||
// one operator feedback, normal process
|
||||
compute_fb(outptr, param.phase, param.freq, gain1, gain2, fb_buf, feedback_shift, add); |
||||
break; |
||||
} |
||||
} else { |
||||
compute_pure(outptr, param.phase, param.freq, gain1, gain2, add); |
||||
} |
||||
} else { |
||||
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; |
||||
} |
||||
} |
||||
|
||||
@ -0,0 +1,44 @@ |
||||
/*
|
||||
* Copyright 2014 Pascal Gauthier. |
||||
* Copyright 2012 Google Inc. |
||||
* |
||||
* Licensed under the Apache License, Version 2.0 (the "License"); |
||||
* you may not use this file except in compliance with the License. |
||||
* You may obtain a copy of the License at |
||||
* |
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
* |
||||
* Unless required by applicable law or agreed to in writing, software |
||||
* distributed under the License is distributed on an "AS IS" BASIS, |
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
||||
* See the License for the specific language governing permissions and |
||||
* limitations under the License. |
||||
*/ |
||||
|
||||
#ifndef ENGINEMKI_H_INCLUDED |
||||
#define ENGINEMKI_H_INCLUDED |
||||
|
||||
#include "aligned_buf.h" |
||||
#include "fm_op_kernel.h" |
||||
#include "controllers.h" |
||||
#include "fm_core.h" |
||||
|
||||
class EngineMkI : public FmCore { |
||||
public: |
||||
EngineMkI(); |
||||
|
||||
void render(int32_t *output, FmOpParams *params, int32_t algorithm, int32_t *fb_buf, int32_t feedback_shift); |
||||
|
||||
void compute(int32_t *output, const int32_t *input, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, bool add); |
||||
|
||||
void compute_pure(int32_t *output, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, bool add); |
||||
|
||||
void compute_fb(int32_t *output, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, int32_t *fb_buf, int fb_gain, bool add); |
||||
|
||||
void compute_fb2(int32_t *output, FmOpParams *params, int32_t gain01, int32_t gain02, int32_t *fb_buf, int fb_shift); |
||||
|
||||
void compute_fb3(int32_t *output, FmOpParams *params, int32_t gain01, int32_t gain02, int32_t *fb_buf, int fb_shift); |
||||
}; |
||||
|
||||
|
||||
#endif // ENGINEMKI_H_INCLUDED
|
||||
@ -0,0 +1,221 @@ |
||||
/*
|
||||
* Copyright (C) 2014 Pascal Gauthier. |
||||
* Copyright (C) 2012 Steffen Ohrendorf <steffen.ohrendorf@gmx.de> |
||||
* |
||||
* This program is free software; you can redistribute it and/or modify |
||||
* it under the terms of the GNU General Public License as published by |
||||
* the Free Software Foundation; either version 3 of the License, or |
||||
* (at your option) any later version. |
||||
* |
||||
* This program is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
||||
* GNU General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU General Public License |
||||
* along with this program; if not, write to the Free Software Foundation, |
||||
* Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
* |
||||
* Original Java Code: Copyright (C) 2008 Robson Cozendey <robson@cozendey.com> |
||||
* |
||||
* Some code based on forum posts in: http://forums.submarine.org.uk/phpBB/viewforum.php?f=9,
|
||||
* Copyright (C) 2010-2013 by carbon14 and opl3 |
||||
* |
||||
*/ |
||||
|
||||
#include "EngineOpl.h" |
||||
|
||||
const int32_t __attribute__ ((aligned(16))) zeros[_N_] = {0}; |
||||
|
||||
uint16_t SignBit = 0x8000; |
||||
|
||||
uint16_t sinLogTable[256] = { |
||||
2137, 1731, 1543, 1419, 1326, 1252, 1190, 1137, 1091, 1050, 1013, 979, 949, 920, 894, 869, |
||||
846, 825, 804, 785, 767, 749, 732, 717, 701, 687, 672, 659, 646, 633, 621, 609, |
||||
598, 587, 576, 566, 556, 546, 536, 527, 518, 509, 501, 492, 484, 476, 468, 461, |
||||
453, 446, 439, 432, 425, 418, 411, 405, 399, 392, 386, 380, 375, 369, 363, 358, |
||||
352, 347, 341, 336, 331, 326, 321, 316, 311, 307, 302, 297, 293, 289, 284, 280, |
||||
276, 271, 267, 263, 259, 255, 251, 248, 244, 240, 236, 233, 229, 226, 222, 219, |
||||
215, 212, 209, 205, 202, 199, 196, 193, 190, 187, 184, 181, 178, 175, 172, 169, |
||||
167, 164, 161, 159, 156, 153, 151, 148, 146, 143, 141, 138, 136, 134, 131, 129, |
||||
127, 125, 122, 120, 118, 116, 114, 112, 110, 108, 106, 104, 102, 100, 98, 96, |
||||
94, 92, 91, 89, 87, 85, 83, 82, 80, 78, 77, 75, 74, 72, 70, 69, |
||||
67, 66, 64, 63, 62, 60, 59, 57, 56, 55, 53, 52, 51, 49, 48, 47, |
||||
46, 45, 43, 42, 41, 40, 39, 38, 37, 36, 35, 34, 33, 32, 31, 30, |
||||
29, 28, 27, 26, 25, 24, 23, 23, 22, 21, 20, 20, 19, 18, 17, 17, |
||||
16, 15, 15, 14, 13, 13, 12, 12, 11, 10, 10, 9, 9, 8, 8, 7, |
||||
7, 7, 6, 6, 5, 5, 5, 4, 4, 4, 3, 3, 3, 2, 2, 2, |
||||
2, 1, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0 |
||||
}; |
||||
|
||||
uint16_t sinExpTable[256] = { |
||||
0, 3, 6, 8, 11, 14, 17, 20, 22, 25, 28, 31, 34, 37, 40, 42, |
||||
45, 48, 51, 54, 57, 60, 63, 66, 69, 72, 75, 78, 81, 84, 87, 90, |
||||
93, 96, 99, 102, 105, 108, 111, 114, 117, 120, 123, 126, 130, 133, 136, 139, |
||||
142, 145, 148, 152, 155, 158, 161, 164, 168, 171, 174, 177, 181, 184, 187, 190, |
||||
194, 197, 200, 204, 207, 210, 214, 217, 220, 224, 227, 231, 234, 237, 241, 244, |
||||
248, 251, 255, 258, 262, 265, 268, 272, 276, 279, 283, 286, 290, 293, 297, 300, |
||||
304, 308, 311, 315, 318, 322, 326, 329, 333, 337, 340, 344, 348, 352, 355, 359, |
||||
363, 367, 370, 374, 378, 382, 385, 389, 393, 397, 401, 405, 409, 412, 416, 420, |
||||
424, 428, 432, 436, 440, 444, 448, 452, 456, 460, 464, 468, 472, 476, 480, 484, |
||||
488, 492, 496, 501, 505, 509, 513, 517, 521, 526, 530, 534, 538, 542, 547, 551, |
||||
555, 560, 564, 568, 572, 577, 581, 585, 590, 594, 599, 603, 607, 612, 616, 621, |
||||
625, 630, 634, 639, 643, 648, 652, 657, 661, 666, 670, 675, 680, 684, 689, 693, |
||||
698, 703, 708, 712, 717, 722, 726, 731, 736, 741, 745, 750, 755, 760, 765, 770, |
||||
774, 779, 784, 789, 794, 799, 804, 809, 814, 819, 824, 829, 834, 839, 844, 849, |
||||
854, 859, 864, 869, 874, 880, 885, 890, 895, 900, 906, 911, 916, 921, 927, 932, |
||||
937, 942, 948, 953, 959, 964, 969, 975, 980, 986, 991, 996, 1002, 1007, 1013, 1018 |
||||
}; |
||||
|
||||
inline uint16_t sinLog(uint16_t phi) { |
||||
const uint8_t index = (phi & 0xff); |
||||
|
||||
switch( ( phi & 0x0300 ) ) { |
||||
case 0x0000: |
||||
// rising quarter wave Shape A
|
||||
return sinLogTable[index]; |
||||
case 0x0100: |
||||
// falling quarter wave Shape B
|
||||
return sinLogTable[index ^ 0xFF]; |
||||
case 0x0200: |
||||
// rising quarter wave -ve Shape C
|
||||
return sinLogTable[index] | SignBit; |
||||
default: |
||||
// falling quarter wave -ve Shape D
|
||||
return sinLogTable[index ^ 0xFF] | SignBit; |
||||
} |
||||
} |
||||
|
||||
// 16 env units are ~3dB and halve the output
|
||||
/**
|
||||
* @brief OPL Sine Wave calculation |
||||
* @param[in] phase Wave phase (0..1023) |
||||
* @param[in] env Envelope value (0..511) |
||||
* @warning @a env will not be checked for correct values. |
||||
*/ |
||||
inline int16_t oplSin( uint16_t phase, uint16_t env ) { |
||||
uint16_t expVal = sinLog(phase) + (env << 3); |
||||
const bool isSigned = expVal & SignBit; |
||||
|
||||
expVal &= ~SignBit; |
||||
// expVal: 0..2137+511*8 = 0..6225
|
||||
// result: 0..1018+1024
|
||||
uint32_t result = 0x0400 + sinExpTable[( expVal & 0xff ) ^ 0xFF]; |
||||
result <<= 1; |
||||
result >>= ( expVal >> 8 ); // exp
|
||||
|
||||
if( isSigned ) { |
||||
// -1 for one's complement
|
||||
return -result - 1; |
||||
} else { |
||||
return result; |
||||
}
|
||||
} |
||||
|
||||
void EngineOpl::compute(int32_t *output, const int32_t *input, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, bool add) { |
||||
int32_t dgain = (gain2 - gain1 + (_N_ >> 1)) >> LG_N; |
||||
int32_t gain = gain1; |
||||
int32_t phase = phase0; |
||||
const int32_t *adder = add ? output : zeros; |
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
gain += dgain; |
||||
int32_t y = oplSin((phase+input[i]) >> 14, gain); |
||||
output[i] = (y << 14) + adder[i]; |
||||
phase += freq; |
||||
} |
||||
} |
||||
|
||||
void EngineOpl::compute_pure(int32_t *output, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, bool add) { |
||||
int32_t dgain = (gain2 - gain1 + (_N_ >> 1)) >> LG_N; |
||||
int32_t gain = gain1; |
||||
int32_t phase = phase0; |
||||
const int32_t *adder = add ? output : zeros; |
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
gain += dgain; |
||||
int32_t y = oplSin(phase >> 14, gain); |
||||
output[i] = (y << 14) + adder[i]; |
||||
phase += freq; |
||||
} |
||||
} |
||||
|
||||
void EngineOpl::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) { |
||||
int32_t dgain = (gain2 - gain1 + (_N_ >> 1)) >> LG_N; |
||||
int32_t gain = gain1; |
||||
int32_t phase = phase0; |
||||
const int32_t *adder = add ? output : zeros; |
||||
int32_t y0 = fb_buf[0]; |
||||
int32_t y = fb_buf[1]; |
||||
|
||||
for (int i = 0; i < _N_; i++) { |
||||
gain += dgain; |
||||
int32_t scaled_fb = (y0 + y) >> (fb_shift + 1); |
||||
y0 = y; |
||||
y = oplSin((phase+scaled_fb) >> 14, gain) << 14; |
||||
output[i] = y + adder[i]; |
||||
phase += freq; |
||||
} |
||||
|
||||
fb_buf[0] = y0; |
||||
fb_buf[1] = y; |
||||
} |
||||
|
||||
|
||||
void EngineOpl::render(int32_t *output, FmOpParams *params, int algorithm, int32_t *fb_buf, int32_t feedback_shift) { |
||||
const int kLevelThresh = 507; // really ????
|
||||
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_out == 0 ? 511 : param.gain_out; |
||||
int32_t gain2 = 512-(param.level_in >> 19); |
||||
param.gain_out = gain2; |
||||
|
||||
if (gain1 <= kLevelThresh || gain2 <= kLevelThresh) { |
||||
if (!has_contents[outbus]) { |
||||
add = false; |
||||
} |
||||
if (inbus == 0 || !has_contents[inbus]) { |
||||
// todo: more than one op in a feedback loop
|
||||
if ((flags & 0xc0) == 0xc0 && feedback_shift < 16) { |
||||
// cout << op << " fb " << inbus << outbus << add << endl;
|
||||
compute_fb(outptr, param.phase, param.freq, |
||||
gain1, gain2, |
||||
fb_buf, feedback_shift, add); |
||||
} else { |
||||
// cout << op << " pure " << inbus << outbus << add << endl;
|
||||
compute_pure(outptr, param.phase, param.freq, |
||||
gain1, gain2, add); |
||||
} |
||||
} else { |
||||
// cout << op << " normal " << inbus << outbus << " " << param.freq << add << endl;
|
||||
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; |
||||
} |
||||
} |
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
@ -0,0 +1,37 @@ |
||||
/**
|
||||
* |
||||
* Copyright (c) 2014 Pascal Gauthier. |
||||
* |
||||
* This program is free software; you can redistribute it and/or modify |
||||
* it under the terms of the GNU General Public License as published by |
||||
* the Free Software Foundation; either version 3 of the License, or |
||||
* (at your option) any later version. |
||||
* |
||||
* This program is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
||||
* GNU General Public License for more details. |
||||
* |
||||
* You should have received a copy of the GNU General Public License |
||||
* along with this program; if not, write to the Free Software Foundation, |
||||
* Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
||||
* |
||||
*/ |
||||
|
||||
#ifndef ENGINEOPL_H_INCLUDED |
||||
#define ENGINEOPL_H_INCLUDED |
||||
|
||||
#include "aligned_buf.h" |
||||
#include "fm_op_kernel.h" |
||||
#include "controllers.h" |
||||
#include "fm_core.h" |
||||
|
||||
class EngineOpl : public FmCore { |
||||
public: |
||||
virtual void render(int32_t *output, FmOpParams *params, int algorithm, int32_t *fb_buf, int32_t feedback_shift); |
||||
void compute(int32_t *output, const int32_t *input, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, bool add); |
||||
void compute_pure(int32_t *output, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, bool add); |
||||
void compute_fb(int32_t *output, int32_t phase0, int32_t freq, int32_t gain1, int32_t gain2, int32_t *fb_buf, int fb_gain, bool add); |
||||
}; |
||||
|
||||
#endif // ENGINEOPL_H_INCLUDED
|
||||
Loading…
Reference in new issue