You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
224 lines
7.2 KiB
224 lines
7.2 KiB
/*
|
|
|
|
Copyright (C) 2000 Stefan Westerfeld
|
|
stefan@space.twc.de
|
|
2001, 2003 Matthias Kretz
|
|
kretz@kde.org
|
|
|
|
This library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Library General Public
|
|
License as published by the Free Software Foundation; either
|
|
version 2 of the License, or (at your option) any later version.
|
|
|
|
This library 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
|
|
Library General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Library General Public License
|
|
along with this library; see the file COPYING.LIB. If not, write to
|
|
the Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
|
|
Boston, MA 02110-1301, USA.
|
|
|
|
*/
|
|
|
|
#include "artsflow.h"
|
|
#include "stdsynthmodule.h"
|
|
#include "debug.h"
|
|
|
|
#include <vector>
|
|
#include <iostream>
|
|
#include <math.h>
|
|
|
|
#undef DEBUG_MESSAGES
|
|
|
|
using namespace std;
|
|
using namespace Arts;
|
|
|
|
namespace Arts {
|
|
|
|
class AudioToByteStream_impl : public AudioToByteStream_skel,
|
|
public StdSynthModule
|
|
{
|
|
long _samplingRate, _channels, _bits;
|
|
long sampleSize;
|
|
double step;
|
|
bool interpolate;
|
|
vector<float> leftbuffer;
|
|
vector<float> rightbuffer;
|
|
int range;
|
|
double _pos;
|
|
protected:
|
|
void updateSampleSize()
|
|
{
|
|
sampleSize = _channels * _bits / 8;
|
|
}
|
|
|
|
public:
|
|
AudioToByteStream_impl() :
|
|
_pos(0)
|
|
{
|
|
samplingRate(44100);
|
|
channels(2);
|
|
bits(16);
|
|
}
|
|
|
|
long samplingRate() { return _samplingRate; }
|
|
void samplingRate(long newRate) {
|
|
double newStep = samplingRateFloat / (float)newRate;
|
|
arts_return_if_fail(newStep > 0);
|
|
_samplingRate = newRate;
|
|
step = newStep;
|
|
|
|
double delta = step - floor(step);
|
|
interpolate = fabs(delta) > 0.001;
|
|
#ifdef DEBUG_MESSAGES
|
|
arts_debug( "samplingRate(%i): step = %e, delta = %e, interpolate: %i", newRate, step, delta, interpolate );
|
|
#endif
|
|
}
|
|
|
|
long channels() { return _channels; }
|
|
void channels(long newChannels) {
|
|
arts_return_if_fail(newChannels == 1 || newChannels == 2);
|
|
_channels = newChannels;
|
|
updateSampleSize();
|
|
}
|
|
|
|
long bits() { return _bits; }
|
|
void bits(long newBits) {
|
|
arts_return_if_fail(newBits == 8 || newBits == 16);
|
|
_bits = newBits;
|
|
range = (newBits == 8 ) ? 128 : 32768;
|
|
updateSampleSize();
|
|
}
|
|
|
|
void calculateBlock(unsigned long samples)
|
|
{
|
|
leftbuffer.resize( 1 + samples );
|
|
rightbuffer.resize( 1 + samples );
|
|
for( unsigned long i = 0; i < samples; ++i ) {
|
|
leftbuffer[1 + i] = (left[i] > 1.0f) ? 1.0f : (left[i] < -1.0f) ? -1.0f : left[i];
|
|
rightbuffer[1 + i] = (right[i] > 1.0f) ? 1.0f : (right[i] < -1.0f) ? -1.0f : right[i];
|
|
}
|
|
|
|
int samplestosend = (int)ceil(leftbuffer.size() / step);
|
|
DataPacket<mcopbyte> *packet = outdata.allocPacket( samplestosend * sampleSize );
|
|
#ifdef DEBUG_MESSAGES
|
|
arts_debug( "calculateBlock(%i): send %i samples", samples, samplestosend );
|
|
#endif
|
|
|
|
int processed = 0;
|
|
if( interpolate ) {
|
|
double pos = 0;
|
|
if( _channels == 2 ) {
|
|
if( _bits == 16 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
double error = modf(_pos, &pos);
|
|
int intpos = (int)pos;
|
|
#ifdef DEBUG_MESSAGES
|
|
arts_debug( "pos=%i, error=%e", intpos, error );
|
|
#endif
|
|
long leftchannel = long((leftbuffer[intpos] * (1.0 - error) + leftbuffer[intpos + 1] * error) * 32768) + 32768;
|
|
long rightchannel = long((rightbuffer[intpos] * (1.0 - error) + rightbuffer[intpos + 1] * error) * 32768) + 32768;
|
|
packet->contents[processed ] = leftchannel;
|
|
packet->contents[processed + 1] = (leftchannel >> 8) - 128;
|
|
packet->contents[processed + 2] = rightchannel;
|
|
packet->contents[processed + 3] = (rightchannel >> 8) - 128;
|
|
_pos += step;
|
|
processed += 4;
|
|
}
|
|
} else if( _bits == 8 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
double error = modf(_pos, &pos);
|
|
int intpos = (int)pos;
|
|
long leftchannel = long((leftbuffer[intpos] * (1.0 - error) + leftbuffer[intpos + 1] * error) * 128) + 128;
|
|
long rightchannel = long((rightbuffer[intpos] * (1.0 - error) + rightbuffer[intpos + 1] * error) * 128) + 128;
|
|
packet->contents[processed ] = leftchannel;
|
|
packet->contents[processed + 1] = rightchannel;
|
|
_pos += step;
|
|
processed += 2;
|
|
}
|
|
}
|
|
} else {
|
|
if( _bits == 16 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
double error = modf(_pos, &pos);
|
|
int intpos = (int)pos;
|
|
long leftchannel = long(((leftbuffer[intpos] + rightbuffer[intpos]) * (1.0 - error) + (leftbuffer[intpos + 1] + rightbuffer[intpos + 1]) * error) * 16384) + 32768;
|
|
packet->contents[processed ] = leftchannel;
|
|
packet->contents[processed + 1] = (leftchannel >> 8) - 128;
|
|
_pos += step;
|
|
processed += 2;
|
|
}
|
|
} else if( _bits == 8 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
double error = modf(_pos, &pos);
|
|
int intpos = (int)pos;
|
|
long leftchannel = long(((leftbuffer[intpos] + rightbuffer[intpos]) * (1.0 - error) + (leftbuffer[intpos + 1] + rightbuffer[intpos + 1]) * error) * 64) + 128;
|
|
packet->contents[processed] = leftchannel;
|
|
_pos += step;
|
|
++processed;
|
|
}
|
|
}
|
|
}
|
|
} else {
|
|
if( _channels == 2 ) {
|
|
if( _bits == 16 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
int intpos = (int)_pos;
|
|
long leftchannel = long(leftbuffer[intpos] * 32768) + 32768;
|
|
long rightchannel = long(rightbuffer[intpos] * 32768) + 32768;
|
|
packet->contents[processed ] = leftchannel;
|
|
packet->contents[processed + 1] = (leftchannel >> 8) - 128;
|
|
packet->contents[processed + 2] = rightchannel;
|
|
packet->contents[processed + 3] = (rightchannel >> 8) - 128;
|
|
_pos += step;
|
|
processed += 4;
|
|
}
|
|
} else if( _bits == 8 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
int intpos = (int)_pos;
|
|
long leftchannel = long(leftbuffer[intpos] * 128) + 128;
|
|
long rightchannel = long(rightbuffer[intpos] * 128) + 128;
|
|
packet->contents[processed ] = leftchannel;
|
|
packet->contents[processed + 1] = rightchannel;
|
|
_pos += step;
|
|
processed += 2;
|
|
}
|
|
}
|
|
} else {
|
|
if( _bits == 16 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
int intpos = (int)_pos;
|
|
long leftchannel = long((leftbuffer[intpos] + rightbuffer[intpos]) * 16384) + 32768;
|
|
packet->contents[processed ] = leftchannel;
|
|
packet->contents[processed + 1] = (leftchannel >> 8) - 128;
|
|
_pos += step;
|
|
processed += 2;
|
|
}
|
|
} else if( _bits == 8 ) {
|
|
while( _pos < (double)leftbuffer.size() - 1 ) {
|
|
int intpos = (int)_pos;
|
|
long leftchannel = long((leftbuffer[intpos] + rightbuffer[intpos]) * 64) + 128;
|
|
packet->contents[processed] = leftchannel;
|
|
_pos += step;
|
|
++processed;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
leftbuffer[0] = leftbuffer.back();
|
|
rightbuffer[0] = rightbuffer.back();
|
|
_pos = _pos - floor(_pos);
|
|
packet->size = processed;
|
|
packet->send();
|
|
#ifdef DEBUG_MESSAGES
|
|
arts_debug( "calculateBlock(%i): %i samples sent, _pos = %e", samples, processed / sampleSize, _pos );
|
|
#endif
|
|
}
|
|
};
|
|
|
|
REGISTER_IMPLEMENTATION(AudioToByteStream_impl);
|
|
|
|
}
|