parent
5c6bd90446
commit
f9a0e09cf9
@ -0,0 +1,30 @@ |
|||||||
|
#include "AudioMixer4_F32.h" |
||||||
|
|
||||||
|
void AudioMixer4_F32::update(void) { |
||||||
|
audio_block_f32_t *in, *out=NULL; |
||||||
|
|
||||||
|
out = receiveWritable_f32(0); |
||||||
|
if (!out) return; |
||||||
|
|
||||||
|
arm_scale_f32(out->data, multiplier[0], out->data, AUDIO_BLOCK_SAMPLES); |
||||||
|
|
||||||
|
for (int channel=1; channel < 4; channel++) { |
||||||
|
in = receiveReadOnly_f32(channel); |
||||||
|
if (!in) { |
||||||
|
continue; |
||||||
|
} |
||||||
|
|
||||||
|
audio_block_f32_t *tmp = allocate_f32(); |
||||||
|
|
||||||
|
arm_scale_f32(in->data, multiplier[channel], tmp->data, AUDIO_BLOCK_SAMPLES); |
||||||
|
arm_add_f32(out->data, tmp->data, out->data, AUDIO_BLOCK_SAMPLES); |
||||||
|
|
||||||
|
release(tmp); |
||||||
|
release(in); |
||||||
|
} |
||||||
|
|
||||||
|
if (out) { |
||||||
|
transmit(out); |
||||||
|
release(out); |
||||||
|
} |
||||||
|
} |
@ -0,0 +1,28 @@ |
|||||||
|
#ifndef AUDIOMIXER4F32_H |
||||||
|
#define AUDIOMIXER4F32_H |
||||||
|
|
||||||
|
#include <arm_math.h> |
||||||
|
#include <AudioStream_F32.h> |
||||||
|
|
||||||
|
|
||||||
|
class AudioMixer4_F32 : public AudioStream_F32 { |
||||||
|
public: |
||||||
|
AudioMixer4_F32() : AudioStream_F32(4, inputQueueArray) { |
||||||
|
for (int i=0; i<4; i++) multiplier[i] = 0.5; |
||||||
|
} |
||||||
|
|
||||||
|
virtual void update(void); |
||||||
|
|
||||||
|
void gain(unsigned int channel, float gain) { |
||||||
|
if (channel >= 4) return; |
||||||
|
if (gain > 127.0f) gain = 127.0f; |
||||||
|
else if (gain < 0.0f) gain = 0.0f; |
||||||
|
multiplier[channel] = gain; |
||||||
|
} |
||||||
|
|
||||||
|
private: |
||||||
|
audio_block_f32_t *inputQueueArray[4]; |
||||||
|
float multiplier[4]; |
||||||
|
}; |
||||||
|
|
||||||
|
#endif |
Loading…
Reference in new issue