Holger Wirtz
6 years ago
parent
94c5d375df
commit
be8f93b976
@ -0,0 +1,144 @@ |
|||||||
|
/* Audio Library for Teensy 3.X
|
||||||
|
* Dynamics Processor (Gate, Compressor & Limiter) |
||||||
|
* Copyright (c) 2017, Marc Paquette (marc@dacsystemes.com) |
||||||
|
* Based on analyse_rms & mixer objects by Paul Stoffregen |
||||||
|
* |
||||||
|
* Development of this audio library was funded by PJRC.COM, LLC by sales of |
||||||
|
* Teensy and Audio Adaptor boards. Please support PJRC's efforts to develop |
||||||
|
* open source software by purchasing Teensy or other PJRC products. |
||||||
|
* |
||||||
|
* Permission is hereby granted, free of charge, to any person obtaining a copy |
||||||
|
* of this software and associated documentation files (the "Software"), to deal |
||||||
|
* in the Software without restriction, including without limitation the rights |
||||||
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
||||||
|
* copies of the Software, and to permit persons to whom the Software is |
||||||
|
* furnished to do so, subject to the following conditions: |
||||||
|
* |
||||||
|
* The above copyright notice, development funding notice, and this permission |
||||||
|
* notice shall be included in all copies or substantial portions of the Software. |
||||||
|
* |
||||||
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
||||||
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
||||||
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
||||||
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
||||||
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
||||||
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
||||||
|
* THE SOFTWARE. |
||||||
|
*/ |
||||||
|
|
||||||
|
#include "effect_dynamics.h" |
||||||
|
#include "fast_log.h" |
||||||
|
#include "utility/dspinst.h" |
||||||
|
#include "utility/sqrt_integer.h" |
||||||
|
|
||||||
|
static float analyse_rms(int16_t *data) { |
||||||
|
|
||||||
|
uint32_t *p = (uint32_t *)data; |
||||||
|
const uint32_t *end = p + AUDIO_BLOCK_SAMPLES / 2; |
||||||
|
int64_t sum = 0; |
||||||
|
do { |
||||||
|
uint32_t n1 = *p++; |
||||||
|
uint32_t n2 = *p++; |
||||||
|
uint32_t n3 = *p++; |
||||||
|
uint32_t n4 = *p++; |
||||||
|
sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n1, n1); |
||||||
|
sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n2, n2); |
||||||
|
sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n3, n3); |
||||||
|
sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n4, n4); |
||||||
|
|
||||||
|
} while (p < end); |
||||||
|
|
||||||
|
int32_t meansq = sum / AUDIO_BLOCK_SAMPLES; |
||||||
|
return sqrt_uint32(meansq) / 32767.0f; |
||||||
|
} |
||||||
|
|
||||||
|
static void applyGain(int16_t *data, int32_t mult1, int32_t mult2) { |
||||||
|
|
||||||
|
uint32_t *p = (uint32_t *)data; |
||||||
|
const uint32_t *end = p + AUDIO_BLOCK_SAMPLES / 2; |
||||||
|
int32_t inc = (mult2 - mult1) / (AUDIO_BLOCK_SAMPLES / 2); |
||||||
|
|
||||||
|
do { |
||||||
|
uint32_t tmp32 = *p; // read 2 samples from *data
|
||||||
|
int32_t val1 = signed_multiply_32x16b(mult1, tmp32); |
||||||
|
mult1 += inc; |
||||||
|
int32_t val2 = signed_multiply_32x16t(mult1, tmp32); |
||||||
|
mult1 += inc; |
||||||
|
val1 = signed_saturate_rshift(val1, 16, 0); |
||||||
|
val2 = signed_saturate_rshift(val2, 16, 0); |
||||||
|
*p++ = pack_16b_16b(val2, val1); |
||||||
|
} while (p < end); |
||||||
|
} |
||||||
|
|
||||||
|
void AudioEffectDynamics::update(void) { |
||||||
|
|
||||||
|
audio_block_t *block; |
||||||
|
|
||||||
|
block = receiveWritable(0); |
||||||
|
|
||||||
|
if (!block) return; |
||||||
|
|
||||||
|
if (!gateEnabled && !compEnabled && !limiterEnabled) { |
||||||
|
|
||||||
|
//Transmit & release
|
||||||
|
transmit(block); |
||||||
|
release(block); |
||||||
|
return; |
||||||
|
} |
||||||
|
|
||||||
|
//Analyze received block
|
||||||
|
float rms = analyse_rms(block->data); |
||||||
|
|
||||||
|
//Compute block RMS level in Db
|
||||||
|
float inputdb = MIN_DB; |
||||||
|
if (rms > 0) inputdb = unitToDb(rms); |
||||||
|
|
||||||
|
//Gate
|
||||||
|
if (gateEnabled) { |
||||||
|
if (inputdb >= gateThresholdOpen) gatedb = (aGateAttack * gatedb) + (aOneMinusGateAttack * MAX_DB); |
||||||
|
else if (inputdb < gateThresholdClose) gatedb = (aGateRelease * gatedb) + (aOneMinusGateRelease * MIN_DB); |
||||||
|
} |
||||||
|
else gatedb = MAX_DB; |
||||||
|
|
||||||
|
//Compressor
|
||||||
|
if (compEnabled) { |
||||||
|
float attdb = MAX_DB; //Below knee
|
||||||
|
if (inputdb >= aLowKnee) { |
||||||
|
if(inputdb <= aHighKnee) { |
||||||
|
//Knee transition
|
||||||
|
float knee = inputdb - aLowKnee; |
||||||
|
attdb = aKneeRatio * knee * knee * aTwoKneeWidth; |
||||||
|
} |
||||||
|
else { |
||||||
|
//Above knee
|
||||||
|
attdb = compThreshold + ((inputdb - compThreshold) * compRatio) - inputdb; |
||||||
|
} |
||||||
|
} |
||||||
|
if (attdb <= compdb) compdb = (aCompAttack * compdb) + (aOneMinusCompAttack * attdb); |
||||||
|
else compdb = (aCompRelease * compdb) + (aOneMinusCompRelease * attdb); |
||||||
|
} |
||||||
|
else compdb = MAX_DB; |
||||||
|
|
||||||
|
//Brickwall Limiter
|
||||||
|
if (limiterEnabled) { |
||||||
|
float outdb = inputdb + compdb + makeupdb; |
||||||
|
if (outdb >= limitThreshold) limitdb = (aLimitAttack * limitdb) + (aOneMinusLimitAttack * (limitThreshold - outdb)); |
||||||
|
else limitdb *= aLimitRelease; |
||||||
|
} |
||||||
|
else limitdb = MAX_DB; |
||||||
|
|
||||||
|
//Compute linear gain
|
||||||
|
float totalGain = gatedb + compdb + makeupdb + limitdb; |
||||||
|
int32_t mult = dbToUnit(totalGain) * 65536.0f; |
||||||
|
|
||||||
|
//Apply gain to block
|
||||||
|
applyGain(block->data, last_mult, mult); |
||||||
|
last_mult = mult; |
||||||
|
|
||||||
|
//Transmit & release
|
||||||
|
transmit(block); |
||||||
|
release(block); |
||||||
|
} |
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -0,0 +1,196 @@ |
|||||||
|
/* Audio Library for Teensy 3.X
|
||||||
|
* Dynamics Processor (Gate, Compressor & Limiter) |
||||||
|
* Copyright (c) 2018, Marc Paquette (marc@dacsystemes.com) |
||||||
|
* Based on analyse_rms, effect_envelope & mixer objects by Paul Stoffregen |
||||||
|
* |
||||||
|
* Development of this audio library was funded by PJRC.COM, LLC by sales of |
||||||
|
* Teensy and Audio Adaptor boards. Please support PJRC's efforts to develop |
||||||
|
* open source software by purchasing Teensy or other PJRC products. |
||||||
|
* |
||||||
|
* Permission is hereby granted, free of charge, to any person obtaining a copy |
||||||
|
* of this software and associated documentation files (the "Software"), to deal |
||||||
|
* in the Software without restriction, including without limitation the rights |
||||||
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
||||||
|
* copies of the Software, and to permit persons to whom the Software is |
||||||
|
* furnished to do so, subject to the following conditions: |
||||||
|
* |
||||||
|
* The above copyright notice, development funding notice, and this permission |
||||||
|
* notice shall be included in all copies or substantial portions of the Software. |
||||||
|
* |
||||||
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
||||||
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
||||||
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
||||||
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
||||||
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
||||||
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
||||||
|
* THE SOFTWARE. |
||||||
|
*/ |
||||||
|
|
||||||
|
#ifndef effect_dynamics_h_ |
||||||
|
#define effect_dynamics_h_ |
||||||
|
|
||||||
|
#include "Arduino.h" |
||||||
|
#include "AudioStream.h" |
||||||
|
|
||||||
|
#define MIN_DB -110.0f |
||||||
|
#define MAX_DB 0.0f |
||||||
|
|
||||||
|
#define MIN_T 0.03f //Roughly 1 block
|
||||||
|
#define MAX_T 4.00f |
||||||
|
|
||||||
|
#define RATIO_OFF 1.0f |
||||||
|
#define RATIO_INFINITY 60.0f |
||||||
|
|
||||||
|
class AudioEffectDynamics : public AudioStream |
||||||
|
{ |
||||||
|
public: |
||||||
|
AudioEffectDynamics(void) : AudioStream(1, inputQueueArray) { |
||||||
|
|
||||||
|
gate(); |
||||||
|
compression(); |
||||||
|
limit(); |
||||||
|
autoMakeupGain(); |
||||||
|
} |
||||||
|
|
||||||
|
//Sets the gate parameters.
|
||||||
|
//threshold is in dbFS
|
||||||
|
//attack & release are in seconds
|
||||||
|
void gate(float threshold = -50.0f, float attack = MIN_T, float release = 0.3f, float hysterisis = 6.0f) { |
||||||
|
|
||||||
|
gateEnabled = threshold > MIN_DB; |
||||||
|
|
||||||
|
gateThresholdOpen = constrain(threshold, MIN_DB, MAX_DB); |
||||||
|
gateThresholdClose = gateThresholdOpen - constrain(hysterisis, 0.0f, 6.0f); |
||||||
|
|
||||||
|
float gateAttackTime = constrain(attack, MIN_T, MAX_T); |
||||||
|
float gateReleaseTime = constrain(release, MIN_T, MAX_T); |
||||||
|
|
||||||
|
aGateAttack = timeToAlpha(gateAttackTime); |
||||||
|
aOneMinusGateAttack = 1.0f - aGateAttack; |
||||||
|
aGateRelease = timeToAlpha(gateReleaseTime); |
||||||
|
aOneMinusGateRelease = 1.0f - aGateRelease; |
||||||
|
|
||||||
|
gatedb = MIN_DB; |
||||||
|
} |
||||||
|
|
||||||
|
//Sets the compression parameters.
|
||||||
|
//threshold & kneeWidth are in db(FS)
|
||||||
|
//attack and release are in seconds
|
||||||
|
//ratio is expressed as x:1 i.e. 1 for no compression, 60 for brickwall limiting
|
||||||
|
//Set kneeWidth to 0 for hard knee
|
||||||
|
void compression(float threshold = -40.0f, float attack = MIN_T, float release = 0.5f, float ratio = 35.0f, float kneeWidth = 6.0f) { |
||||||
|
|
||||||
|
compEnabled = threshold < MAX_DB; |
||||||
|
|
||||||
|
compThreshold = constrain(threshold, MIN_DB, MAX_DB); |
||||||
|
float compAttackTime = constrain(attack, MIN_T, MAX_T); |
||||||
|
float compReleaseTime = constrain(release, MIN_T, MAX_T); |
||||||
|
compRatio = 1.0f / constrain(abs(ratio), RATIO_OFF, RATIO_INFINITY); |
||||||
|
float compKneeWidth = constrain(abs(kneeWidth), 0.0f, 32.0f); |
||||||
|
computeMakeupGain(); |
||||||
|
|
||||||
|
aCompAttack = timeToAlpha(compAttackTime); |
||||||
|
aOneMinusCompAttack = 1.0f - aCompAttack; |
||||||
|
aCompRelease = timeToAlpha(compReleaseTime); |
||||||
|
aOneMinusCompRelease = 1.0f - aCompRelease; |
||||||
|
aHalfKneeWidth = compKneeWidth / 2.0f; |
||||||
|
aTwoKneeWidth = 1.0f / (compKneeWidth * 2.0f); |
||||||
|
aKneeRatio = compRatio - 1.0f; |
||||||
|
aLowKnee = compThreshold - aHalfKneeWidth; |
||||||
|
aHighKnee = compThreshold + aHalfKneeWidth; |
||||||
|
|
||||||
|
compdb = MIN_DB; |
||||||
|
} |
||||||
|
|
||||||
|
//Sets the hard limiter parameters
|
||||||
|
//threshold is in dbFS
|
||||||
|
//attack & release are in seconds
|
||||||
|
void limit(float threshold = -3.0f, float attack = MIN_T, float release = MIN_T) { |
||||||
|
|
||||||
|
limiterEnabled = threshold < MAX_DB; |
||||||
|
|
||||||
|
limitThreshold = constrain(threshold, MIN_DB, MAX_DB); |
||||||
|
float limitAttackTime = constrain(attack, MIN_T, MAX_T); |
||||||
|
float limitReleaseTime = constrain(release, MIN_T, MAX_T);
|
||||||
|
|
||||||
|
computeMakeupGain(); |
||||||
|
|
||||||
|
aLimitAttack = timeToAlpha(limitAttackTime); |
||||||
|
aOneMinusLimitAttack = 1.0f - aLimitAttack; |
||||||
|
aLimitRelease = timeToAlpha(limitReleaseTime); |
||||||
|
|
||||||
|
limitdb = MIN_DB; |
||||||
|
} |
||||||
|
|
||||||
|
//Enables automatic makeup gain setting
|
||||||
|
//headroom is in dbFS
|
||||||
|
void autoMakeupGain(float headroom = 6.0f) { |
||||||
|
|
||||||
|
mgAutoEnabled = true; |
||||||
|
mgHeadroom = constrain(headroom, 0.0f, 60.0f); |
||||||
|
computeMakeupGain(); |
||||||
|
} |
||||||
|
|
||||||
|
//Sets a fixed makeup gain value.
|
||||||
|
//gain is in dbFS
|
||||||
|
void makeupGain(float gain = 0.0f) { |
||||||
|
|
||||||
|
mgAutoEnabled = false; |
||||||
|
makeupdb = constrain(gain, -12.0f, 24.0f); |
||||||
|
} |
||||||
|
|
||||||
|
private: |
||||||
|
audio_block_t *inputQueueArray[1]; |
||||||
|
|
||||||
|
bool gateEnabled = false; |
||||||
|
float gateThresholdOpen; |
||||||
|
float gateThresholdClose; |
||||||
|
float gatedb; |
||||||
|
|
||||||
|
bool compEnabled = false; |
||||||
|
float compThreshold; |
||||||
|
float compRatio; |
||||||
|
float compdb; |
||||||
|
|
||||||
|
bool limiterEnabled = false; |
||||||
|
float limitThreshold; |
||||||
|
float limitdb; |
||||||
|
|
||||||
|
bool mgAutoEnabled; |
||||||
|
float mgHeadroom; |
||||||
|
float makeupdb; |
||||||
|
|
||||||
|
float aGateAttack; |
||||||
|
float aOneMinusGateAttack; |
||||||
|
float aGateRelease; |
||||||
|
float aOneMinusGateRelease; |
||||||
|
float aHalfKneeWidth; |
||||||
|
float aTwoKneeWidth; |
||||||
|
float aKneeRatio; |
||||||
|
float aLowKnee; |
||||||
|
float aHighKnee; |
||||||
|
float aCompAttack; |
||||||
|
float aOneMinusCompAttack; |
||||||
|
float aCompRelease; |
||||||
|
float aOneMinusCompRelease; |
||||||
|
float aLimitAttack; |
||||||
|
float aOneMinusLimitAttack; |
||||||
|
float aLimitRelease; |
||||||
|
|
||||||
|
int32_t last_mult; |
||||||
|
|
||||||
|
void computeMakeupGain() { |
||||||
|
if (mgAutoEnabled) { |
||||||
|
makeupdb = -compThreshold + (compThreshold * compRatio) + limitThreshold - mgHeadroom; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
//Computes smoothing time constants for a 10% to 90% change
|
||||||
|
float timeToAlpha(float time) { |
||||||
|
return expf(-0.9542f / (((float)AUDIO_SAMPLE_RATE_EXACT / (float)AUDIO_BLOCK_SAMPLES) * time)); |
||||||
|
} |
||||||
|
|
||||||
|
virtual void update(void); |
||||||
|
}; |
||||||
|
|
||||||
|
#endif |
||||||
@ -0,0 +1,50 @@ |
|||||||
|
/* ----------------------------------------------------------------------
|
||||||
|
* https://community.arm.com/tools/f/discussions/4292/cmsis-dsp-new-functionality-proposal/22621#22621
|
||||||
|
* Fast approximation to the log2() function. It uses a two step |
||||||
|
* process. First, it decomposes the floating-point number into |
||||||
|
* a fractional component F and an exponent E. The fraction component |
||||||
|
* is used in a polynomial approximation and then the exponent added |
||||||
|
* to the result. A 3rd order polynomial is used and the result |
||||||
|
* when computing db20() is accurate to 7.984884e-003 dB. |
||||||
|
** ------------------------------------------------------------------- */ |
||||||
|
|
||||||
|
float log2f_approx_coeff[4] = {1.23149591368684f, -4.11852516267426f, 6.02197014179219f, -3.13396450166353f}; |
||||||
|
|
||||||
|
float log2f_approx(float X) |
||||||
|
{ |
||||||
|
float *C = &log2f_approx_coeff[0]; |
||||||
|
float Y; |
||||||
|
float F; |
||||||
|
int E; |
||||||
|
|
||||||
|
// This is the approximation to log2()
|
||||||
|
F = frexpf(fabsf(X), &E); |
||||||
|
|
||||||
|
// Y = C[0]*F*F*F + C[1]*F*F + C[2]*F + C[3] + E;
|
||||||
|
Y = *C++; |
||||||
|
Y *= F; |
||||||
|
Y += (*C++); |
||||||
|
Y *= F; |
||||||
|
Y += (*C++); |
||||||
|
Y *= F; |
||||||
|
Y += (*C++); |
||||||
|
Y += E; |
||||||
|
return(Y); |
||||||
|
} |
||||||
|
|
||||||
|
// https://codingforspeed.com/using-faster-exponential-approximation/
|
||||||
|
inline float expf_approx(float x) { |
||||||
|
x = 1.0f + x / 1024; |
||||||
|
x *= x; x *= x; x *= x; x *= x; |
||||||
|
x *= x; x *= x; x *= x; x *= x; |
||||||
|
x *= x; x *= x; |
||||||
|
return x; |
||||||
|
} |
||||||
|
|
||||||
|
inline float unitToDb(float unit) { |
||||||
|
return 6.02f * log2f_approx(unit); |
||||||
|
} |
||||||
|
|
||||||
|
inline float dbToUnit(float db) { |
||||||
|
return expf_approx(db * 2.302585092994046f * 0.05f); |
||||||
|
} |
||||||
Loading…
Reference in new issue