|
|
|
|
@ -164,3 +164,155 @@ void AudioEffectModulatedDelay::update(void) |
|
|
|
|
release(block); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
boolean AudioEffectModulatedDelayStereo::begin(short *delayline_l, short *delayline_r, uint16_t d_length) |
|
|
|
|
{ |
|
|
|
|
#if 0 |
|
|
|
|
Serial.print(F("AudioEffectModulatedDelayStereo.begin(modulated-delay line length = ")); |
|
|
|
|
Serial.print(d_length); |
|
|
|
|
Serial.println(F(")")); |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
_delay_length = 0; |
|
|
|
|
|
|
|
|
|
_delayline[0] = NULL; |
|
|
|
|
_cb_index[0] = 0; |
|
|
|
|
_delay_offset[0] = 0; |
|
|
|
|
|
|
|
|
|
_delayline[1] = NULL; |
|
|
|
|
_cb_index[1] = 0; |
|
|
|
|
_delay_offset[1] = 0; |
|
|
|
|
|
|
|
|
|
if (delayline_r == NULL) |
|
|
|
|
return (false); |
|
|
|
|
if (delayline_l == NULL) |
|
|
|
|
return (false); |
|
|
|
|
if (d_length < 10) |
|
|
|
|
return (false); |
|
|
|
|
|
|
|
|
|
_delay_length = d_length; |
|
|
|
|
|
|
|
|
|
_delayline[0] = delayline_l; |
|
|
|
|
memset(_delayline[0], 0, _delay_length * sizeof(int16_t)); |
|
|
|
|
_delay_offset[0] = _delay_length >> 1 ; |
|
|
|
|
|
|
|
|
|
_delayline[1] = delayline_r; |
|
|
|
|
memset(_delayline[1], 0, _delay_length * sizeof(int16_t)); |
|
|
|
|
_delay_offset[1] = _delay_length >> 1 ; |
|
|
|
|
|
|
|
|
|
return (true); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
uint16_t AudioEffectModulatedDelayStereo::get_delay_length(void) |
|
|
|
|
{ |
|
|
|
|
return (_delay_length); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void AudioEffectModulatedDelayStereo::update(void) |
|
|
|
|
{ |
|
|
|
|
audio_block_t *block[2]; |
|
|
|
|
audio_block_t *modulation; |
|
|
|
|
|
|
|
|
|
if (_delayline == NULL) |
|
|
|
|
return; |
|
|
|
|
|
|
|
|
|
block[0] = receiveWritable(0); |
|
|
|
|
if (!block[0]) |
|
|
|
|
block[0] = (audio_block_t*)&zeroblock; |
|
|
|
|
|
|
|
|
|
block[1] = receiveWritable(1); |
|
|
|
|
if (!block[1]) |
|
|
|
|
block[1] = (audio_block_t*)&zeroblock; |
|
|
|
|
|
|
|
|
|
modulation = receiveReadOnly(2); |
|
|
|
|
if (!modulation) |
|
|
|
|
modulation = (audio_block_t*)&zeroblock; |
|
|
|
|
|
|
|
|
|
if (block[0] && block[1] && modulation) |
|
|
|
|
{ |
|
|
|
|
int16_t *bp[2]; |
|
|
|
|
int16_t cb_mod_index_neighbor[2]; |
|
|
|
|
float *mp; |
|
|
|
|
float mod_index; |
|
|
|
|
float mod_number; |
|
|
|
|
float mod_fraction; |
|
|
|
|
float modulation_f32[AUDIO_BLOCK_SAMPLES]; |
|
|
|
|
|
|
|
|
|
bp[0] = block[0]->data; |
|
|
|
|
bp[1] = block[1]->data; |
|
|
|
|
|
|
|
|
|
arm_q15_to_float(modulation->data, modulation_f32, AUDIO_BLOCK_SAMPLES); |
|
|
|
|
mp = modulation_f32; |
|
|
|
|
|
|
|
|
|
for (uint16_t i = 0; i < AUDIO_BLOCK_SAMPLES; i++) |
|
|
|
|
{ |
|
|
|
|
// LEFT
|
|
|
|
|
// calculate the modulation-index as a floating point number for interpolation
|
|
|
|
|
mod_index = *mp * _delay_offset[0]; |
|
|
|
|
mod_fraction = modff(mod_index, &mod_number); // split float of mod_index into integer (= mod_number) and fraction part
|
|
|
|
|
|
|
|
|
|
// write data into circular buffer (delayline)
|
|
|
|
|
if (_cb_index[0] >= _delay_length) |
|
|
|
|
_cb_index[0] = 0; |
|
|
|
|
_delayline[0][_cb_index[0]] = *bp[0]; |
|
|
|
|
|
|
|
|
|
// calculate modulation index into circular buffer
|
|
|
|
|
cb_mod_index[0] = _cb_index[0] - (_delay_offset[0] + mod_number); |
|
|
|
|
if (cb_mod_index[0] < 0) // check for negative offsets and correct them
|
|
|
|
|
cb_mod_index[0] += _delay_length; |
|
|
|
|
|
|
|
|
|
if (cb_mod_index[0] == _delay_length - 1) |
|
|
|
|
cb_mod_index_neighbor[0] = 0; |
|
|
|
|
else |
|
|
|
|
cb_mod_index_neighbor[0] = cb_mod_index[0] + 1; |
|
|
|
|
|
|
|
|
|
*bp[0] = round(float(_delayline[0][cb_mod_index[0]]) * mod_fraction + float(_delayline[0][cb_mod_index_neighbor[0]]) * (1.0 - mod_fraction)); |
|
|
|
|
|
|
|
|
|
// push the pointers forward
|
|
|
|
|
bp[0]++; // next audio data
|
|
|
|
|
_cb_index[0]++; // next circular buffer index
|
|
|
|
|
|
|
|
|
|
// RIGHT
|
|
|
|
|
// calculate the modulation-index as a floating point number for interpolation
|
|
|
|
|
mod_index = -1.0 * *mp * _delay_offset[0]; |
|
|
|
|
mod_fraction = modff(mod_index, &mod_number); // split float of mod_index into integer (= mod_number) and fraction part
|
|
|
|
|
|
|
|
|
|
// write data into circular buffer (delayline)
|
|
|
|
|
if (_cb_index[1] >= _delay_length) |
|
|
|
|
_cb_index[1] = 0; |
|
|
|
|
_delayline[1][_cb_index[1]] = *bp[1]; |
|
|
|
|
|
|
|
|
|
// calculate modulation index into circular buffer
|
|
|
|
|
cb_mod_index[1] = _cb_index[1] - (_delay_offset[1] + mod_number); |
|
|
|
|
if (cb_mod_index[1] < 0) // check for negative offsets and correct them
|
|
|
|
|
cb_mod_index[1] += _delay_length; |
|
|
|
|
|
|
|
|
|
if (cb_mod_index[1] == _delay_length - 1) |
|
|
|
|
cb_mod_index_neighbor[1] = 0; |
|
|
|
|
else |
|
|
|
|
cb_mod_index_neighbor[1] = cb_mod_index[1] + 1; |
|
|
|
|
|
|
|
|
|
*bp[1] = round(float(_delayline[1][cb_mod_index[1]]) * mod_fraction + float(_delayline[1][cb_mod_index_neighbor[1]]) * (1.0 - mod_fraction)); |
|
|
|
|
|
|
|
|
|
// push the pointers forward
|
|
|
|
|
bp[1]++; // next audio data
|
|
|
|
|
_cb_index[1]++; // next circular buffer index
|
|
|
|
|
|
|
|
|
|
mp++; // next modulation data
|
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (modulation != (audio_block_t*)&zeroblock) |
|
|
|
|
release(modulation); |
|
|
|
|
|
|
|
|
|
if (block[0] != (audio_block_t*)&zeroblock) |
|
|
|
|
{ |
|
|
|
|
transmit(block[0], 0); |
|
|
|
|
release(block[0]); |
|
|
|
|
} |
|
|
|
|
if (block[1] != (audio_block_t*)&zeroblock) |
|
|
|
|
{ |
|
|
|
|
transmit(block[1], 0); |
|
|
|
|
release(block[1]); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
