2009-01-07 18:53:36 +01:00
|
|
|
/*
|
2011-01-29 10:13:54 +01:00
|
|
|
* Copyright (C) 2003-2011 The Music Player Daemon Project
|
2009-01-07 18:53:36 +01:00
|
|
|
* http://www.musicpd.org
|
2004-02-24 18:06:14 +01:00
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program 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 General Public License for more details.
|
2009-03-13 18:43:16 +01:00
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License along
|
|
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
2004-02-24 18:06:14 +01:00
|
|
|
*/
|
|
|
|
|
2009-11-12 09:12:38 +01:00
|
|
|
#include "config.h"
|
2009-01-07 18:53:36 +01:00
|
|
|
#include "pcm_convert.h"
|
2008-10-23 20:03:14 +02:00
|
|
|
#include "pcm_channels.h"
|
2009-01-07 18:19:09 +01:00
|
|
|
#include "pcm_format.h"
|
2009-07-19 17:42:19 +02:00
|
|
|
#include "pcm_byteswap.h"
|
2010-01-15 09:23:36 +01:00
|
|
|
#include "pcm_pack.h"
|
2008-09-07 19:19:55 +02:00
|
|
|
#include "audio_format.h"
|
2008-10-08 10:49:29 +02:00
|
|
|
|
|
|
|
#include <assert.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <math.h>
|
2008-12-02 02:22:43 +01:00
|
|
|
#include <glib.h>
|
2004-02-24 00:41:20 +01:00
|
|
|
|
2008-12-29 17:28:49 +01:00
|
|
|
#undef G_LOG_DOMAIN
|
|
|
|
#define G_LOG_DOMAIN "pcm"
|
|
|
|
|
2008-10-21 22:53:16 +02:00
|
|
|
void pcm_convert_init(struct pcm_convert_state *state)
|
|
|
|
{
|
|
|
|
memset(state, 0, sizeof(*state));
|
2008-10-23 16:58:07 +02:00
|
|
|
|
2008-10-23 20:00:51 +02:00
|
|
|
pcm_resample_init(&state->resample);
|
2008-10-23 16:58:07 +02:00
|
|
|
pcm_dither_24_init(&state->dither);
|
2009-01-07 23:56:34 +01:00
|
|
|
|
|
|
|
pcm_buffer_init(&state->format_buffer);
|
2010-01-15 09:23:36 +01:00
|
|
|
pcm_buffer_init(&state->pack_buffer);
|
2009-01-07 23:56:35 +01:00
|
|
|
pcm_buffer_init(&state->channels_buffer);
|
2009-07-22 15:56:56 +02:00
|
|
|
pcm_buffer_init(&state->byteswap_buffer);
|
2008-10-21 22:53:16 +02:00
|
|
|
}
|
|
|
|
|
2009-01-07 22:20:30 +01:00
|
|
|
void pcm_convert_deinit(struct pcm_convert_state *state)
|
|
|
|
{
|
|
|
|
pcm_resample_deinit(&state->resample);
|
2009-01-07 23:56:34 +01:00
|
|
|
|
|
|
|
pcm_buffer_deinit(&state->format_buffer);
|
2010-01-15 09:23:36 +01:00
|
|
|
pcm_buffer_deinit(&state->pack_buffer);
|
2009-01-07 23:56:35 +01:00
|
|
|
pcm_buffer_deinit(&state->channels_buffer);
|
2009-07-22 15:56:56 +02:00
|
|
|
pcm_buffer_deinit(&state->byteswap_buffer);
|
2009-01-07 22:20:30 +01:00
|
|
|
}
|
|
|
|
|
2011-10-08 18:19:43 +02:00
|
|
|
G_GNUC_UNUSED
|
|
|
|
static const void *
|
|
|
|
pcm_convert_channels(struct pcm_buffer *buffer, enum sample_format format,
|
|
|
|
uint8_t dest_channels,
|
|
|
|
uint8_t src_channels, const void *src,
|
|
|
|
size_t src_size, size_t *dest_size_r,
|
|
|
|
GError **error_r)
|
|
|
|
{
|
|
|
|
const void *dest = NULL;
|
|
|
|
|
|
|
|
switch (format) {
|
|
|
|
case SAMPLE_FORMAT_UNDEFINED:
|
|
|
|
case SAMPLE_FORMAT_S8:
|
|
|
|
case SAMPLE_FORMAT_S24:
|
|
|
|
case SAMPLE_FORMAT_FLOAT:
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
|
|
|
"Channel conversion not implemented for format '%s'",
|
|
|
|
sample_format_to_string(format));
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
case SAMPLE_FORMAT_S16:
|
|
|
|
dest = pcm_convert_channels_16(buffer, dest_channels,
|
|
|
|
src_channels, src,
|
|
|
|
src_size, dest_size_r);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case SAMPLE_FORMAT_S24_P32:
|
|
|
|
dest = pcm_convert_channels_24(buffer, dest_channels,
|
|
|
|
src_channels, src,
|
|
|
|
src_size, dest_size_r);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case SAMPLE_FORMAT_S32:
|
|
|
|
dest = pcm_convert_channels_32(buffer, dest_channels,
|
|
|
|
src_channels, src,
|
|
|
|
src_size, dest_size_r);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (dest == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
|
|
|
"Conversion from %u to %u channels "
|
|
|
|
"is not implemented",
|
|
|
|
src_channels, dest_channels);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return dest;
|
|
|
|
}
|
|
|
|
|
2009-01-17 13:11:16 +01:00
|
|
|
static const int16_t *
|
|
|
|
pcm_convert_16(struct pcm_convert_state *state,
|
|
|
|
const struct audio_format *src_format,
|
2008-10-23 20:11:24 +02:00
|
|
|
const void *src_buffer, size_t src_size,
|
2009-07-23 12:01:03 +02:00
|
|
|
const struct audio_format *dest_format, size_t *dest_size_r,
|
|
|
|
GError **error_r)
|
2007-05-23 01:11:36 +02:00
|
|
|
{
|
2008-10-12 11:28:37 +02:00
|
|
|
const int16_t *buf;
|
2008-10-23 20:11:24 +02:00
|
|
|
size_t len;
|
2007-05-23 01:11:36 +02:00
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
assert(dest_format->format == SAMPLE_FORMAT_S16);
|
2007-05-23 01:11:36 +02:00
|
|
|
|
2009-01-07 23:56:34 +01:00
|
|
|
buf = pcm_convert_to_16(&state->format_buffer, &state->dither,
|
2009-11-10 17:11:34 +01:00
|
|
|
src_format->format, src_buffer, src_size,
|
2009-01-07 23:56:34 +01:00
|
|
|
&len);
|
2009-07-23 12:01:03 +02:00
|
|
|
if (buf == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
2009-11-10 17:11:34 +01:00
|
|
|
"Conversion from %s to 16 bit is not implemented",
|
|
|
|
sample_format_to_string(src_format->format));
|
2009-07-23 12:01:03 +02:00
|
|
|
return NULL;
|
|
|
|
}
|
2007-05-23 01:11:36 +02:00
|
|
|
|
2008-10-23 20:11:24 +02:00
|
|
|
if (src_format->channels != dest_format->channels) {
|
2009-01-07 23:56:35 +01:00
|
|
|
buf = pcm_convert_channels_16(&state->channels_buffer,
|
|
|
|
dest_format->channels,
|
2008-10-23 20:11:24 +02:00
|
|
|
src_format->channels,
|
2008-10-23 20:03:14 +02:00
|
|
|
buf, len, &len);
|
2009-07-23 12:01:03 +02:00
|
|
|
if (buf == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
|
|
|
"Conversion from %u to %u channels "
|
|
|
|
"is not implemented",
|
|
|
|
src_format->channels,
|
|
|
|
dest_format->channels);
|
|
|
|
return NULL;
|
|
|
|
}
|
2007-05-23 01:11:36 +02:00
|
|
|
}
|
|
|
|
|
2009-07-23 12:01:03 +02:00
|
|
|
if (src_format->sample_rate != dest_format->sample_rate) {
|
2009-01-08 00:46:38 +01:00
|
|
|
buf = pcm_resample_16(&state->resample,
|
|
|
|
dest_format->channels,
|
2008-10-23 20:11:24 +02:00
|
|
|
src_format->sample_rate, buf, len,
|
2009-07-23 12:01:03 +02:00
|
|
|
dest_format->sample_rate, &len,
|
|
|
|
error_r);
|
|
|
|
if (buf == NULL)
|
|
|
|
return NULL;
|
|
|
|
}
|
2009-01-08 00:46:38 +01:00
|
|
|
|
2009-07-19 17:42:19 +02:00
|
|
|
if (dest_format->reverse_endian) {
|
2009-07-22 15:56:56 +02:00
|
|
|
buf = pcm_byteswap_16(&state->byteswap_buffer, buf, len);
|
2009-07-22 19:04:38 +02:00
|
|
|
assert(buf != NULL);
|
2009-07-19 17:42:19 +02:00
|
|
|
}
|
|
|
|
|
2009-01-17 13:11:16 +01:00
|
|
|
*dest_size_r = len;
|
|
|
|
return buf;
|
2004-05-10 16:06:23 +02:00
|
|
|
}
|
|
|
|
|
2009-01-17 13:11:16 +01:00
|
|
|
static const int32_t *
|
|
|
|
pcm_convert_24(struct pcm_convert_state *state,
|
|
|
|
const struct audio_format *src_format,
|
2008-10-23 20:11:37 +02:00
|
|
|
const void *src_buffer, size_t src_size,
|
2009-07-23 12:01:03 +02:00
|
|
|
const struct audio_format *dest_format, size_t *dest_size_r,
|
|
|
|
GError **error_r)
|
2008-10-23 20:11:37 +02:00
|
|
|
{
|
|
|
|
const int32_t *buf;
|
|
|
|
size_t len;
|
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
assert(dest_format->format == SAMPLE_FORMAT_S24_P32);
|
2008-10-23 20:11:37 +02:00
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
buf = pcm_convert_to_24(&state->format_buffer, src_format->format,
|
2008-10-23 20:11:37 +02:00
|
|
|
src_buffer, src_size, &len);
|
2009-07-23 12:01:03 +02:00
|
|
|
if (buf == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
2009-11-10 17:11:34 +01:00
|
|
|
"Conversion from %s to 24 bit is not implemented",
|
|
|
|
sample_format_to_string(src_format->format));
|
2009-07-23 12:01:03 +02:00
|
|
|
return NULL;
|
|
|
|
}
|
2008-10-23 20:11:37 +02:00
|
|
|
|
|
|
|
if (src_format->channels != dest_format->channels) {
|
2009-01-07 23:56:35 +01:00
|
|
|
buf = pcm_convert_channels_24(&state->channels_buffer,
|
|
|
|
dest_format->channels,
|
2008-10-23 20:11:37 +02:00
|
|
|
src_format->channels,
|
|
|
|
buf, len, &len);
|
2009-07-23 12:01:03 +02:00
|
|
|
if (buf == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
|
|
|
"Conversion from %u to %u channels "
|
|
|
|
"is not implemented",
|
|
|
|
src_format->channels,
|
|
|
|
dest_format->channels);
|
|
|
|
return NULL;
|
|
|
|
}
|
2008-10-23 20:11:37 +02:00
|
|
|
}
|
|
|
|
|
2009-07-23 12:01:03 +02:00
|
|
|
if (src_format->sample_rate != dest_format->sample_rate) {
|
2009-01-08 00:46:38 +01:00
|
|
|
buf = pcm_resample_24(&state->resample,
|
|
|
|
dest_format->channels,
|
2008-10-23 20:11:37 +02:00
|
|
|
src_format->sample_rate, buf, len,
|
2009-07-23 12:01:03 +02:00
|
|
|
dest_format->sample_rate, &len,
|
|
|
|
error_r);
|
|
|
|
if (buf == NULL)
|
|
|
|
return NULL;
|
|
|
|
}
|
2009-01-08 00:46:38 +01:00
|
|
|
|
2009-07-19 17:42:19 +02:00
|
|
|
if (dest_format->reverse_endian) {
|
2009-07-22 15:56:56 +02:00
|
|
|
buf = pcm_byteswap_32(&state->byteswap_buffer, buf, len);
|
2009-07-22 19:04:38 +02:00
|
|
|
assert(buf != NULL);
|
2009-07-19 17:42:19 +02:00
|
|
|
}
|
|
|
|
|
2009-01-17 13:11:16 +01:00
|
|
|
*dest_size_r = len;
|
|
|
|
return buf;
|
2008-10-23 20:11:37 +02:00
|
|
|
}
|
|
|
|
|
2010-01-15 09:23:36 +01:00
|
|
|
/**
|
|
|
|
* Convert to 24 bit packed samples (aka S24_3LE / S24_3BE).
|
|
|
|
*/
|
|
|
|
static const void *
|
|
|
|
pcm_convert_24_packed(struct pcm_convert_state *state,
|
|
|
|
const struct audio_format *src_format,
|
|
|
|
const void *src_buffer, size_t src_size,
|
|
|
|
const struct audio_format *dest_format,
|
|
|
|
size_t *dest_size_r,
|
|
|
|
GError **error_r)
|
|
|
|
{
|
|
|
|
assert(dest_format->format == SAMPLE_FORMAT_S24);
|
|
|
|
|
|
|
|
/* use the normal 24 bit conversion first */
|
|
|
|
|
|
|
|
struct audio_format audio_format;
|
|
|
|
audio_format_init(&audio_format, dest_format->sample_rate,
|
|
|
|
SAMPLE_FORMAT_S24_P32, dest_format->channels);
|
|
|
|
|
|
|
|
const int32_t *buffer;
|
|
|
|
size_t buffer_size;
|
|
|
|
|
|
|
|
buffer = pcm_convert_24(state, src_format, src_buffer, src_size,
|
|
|
|
&audio_format, &buffer_size, error_r);
|
|
|
|
if (buffer == NULL)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
/* now convert to packed 24 bit */
|
|
|
|
|
|
|
|
unsigned num_samples = buffer_size / 4;
|
|
|
|
size_t dest_size = num_samples * 3;
|
|
|
|
|
|
|
|
uint8_t *dest = pcm_buffer_get(&state->pack_buffer, dest_size);
|
2011-10-09 12:48:17 +02:00
|
|
|
pcm_pack_24(dest, buffer, buffer + num_samples,
|
|
|
|
dest_format->reverse_endian);
|
2010-01-15 09:23:36 +01:00
|
|
|
|
|
|
|
*dest_size_r = dest_size;
|
|
|
|
return dest;
|
|
|
|
}
|
|
|
|
|
2009-03-02 16:41:10 +01:00
|
|
|
static const int32_t *
|
|
|
|
pcm_convert_32(struct pcm_convert_state *state,
|
|
|
|
const struct audio_format *src_format,
|
|
|
|
const void *src_buffer, size_t src_size,
|
2009-07-23 12:01:03 +02:00
|
|
|
const struct audio_format *dest_format, size_t *dest_size_r,
|
|
|
|
GError **error_r)
|
2009-03-02 16:41:10 +01:00
|
|
|
{
|
|
|
|
const int32_t *buf;
|
|
|
|
size_t len;
|
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
assert(dest_format->format == SAMPLE_FORMAT_S32);
|
2009-03-02 16:41:10 +01:00
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
buf = pcm_convert_to_32(&state->format_buffer, src_format->format,
|
2009-03-02 16:41:10 +01:00
|
|
|
src_buffer, src_size, &len);
|
2009-07-23 12:01:03 +02:00
|
|
|
if (buf == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
2011-10-08 15:36:55 +02:00
|
|
|
"Conversion from %s to 32 bit is not implemented",
|
2009-11-10 17:11:34 +01:00
|
|
|
sample_format_to_string(src_format->format));
|
2009-07-23 12:01:03 +02:00
|
|
|
return NULL;
|
|
|
|
}
|
2009-03-02 16:41:10 +01:00
|
|
|
|
|
|
|
if (src_format->channels != dest_format->channels) {
|
|
|
|
buf = pcm_convert_channels_32(&state->channels_buffer,
|
|
|
|
dest_format->channels,
|
|
|
|
src_format->channels,
|
|
|
|
buf, len, &len);
|
2009-07-23 12:01:03 +02:00
|
|
|
if (buf == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
|
|
|
"Conversion from %u to %u channels "
|
|
|
|
"is not implemented",
|
|
|
|
src_format->channels,
|
|
|
|
dest_format->channels);
|
|
|
|
return NULL;
|
|
|
|
}
|
2009-03-02 16:41:10 +01:00
|
|
|
}
|
|
|
|
|
2009-07-23 12:01:03 +02:00
|
|
|
if (src_format->sample_rate != dest_format->sample_rate) {
|
2009-03-02 16:41:10 +01:00
|
|
|
buf = pcm_resample_32(&state->resample,
|
|
|
|
dest_format->channels,
|
|
|
|
src_format->sample_rate, buf, len,
|
2009-07-23 12:01:03 +02:00
|
|
|
dest_format->sample_rate, &len,
|
|
|
|
error_r);
|
|
|
|
if (buf == NULL)
|
|
|
|
return buf;
|
|
|
|
}
|
2009-03-02 16:41:10 +01:00
|
|
|
|
2009-07-19 17:42:19 +02:00
|
|
|
if (dest_format->reverse_endian) {
|
2009-07-22 15:56:56 +02:00
|
|
|
buf = pcm_byteswap_32(&state->byteswap_buffer, buf, len);
|
2009-07-22 19:04:38 +02:00
|
|
|
assert(buf != NULL);
|
2009-07-19 17:42:19 +02:00
|
|
|
}
|
|
|
|
|
2009-03-02 16:41:10 +01:00
|
|
|
*dest_size_r = len;
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
|
2009-01-17 13:11:16 +01:00
|
|
|
const void *
|
|
|
|
pcm_convert(struct pcm_convert_state *state,
|
|
|
|
const struct audio_format *src_format,
|
|
|
|
const void *src, size_t src_size,
|
|
|
|
const struct audio_format *dest_format,
|
2009-07-23 12:01:03 +02:00
|
|
|
size_t *dest_size_r,
|
|
|
|
GError **error_r)
|
2008-10-23 20:11:24 +02:00
|
|
|
{
|
2011-10-10 09:29:02 +02:00
|
|
|
if (src_format->reverse_endian) {
|
|
|
|
/* convert to host byte order, because all of our
|
|
|
|
conversion libraries assume host byte order */
|
|
|
|
|
|
|
|
src = pcm_byteswap(&state->byteswap_buffer, src_format->format,
|
|
|
|
src, src_size);
|
|
|
|
if (src == NULL) {
|
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
|
|
|
"PCM byte order change of format '%s' is not implemented",
|
|
|
|
sample_format_to_string(src_format->format));
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
switch (dest_format->format) {
|
|
|
|
case SAMPLE_FORMAT_S16:
|
2009-01-17 13:11:16 +01:00
|
|
|
return pcm_convert_16(state,
|
|
|
|
src_format, src, src_size,
|
2009-07-23 12:01:03 +02:00
|
|
|
dest_format, dest_size_r,
|
|
|
|
error_r);
|
2009-01-17 13:11:16 +01:00
|
|
|
|
2010-01-15 09:23:36 +01:00
|
|
|
case SAMPLE_FORMAT_S24:
|
|
|
|
return pcm_convert_24_packed(state,
|
|
|
|
src_format, src, src_size,
|
|
|
|
dest_format, dest_size_r,
|
|
|
|
error_r);
|
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
case SAMPLE_FORMAT_S24_P32:
|
2009-01-17 13:11:16 +01:00
|
|
|
return pcm_convert_24(state,
|
|
|
|
src_format, src, src_size,
|
2009-07-23 12:01:03 +02:00
|
|
|
dest_format, dest_size_r,
|
|
|
|
error_r);
|
2008-10-23 20:11:24 +02:00
|
|
|
|
2009-11-10 17:11:34 +01:00
|
|
|
case SAMPLE_FORMAT_S32:
|
2009-03-02 16:41:10 +01:00
|
|
|
return pcm_convert_32(state,
|
|
|
|
src_format, src, src_size,
|
2009-07-23 12:01:03 +02:00
|
|
|
dest_format, dest_size_r,
|
|
|
|
error_r);
|
2009-03-02 16:41:10 +01:00
|
|
|
|
2008-10-23 20:11:24 +02:00
|
|
|
default:
|
2009-07-23 12:01:03 +02:00
|
|
|
g_set_error(error_r, pcm_convert_quark(), 0,
|
2009-11-10 17:11:34 +01:00
|
|
|
"PCM conversion to %s is not implemented",
|
|
|
|
sample_format_to_string(dest_format->format));
|
2009-03-14 14:36:44 +01:00
|
|
|
return NULL;
|
2008-10-23 20:11:24 +02:00
|
|
|
}
|
|
|
|
}
|