2902 lines
77 KiB
C
2902 lines
77 KiB
C
/*
|
|
** Copyright (C) 1999-2009 Erik de Castro Lopo <erikd@mega-nerd.com>
|
|
**
|
|
** This program is free software; you can redistribute it and/or modify
|
|
** it under the terms of the GNU Lesser General Public License as published by
|
|
** the Free Software Foundation; either version 2.1 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 Lesser General Public License for more details.
|
|
**
|
|
** You should have received a copy of the GNU Lesser General Public License
|
|
** along with this program; if not, write to the Free Software
|
|
** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*/
|
|
|
|
#include "sfconfig.h"
|
|
|
|
#include <math.h>
|
|
|
|
#include "sndfile.h"
|
|
#include "sfendian.h"
|
|
#include "common.h"
|
|
|
|
/* Need to be able to handle 3 byte (24 bit) integers. So defined a
|
|
** type and use SIZEOF_TRIBYTE instead of (tribyte).
|
|
*/
|
|
|
|
typedef void tribyte ;
|
|
|
|
#define SIZEOF_TRIBYTE 3
|
|
|
|
static sf_count_t pcm_read_sc2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_uc2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bes2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_les2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bet2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_let2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bei2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_lei2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
|
|
|
|
static sf_count_t pcm_read_sc2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_uc2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bes2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_les2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bet2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_let2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bei2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_lei2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
|
|
|
|
static sf_count_t pcm_read_sc2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_uc2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bes2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_les2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bet2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_let2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bei2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_lei2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
|
|
|
|
static sf_count_t pcm_read_sc2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_uc2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bes2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_les2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bet2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_let2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_bei2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_read_lei2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
|
|
|
|
static sf_count_t pcm_write_s2sc (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_s2uc (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_s2bes (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_s2les (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_s2bet (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_s2let (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_s2bei (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_s2lei (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
|
|
|
|
static sf_count_t pcm_write_i2sc (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_i2uc (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_i2bes (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_i2les (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_i2bet (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_i2let (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_i2bei (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_i2lei (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
|
|
|
|
static sf_count_t pcm_write_f2sc (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_f2uc (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_f2bes (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_f2les (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_f2bet (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_f2let (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_f2bei (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_f2lei (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
|
|
|
|
static sf_count_t pcm_write_d2sc (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_d2uc (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_d2bes (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_d2les (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_d2bet (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_d2let (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_d2bei (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
static sf_count_t pcm_write_d2lei (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
|
|
|
|
/*-----------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
enum
|
|
{ /* Char type for 8 bit files. */
|
|
SF_CHARS_SIGNED = 200,
|
|
SF_CHARS_UNSIGNED = 201
|
|
} ;
|
|
|
|
/*-----------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
int
|
|
pcm_init (SF_PRIVATE *psf)
|
|
{ int chars = 0 ;
|
|
|
|
if (psf->bytewidth == 0 || psf->sf.channels == 0)
|
|
{ psf_log_printf (psf, "pcm_init : internal error : bytewitdh = %d, channels = %d\n", psf->bytewidth, psf->sf.channels) ;
|
|
return SFE_INTERNAL ;
|
|
} ;
|
|
|
|
psf->blockwidth = psf->bytewidth * psf->sf.channels ;
|
|
|
|
if ((SF_CODEC (psf->sf.format)) == SF_FORMAT_PCM_S8)
|
|
chars = SF_CHARS_SIGNED ;
|
|
else if ((SF_CODEC (psf->sf.format)) == SF_FORMAT_PCM_U8)
|
|
chars = SF_CHARS_UNSIGNED ;
|
|
|
|
if (CPU_IS_BIG_ENDIAN)
|
|
psf->data_endswap = (psf->endian == SF_ENDIAN_BIG) ? SF_FALSE : SF_TRUE ;
|
|
else
|
|
psf->data_endswap = (psf->endian == SF_ENDIAN_LITTLE) ? SF_FALSE : SF_TRUE ;
|
|
|
|
if (psf->mode == SFM_READ || psf->mode == SFM_RDWR)
|
|
{ switch (psf->bytewidth * 0x10000 + psf->endian + chars)
|
|
{ case (0x10000 + SF_ENDIAN_BIG + SF_CHARS_SIGNED) :
|
|
case (0x10000 + SF_ENDIAN_LITTLE + SF_CHARS_SIGNED) :
|
|
psf->read_short = pcm_read_sc2s ;
|
|
psf->read_int = pcm_read_sc2i ;
|
|
psf->read_float = pcm_read_sc2f ;
|
|
psf->read_double = pcm_read_sc2d ;
|
|
break ;
|
|
case (0x10000 + SF_ENDIAN_BIG + SF_CHARS_UNSIGNED) :
|
|
case (0x10000 + SF_ENDIAN_LITTLE + SF_CHARS_UNSIGNED) :
|
|
psf->read_short = pcm_read_uc2s ;
|
|
psf->read_int = pcm_read_uc2i ;
|
|
psf->read_float = pcm_read_uc2f ;
|
|
psf->read_double = pcm_read_uc2d ;
|
|
break ;
|
|
|
|
case (2 * 0x10000 + SF_ENDIAN_BIG) :
|
|
psf->read_short = pcm_read_bes2s ;
|
|
psf->read_int = pcm_read_bes2i ;
|
|
psf->read_float = pcm_read_bes2f ;
|
|
psf->read_double = pcm_read_bes2d ;
|
|
break ;
|
|
case (3 * 0x10000 + SF_ENDIAN_BIG) :
|
|
psf->read_short = pcm_read_bet2s ;
|
|
psf->read_int = pcm_read_bet2i ;
|
|
psf->read_float = pcm_read_bet2f ;
|
|
psf->read_double = pcm_read_bet2d ;
|
|
break ;
|
|
case (4 * 0x10000 + SF_ENDIAN_BIG) :
|
|
|
|
psf->read_short = pcm_read_bei2s ;
|
|
psf->read_int = pcm_read_bei2i ;
|
|
psf->read_float = pcm_read_bei2f ;
|
|
psf->read_double = pcm_read_bei2d ;
|
|
break ;
|
|
|
|
case (2 * 0x10000 + SF_ENDIAN_LITTLE) :
|
|
psf->read_short = pcm_read_les2s ;
|
|
psf->read_int = pcm_read_les2i ;
|
|
psf->read_float = pcm_read_les2f ;
|
|
psf->read_double = pcm_read_les2d ;
|
|
break ;
|
|
case (3 * 0x10000 + SF_ENDIAN_LITTLE) :
|
|
psf->read_short = pcm_read_let2s ;
|
|
psf->read_int = pcm_read_let2i ;
|
|
psf->read_float = pcm_read_let2f ;
|
|
psf->read_double = pcm_read_let2d ;
|
|
break ;
|
|
case (4 * 0x10000 + SF_ENDIAN_LITTLE) :
|
|
psf->read_short = pcm_read_lei2s ;
|
|
psf->read_int = pcm_read_lei2i ;
|
|
psf->read_float = pcm_read_lei2f ;
|
|
psf->read_double = pcm_read_lei2d ;
|
|
break ;
|
|
default :
|
|
psf_log_printf (psf, "pcm.c returning SFE_UNIMPLEMENTED\nbytewidth %d endian %d\n", psf->bytewidth, psf->endian) ;
|
|
return SFE_UNIMPLEMENTED ;
|
|
} ;
|
|
} ;
|
|
|
|
if (psf->mode == SFM_WRITE || psf->mode == SFM_RDWR)
|
|
{ switch (psf->bytewidth * 0x10000 + psf->endian + chars)
|
|
{ case (0x10000 + SF_ENDIAN_BIG + SF_CHARS_SIGNED) :
|
|
case (0x10000 + SF_ENDIAN_LITTLE + SF_CHARS_SIGNED) :
|
|
psf->write_short = pcm_write_s2sc ;
|
|
psf->write_int = pcm_write_i2sc ;
|
|
psf->write_float = pcm_write_f2sc ;
|
|
psf->write_double = pcm_write_d2sc ;
|
|
break ;
|
|
case (0x10000 + SF_ENDIAN_BIG + SF_CHARS_UNSIGNED) :
|
|
case (0x10000 + SF_ENDIAN_LITTLE + SF_CHARS_UNSIGNED) :
|
|
psf->write_short = pcm_write_s2uc ;
|
|
psf->write_int = pcm_write_i2uc ;
|
|
psf->write_float = pcm_write_f2uc ;
|
|
psf->write_double = pcm_write_d2uc ;
|
|
break ;
|
|
|
|
case (2 * 0x10000 + SF_ENDIAN_BIG) :
|
|
psf->write_short = pcm_write_s2bes ;
|
|
psf->write_int = pcm_write_i2bes ;
|
|
psf->write_float = pcm_write_f2bes ;
|
|
psf->write_double = pcm_write_d2bes ;
|
|
break ;
|
|
|
|
case (3 * 0x10000 + SF_ENDIAN_BIG) :
|
|
psf->write_short = pcm_write_s2bet ;
|
|
psf->write_int = pcm_write_i2bet ;
|
|
psf->write_float = pcm_write_f2bet ;
|
|
psf->write_double = pcm_write_d2bet ;
|
|
break ;
|
|
|
|
case (4 * 0x10000 + SF_ENDIAN_BIG) :
|
|
psf->write_short = pcm_write_s2bei ;
|
|
psf->write_int = pcm_write_i2bei ;
|
|
psf->write_float = pcm_write_f2bei ;
|
|
psf->write_double = pcm_write_d2bei ;
|
|
break ;
|
|
|
|
case (2 * 0x10000 + SF_ENDIAN_LITTLE) :
|
|
psf->write_short = pcm_write_s2les ;
|
|
psf->write_int = pcm_write_i2les ;
|
|
psf->write_float = pcm_write_f2les ;
|
|
psf->write_double = pcm_write_d2les ;
|
|
break ;
|
|
|
|
case (3 * 0x10000 + SF_ENDIAN_LITTLE) :
|
|
psf->write_short = pcm_write_s2let ;
|
|
psf->write_int = pcm_write_i2let ;
|
|
psf->write_float = pcm_write_f2let ;
|
|
psf->write_double = pcm_write_d2let ;
|
|
break ;
|
|
|
|
case (4 * 0x10000 + SF_ENDIAN_LITTLE) :
|
|
psf->write_short = pcm_write_s2lei ;
|
|
psf->write_int = pcm_write_i2lei ;
|
|
psf->write_float = pcm_write_f2lei ;
|
|
psf->write_double = pcm_write_d2lei ;
|
|
break ;
|
|
|
|
default :
|
|
psf_log_printf (psf, "pcm.c returning SFE_UNIMPLEMENTED\nbytewidth %s endian %d\n", psf->bytewidth, psf->endian) ;
|
|
return SFE_UNIMPLEMENTED ;
|
|
} ;
|
|
|
|
} ;
|
|
|
|
if (psf->filelength > psf->dataoffset)
|
|
{ psf->datalength = (psf->dataend > 0) ? psf->dataend - psf->dataoffset :
|
|
psf->filelength - psf->dataoffset ;
|
|
}
|
|
else
|
|
psf->datalength = 0 ;
|
|
|
|
psf->sf.frames = psf->datalength / psf->blockwidth ;
|
|
|
|
return 0 ;
|
|
} /* pcm_init */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static inline void
|
|
sc2s_array (signed char *src, int count, short *dest)
|
|
{ while (--count >= 0)
|
|
{ dest [count] = src [count] << 8 ;
|
|
} ;
|
|
} /* sc2s_array */
|
|
|
|
static inline void
|
|
uc2s_array (unsigned char *src, int count, short *dest)
|
|
{ while (--count >= 0)
|
|
{ dest [count] = (((short) src [count]) - 0x80) << 8 ;
|
|
} ;
|
|
} /* uc2s_array */
|
|
|
|
static inline void
|
|
let2s_array (tribyte *src, int count, short *dest)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
dest [count] = LET2H_SHORT_PTR (ucptr) ;
|
|
} ;
|
|
} /* let2s_array */
|
|
|
|
static inline void
|
|
bet2s_array (tribyte *src, int count, short *dest)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
dest [count] = BET2H_SHORT_PTR (ucptr) ;
|
|
} ;
|
|
} /* bet2s_array */
|
|
|
|
static inline void
|
|
lei2s_array (int *src, int count, short *dest)
|
|
{ int value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = LEI2H_INT (src [count]) ;
|
|
dest [count] = value >> 16 ;
|
|
} ;
|
|
} /* lei2s_array */
|
|
|
|
static inline void
|
|
bei2s_array (int *src, int count, short *dest)
|
|
{ int value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = BEI2H_INT (src [count]) ;
|
|
dest [count] = value >> 16 ;
|
|
} ;
|
|
} /* bei2s_array */
|
|
|
|
/*--------------------------------------------------------------------------
|
|
*/
|
|
|
|
static inline void
|
|
sc2i_array (signed char *src, int count, int *dest)
|
|
{ while (--count >= 0)
|
|
{ dest [count] = ((int) src [count]) << 24 ;
|
|
} ;
|
|
} /* sc2i_array */
|
|
|
|
static inline void
|
|
uc2i_array (unsigned char *src, int count, int *dest)
|
|
{ while (--count >= 0)
|
|
{ dest [count] = (((int) src [count]) - 128) << 24 ;
|
|
} ;
|
|
} /* uc2i_array */
|
|
|
|
static inline void
|
|
bes2i_array (short *src, int count, int *dest)
|
|
{ short value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = BES2H_SHORT (src [count]) ;
|
|
dest [count] = value << 16 ;
|
|
} ;
|
|
} /* bes2i_array */
|
|
|
|
static inline void
|
|
les2i_array (short *src, int count, int *dest)
|
|
{ short value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = LES2H_SHORT (src [count]) ;
|
|
dest [count] = value << 16 ;
|
|
} ;
|
|
} /* les2i_array */
|
|
|
|
static inline void
|
|
bet2i_array (tribyte *src, int count, int *dest)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
dest [count] = BET2H_INT_PTR (ucptr) ;
|
|
} ;
|
|
} /* bet2i_array */
|
|
|
|
static inline void
|
|
let2i_array (tribyte *src, int count, int *dest)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
dest [count] = LET2H_INT_PTR (ucptr) ;
|
|
} ;
|
|
} /* let2i_array */
|
|
|
|
/*--------------------------------------------------------------------------
|
|
*/
|
|
|
|
static inline void
|
|
sc2f_array (signed char *src, int count, float *dest, float normfact)
|
|
{ while (--count >= 0)
|
|
dest [count] = ((float) src [count]) * normfact ;
|
|
} /* sc2f_array */
|
|
|
|
static inline void
|
|
uc2f_array (unsigned char *src, int count, float *dest, float normfact)
|
|
{ while (--count >= 0)
|
|
dest [count] = (((int) src [count]) - 128) * normfact ;
|
|
} /* uc2f_array */
|
|
|
|
static inline void
|
|
les2f_array (short *src, int count, float *dest, float normfact)
|
|
{ short value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = LES2H_SHORT (value) ;
|
|
dest [count] = ((float) value) * normfact ;
|
|
} ;
|
|
} /* les2f_array */
|
|
|
|
static inline void
|
|
bes2f_array (short *src, int count, float *dest, float normfact)
|
|
{ short value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = BES2H_SHORT (value) ;
|
|
dest [count] = ((float) value) * normfact ;
|
|
} ;
|
|
} /* bes2f_array */
|
|
|
|
static inline void
|
|
let2f_array (tribyte *src, int count, float *dest, float normfact)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = LET2H_INT_PTR (ucptr) ;
|
|
dest [count] = ((float) value) * normfact ;
|
|
} ;
|
|
} /* let2f_array */
|
|
|
|
static inline void
|
|
bet2f_array (tribyte *src, int count, float *dest, float normfact)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = BET2H_INT_PTR (ucptr) ;
|
|
dest [count] = ((float) value) * normfact ;
|
|
} ;
|
|
} /* bet2f_array */
|
|
|
|
static inline void
|
|
lei2f_array (int *src, int count, float *dest, float normfact)
|
|
{ int value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = LEI2H_INT (value) ;
|
|
dest [count] = ((float) value) * normfact ;
|
|
} ;
|
|
} /* lei2f_array */
|
|
|
|
static inline void
|
|
bei2f_array (int *src, int count, float *dest, float normfact)
|
|
{ int value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = BEI2H_INT (value) ;
|
|
dest [count] = ((float) value) * normfact ;
|
|
} ;
|
|
} /* bei2f_array */
|
|
|
|
/*--------------------------------------------------------------------------
|
|
*/
|
|
|
|
static inline void
|
|
sc2d_array (signed char *src, int count, double *dest, double normfact)
|
|
{ while (--count >= 0)
|
|
dest [count] = ((double) src [count]) * normfact ;
|
|
} /* sc2d_array */
|
|
|
|
static inline void
|
|
uc2d_array (unsigned char *src, int count, double *dest, double normfact)
|
|
{ while (--count >= 0)
|
|
dest [count] = (((int) src [count]) - 128) * normfact ;
|
|
} /* uc2d_array */
|
|
|
|
static inline void
|
|
les2d_array (short *src, int count, double *dest, double normfact)
|
|
{ short value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = LES2H_SHORT (value) ;
|
|
dest [count] = ((double) value) * normfact ;
|
|
} ;
|
|
} /* les2d_array */
|
|
|
|
static inline void
|
|
bes2d_array (short *src, int count, double *dest, double normfact)
|
|
{ short value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = BES2H_SHORT (value) ;
|
|
dest [count] = ((double) value) * normfact ;
|
|
} ;
|
|
} /* bes2d_array */
|
|
|
|
static inline void
|
|
let2d_array (tribyte *src, int count, double *dest, double normfact)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = LET2H_INT_PTR (ucptr) ;
|
|
dest [count] = ((double) value) * normfact ;
|
|
} ;
|
|
} /* let2d_array */
|
|
|
|
static inline void
|
|
bet2d_array (tribyte *src, int count, double *dest, double normfact)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
|
|
ucptr = ((unsigned char*) src) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = (ucptr [0] << 24) | (ucptr [1] << 16) | (ucptr [2] << 8) ;
|
|
dest [count] = ((double) value) * normfact ;
|
|
} ;
|
|
} /* bet2d_array */
|
|
|
|
static inline void
|
|
lei2d_array (int *src, int count, double *dest, double normfact)
|
|
{ int value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = LEI2H_INT (value) ;
|
|
dest [count] = ((double) value) * normfact ;
|
|
} ;
|
|
} /* lei2d_array */
|
|
|
|
static inline void
|
|
bei2d_array (int *src, int count, double *dest, double normfact)
|
|
{ int value ;
|
|
|
|
while (--count >= 0)
|
|
{ value = src [count] ;
|
|
value = BEI2H_INT (value) ;
|
|
dest [count] = ((double) value) * normfact ;
|
|
} ;
|
|
} /* bei2d_array */
|
|
|
|
/*--------------------------------------------------------------------------
|
|
*/
|
|
|
|
static inline void
|
|
s2sc_array (const short *src, signed char *dest, int count)
|
|
{ while (--count >= 0)
|
|
dest [count] = src [count] >> 8 ;
|
|
} /* s2sc_array */
|
|
|
|
static inline void
|
|
s2uc_array (const short *src, unsigned char *dest, int count)
|
|
{ while (--count >= 0)
|
|
dest [count] = (src [count] >> 8) + 0x80 ;
|
|
} /* s2uc_array */
|
|
|
|
static inline void
|
|
s2let_array (const short *src, tribyte *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
ucptr [0] = 0 ;
|
|
ucptr [1] = src [count] ;
|
|
ucptr [2] = src [count] >> 8 ;
|
|
} ;
|
|
} /* s2let_array */
|
|
|
|
static inline void
|
|
s2bet_array (const short *src, tribyte *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
ucptr [2] = 0 ;
|
|
ucptr [1] = src [count] ;
|
|
ucptr [0] = src [count] >> 8 ;
|
|
} ;
|
|
} /* s2bet_array */
|
|
|
|
static inline void
|
|
s2lei_array (const short *src, int *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
ucptr [0] = 0 ;
|
|
ucptr [1] = 0 ;
|
|
ucptr [2] = src [count] ;
|
|
ucptr [3] = src [count] >> 8 ;
|
|
} ;
|
|
} /* s2lei_array */
|
|
|
|
static inline void
|
|
s2bei_array (const short *src, int *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
ucptr [0] = src [count] >> 8 ;
|
|
ucptr [1] = src [count] ;
|
|
ucptr [2] = 0 ;
|
|
ucptr [3] = 0 ;
|
|
} ;
|
|
} /* s2bei_array */
|
|
|
|
/*--------------------------------------------------------------------------
|
|
*/
|
|
|
|
static inline void
|
|
i2sc_array (const int *src, signed char *dest, int count)
|
|
{ while (--count >= 0)
|
|
dest [count] = (src [count] >> 24) ;
|
|
} /* i2sc_array */
|
|
|
|
static inline void
|
|
i2uc_array (const int *src, unsigned char *dest, int count)
|
|
{ while (--count >= 0)
|
|
dest [count] = ((src [count] >> 24) + 128) ;
|
|
} /* i2uc_array */
|
|
|
|
static inline void
|
|
i2bes_array (const int *src, short *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
ucptr [0] = src [count] >> 24 ;
|
|
ucptr [1] = src [count] >> 16 ;
|
|
} ;
|
|
} /* i2bes_array */
|
|
|
|
static inline void
|
|
i2les_array (const int *src, short *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
ucptr [0] = src [count] >> 16 ;
|
|
ucptr [1] = src [count] >> 24 ;
|
|
} ;
|
|
} /* i2les_array */
|
|
|
|
static inline void
|
|
i2let_array (const int *src, tribyte *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = src [count] >> 8 ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value >> 16 ;
|
|
} ;
|
|
} /* i2let_array */
|
|
|
|
static inline void
|
|
i2bet_array (const int *src, tribyte *dest, int count)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = src [count] >> 8 ;
|
|
ucptr [2] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [0] = value >> 16 ;
|
|
} ;
|
|
} /* i2bet_array */
|
|
|
|
/*===============================================================================================
|
|
*/
|
|
|
|
static sf_count_t
|
|
pcm_read_sc2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
sc2s_array (psf->u.scbuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_sc2s */
|
|
|
|
static sf_count_t
|
|
pcm_read_uc2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, sizeof (unsigned char), bufferlen, psf) ;
|
|
uc2s_array (psf->u.ucbuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_uc2s */
|
|
|
|
static sf_count_t
|
|
pcm_read_bes2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int total ;
|
|
|
|
total = psf_fread (ptr, sizeof (short), len, psf) ;
|
|
if (CPU_IS_LITTLE_ENDIAN)
|
|
endswap_short_array (ptr, len) ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bes2s */
|
|
|
|
static sf_count_t
|
|
pcm_read_les2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int total ;
|
|
|
|
total = psf_fread (ptr, sizeof (short), len, psf) ;
|
|
if (CPU_IS_BIG_ENDIAN)
|
|
endswap_short_array (ptr, len) ;
|
|
|
|
return total ;
|
|
} /* pcm_read_les2s */
|
|
|
|
static sf_count_t
|
|
pcm_read_bet2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
bet2s_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bet2s */
|
|
|
|
static sf_count_t
|
|
pcm_read_let2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
let2s_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_let2s */
|
|
|
|
static sf_count_t
|
|
pcm_read_bei2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
bei2s_array (psf->u.ibuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bei2s */
|
|
|
|
static sf_count_t
|
|
pcm_read_lei2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
lei2s_array (psf->u.ibuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_lei2s */
|
|
|
|
/*-----------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static sf_count_t
|
|
pcm_read_sc2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
sc2i_array (psf->u.scbuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_sc2i */
|
|
|
|
static sf_count_t
|
|
pcm_read_uc2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, sizeof (unsigned char), bufferlen, psf) ;
|
|
uc2i_array (psf->u.ucbuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_uc2i */
|
|
|
|
static sf_count_t
|
|
pcm_read_bes2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
bes2i_array (psf->u.sbuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bes2i */
|
|
|
|
static sf_count_t
|
|
pcm_read_les2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
les2i_array (psf->u.sbuf, readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_les2i */
|
|
|
|
static sf_count_t
|
|
pcm_read_bet2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
bet2i_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bet2i */
|
|
|
|
static sf_count_t
|
|
pcm_read_let2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
let2i_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_let2i */
|
|
|
|
static sf_count_t
|
|
pcm_read_bei2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int total ;
|
|
|
|
total = psf_fread (ptr, sizeof (int), len, psf) ;
|
|
if (CPU_IS_LITTLE_ENDIAN)
|
|
endswap_int_array (ptr, len) ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bei2i */
|
|
|
|
static sf_count_t
|
|
pcm_read_lei2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
|
|
{ int total ;
|
|
|
|
total = psf_fread (ptr, sizeof (int), len, psf) ;
|
|
if (CPU_IS_BIG_ENDIAN)
|
|
endswap_int_array (ptr, len) ;
|
|
|
|
return total ;
|
|
} /* pcm_read_lei2i */
|
|
|
|
/*-----------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static sf_count_t
|
|
pcm_read_sc2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x80) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
sc2f_array (psf->u.scbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_sc2f */
|
|
|
|
static sf_count_t
|
|
pcm_read_uc2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x80) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, sizeof (unsigned char), bufferlen, psf) ;
|
|
uc2f_array (psf->u.ucbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_uc2f */
|
|
|
|
static sf_count_t
|
|
pcm_read_bes2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x8000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
bes2f_array (psf->u.sbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bes2f */
|
|
|
|
static sf_count_t
|
|
pcm_read_les2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x8000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
les2f_array (psf->u.sbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_les2f */
|
|
|
|
static sf_count_t
|
|
pcm_read_bet2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
/* Special normfactor because tribyte value is read into an int. */
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x80000000) : 1.0 / 256.0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
bet2f_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bet2f */
|
|
|
|
static sf_count_t
|
|
pcm_read_let2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
/* Special normfactor because tribyte value is read into an int. */
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x80000000) : 1.0 / 256.0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
let2f_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_let2f */
|
|
|
|
static sf_count_t
|
|
pcm_read_bei2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x80000000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
bei2f_array (psf->u.ibuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bei2f */
|
|
|
|
static sf_count_t
|
|
pcm_read_lei2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
float normfact ;
|
|
|
|
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x80000000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
lei2f_array (psf->u.ibuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_lei2f */
|
|
|
|
/*-----------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static sf_count_t
|
|
pcm_read_sc2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x80) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
sc2d_array (psf->u.scbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_sc2d */
|
|
|
|
static sf_count_t
|
|
pcm_read_uc2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x80) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, sizeof (unsigned char), bufferlen, psf) ;
|
|
uc2d_array (psf->u.ucbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_uc2d */
|
|
|
|
static sf_count_t
|
|
pcm_read_bes2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x8000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
bes2d_array (psf->u.sbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bes2d */
|
|
|
|
static sf_count_t
|
|
pcm_read_les2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x8000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
les2d_array (psf->u.sbuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_les2d */
|
|
|
|
static sf_count_t
|
|
pcm_read_bet2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x80000000) : 1.0 / 256.0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
bet2d_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bet2d */
|
|
|
|
static sf_count_t
|
|
pcm_read_let2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
/* Special normfactor because tribyte value is read into an int. */
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x80000000) : 1.0 / 256.0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
let2d_array ((tribyte*) (psf->u.ucbuf), readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_let2d */
|
|
|
|
static sf_count_t
|
|
pcm_read_bei2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x80000000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
bei2d_array (psf->u.ibuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_bei2d */
|
|
|
|
static sf_count_t
|
|
pcm_read_lei2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
|
|
{ int bufferlen, readcount ;
|
|
sf_count_t total = 0 ;
|
|
double normfact ;
|
|
|
|
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x80000000) : 1.0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
readcount = psf_fread (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
lei2d_array (psf->u.ibuf, readcount, ptr + total, normfact) ;
|
|
total += readcount ;
|
|
if (readcount < bufferlen)
|
|
break ;
|
|
len -= readcount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_read_lei2d */
|
|
|
|
/*===============================================================================================
|
|
**-----------------------------------------------------------------------------------------------
|
|
**===============================================================================================
|
|
*/
|
|
|
|
static sf_count_t
|
|
pcm_write_s2sc (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
s2sc_array (ptr + total, psf->u.scbuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2sc */
|
|
|
|
static sf_count_t
|
|
pcm_write_s2uc (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
s2uc_array (ptr + total, psf->u.ucbuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, sizeof (unsigned char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2uc */
|
|
|
|
static sf_count_t
|
|
pcm_write_s2bes (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
if (CPU_IS_BIG_ENDIAN)
|
|
return psf_fwrite (ptr, sizeof (short), len, psf) ;
|
|
else
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
endswap_short_copy (psf->u.sbuf, ptr + total, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2bes */
|
|
|
|
static sf_count_t
|
|
pcm_write_s2les (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
if (CPU_IS_LITTLE_ENDIAN)
|
|
return psf_fwrite (ptr, sizeof (short), len, psf) ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
endswap_short_copy (psf->u.sbuf, ptr + total, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2les */
|
|
|
|
static sf_count_t
|
|
pcm_write_s2bet (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
s2bet_array (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2bet */
|
|
|
|
static sf_count_t
|
|
pcm_write_s2let (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
s2let_array (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2let */
|
|
|
|
static sf_count_t
|
|
pcm_write_s2bei (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
s2bei_array (ptr + total, psf->u.ibuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2bei */
|
|
|
|
static sf_count_t
|
|
pcm_write_s2lei (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
s2lei_array (ptr + total, psf->u.ibuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_s2lei */
|
|
|
|
/*-----------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static sf_count_t
|
|
pcm_write_i2sc (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
i2sc_array (ptr + total, psf->u.scbuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2sc */
|
|
|
|
static sf_count_t
|
|
pcm_write_i2uc (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
i2uc_array (ptr + total, psf->u.ucbuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, sizeof (signed char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2uc */
|
|
|
|
static sf_count_t
|
|
pcm_write_i2bes (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
i2bes_array (ptr + total, psf->u.sbuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2bes */
|
|
|
|
static sf_count_t
|
|
pcm_write_i2les (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
i2les_array (ptr + total, psf->u.sbuf, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2les */
|
|
|
|
static sf_count_t
|
|
pcm_write_i2bet (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
i2bet_array (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2bet */
|
|
|
|
static sf_count_t
|
|
pcm_write_i2let (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
i2let_array (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2les */
|
|
|
|
static sf_count_t
|
|
pcm_write_i2bei (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
if (CPU_IS_BIG_ENDIAN)
|
|
return psf_fwrite (ptr, sizeof (int), len, psf) ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
endswap_int_copy (psf->u.ibuf, ptr + total, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2bei */
|
|
|
|
static sf_count_t
|
|
pcm_write_i2lei (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
|
|
{ int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
if (CPU_IS_LITTLE_ENDIAN)
|
|
return psf_fwrite (ptr, sizeof (int), len, psf) ;
|
|
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
endswap_int_copy (psf->u.ibuf, ptr + total, bufferlen) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_i2lei */
|
|
|
|
/*------------------------------------------------------------------------------
|
|
**==============================================================================
|
|
**------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static void
|
|
f2sc_array (const float *src, signed char *dest, int count, int normalize)
|
|
{ float normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7F) : 1.0 ;
|
|
|
|
while (--count >= 0)
|
|
{ dest [count] = lrintf (src [count] * normfact) ;
|
|
} ;
|
|
} /* f2sc_array */
|
|
|
|
static void
|
|
f2sc_clip_array (const float *src, signed char *dest, int count, int normalize)
|
|
{ float normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x1000000) ;
|
|
|
|
while (--count >= 0)
|
|
{ scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ dest [count] = 127 ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ dest [count] = -128 ;
|
|
continue ;
|
|
} ;
|
|
|
|
dest [count] = lrintf (scaled_value) >> 24 ;
|
|
} ;
|
|
} /* f2sc_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2sc (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, signed char *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2sc_clip_array : f2sc_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.scbuf, bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2sc */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
f2uc_array (const float *src, unsigned char *dest, int count, int normalize)
|
|
{ float normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7F) : 1.0 ;
|
|
|
|
while (--count >= 0)
|
|
{ dest [count] = lrintf (src [count] * normfact) + 128 ;
|
|
} ;
|
|
} /* f2uc_array */
|
|
|
|
static void
|
|
f2uc_clip_array (const float *src, unsigned char *dest, int count, int normalize)
|
|
{ float normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x1000000) ;
|
|
|
|
while (--count >= 0)
|
|
{ scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ dest [count] = 0xFF ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ dest [count] = 0 ;
|
|
continue ;
|
|
} ;
|
|
|
|
dest [count] = (lrintf (scaled_value) >> 24) + 128 ;
|
|
} ;
|
|
} /* f2uc_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2uc (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, unsigned char *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2uc_clip_array : f2uc_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.ucbuf, bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, sizeof (unsigned char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2uc */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
f2bes_array (const float *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact ;
|
|
short value ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
value = lrintf (src [count] * normfact) ;
|
|
ucptr [1] = value ;
|
|
ucptr [0] = value >> 8 ;
|
|
} ;
|
|
} /* f2bes_array */
|
|
|
|
static void
|
|
f2bes_clip_array (const float *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact, scaled_value ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x10000) ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [1] = 0xFF ;
|
|
ucptr [0] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [1] = 0x00 ;
|
|
ucptr [0] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrintf (scaled_value) ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [0] = value >> 24 ;
|
|
} ;
|
|
} /* f2bes_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2bes (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, short *t, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2bes_clip_array : f2bes_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.sbuf, bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2bes */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
f2les_array (const float *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
value = lrintf (src [count] * normfact) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
} ;
|
|
} /* f2les_array */
|
|
|
|
static void
|
|
f2les_clip_array (const float *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact, scaled_value ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x10000) ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [0] = 0xFF ;
|
|
ucptr [1] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x00 ;
|
|
ucptr [1] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrintf (scaled_value) ;
|
|
ucptr [0] = value >> 16 ;
|
|
ucptr [1] = value >> 24 ;
|
|
} ;
|
|
} /* f2les_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2les (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, short *t, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2les_clip_array : f2les_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.sbuf, bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2les */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
f2let_array (const float *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = lrintf (src [count] * normfact) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value >> 16 ;
|
|
} ;
|
|
} /* f2let_array */
|
|
|
|
static void
|
|
f2let_clip_array (const float *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact, scaled_value ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x100) ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [0] = 0xFF ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [2] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x00 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [2] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrintf (scaled_value) ;
|
|
ucptr [0] = value >> 8 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [2] = value >> 24 ;
|
|
} ;
|
|
} /* f2let_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2let (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, tribyte *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2let_clip_array : f2let_array ;
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2let */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
f2bet_array (const float *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = lrintf (src [count] * normfact) ;
|
|
ucptr [0] = value >> 16 ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value ;
|
|
} ;
|
|
} /* f2bet_array */
|
|
|
|
static void
|
|
f2bet_clip_array (const float *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact, scaled_value ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x100) ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [0] = 0x7F ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [2] = 0xFF ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x80 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [2] = 0x00 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrint (scaled_value) ;
|
|
ucptr [0] = value >> 24 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [2] = value >> 8 ;
|
|
} ;
|
|
} /* f2bet_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2bet (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, tribyte *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2bet_clip_array : f2bet_array ;
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2bet */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
f2bei_array (const float *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
value = lrintf (src [count] * normfact) ;
|
|
ucptr [0] = value >> 24 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [2] = value >> 8 ;
|
|
ucptr [3] = value ;
|
|
} ;
|
|
} /* f2bei_array */
|
|
|
|
static void
|
|
f2bei_clip_array (const float *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact, scaled_value ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= 1.0 * 0x7FFFFFFF)
|
|
{ ucptr [0] = 0x7F ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [2] = 0xFF ;
|
|
ucptr [3] = 0xFF ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x80 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [2] = 0x00 ;
|
|
ucptr [3] = 0x00 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrintf (scaled_value) ;
|
|
ucptr [0] = value >> 24 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [2] = value >> 8 ;
|
|
ucptr [3] = value ;
|
|
} ;
|
|
} /* f2bei_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2bei (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, int *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2bei_clip_array : f2bei_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.ibuf, bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2bei */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
f2lei_array (const float *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
value = lrintf (src [count] * normfact) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value >> 16 ;
|
|
ucptr [3] = value >> 24 ;
|
|
} ;
|
|
} /* f2lei_array */
|
|
|
|
static void
|
|
f2lei_clip_array (const float *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
float normfact, scaled_value ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [0] = 0xFF ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [2] = 0xFF ;
|
|
ucptr [3] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x00 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [2] = 0x00 ;
|
|
ucptr [3] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrintf (scaled_value) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value >> 16 ;
|
|
ucptr [3] = value >> 24 ;
|
|
} ;
|
|
} /* f2lei_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_f2lei (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
|
|
{ void (*convert) (const float *, int *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? f2lei_clip_array : f2lei_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.ibuf, bufferlen, psf->norm_float) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_f2lei */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2sc_array (const double *src, signed char *dest, int count, int normalize)
|
|
{ double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7F) : 1.0 ;
|
|
|
|
while (--count >= 0)
|
|
{ dest [count] = lrint (src [count] * normfact) ;
|
|
} ;
|
|
} /* d2sc_array */
|
|
|
|
static void
|
|
d2sc_clip_array (const double *src, signed char *dest, int count, int normalize)
|
|
{ double normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x1000000) ;
|
|
|
|
while (--count >= 0)
|
|
{ scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ dest [count] = 127 ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ dest [count] = -128 ;
|
|
continue ;
|
|
} ;
|
|
|
|
dest [count] = lrintf (scaled_value) >> 24 ;
|
|
} ;
|
|
} /* d2sc_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2sc (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, signed char *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2sc_clip_array : d2sc_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.scbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.scbuf, bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2sc */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2uc_array (const double *src, unsigned char *dest, int count, int normalize)
|
|
{ double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7F) : 1.0 ;
|
|
|
|
while (--count >= 0)
|
|
{ dest [count] = lrint (src [count] * normfact) + 128 ;
|
|
} ;
|
|
} /* d2uc_array */
|
|
|
|
static void
|
|
d2uc_clip_array (const double *src, unsigned char *dest, int count, int normalize)
|
|
{ double normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x1000000) ;
|
|
|
|
while (--count >= 0)
|
|
{ scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ dest [count] = 255 ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ dest [count] = 0 ;
|
|
continue ;
|
|
} ;
|
|
|
|
dest [count] = (lrint (src [count] * normfact) >> 24) + 128 ;
|
|
} ;
|
|
} /* d2uc_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2uc (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, unsigned char *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2uc_clip_array : d2uc_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.ucbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.ucbuf, bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, sizeof (unsigned char), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2uc */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2bes_array (const double *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
short value ;
|
|
double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
value = lrint (src [count] * normfact) ;
|
|
ucptr [1] = value ;
|
|
ucptr [0] = value >> 8 ;
|
|
} ;
|
|
} /* d2bes_array */
|
|
|
|
static void
|
|
d2bes_clip_array (const double *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
double normfact, scaled_value ;
|
|
int value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x10000) ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [1] = 0xFF ;
|
|
ucptr [0] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [1] = 0x00 ;
|
|
ucptr [0] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrint (scaled_value) ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [0] = value >> 24 ;
|
|
} ;
|
|
} /* d2bes_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2bes (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, short *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2bes_clip_array : d2bes_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.sbuf, bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2bes */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2les_array (const double *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
short value ;
|
|
double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
value = lrint (src [count] * normfact) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
} ;
|
|
} /* d2les_array */
|
|
|
|
static void
|
|
d2les_clip_array (const double *src, short *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x10000) ;
|
|
ucptr = ((unsigned char*) dest) + 2 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 2 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [0] = 0xFF ;
|
|
ucptr [1] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x00 ;
|
|
ucptr [1] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrint (scaled_value) ;
|
|
ucptr [0] = value >> 16 ;
|
|
ucptr [1] = value >> 24 ;
|
|
} ;
|
|
} /* d2les_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2les (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, short *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2les_clip_array : d2les_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.sbuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.sbuf, bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.sbuf, sizeof (short), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2les */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2let_array (const double *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = lrint (src [count] * normfact) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value >> 16 ;
|
|
} ;
|
|
} /* d2let_array */
|
|
|
|
static void
|
|
d2let_clip_array (const double *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x100) ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [0] = 0xFF ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [2] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x00 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [2] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrint (scaled_value) ;
|
|
ucptr [0] = value >> 8 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [2] = value >> 24 ;
|
|
} ;
|
|
} /* d2let_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2let (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, tribyte *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2let_clip_array : d2let_array ;
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2let */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2bet_array (const double *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
value = lrint (src [count] * normfact) ;
|
|
ucptr [2] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [0] = value >> 16 ;
|
|
} ;
|
|
} /* d2bet_array */
|
|
|
|
static void
|
|
d2bet_clip_array (const double *src, tribyte *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : (1.0 * 0x100) ;
|
|
ucptr = ((unsigned char*) dest) + 3 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 3 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [2] = 0xFF ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [0] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [2] = 0x00 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [0] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrint (scaled_value) ;
|
|
ucptr [2] = value >> 8 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [0] = value >> 24 ;
|
|
} ;
|
|
} /* d2bet_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2bet (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, tribyte *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2bet_clip_array : d2bet_array ;
|
|
bufferlen = sizeof (psf->u.ucbuf) / SIZEOF_TRIBYTE ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, (tribyte*) (psf->u.ucbuf), bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.ucbuf, SIZEOF_TRIBYTE, bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2bet */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2bei_array (const double *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
value = lrint (src [count] * normfact) ;
|
|
ucptr [0] = value >> 24 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [2] = value >> 8 ;
|
|
ucptr [3] = value ;
|
|
} ;
|
|
} /* d2bei_array */
|
|
|
|
static void
|
|
d2bei_clip_array (const double *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [3] = 0xFF ;
|
|
ucptr [2] = 0xFF ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [0] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [3] = 0x00 ;
|
|
ucptr [2] = 0x00 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [0] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrint (scaled_value) ;
|
|
ucptr [0] = value >> 24 ;
|
|
ucptr [1] = value >> 16 ;
|
|
ucptr [2] = value >> 8 ;
|
|
ucptr [3] = value ;
|
|
} ;
|
|
} /* d2bei_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2bei (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, int *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2bei_clip_array : d2bei_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.ibuf, bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2bei */
|
|
|
|
/*==============================================================================
|
|
*/
|
|
|
|
static void
|
|
d2lei_array (const double *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact ;
|
|
|
|
normfact = normalize ? (1.0 * 0x7FFFFFFF) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
value = lrint (src [count] * normfact) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value >> 16 ;
|
|
ucptr [3] = value >> 24 ;
|
|
} ;
|
|
} /* d2lei_array */
|
|
|
|
static void
|
|
d2lei_clip_array (const double *src, int *dest, int count, int normalize)
|
|
{ unsigned char *ucptr ;
|
|
int value ;
|
|
double normfact, scaled_value ;
|
|
|
|
normfact = normalize ? (8.0 * 0x10000000) : 1.0 ;
|
|
ucptr = ((unsigned char*) dest) + 4 * count ;
|
|
|
|
while (--count >= 0)
|
|
{ ucptr -= 4 ;
|
|
scaled_value = src [count] * normfact ;
|
|
if (CPU_CLIPS_POSITIVE == 0 && scaled_value >= (1.0 * 0x7FFFFFFF))
|
|
{ ucptr [0] = 0xFF ;
|
|
ucptr [1] = 0xFF ;
|
|
ucptr [2] = 0xFF ;
|
|
ucptr [3] = 0x7F ;
|
|
continue ;
|
|
} ;
|
|
if (CPU_CLIPS_NEGATIVE == 0 && scaled_value <= (-8.0 * 0x10000000))
|
|
{ ucptr [0] = 0x00 ;
|
|
ucptr [1] = 0x00 ;
|
|
ucptr [2] = 0x00 ;
|
|
ucptr [3] = 0x80 ;
|
|
continue ;
|
|
} ;
|
|
|
|
value = lrint (scaled_value) ;
|
|
ucptr [0] = value ;
|
|
ucptr [1] = value >> 8 ;
|
|
ucptr [2] = value >> 16 ;
|
|
ucptr [3] = value >> 24 ;
|
|
} ;
|
|
} /* d2lei_clip_array */
|
|
|
|
static sf_count_t
|
|
pcm_write_d2lei (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
|
|
{ void (*convert) (const double *, int *, int, int) ;
|
|
int bufferlen, writecount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
convert = (psf->add_clipping) ? d2lei_clip_array : d2lei_array ;
|
|
bufferlen = ARRAY_LEN (psf->u.ibuf) ;
|
|
|
|
while (len > 0)
|
|
{ if (len < bufferlen)
|
|
bufferlen = (int) len ;
|
|
convert (ptr + total, psf->u.ibuf, bufferlen, psf->norm_double) ;
|
|
writecount = psf_fwrite (psf->u.ibuf, sizeof (int), bufferlen, psf) ;
|
|
total += writecount ;
|
|
if (writecount < bufferlen)
|
|
break ;
|
|
len -= writecount ;
|
|
} ;
|
|
|
|
return total ;
|
|
} /* pcm_write_d2lei */
|
|
|