--- /dev/null
+/*
+** Copyright (C) 2002-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 <fcntl.h>
+#include <string.h>
+#include <ctype.h>
+#include <math.h>
+
+#include "sndfile.h"
+#include "sfendian.h"
+#include "common.h"
+
+/*------------------------------------------------------------------------------
+** Information on how to decode and encode this file was obtained in a PDF
+** file which I found on http://www.wotsit.org/.
+** Also did a lot of testing with GNU Octave but do not have access to
+** Matlab (tm) and so could not test it there.
+*/
+
+/*------------------------------------------------------------------------------
+** Macros to handle big/little endian issues.
+*/
+
+#define MAT4_BE_DOUBLE (MAKE_MARKER (0, 0, 0x03, 0xE8))
+#define MAT4_LE_DOUBLE (MAKE_MARKER (0, 0, 0, 0))
+
+#define MAT4_BE_FLOAT (MAKE_MARKER (0, 0, 0x03, 0xF2))
+#define MAT4_LE_FLOAT (MAKE_MARKER (0x0A, 0, 0, 0))
+
+#define MAT4_BE_PCM_32 (MAKE_MARKER (0, 0, 0x03, 0xFC))
+#define MAT4_LE_PCM_32 (MAKE_MARKER (0x14, 0, 0, 0))
+
+#define MAT4_BE_PCM_16 (MAKE_MARKER (0, 0, 0x04, 0x06))
+#define MAT4_LE_PCM_16 (MAKE_MARKER (0x1E, 0, 0, 0))
+
+/* Can't see any reason to ever implement this. */
+#define MAT4_BE_PCM_U8 (MAKE_MARKER (0, 0, 0x04, 0x1A))
+#define MAT4_LE_PCM_U8 (MAKE_MARKER (0x32, 0, 0, 0))
+
+/*------------------------------------------------------------------------------
+** Private static functions.
+*/
+
+static int mat4_close (SF_PRIVATE *psf) ;
+
+static int mat4_format_to_encoding (int format, int endian) ;
+
+static int mat4_write_header (SF_PRIVATE *psf, int calc_length) ;
+static int mat4_read_header (SF_PRIVATE *psf) ;
+
+static const char * mat4_marker_to_str (int marker) ;
+
+/*------------------------------------------------------------------------------
+** Public function.
+*/
+
+int
+mat4_open (SF_PRIVATE *psf)
+{ int subformat, error = 0 ;
+
+ if (psf->file.mode == SFM_READ || (psf->file.mode == SFM_RDWR && psf->filelength > 0))
+ { if ((error = mat4_read_header (psf)))
+ return error ;
+ } ;
+
+ if ((SF_CONTAINER (psf->sf.format)) != SF_FORMAT_MAT4)
+ return SFE_BAD_OPEN_FORMAT ;
+
+ subformat = SF_CODEC (psf->sf.format) ;
+
+ if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
+ { if (psf->is_pipe)
+ return SFE_NO_PIPE_WRITE ;
+
+ psf->endian = SF_ENDIAN (psf->sf.format) ;
+ if (CPU_IS_LITTLE_ENDIAN && (psf->endian == SF_ENDIAN_CPU || psf->endian == 0))
+ psf->endian = SF_ENDIAN_LITTLE ;
+ else if (CPU_IS_BIG_ENDIAN && (psf->endian == SF_ENDIAN_CPU || psf->endian == 0))
+ psf->endian = SF_ENDIAN_BIG ;
+
+ if ((error = mat4_write_header (psf, SF_FALSE)))
+ return error ;
+
+ psf->write_header = mat4_write_header ;
+ } ;
+
+ psf->container_close = mat4_close ;
+
+ psf->blockwidth = psf->bytewidth * psf->sf.channels ;
+
+ switch (subformat)
+ { case SF_FORMAT_PCM_16 :
+ case SF_FORMAT_PCM_32 :
+ error = pcm_init (psf) ;
+ break ;
+
+ case SF_FORMAT_FLOAT :
+ error = float32_init (psf) ;
+ break ;
+
+ case SF_FORMAT_DOUBLE :
+ error = double64_init (psf) ;
+ break ;
+
+ default : break ;
+ } ;
+
+ if (error)
+ return error ;
+
+ return error ;
+} /* mat4_open */
+
+/*------------------------------------------------------------------------------
+*/
+
+static int
+mat4_close (SF_PRIVATE *psf)
+{
+ if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
+ mat4_write_header (psf, SF_TRUE) ;
+
+ return 0 ;
+} /* mat4_close */
+
+/*------------------------------------------------------------------------------
+*/
+
+static int
+mat4_write_header (SF_PRIVATE *psf, int calc_length)
+{ sf_count_t current ;
+ int encoding ;
+ double samplerate ;
+
+ current = psf_ftell (psf) ;
+
+ if (calc_length)
+ { psf->filelength = psf_get_filelen (psf) ;
+
+ psf->datalength = psf->filelength - psf->dataoffset ;
+ if (psf->dataend)
+ psf->datalength -= psf->filelength - psf->dataend ;
+
+ psf->sf.frames = psf->datalength / (psf->bytewidth * psf->sf.channels) ;
+ } ;
+
+ encoding = mat4_format_to_encoding (SF_CODEC (psf->sf.format), psf->endian) ;
+
+ if (encoding == -1)
+ return SFE_BAD_OPEN_FORMAT ;
+
+ /* Reset the current header length to zero. */
+ psf->header [0] = 0 ;
+ psf->headindex = 0 ;
+ psf_fseek (psf, 0, SEEK_SET) ;
+
+ /* Need sample rate as a double for writing to the header. */
+ samplerate = psf->sf.samplerate ;
+
+ if (psf->endian == SF_ENDIAN_BIG)
+ { psf_binheader_writef (psf, "Em444", MAT4_BE_DOUBLE, 1, 1, 0) ;
+ psf_binheader_writef (psf, "E4bd", 11, "samplerate", make_size_t (11), samplerate) ;
+ psf_binheader_writef (psf, "tEm484", encoding, psf->sf.channels, psf->sf.frames, 0) ;
+ psf_binheader_writef (psf, "E4b", 9, "wavedata", make_size_t (9)) ;
+ }
+ else if (psf->endian == SF_ENDIAN_LITTLE)
+ { psf_binheader_writef (psf, "em444", MAT4_LE_DOUBLE, 1, 1, 0) ;
+ psf_binheader_writef (psf, "e4bd", 11, "samplerate", make_size_t (11), samplerate) ;
+ psf_binheader_writef (psf, "tem484", encoding, psf->sf.channels, psf->sf.frames, 0) ;
+ psf_binheader_writef (psf, "e4b", 9, "wavedata", make_size_t (9)) ;
+ }
+ else
+ return SFE_BAD_OPEN_FORMAT ;
+
+ /* 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 ;
+} /* mat4_write_header */
+
+static int
+mat4_read_header (SF_PRIVATE *psf)
+{ int marker, rows, cols, imag ;
+ unsigned namesize ;
+ double value ;
+ const char *marker_str ;
+ char name [64] ;
+
+ psf_binheader_readf (psf, "pm", 0, &marker) ;
+
+ /* MAT4 file must start with a double for the samplerate. */
+ if (marker == MAT4_BE_DOUBLE)
+ { psf->endian = psf->rwf_endian = SF_ENDIAN_BIG ;
+ marker_str = "big endian double" ;
+ }
+ else if (marker == MAT4_LE_DOUBLE)
+ { psf->endian = psf->rwf_endian = SF_ENDIAN_LITTLE ;
+ marker_str = "little endian double" ;
+ }
+ else
+ return SFE_UNIMPLEMENTED ;
+
+ psf_log_printf (psf, "GNU Octave 2.0 / MATLAB v4.2 format\nMarker : %s\n", marker_str) ;
+
+ psf_binheader_readf (psf, "444", &rows, &cols, &imag) ;
+
+ psf_log_printf (psf, " Rows : %d\n Cols : %d\n Imag : %s\n", rows, cols, imag ? "True" : "False") ;
+
+ psf_binheader_readf (psf, "4", &namesize) ;
+
+ if (namesize >= SIGNED_SIZEOF (name))
+ return SFE_MAT4_BAD_NAME ;
+
+ psf_binheader_readf (psf, "b", name, namesize) ;
+ name [namesize] = 0 ;
+
+ psf_log_printf (psf, " Name : %s\n", name) ;
+
+ psf_binheader_readf (psf, "d", &value) ;
+
+ snprintf (psf->u.cbuf, sizeof (psf->u.cbuf), " Value : %f\n", value) ;
+ psf_log_printf (psf, psf->u.cbuf) ;
+
+ if ((rows != 1) || (cols != 1))
+ return SFE_MAT4_NO_SAMPLERATE ;
+
+ psf->sf.samplerate = lrint (value) ;
+
+ /* Now write out the audio data. */
+
+ psf_binheader_readf (psf, "m", &marker) ;
+
+ psf_log_printf (psf, "Marker : %s\n", mat4_marker_to_str (marker)) ;
+
+ psf_binheader_readf (psf, "444", &rows, &cols, &imag) ;
+
+ psf_log_printf (psf, " Rows : %d\n Cols : %d\n Imag : %s\n", rows, cols, imag ? "True" : "False") ;
+
+ psf_binheader_readf (psf, "4", &namesize) ;
+
+ if (namesize >= SIGNED_SIZEOF (name))
+ return SFE_MAT4_BAD_NAME ;
+
+ psf_binheader_readf (psf, "b", name, namesize) ;
+ name [namesize] = 0 ;
+
+ psf_log_printf (psf, " Name : %s\n", name) ;
+
+ psf->dataoffset = psf_ftell (psf) ;
+
+ if (rows == 0 && cols == 0)
+ { psf_log_printf (psf, "*** Error : zero channel count.\n") ;
+ return SFE_CHANNEL_COUNT_ZERO ;
+ } ;
+
+ psf->sf.channels = rows ;
+ psf->sf.frames = cols ;
+
+ psf->sf.format = psf->endian | SF_FORMAT_MAT4 ;
+ switch (marker)
+ { case MAT4_BE_DOUBLE :
+ case MAT4_LE_DOUBLE :
+ psf->sf.format |= SF_FORMAT_DOUBLE ;
+ psf->bytewidth = 8 ;
+ break ;
+
+ case MAT4_BE_FLOAT :
+ case MAT4_LE_FLOAT :
+ psf->sf.format |= SF_FORMAT_FLOAT ;
+ psf->bytewidth = 4 ;
+ break ;
+
+ case MAT4_BE_PCM_32 :
+ case MAT4_LE_PCM_32 :
+ psf->sf.format |= SF_FORMAT_PCM_32 ;
+ psf->bytewidth = 4 ;
+ break ;
+
+ case MAT4_BE_PCM_16 :
+ case MAT4_LE_PCM_16 :
+ psf->sf.format |= SF_FORMAT_PCM_16 ;
+ psf->bytewidth = 2 ;
+ break ;
+
+ default :
+ psf_log_printf (psf, "*** Error : Bad marker %08X\n", marker) ;
+ return SFE_UNIMPLEMENTED ;
+ } ;
+
+ if ((psf->filelength - psf->dataoffset) < psf->sf.channels * psf->sf.frames * psf->bytewidth)
+ { psf_log_printf (psf, "*** File seems to be truncated. %D <--> %D\n",
+ psf->filelength - psf->dataoffset, psf->sf.channels * psf->sf.frames * psf->bytewidth) ;
+ }
+ else if ((psf->filelength - psf->dataoffset) > psf->sf.channels * psf->sf.frames * psf->bytewidth)
+ psf->dataend = psf->dataoffset + rows * cols * psf->bytewidth ;
+
+ psf->datalength = psf->filelength - psf->dataoffset - psf->dataend ;
+
+ psf->sf.sections = 1 ;
+
+ return 0 ;
+} /* mat4_read_header */
+
+static int
+mat4_format_to_encoding (int format, int endian)
+{
+ switch (format | endian)
+ { case (SF_FORMAT_PCM_16 | SF_ENDIAN_BIG) :
+ return MAT4_BE_PCM_16 ;
+
+ case (SF_FORMAT_PCM_16 | SF_ENDIAN_LITTLE) :
+ return MAT4_LE_PCM_16 ;
+
+ case (SF_FORMAT_PCM_32 | SF_ENDIAN_BIG) :
+ return MAT4_BE_PCM_32 ;
+
+ case (SF_FORMAT_PCM_32 | SF_ENDIAN_LITTLE) :
+ return MAT4_LE_PCM_32 ;
+
+ case (SF_FORMAT_FLOAT | SF_ENDIAN_BIG) :
+ return MAT4_BE_FLOAT ;
+
+ case (SF_FORMAT_FLOAT | SF_ENDIAN_LITTLE) :
+ return MAT4_LE_FLOAT ;
+
+ case (SF_FORMAT_DOUBLE | SF_ENDIAN_BIG) :
+ return MAT4_BE_DOUBLE ;
+
+ case (SF_FORMAT_DOUBLE | SF_ENDIAN_LITTLE) :
+ return MAT4_LE_DOUBLE ;
+
+ default : break ;
+ } ;
+
+ return -1 ;
+} /* mat4_format_to_encoding */
+
+static const char *
+mat4_marker_to_str (int marker)
+{ static char str [32] ;
+
+ switch (marker)
+ {
+ case MAT4_BE_PCM_16 : return "big endian 16 bit PCM" ;
+ case MAT4_LE_PCM_16 : return "little endian 16 bit PCM" ;
+
+ case MAT4_BE_PCM_32 : return "big endian 32 bit PCM" ;
+ case MAT4_LE_PCM_32 : return "little endian 32 bit PCM" ;
+
+
+ case MAT4_BE_FLOAT : return "big endian float" ;
+ case MAT4_LE_FLOAT : return "big endian float" ;
+
+ case MAT4_BE_DOUBLE : return "big endian double" ;
+ case MAT4_LE_DOUBLE : return "little endian double" ;
+ } ;
+
+ /* This is a little unsafe but is really only for debugging. */
+ str [sizeof (str) - 1] = 0 ;
+ snprintf (str, sizeof (str) - 1, "%08X", marker) ;
+ return str ;
+} /* mat4_marker_to_str */
+
projects / Faustine.git / blobdiff