| /* |
| ** Copyright (C) 2003-2011 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 "-" 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) |
| { 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 (psf->u.sbuf) ; |
| while (total > 0) |
| { len = (total > bufferlen) ? bufferlen : total ; |
| total -= dpcm_read_dles2s (psf, psf->u.sbuf, len) ; |
| } ; |
| } |
| else |
| { total = offset ; |
| bufferlen = ARRAY_LEN (psf->u.sbuf) ; |
| while (total > 0) |
| { len = (total > bufferlen) ? bufferlen : total ; |
| total -= dpcm_read_dsc2s (psf, psf->u.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 [0] = 0 ; |
| psf->headindex = 0 ; |
| psf_fseek (psf, 0, SEEK_SET) ; |
| |
| string = "Extended Instrument: " ; |
| psf_binheader_writef (psf, "b", string, strlen (string)) ; |
| psf_binheader_writef (psf, "b1", pxi->filename, sizeof (pxi->filename), 0x1A) ; |
| |
| /* Write software version and two byte XI version. */ |
| psf_binheader_writef (psf, "eb2", pxi->software, sizeof (pxi->software), (1 << 8) + 2) ; |
| |
| /* |
| ** Jump note numbers (96), volume envelope (48), pan envelope (48), |
| ** volume points (1), pan points (1) |
| */ |
| psf_binheader_writef (psf, "z", (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", (size_t) (4 * 3), 0x1234, make_size_t (22), 1) ; |
| |
| pxi->loop_begin = 0 ; |
| pxi->loop_end = 0 ; |
| |
| psf_binheader_writef (psf, "et844", psf->sf.frames, pxi->loop_begin, pxi->loop_end) ; |
| |
| /* volume, fine tune, flags, pan, note, namelen */ |
| psf_binheader_writef (psf, "111111", 128, 0, pxi->sample_flags, 128, 0, strlen (pxi->sample_name)) ; |
| |
| psf_binheader_writef (psf, "b", pxi->sample_name, sizeof (pxi->sample_name)) ; |
| |
| |
| |
| |
| |
| /* Header construction complete so write it out. */ |
| psf_fwrite (psf->header, psf->headindex, 1, psf) ; |
| |
| if (psf->error) |
| return psf->error ; |
| |
| psf->dataoffset = psf->headindex ; |
| |
| 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 ; |
| psf_log_printf (psf, "Extended Instrument : %s\n", buffer) ; |
| |
| psf_binheader_readf (psf, "be2", buffer, 20, &version) ; |
| buffer [19] = 0 ; |
| psf_log_printf (psf, "Software : %s\nVersion : %d.%02d\n", buffer, version / 256, version % 256) ; |
| |
| /* 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 ; |
| |
| /* 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]) ; |
| |
| 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->basenote = 0 ; |
| 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) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, readcount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 0 ; |
| |
| bufferlen = ARRAY_LEN (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ; |
| dsc2s_array (pxi, psf->u.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) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, readcount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 0 ; |
| |
| bufferlen = ARRAY_LEN (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ; |
| dsc2i_array (pxi, psf->u.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) |
| { 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 (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ; |
| dsc2f_array (pxi, psf->u.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) |
| { 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 (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| readcount = psf_fread (psf->u.scbuf, sizeof (signed char), bufferlen, psf) ; |
| dsc2d_array (pxi, psf->u.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) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, readcount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 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) ; |
| dles2s_array (pxi, psf->u.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) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, readcount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 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) ; |
| dles2i_array (pxi, psf->u.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) |
| { 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 (psf->u.sbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ; |
| dles2f_array (pxi, psf->u.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) |
| { 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 (psf->u.sbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| readcount = psf_fread (psf->u.sbuf, sizeof (short), bufferlen, psf) ; |
| dles2d_array (pxi, psf->u.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) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, writecount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 0 ; |
| |
| bufferlen = ARRAY_LEN (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| s2dsc_array (pxi, 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 ; |
| } /* dpcm_write_s2dsc */ |
| |
| static sf_count_t |
| dpcm_write_i2dsc (SF_PRIVATE *psf, const int *ptr, sf_count_t len) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, writecount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 0 ; |
| |
| bufferlen = ARRAY_LEN (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| i2dsc_array (pxi, 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 ; |
| } /* dpcm_write_i2dsc */ |
| |
| static sf_count_t |
| dpcm_write_f2dsc (SF_PRIVATE *psf, const float *ptr, sf_count_t len) |
| { 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 (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| f2dsc_array (pxi, ptr + total, psf->u.scbuf, bufferlen, normfact) ; |
| writecount = psf_fwrite (psf->u.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) |
| { 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 (psf->u.ucbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| d2dsc_array (pxi, ptr + total, psf->u.scbuf, bufferlen, normfact) ; |
| writecount = psf_fwrite (psf->u.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) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, writecount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 0 ; |
| |
| bufferlen = ARRAY_LEN (psf->u.sbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| s2dles_array (pxi, 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 ; |
| } /* dpcm_write_s2dles */ |
| |
| static sf_count_t |
| dpcm_write_i2dles (SF_PRIVATE *psf, const int *ptr, sf_count_t len) |
| { XI_PRIVATE *pxi ; |
| int bufferlen, writecount ; |
| sf_count_t total = 0 ; |
| |
| if ((pxi = psf->codec_data) == NULL) |
| return 0 ; |
| |
| bufferlen = ARRAY_LEN (psf->u.sbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| i2dles_array (pxi, 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 ; |
| } /* dpcm_write_i2dles */ |
| |
| static sf_count_t |
| dpcm_write_f2dles (SF_PRIVATE *psf, const float *ptr, sf_count_t len) |
| { 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 (psf->u.sbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| f2dles_array (pxi, ptr + total, psf->u.sbuf, bufferlen, normfact) ; |
| writecount = psf_fwrite (psf->u.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) |
| { 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 (psf->u.sbuf) ; |
| |
| while (len > 0) |
| { if (len < bufferlen) |
| bufferlen = (int) len ; |
| d2dles_array (pxi, ptr + total, psf->u.sbuf, bufferlen, normfact) ; |
| writecount = psf_fwrite (psf->u.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] = last_val << 8 ; |
| } ; |
| |
| pxi->last_16 = 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] = last_val << 24 ; |
| } ; |
| |
| pxi->last_16 = 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 = 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 = 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 = 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 = 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 = lrintf (src [k] * normfact) ; |
| dest [k] = current - last_val ; |
| last_val = current ; |
| } ; |
| |
| pxi->last_16 = 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 = lrint (src [k] * normfact) ; |
| dest [k] = current - last_val ; |
| last_val = current ; |
| } ; |
| |
| pxi->last_16 = 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 += LES2H_SHORT (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 += LES2H_SHORT (src [k]) ; |
| dest [k] = 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 += LES2H_SHORT (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 += LES2H_SHORT (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] = LES2H_SHORT (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] = LES2H_SHORT (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 = lrintf (src [k] * normfact) ; |
| diff = current - last_val ; |
| dest [k] = LES2H_SHORT (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 = lrint (src [k] * normfact) ; |
| diff = current - last_val ; |
| dest [k] = LES2H_SHORT (diff) ; |
| last_val = current ; |
| } ; |
| |
| pxi->last_16 = last_val ; |
| } /* d2dles_array */ |
| |