134 lines
2.7 KiB
C
134 lines
2.7 KiB
C
|
#ifndef AUDIO_RB_RESAMPLER_H
|
||
|
|
#define AUDIO_RB_RESAMPLER_H
|
||
|
|
|
||
|
|
#include "typedefs.h"
|
||
|
|
#include "os/memory.h"
|
||
|
|
|
||
|
|
struct AudioRBResampler {
|
||
|
|
|
||
|
|
uint32_t rb_bits;
|
||
|
|
uint32_t rb_len;
|
||
|
|
uint32_t rb_mask;
|
||
|
|
uint32_t read_buff_len;
|
||
|
|
uint32_t channels;
|
||
|
|
uint32_t src_mix_rate;
|
||
|
|
uint32_t target_mix_rate;
|
||
|
|
|
||
|
|
volatile int rb_read_pos;
|
||
|
|
volatile int rb_write_pos;
|
||
|
|
|
||
|
|
int32_t offset; //contains the fractional remainder of the resampler
|
||
|
|
enum {
|
||
|
|
MIX_FRAC_BITS=13,
|
||
|
|
MIX_FRAC_LEN=(1<<MIX_FRAC_BITS),
|
||
|
|
MIX_FRAC_MASK=MIX_FRAC_LEN-1,
|
||
|
|
};
|
||
|
|
|
||
|
|
int16_t *read_buf;
|
||
|
|
int16_t *rb;
|
||
|
|
|
||
|
|
|
||
|
|
template<int C>
|
||
|
|
uint32_t _resample(int32_t *p_dest,int p_todo,int32_t p_increment);
|
||
|
|
|
||
|
|
|
||
|
|
public:
|
||
|
|
|
||
|
|
_FORCE_INLINE_ void flush() {
|
||
|
|
rb_read_pos=0;
|
||
|
|
rb_write_pos=0;
|
||
|
|
}
|
||
|
|
|
||
|
|
_FORCE_INLINE_ bool is_ready() const{
|
||
|
|
return rb!=NULL;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
_FORCE_INLINE_ int get_total() const {
|
||
|
|
|
||
|
|
return rb_len-1;
|
||
|
|
}
|
||
|
|
|
||
|
|
_FORCE_INLINE_ int get_todo() const { //return amount of frames to mix
|
||
|
|
|
||
|
|
int todo;
|
||
|
|
int read_pos_cache=rb_read_pos;
|
||
|
|
|
||
|
|
if (read_pos_cache==rb_write_pos) {
|
||
|
|
todo=rb_len-1;
|
||
|
|
} else if (read_pos_cache>rb_write_pos) {
|
||
|
|
|
||
|
|
todo=read_pos_cache-rb_write_pos-1;
|
||
|
|
} else {
|
||
|
|
|
||
|
|
todo=(rb_len-rb_write_pos)+read_pos_cache-1;
|
||
|
|
}
|
||
|
|
|
||
|
|
return todo;
|
||
|
|
}
|
||
|
|
|
||
|
|
_FORCE_INLINE_ int16_t *get_write_buffer() { return read_buf; }
|
||
|
|
_FORCE_INLINE_ void write(uint32_t p_frames) {
|
||
|
|
|
||
|
|
ERR_FAIL_COND(p_frames >= rb_len);
|
||
|
|
|
||
|
|
switch(channels) {
|
||
|
|
case 1: {
|
||
|
|
|
||
|
|
for(uint32_t i=0;i<p_frames;i++) {
|
||
|
|
|
||
|
|
rb[ rb_write_pos ] = read_buf[i];
|
||
|
|
rb_write_pos=(rb_write_pos+1)&rb_mask;
|
||
|
|
}
|
||
|
|
} break;
|
||
|
|
case 2: {
|
||
|
|
|
||
|
|
for(uint32_t i=0;i<p_frames;i++) {
|
||
|
|
|
||
|
|
rb[ (rb_write_pos<<1)+0 ] = read_buf[(i<<1)+0];
|
||
|
|
rb[ (rb_write_pos<<1)+1 ] = read_buf[(i<<1)+1];
|
||
|
|
rb_write_pos=(rb_write_pos+1)&rb_mask;
|
||
|
|
}
|
||
|
|
} break;
|
||
|
|
case 4: {
|
||
|
|
|
||
|
|
for(uint32_t i=0;i<p_frames;i++) {
|
||
|
|
|
||
|
|
rb[ (rb_write_pos<<2)+0 ] = read_buf[(i<<2)+0];
|
||
|
|
rb[ (rb_write_pos<<2)+1 ] = read_buf[(i<<2)+1];
|
||
|
|
rb[ (rb_write_pos<<2)+2 ] = read_buf[(i<<2)+2];
|
||
|
|
rb[ (rb_write_pos<<2)+3 ] = read_buf[(i<<2)+3];
|
||
|
|
rb_write_pos=(rb_write_pos+1)&rb_mask;
|
||
|
|
}
|
||
|
|
} break;
|
||
|
|
case 6: {
|
||
|
|
|
||
|
|
for(uint32_t i=0;i<p_frames;i++) {
|
||
|
|
|
||
|
|
rb[ (rb_write_pos*6)+0 ] = read_buf[(i*6)+0];
|
||
|
|
rb[ (rb_write_pos*6)+1 ] = read_buf[(i*6)+1];
|
||
|
|
rb[ (rb_write_pos*6)+2 ] = read_buf[(i*6)+2];
|
||
|
|
rb[ (rb_write_pos*6)+3 ] = read_buf[(i*6)+3];
|
||
|
|
rb[ (rb_write_pos*6)+4 ] = read_buf[(i*6)+4];
|
||
|
|
rb[ (rb_write_pos*6)+5 ] = read_buf[(i*6)+5];
|
||
|
|
rb_write_pos=(rb_write_pos+1)&rb_mask;
|
||
|
|
}
|
||
|
|
} break;
|
||
|
|
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
int get_channel_count() const;
|
||
|
|
|
||
|
|
Error setup(int p_channels, int p_src_mix_rate, int p_target_mix_rate, int p_buffer_msec, int p_minbuff_needed=-1);
|
||
|
|
void clear();
|
||
|
|
bool mix(int32_t *p_dest, int p_frames);
|
||
|
|
|
||
|
|
AudioRBResampler();
|
||
|
|
~AudioRBResampler();
|
||
|
|
};
|
||
|
|
|
||
|
|
#endif // AUDIO_RB_RESAMPLER_H
|