aboutsummaryrefslogtreecommitdiff
path: root/src/pcm_utils.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/pcm_utils.c')
-rw-r--r--src/pcm_utils.c239
1 files changed, 124 insertions, 115 deletions
diff --git a/src/pcm_utils.c b/src/pcm_utils.c
index 74846387..0210c290 100644
--- a/src/pcm_utils.c
+++ b/src/pcm_utils.c
@@ -16,7 +16,6 @@
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
-
#include "pcm_utils.h"
#include "mpd_types.h"
@@ -26,134 +25,143 @@
#include <math.h>
#include <assert.h>
-void pcm_volumeChange(char * buffer, int bufferSize, AudioFormat * format,
- int volume)
+void pcm_volumeChange(char *buffer, int bufferSize, AudioFormat * format,
+ int volume)
{
mpd_sint32 temp32;
- mpd_sint8 * buffer8 = (mpd_sint8 *)buffer;
- mpd_sint16 * buffer16 = (mpd_sint16 *)buffer;
+ mpd_sint8 *buffer8 = (mpd_sint8 *) buffer;
+ mpd_sint16 *buffer16 = (mpd_sint16 *) buffer;
+
+ if (volume >= 1000)
+ return;
- if(volume>=1000) return;
-
- if(volume<=0) {
- memset(buffer,0,bufferSize);
+ if (volume <= 0) {
+ memset(buffer, 0, bufferSize);
return;
}
- switch(format->bits) {
+ switch (format->bits) {
case 16:
- while(bufferSize>0) {
+ while (bufferSize > 0) {
temp32 = *buffer16;
- temp32*= volume;
- temp32/=1000;
- *buffer16 = temp32>32767 ? 32767 :
- (temp32<-32768 ? -32768 : temp32);
+ temp32 *= volume;
+ temp32 /= 1000;
+ *buffer16 = temp32 > 32767 ? 32767 :
+ (temp32 < -32768 ? -32768 : temp32);
buffer16++;
- bufferSize-=2;
+ bufferSize -= 2;
}
break;
case 8:
- while(bufferSize>0) {
+ while (bufferSize > 0) {
temp32 = *buffer8;
- temp32*= volume;
- temp32/=1000;
- *buffer8 = temp32>127 ? 127 :
- (temp32<-128 ? -128 : temp32);
+ temp32 *= volume;
+ temp32 /= 1000;
+ *buffer8 = temp32 > 127 ? 127 :
+ (temp32 < -128 ? -128 : temp32);
buffer8++;
bufferSize--;
}
break;
default:
ERROR("%i bits not supported by pcm_volumeChange!\n",
- format->bits);
+ format->bits);
exit(EXIT_FAILURE);
}
}
-static void pcm_add(char * buffer1, char * buffer2, size_t bufferSize1,
- size_t bufferSize2, int vol1, int vol2, AudioFormat * format)
+static void pcm_add(char *buffer1, char *buffer2, size_t bufferSize1,
+ size_t bufferSize2, int vol1, int vol2,
+ AudioFormat * format)
{
mpd_sint32 temp32;
- mpd_sint8 * buffer8_1 = (mpd_sint8 *)buffer1;
- mpd_sint8 * buffer8_2 = (mpd_sint8 *)buffer2;
- mpd_sint16 * buffer16_1 = (mpd_sint16 *)buffer1;
- mpd_sint16 * buffer16_2 = (mpd_sint16 *)buffer2;
+ mpd_sint8 *buffer8_1 = (mpd_sint8 *) buffer1;
+ mpd_sint8 *buffer8_2 = (mpd_sint8 *) buffer2;
+ mpd_sint16 *buffer16_1 = (mpd_sint16 *) buffer1;
+ mpd_sint16 *buffer16_2 = (mpd_sint16 *) buffer2;
- switch(format->bits) {
+ switch (format->bits) {
case 16:
- while(bufferSize1>0 && bufferSize2>0) {
- temp32 = (vol1*(*buffer16_1)+vol2*(*buffer16_2))/1000;
- *buffer16_1 = temp32>32767 ? 32767 :
- (temp32<-32768 ? -32768 : temp32);
+ while (bufferSize1 > 0 && bufferSize2 > 0) {
+ temp32 =
+ (vol1 * (*buffer16_1) +
+ vol2 * (*buffer16_2)) / 1000;
+ *buffer16_1 =
+ temp32 > 32767 ? 32767 : (temp32 <
+ -32768 ? -32768 : temp32);
buffer16_1++;
buffer16_2++;
- bufferSize1-=2;
- bufferSize2-=2;
+ bufferSize1 -= 2;
+ bufferSize2 -= 2;
}
- if(bufferSize2>0) memcpy(buffer16_1,buffer16_2,bufferSize2);
+ if (bufferSize2 > 0)
+ memcpy(buffer16_1, buffer16_2, bufferSize2);
break;
case 8:
- while(bufferSize1>0 && bufferSize2>0) {
- temp32 = (vol1*(*buffer8_1)+vol2*(*buffer8_2))/1000;
- *buffer8_1 = temp32>127 ? 127 :
- (temp32<-128 ? -128 : temp32);
+ while (bufferSize1 > 0 && bufferSize2 > 0) {
+ temp32 =
+ (vol1 * (*buffer8_1) + vol2 * (*buffer8_2)) / 1000;
+ *buffer8_1 =
+ temp32 > 127 ? 127 : (temp32 <
+ -128 ? -128 : temp32);
buffer8_1++;
buffer8_2++;
bufferSize1--;
bufferSize2--;
}
- if(bufferSize2>0) memcpy(buffer8_1,buffer8_2,bufferSize2);
+ if (bufferSize2 > 0)
+ memcpy(buffer8_1, buffer8_2, bufferSize2);
break;
default:
- ERROR("%i bits not supported by pcm_add!\n",format->bits);
+ ERROR("%i bits not supported by pcm_add!\n", format->bits);
exit(EXIT_FAILURE);
}
}
-void pcm_mix(char * buffer1, char * buffer2, size_t bufferSize1,
- size_t bufferSize2, AudioFormat * format, float portion1)
+void pcm_mix(char *buffer1, char *buffer2, size_t bufferSize1,
+ size_t bufferSize2, AudioFormat * format, float portion1)
{
int vol1;
- float s = sin(M_PI_2*portion1);
- s*=s;
-
- vol1 = s*1000+0.5;
- vol1 = vol1>1000 ? 1000 : ( vol1<0 ? 0 : vol1 );
+ float s = sin(M_PI_2 * portion1);
+ s *= s;
- pcm_add(buffer1,buffer2,bufferSize1,bufferSize2,vol1,1000-vol1,format);
-}
+ vol1 = s * 1000 + 0.5;
+ vol1 = vol1 > 1000 ? 1000 : (vol1 < 0 ? 0 : vol1);
+ pcm_add(buffer1, buffer2, bufferSize1, bufferSize2, vol1, 1000 - vol1,
+ format);
+}
/* outFormat bits must be 16 and channels must be 2! */
-void pcm_convertAudioFormat(AudioFormat * inFormat, char * inBuffer, size_t
- inSize, AudioFormat * outFormat, char * outBuffer)
+void pcm_convertAudioFormat(AudioFormat * inFormat, char *inBuffer, size_t
+ inSize, AudioFormat * outFormat, char *outBuffer)
{
- static char * bitConvBuffer = NULL;
+ static char *bitConvBuffer = NULL;
static int bitConvBufferLength = 0;
- static char * channelConvBuffer = NULL;
+ static char *channelConvBuffer = NULL;
static int channelConvBufferLength = 0;
- char * dataChannelConv;
+ char *dataChannelConv;
int dataChannelLen;
- char * dataBitConv;
+ char *dataBitConv;
int dataBitLen;
- assert(outFormat->bits==16);
- assert(outFormat->channels==2 || outFormat->channels==1);
+ assert(outFormat->bits == 16);
+ assert(outFormat->channels == 2 || outFormat->channels == 1);
/* converts */
- switch(inFormat->bits) {
+ switch (inFormat->bits) {
case 8:
dataBitLen = inSize << 1;
- if(dataBitLen > bitConvBufferLength) {
+ if (dataBitLen > bitConvBufferLength) {
bitConvBuffer = realloc(bitConvBuffer, dataBitLen);
bitConvBufferLength = dataBitLen;
}
dataBitConv = bitConvBuffer;
{
- mpd_sint8 * in = (mpd_sint8 *)inBuffer;
- mpd_sint16 * out = (mpd_sint16 *)dataBitConv;
+ mpd_sint8 *in = (mpd_sint8 *) inBuffer;
+ mpd_sint16 *out = (mpd_sint16 *) dataBitConv;
int i;
- for(i=0; i<inSize; i++) {
+ for (i = 0; i < inSize; i++) {
*out++ = (*in++) << 8;
}
}
@@ -170,96 +178,96 @@ void pcm_convertAudioFormat(AudioFormat * inFormat, char * inBuffer, size_t
}
/* converts only between 16 bit audio between mono and stereo */
- if(inFormat->channels == outFormat->channels)
- {
+ if (inFormat->channels == outFormat->channels) {
dataChannelConv = dataBitConv;
dataChannelLen = dataBitLen;
- }
- else {
- switch(inFormat->channels) {
- /* convert from 1 -> 2 channels */
+ } else {
+ switch (inFormat->channels) {
+ /* convert from 1 -> 2 channels */
case 1:
dataChannelLen = (dataBitLen >> 1) << 2;
- if(dataChannelLen > channelConvBufferLength) {
+ if (dataChannelLen > channelConvBufferLength) {
channelConvBuffer = realloc(channelConvBuffer,
- dataChannelLen);
+ dataChannelLen);
channelConvBufferLength = dataChannelLen;
}
dataChannelConv = channelConvBuffer;
{
- mpd_sint16 * in = (mpd_sint16 *)dataBitConv;
- mpd_sint16 * out = (mpd_sint16 *)dataChannelConv;
+ mpd_sint16 *in = (mpd_sint16 *) dataBitConv;
+ mpd_sint16 *out =
+ (mpd_sint16 *) dataChannelConv;
int i, inSamples = dataBitLen >> 1;
- for(i=0;i<inSamples;i++) {
+ for (i = 0; i < inSamples; i++) {
*out++ = *in;
*out++ = *in++;
}
}
break;
- /* convert from 2 -> 1 channels */
+ /* convert from 2 -> 1 channels */
case 2:
dataChannelLen = dataBitLen >> 1;
- if(dataChannelLen > channelConvBufferLength) {
+ if (dataChannelLen > channelConvBufferLength) {
channelConvBuffer = realloc(channelConvBuffer,
- dataChannelLen);
+ dataChannelLen);
channelConvBufferLength = dataChannelLen;
}
dataChannelConv = channelConvBuffer;
{
- mpd_sint16 * in = (mpd_sint16 *)dataBitConv;
- mpd_sint16 * out = (mpd_sint16 *)dataChannelConv;
+ mpd_sint16 *in = (mpd_sint16 *) dataBitConv;
+ mpd_sint16 *out =
+ (mpd_sint16 *) dataChannelConv;
int i, inSamples = dataBitLen >> 2;
- for(i=0;i<inSamples;i++) {
- *out = (*in++)/2;
- *out++ += (*in++)/2;
+ for (i = 0; i < inSamples; i++) {
+ *out = (*in++) / 2;
+ *out++ += (*in++) / 2;
}
}
break;
default:
- ERROR("only 1 or 2 channels are supported for conversion!\n");
+ ERROR
+ ("only 1 or 2 channels are supported for conversion!\n");
exit(EXIT_FAILURE);
}
}
- if(inFormat->sampleRate == outFormat->sampleRate) {
- memcpy(outBuffer,dataChannelConv,dataChannelLen);
- }
- else {
+ if (inFormat->sampleRate == outFormat->sampleRate) {
+ memcpy(outBuffer, dataChannelConv, dataChannelLen);
+ } else {
/* only works if outFormat is 16-bit stereo! */
/* resampling code blatantly ripped from ESD */
mpd_uint32 rd_dat = 0;
mpd_uint32 wr_dat = 0;
mpd_sint16 lsample, rsample;
- mpd_sint16 * out = (mpd_sint16 *)outBuffer;
- mpd_sint16 * in = (mpd_sint16 *)dataChannelConv;
- const int shift = sizeof(mpd_sint16)*outFormat->channels;
- mpd_uint32 nlen = ((( dataChannelLen / shift) *
- (mpd_uint32)(outFormat->sampleRate)) /
- inFormat->sampleRate);
+ mpd_sint16 *out = (mpd_sint16 *) outBuffer;
+ mpd_sint16 *in = (mpd_sint16 *) dataChannelConv;
+ const int shift = sizeof(mpd_sint16) * outFormat->channels;
+ mpd_uint32 nlen = (((dataChannelLen / shift) *
+ (mpd_uint32) (outFormat->sampleRate)) /
+ inFormat->sampleRate);
nlen *= outFormat->channels;
- switch(outFormat->channels) {
+ switch (outFormat->channels) {
case 1:
- while( wr_dat < nlen) {
- rd_dat = wr_dat * inFormat->sampleRate /
- outFormat->sampleRate;
+ while (wr_dat < nlen) {
+ rd_dat = wr_dat * inFormat->sampleRate /
+ outFormat->sampleRate;
- lsample = in[ rd_dat++ ];
+ lsample = in[rd_dat++];
- out[ wr_dat++ ] = lsample;
+ out[wr_dat++] = lsample;
}
break;
case 2:
- while( wr_dat < nlen) {
- rd_dat = wr_dat * inFormat->sampleRate /
- outFormat->sampleRate;
+ while (wr_dat < nlen) {
+ rd_dat = wr_dat * inFormat->sampleRate /
+ outFormat->sampleRate;
rd_dat &= ~1;
- lsample = in[ rd_dat++ ];
- rsample = in[ rd_dat++ ];
+ lsample = in[rd_dat++];
+ rsample = in[rd_dat++];
- out[ wr_dat++ ] = lsample;
- out[ wr_dat++ ] = rsample;
+ out[wr_dat++] = lsample;
+ out[wr_dat++] = rsample;
}
break;
}
@@ -269,12 +277,13 @@ void pcm_convertAudioFormat(AudioFormat * inFormat, char * inBuffer, size_t
}
size_t pcm_sizeOfOutputBufferForAudioFormatConversion(AudioFormat * inFormat,
- size_t inSize, AudioFormat * outFormat)
+ size_t inSize,
+ AudioFormat * outFormat)
{
- const int shift = sizeof(mpd_sint16)*outFormat->channels;
+ const int shift = sizeof(mpd_sint16) * outFormat->channels;
size_t outSize = inSize;
- switch(inFormat->bits) {
+ switch (inFormat->bits) {
case 8:
outSize = outSize << 1;
break;
@@ -285,8 +294,8 @@ size_t pcm_sizeOfOutputBufferForAudioFormatConversion(AudioFormat * inFormat,
exit(EXIT_FAILURE);
}
- if(inFormat->channels != outFormat->channels) {
- switch(inFormat->channels) {
+ if (inFormat->channels != outFormat->channels) {
+ switch (inFormat->channels) {
case 1:
outSize = (outSize >> 1) << 2;
break;
@@ -295,9 +304,9 @@ size_t pcm_sizeOfOutputBufferForAudioFormatConversion(AudioFormat * inFormat,
break;
}
}
-
- outSize = (((outSize / shift) * (mpd_uint32)(outFormat->sampleRate)) /
- inFormat->sampleRate);
+
+ outSize = (((outSize / shift) * (mpd_uint32) (outFormat->sampleRate)) /
+ inFormat->sampleRate);
outSize *= shift;