third_party_libsnd/src/xi.c
2021-03-24 08:17:54 +05:00

1224 lines
33 KiB
C

/*
** Copyright (C) 2003-2017 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 <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <string.h>
#include <ctype.h>
#include <math.h>
#include "sndfile.h"
#include "sfendian.h"
#include "common.h"
#define MAX_XI_SAMPLES 16
/*------------------------------------------------------------------------------
** Private static functions and tyepdefs.
*/
typedef struct
{ /* Warning, this filename is NOT nul terminated. */
char filename [22] ;
char software [20] ;
char sample_name [22] ;
int loop_begin, loop_end ;
int sample_flags ;
/* Data for encoder and decoder. */
short last_16 ;
} XI_PRIVATE ;
static int xi_close (SF_PRIVATE *psf) ;
static int xi_write_header (SF_PRIVATE *psf, int calc_length) ;
static int xi_read_header (SF_PRIVATE *psf) ;
static int dpcm_init (SF_PRIVATE *psf) ;
static sf_count_t dpcm_seek (SF_PRIVATE *psf, int mode, sf_count_t offset) ;
/*------------------------------------------------------------------------------
** Public function.
*/
int
xi_open (SF_PRIVATE *psf)
{ XI_PRIVATE *pxi ;
int subformat, error = 0 ;
if (psf->is_pipe)
return SFE_XI_NO_PIPE ;
if (psf->codec_data)
pxi = psf->codec_data ;
else if ((pxi = calloc (1, sizeof (XI_PRIVATE))) == NULL)
return SFE_MALLOC_FAILED ;
psf->codec_data = pxi ;
if (psf->file.mode == SFM_READ || (psf->file.mode == SFM_RDWR && psf->filelength > 0))
{ if ((error = xi_read_header (psf)))
return error ;
} ;
subformat = SF_CODEC (psf->sf.format) ;
if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
{ if ((SF_CONTAINER (psf->sf.format)) != SF_FORMAT_XI)
return SFE_BAD_OPEN_FORMAT ;
psf->endian = SF_ENDIAN_LITTLE ;
psf->sf.channels = 1 ; /* Always mono */
psf->sf.samplerate = 44100 ; /* Always */
/* Set up default instrument and software name. */
memcpy (pxi->filename, "Default Name ", sizeof (pxi->filename)) ;
memcpy (pxi->software, PACKAGE_NAME "-" PACKAGE_VERSION " ", sizeof (pxi->software)) ;
memset (pxi->sample_name, 0, sizeof (pxi->sample_name)) ;
snprintf (pxi->sample_name, sizeof (pxi->sample_name), "%s", "Sample #1") ;
pxi->sample_flags = (subformat == SF_FORMAT_DPCM_16) ? 16 : 0 ;
if (xi_write_header (psf, SF_FALSE))
return psf->error ;
psf->write_header = xi_write_header ;
} ;
psf->container_close = xi_close ;
psf->seek = dpcm_seek ;
psf->sf.seekable = SF_FALSE ;
psf->blockwidth = psf->bytewidth * psf->sf.channels ;
switch (subformat)
{ case SF_FORMAT_DPCM_8 : /* 8-bit differential PCM. */
case SF_FORMAT_DPCM_16 : /* 16-bit differential PCM. */
error = dpcm_init (psf) ;
break ;
default : break ;
} ;
return error ;
} /* xi_open */
/*------------------------------------------------------------------------------
*/
static int
xi_close (SF_PRIVATE * UNUSED (psf))
{
return 0 ;
} /* xi_close */
/*==============================================================================
*/
static sf_count_t dpcm_read_dsc2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
static sf_count_t dpcm_read_dsc2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
static sf_count_t dpcm_read_dsc2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
static sf_count_t dpcm_read_dsc2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_s2dsc (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_i2dsc (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_f2dsc (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_d2dsc (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
static sf_count_t dpcm_read_dles2s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
static sf_count_t dpcm_read_dles2i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
static sf_count_t dpcm_read_dles2f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
static sf_count_t dpcm_read_dles2d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_s2dles (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_i2dles (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_f2dles (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
static sf_count_t dpcm_write_d2dles (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
static int
dpcm_init (SF_PRIVATE *psf)
{ if (psf->bytewidth == 0 || psf->sf.channels == 0)
return SFE_INTERNAL ;
psf->blockwidth = psf->bytewidth * psf->sf.channels ;
if (psf->file.mode == SFM_READ || psf->file.mode == SFM_RDWR)
{ switch (psf->bytewidth)
{ case 1 :
psf->read_short = dpcm_read_dsc2s ;
psf->read_int = dpcm_read_dsc2i ;
psf->read_float = dpcm_read_dsc2f ;
psf->read_double = dpcm_read_dsc2d ;
break ;
case 2 :
psf->read_short = dpcm_read_dles2s ;
psf->read_int = dpcm_read_dles2i ;
psf->read_float = dpcm_read_dles2f ;
psf->read_double = dpcm_read_dles2d ;
break ;
default :
psf_log_printf (psf, "dpcm_init() returning SFE_UNIMPLEMENTED\n") ;
return SFE_UNIMPLEMENTED ;
} ;
} ;
if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
{ switch (psf->bytewidth)
{ case 1 :
psf->write_short = dpcm_write_s2dsc ;
psf->write_int = dpcm_write_i2dsc ;
psf->write_float = dpcm_write_f2dsc ;
psf->write_double = dpcm_write_d2dsc ;
break ;
case 2 :
psf->write_short = dpcm_write_s2dles ;
psf->write_int = dpcm_write_i2dles ;
psf->write_float = dpcm_write_f2dles ;
psf->write_double = dpcm_write_d2dles ;
break ;
default :
psf_log_printf (psf, "dpcm_init() returning SFE_UNIMPLEMENTED\n") ;
return SFE_UNIMPLEMENTED ;
} ;
} ;
psf->filelength = psf_get_filelen (psf) ;
psf->datalength = (psf->dataend) ? psf->dataend - psf->dataoffset :
psf->filelength - psf->dataoffset ;
psf->sf.frames = psf->datalength / psf->blockwidth ;
return 0 ;
} /* dpcm_init */
/*==============================================================================
*/
static sf_count_t
dpcm_seek (SF_PRIVATE *psf, int mode, sf_count_t offset)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int total, bufferlen, len ;
if ((pxi = psf->codec_data) == NULL)
return SFE_INTERNAL ;
if (psf->datalength < 0 || psf->dataoffset < 0)
{ psf->error = SFE_BAD_SEEK ;
return PSF_SEEK_ERROR ;
} ;
if (offset == 0)
{ psf_fseek (psf, psf->dataoffset, SEEK_SET) ;
pxi->last_16 = 0 ;
return 0 ;
} ;
if (offset < 0 || offset > psf->sf.frames)
{ psf->error = SFE_BAD_SEEK ;
return PSF_SEEK_ERROR ;
} ;
if (mode != SFM_READ)
{ /* What to do about write??? */
psf->error = SFE_BAD_SEEK ;
return PSF_SEEK_ERROR ;
} ;
psf_fseek (psf, psf->dataoffset, SEEK_SET) ;
if ((SF_CODEC (psf->sf.format)) == SF_FORMAT_DPCM_16)
{ total = offset ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (total > 0)
{ len = (total > bufferlen) ? bufferlen : total ;
total -= (int) dpcm_read_dles2s (psf, ubuf.sbuf, len) ;
} ;
}
else
{ total = offset ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (total > 0)
{ len = (total > bufferlen) ? bufferlen : total ;
total -= (int) dpcm_read_dsc2s (psf, ubuf.sbuf, len) ;
} ;
} ;
return offset ;
} /* dpcm_seek */
static int
xi_write_header (SF_PRIVATE *psf, int UNUSED (calc_length))
{ XI_PRIVATE *pxi ;
sf_count_t current ;
const char *string ;
if ((pxi = psf->codec_data) == NULL)
return SFE_INTERNAL ;
current = psf_ftell (psf) ;
/* Reset the current header length to zero. */
psf->header.ptr [0] = 0 ;
psf->header.indx = 0 ;
psf_fseek (psf, 0, SEEK_SET) ;
string = "Extended Instrument: " ;
psf_binheader_writef (psf, "b", BHWv (string), BHWz (strlen (string))) ;
psf_binheader_writef (psf, "b1", BHWv (pxi->filename), BHWz (sizeof (pxi->filename)), BHW1 (0x1A)) ;
/* Write software version and two byte XI version. */
psf_binheader_writef (psf, "eb2", BHWv (pxi->software), BHWz (sizeof (pxi->software)), BHW2 ((1 << 8) + 2)) ;
/*
** Jump note numbers (96), volume envelope (48), pan envelope (48),
** volume points (1), pan points (1)
*/
psf_binheader_writef (psf, "z", BHWz ((size_t) (96 + 48 + 48 + 1 + 1))) ;
/* Jump volume loop (3 bytes), pan loop (3), envelope flags (3), vibrato (3)
** fade out (2), 22 unknown bytes, and then write sample_count (2 bytes).
*/
psf_binheader_writef (psf, "ez2z2", BHWz ((size_t) (4 * 3)), BHW2 (0x1234), BHWz (22), BHW2 (1)) ;
pxi->loop_begin = 0 ;
pxi->loop_end = 0 ;
psf_binheader_writef (psf, "et844", BHW8 (psf->sf.frames), BHW4 (pxi->loop_begin), BHW4 (pxi->loop_end)) ;
/* volume, fine tune, flags, pan, note, namelen */
psf_binheader_writef (psf, "111111", BHW1 (128), BHW1 (0), BHW1 (pxi->sample_flags), BHW1 (128), BHW1 (0), BHW1 (strlen (pxi->sample_name))) ;
psf_binheader_writef (psf, "b", BHWv (pxi->sample_name), BHWz (sizeof (pxi->sample_name))) ;
/* Header construction complete so write it out. */
psf_fwrite (psf->header.ptr, psf->header.indx, 1, psf) ;
if (psf->error)
return psf->error ;
psf->dataoffset = psf->header.indx ;
if (current > 0)
psf_fseek (psf, current, SEEK_SET) ;
return psf->error ;
} /* xi_write_header */
static int
xi_read_header (SF_PRIVATE *psf)
{ char buffer [64], name [32] ;
short version, fade_out, sample_count ;
int k, loop_begin, loop_end ;
int sample_sizes [MAX_XI_SAMPLES] ;
psf_binheader_readf (psf, "pb", 0, buffer, 21) ;
memset (sample_sizes, 0, sizeof (sample_sizes)) ;
buffer [20] = 0 ;
if (strcmp (buffer, "Extended Instrument:") != 0)
return SFE_XI_BAD_HEADER ;
memset (buffer, 0, sizeof (buffer)) ;
psf_binheader_readf (psf, "b", buffer, 23) ;
if (buffer [22] != 0x1A)
return SFE_XI_BAD_HEADER ;
buffer [22] = 0 ;
for (k = 21 ; k >= 0 && buffer [k] == ' ' ; k --)
buffer [k] = 0 ;
psf_log_printf (psf, "Extended Instrument : %s\n", buffer) ;
psf_store_string (psf, SF_STR_TITLE, buffer) ;
psf_binheader_readf (psf, "be2", buffer, 20, &version) ;
buffer [19] = 0 ;
for (k = 18 ; k >= 0 && buffer [k] == ' ' ; k --)
buffer [k] = 0 ;
psf_log_printf (psf, "Software : %s\nVersion : %d.%02d\n", buffer, version / 256, version % 256) ;
psf_store_string (psf, SF_STR_SOFTWARE, buffer) ;
/* Jump note numbers (96), volume envelope (48), pan envelope (48),
** volume points (1), pan points (1)
*/
psf_binheader_readf (psf, "j", 96 + 48 + 48 + 1 + 1) ;
psf_binheader_readf (psf, "b", buffer, 12) ;
psf_log_printf (psf, "Volume Loop\n sustain : %u\n begin : %u\n end : %u\n",
buffer [0], buffer [1], buffer [2]) ;
psf_log_printf (psf, "Pan Loop\n sustain : %u\n begin : %u\n end : %u\n",
buffer [3], buffer [4], buffer [5]) ;
psf_log_printf (psf, "Envelope Flags\n volume : 0x%X\n pan : 0x%X\n",
buffer [6] & 0xFF, buffer [7] & 0xFF) ;
psf_log_printf (psf, "Vibrato\n type : %u\n sweep : %u\n depth : %u\n rate : %u\n",
buffer [8], buffer [9], buffer [10], buffer [11]) ;
/*
** Read fade_out then jump reserved (2 bytes) and ???? (20 bytes) and
** sample_count.
*/
psf_binheader_readf (psf, "e2j2", &fade_out, 2 + 20, &sample_count) ;
psf_log_printf (psf, "Fade out : %d\n", fade_out) ;
/* XI file can contain up to 16 samples. */
if (sample_count > MAX_XI_SAMPLES)
return SFE_XI_EXCESS_SAMPLES ;
if (psf->instrument == NULL && (psf->instrument = psf_instrument_alloc ()) == NULL)
return SFE_MALLOC_FAILED ;
psf->instrument->basenote = 0 ;
/* Log all data for each sample. */
for (k = 0 ; k < sample_count ; k++)
{ psf_binheader_readf (psf, "e444", &(sample_sizes [k]), &loop_begin, &loop_end) ;
/* Read 5 know bytes, 1 unknown byte and 22 name bytes. */
psf_binheader_readf (psf, "bb", buffer, 6, name, 22) ;
name [21] = 0 ;
psf_log_printf (psf, "Sample #%d\n name : %s\n", k + 1, name) ;
psf_log_printf (psf, " size : %d\n", sample_sizes [k]) ;
psf_log_printf (psf, " loop\n begin : %d\n end : %d\n", loop_begin, loop_end) ;
psf_log_printf (psf, " volume : %u\n f. tune : %d\n flags : 0x%02X ",
buffer [0] & 0xFF, buffer [1] & 0xFF, buffer [2] & 0xFF) ;
psf_log_printf (psf, " (") ;
if (buffer [2] & 1)
psf_log_printf (psf, " Loop") ;
if (buffer [2] & 2)
psf_log_printf (psf, " PingPong") ;
psf_log_printf (psf, (buffer [2] & 16) ? " 16bit" : " 8bit") ;
psf_log_printf (psf, " )\n") ;
psf_log_printf (psf, " pan : %u\n note : %d\n namelen : %d\n",
buffer [3] & 0xFF, buffer [4], buffer [5]) ;
psf->instrument->basenote = buffer [4] ;
if (buffer [2] & 1)
{ psf->instrument->loop_count = 1 ;
psf->instrument->loops [0].mode = (buffer [2] & 2) ? SF_LOOP_ALTERNATING : SF_LOOP_FORWARD ;
psf->instrument->loops [0].start = loop_begin ;
psf->instrument->loops [0].end = loop_end ;
} ;
if (k != 0)
continue ;
if (buffer [2] & 16)
{ psf->sf.format = SF_FORMAT_XI | SF_FORMAT_DPCM_16 ;
psf->bytewidth = 2 ;
}
else
{ psf->sf.format = SF_FORMAT_XI | SF_FORMAT_DPCM_8 ;
psf->bytewidth = 1 ;
} ;
} ;
while (sample_count > 1 && sample_sizes [sample_count - 1] == 0)
sample_count -- ;
/* Currently, we can only handle 1 sample per file. */
if (sample_count > 2)
{ psf_log_printf (psf, "*** Sample count is less than 16 but more than 1.\n") ;
psf_log_printf (psf, " sample count : %d sample_sizes [%d] : %d\n",
sample_count, sample_count - 1, sample_sizes [sample_count - 1]) ;
return SFE_XI_EXCESS_SAMPLES ;
} ;
psf->datalength = sample_sizes [0] ;
psf->dataoffset = psf_ftell (psf) ;
if (psf->dataoffset < 0)
{ psf_log_printf (psf, "*** Bad Data Offset : %D\n", psf->dataoffset) ;
return SFE_BAD_OFFSET ;
} ;
psf_log_printf (psf, "Data Offset : %D\n", psf->dataoffset) ;
if (psf->dataoffset + psf->datalength > psf->filelength)
{ psf_log_printf (psf, "*** File seems to be truncated. Should be at least %D bytes long.\n",
psf->dataoffset + sample_sizes [0]) ;
psf->datalength = psf->filelength - psf->dataoffset ;
} ;
if (psf_fseek (psf, psf->dataoffset, SEEK_SET) != psf->dataoffset)
return SFE_BAD_SEEK ;
psf->endian = SF_ENDIAN_LITTLE ;
psf->sf.channels = 1 ; /* Always mono */
psf->sf.samplerate = 44100 ; /* Always */
psf->blockwidth = psf->sf.channels * psf->bytewidth ;
if (! psf->sf.frames && psf->blockwidth)
psf->sf.frames = (psf->filelength - psf->dataoffset) / psf->blockwidth ;
psf->instrument->gain = 1 ;
psf->instrument->velocity_lo = psf->instrument->key_lo = 0 ;
psf->instrument->velocity_hi = psf->instrument->key_hi = 127 ;
return 0 ;
} /* xi_read_header */
/*==============================================================================
*/
static void dsc2s_array (XI_PRIVATE *pxi, signed char *src, int count, short *dest) ;
static void dsc2i_array (XI_PRIVATE *pxi, signed char *src, int count, int *dest) ;
static void dsc2f_array (XI_PRIVATE *pxi, signed char *src, int count, float *dest, float normfact) ;
static void dsc2d_array (XI_PRIVATE *pxi, signed char *src, int count, double *dest, double normfact) ;
static void dles2s_array (XI_PRIVATE *pxi, short *src, int count, short *dest) ;
static void dles2i_array (XI_PRIVATE *pxi, short *src, int count, int *dest) ;
static void dles2f_array (XI_PRIVATE *pxi, short *src, int count, float *dest, float normfact) ;
static void dles2d_array (XI_PRIVATE *pxi, short *src, int count, double *dest, double normfact) ;
static sf_count_t
dpcm_read_dsc2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
dsc2s_array (pxi, ubuf.scbuf, readcount, ptr + total) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dsc2s */
static sf_count_t
dpcm_read_dsc2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
dsc2i_array (pxi, ubuf.scbuf, readcount, ptr + total) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dsc2i */
static sf_count_t
dpcm_read_dsc2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
float normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x80) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
dsc2f_array (pxi, ubuf.scbuf, readcount, ptr + total, normfact) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dsc2f */
static sf_count_t
dpcm_read_dsc2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
double normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x80) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
dsc2d_array (pxi, ubuf.scbuf, readcount, ptr + total, normfact) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dsc2d */
/*------------------------------------------------------------------------------
*/
static sf_count_t
dpcm_read_dles2s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
dles2s_array (pxi, ubuf.sbuf, readcount, ptr + total) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dles2s */
static sf_count_t
dpcm_read_dles2i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
dles2i_array (pxi, ubuf.sbuf, readcount, ptr + total) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dles2i */
static sf_count_t
dpcm_read_dles2f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
float normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_float == SF_TRUE) ? 1.0 / ((float) 0x8000) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
dles2f_array (pxi, ubuf.sbuf, readcount, ptr + total, normfact) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dles2f */
static sf_count_t
dpcm_read_dles2d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, readcount ;
sf_count_t total = 0 ;
double normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_double == SF_TRUE) ? 1.0 / ((double) 0x8000) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
readcount = (int) psf_fread (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
dles2d_array (pxi, ubuf.sbuf, readcount, ptr + total, normfact) ;
total += readcount ;
if (readcount < bufferlen)
break ;
len -= readcount ;
} ;
return total ;
} /* dpcm_read_dles2d */
/*==============================================================================
*/
static void s2dsc_array (XI_PRIVATE *pxi, const short *src, signed char *dest, int count) ;
static void i2dsc_array (XI_PRIVATE *pxi, const int *src, signed char *dest, int count) ;
static void f2dsc_array (XI_PRIVATE *pxi, const float *src, signed char *dest, int count, float normfact) ;
static void d2dsc_array (XI_PRIVATE *pxi, const double *src, signed char *dest, int count, double normfact) ;
static void s2dles_array (XI_PRIVATE *pxi, const short *src, short *dest, int count) ;
static void i2dles_array (XI_PRIVATE *pxi, const int *src, short *dest, int count) ;
static void f2dles_array (XI_PRIVATE *pxi, const float *src, short *dest, int count, float normfact) ;
static void d2dles_array (XI_PRIVATE *pxi, const double *src, short *dest, int count, double normfact) ;
static sf_count_t
dpcm_write_s2dsc (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
s2dsc_array (pxi, ptr + total, ubuf.scbuf, bufferlen) ;
writecount = (int) psf_fwrite (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_s2dsc */
static sf_count_t
dpcm_write_i2dsc (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
i2dsc_array (pxi, ptr + total, ubuf.scbuf, bufferlen) ;
writecount = (int) psf_fwrite (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_i2dsc */
static sf_count_t
dpcm_write_f2dsc (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
float normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_float == SF_TRUE) ? (1.0 * 0x7F) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
f2dsc_array (pxi, ptr + total, ubuf.scbuf, bufferlen, normfact) ;
writecount = (int) psf_fwrite (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_f2dsc */
static sf_count_t
dpcm_write_d2dsc (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
double normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_double == SF_TRUE) ? (1.0 * 0x7F) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.ucbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
d2dsc_array (pxi, ptr + total, ubuf.scbuf, bufferlen, normfact) ;
writecount = (int) psf_fwrite (ubuf.scbuf, sizeof (signed char), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_d2dsc */
static sf_count_t
dpcm_write_s2dles (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
s2dles_array (pxi, ptr + total, ubuf.sbuf, bufferlen) ;
writecount = (int) psf_fwrite (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_s2dles */
static sf_count_t
dpcm_write_i2dles (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
i2dles_array (pxi, ptr + total, ubuf.sbuf, bufferlen) ;
writecount = (int) psf_fwrite (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_i2dles */
static sf_count_t
dpcm_write_f2dles (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
float normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_float == SF_TRUE) ? (1.0 * 0x7FFF) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
f2dles_array (pxi, ptr + total, ubuf.sbuf, bufferlen, normfact) ;
writecount = (int) psf_fwrite (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_f2dles */
static sf_count_t
dpcm_write_d2dles (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
{ BUF_UNION ubuf ;
XI_PRIVATE *pxi ;
int bufferlen, writecount ;
sf_count_t total = 0 ;
double normfact ;
if ((pxi = psf->codec_data) == NULL)
return 0 ;
normfact = (psf->norm_double == SF_TRUE) ? (1.0 * 0x7FFF) : 1.0 ;
bufferlen = ARRAY_LEN (ubuf.sbuf) ;
while (len > 0)
{ if (len < bufferlen)
bufferlen = (int) len ;
d2dles_array (pxi, ptr + total, ubuf.sbuf, bufferlen, normfact) ;
writecount = (int) psf_fwrite (ubuf.sbuf, sizeof (short), bufferlen, psf) ;
total += writecount ;
if (writecount < bufferlen)
break ;
len -= writecount ;
} ;
return total ;
} /* dpcm_write_d2dles */
/*==============================================================================
*/
static void
dsc2s_array (XI_PRIVATE *pxi, signed char *src, int count, short *dest)
{ signed char last_val ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ last_val += src [k] ;
dest [k] = arith_shift_left (last_val, 8) ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* dsc2s_array */
static void
dsc2i_array (XI_PRIVATE *pxi, signed char *src, int count, int *dest)
{ signed char last_val ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ last_val += src [k] ;
dest [k] = arith_shift_left (last_val, 24) ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* dsc2i_array */
static void
dsc2f_array (XI_PRIVATE *pxi, signed char *src, int count, float *dest, float normfact)
{ signed char last_val ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ last_val += src [k] ;
dest [k] = last_val * normfact ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* dsc2f_array */
static void
dsc2d_array (XI_PRIVATE *pxi, signed char *src, int count, double *dest, double normfact)
{ signed char last_val ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ last_val += src [k] ;
dest [k] = last_val * normfact ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* dsc2d_array */
/*------------------------------------------------------------------------------
*/
static void
s2dsc_array (XI_PRIVATE *pxi, const short *src, signed char *dest, int count)
{ signed char last_val, current ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ current = src [k] >> 8 ;
dest [k] = current - last_val ;
last_val = current ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* s2dsc_array */
static void
i2dsc_array (XI_PRIVATE *pxi, const int *src, signed char *dest, int count)
{ signed char last_val, current ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ current = src [k] >> 24 ;
dest [k] = current - last_val ;
last_val = current ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* i2dsc_array */
static void
f2dsc_array (XI_PRIVATE *pxi, const float *src, signed char *dest, int count, float normfact)
{ signed char last_val, current ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ current = psf_lrintf (src [k] * normfact) ;
dest [k] = current - last_val ;
last_val = current ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* f2dsc_array */
static void
d2dsc_array (XI_PRIVATE *pxi, const double *src, signed char *dest, int count, double normfact)
{ signed char last_val, current ;
int k ;
last_val = pxi->last_16 >> 8 ;
for (k = 0 ; k < count ; k++)
{ current = psf_lrint (src [k] * normfact) ;
dest [k] = current - last_val ;
last_val = current ;
} ;
pxi->last_16 = arith_shift_left (last_val, 8) ;
} /* d2dsc_array */
/*==============================================================================
*/
static void
dles2s_array (XI_PRIVATE *pxi, short *src, int count, short *dest)
{ short last_val ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ last_val += LE2H_16 (src [k]) ;
dest [k] = last_val ;
} ;
pxi->last_16 = last_val ;
} /* dles2s_array */
static void
dles2i_array (XI_PRIVATE *pxi, short *src, int count, int *dest)
{ short last_val ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ last_val += LE2H_16 (src [k]) ;
dest [k] = arith_shift_left (last_val, 16) ;
} ;
pxi->last_16 = last_val ;
} /* dles2i_array */
static void
dles2f_array (XI_PRIVATE *pxi, short *src, int count, float *dest, float normfact)
{ short last_val ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ last_val += LE2H_16 (src [k]) ;
dest [k] = last_val * normfact ;
} ;
pxi->last_16 = last_val ;
} /* dles2f_array */
static void
dles2d_array (XI_PRIVATE *pxi, short *src, int count, double *dest, double normfact)
{ short last_val ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ last_val += LE2H_16 (src [k]) ;
dest [k] = last_val * normfact ;
} ;
pxi->last_16 = last_val ;
} /* dles2d_array */
/*------------------------------------------------------------------------------
*/
static void
s2dles_array (XI_PRIVATE *pxi, const short *src, short *dest, int count)
{ short diff, last_val ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ diff = src [k] - last_val ;
dest [k] = LE2H_16 (diff) ;
last_val = src [k] ;
} ;
pxi->last_16 = last_val ;
} /* s2dles_array */
static void
i2dles_array (XI_PRIVATE *pxi, const int *src, short *dest, int count)
{ short diff, last_val ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ diff = (src [k] >> 16) - last_val ;
dest [k] = LE2H_16 (diff) ;
last_val = src [k] >> 16 ;
} ;
pxi->last_16 = last_val ;
} /* i2dles_array */
static void
f2dles_array (XI_PRIVATE *pxi, const float *src, short *dest, int count, float normfact)
{ short diff, last_val, current ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ current = psf_lrintf (src [k] * normfact) ;
diff = current - last_val ;
dest [k] = LE2H_16 (diff) ;
last_val = current ;
} ;
pxi->last_16 = last_val ;
} /* f2dles_array */
static void
d2dles_array (XI_PRIVATE *pxi, const double *src, short *dest, int count, double normfact)
{ short diff, last_val, current ;
int k ;
last_val = pxi->last_16 ;
for (k = 0 ; k < count ; k++)
{ current = psf_lrint (src [k] * normfact) ;
diff = current - last_val ;
dest [k] = LE2H_16 (diff) ;
last_val = current ;
} ;
pxi->last_16 = last_val ;
} /* d2dles_array */