508 lines
14 KiB
C
508 lines
14 KiB
C
/*
|
|
** Copyright (C) 2002-2006 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 "sndfile.h"
|
|
#include "sfendian.h"
|
|
#include "common.h"
|
|
#include "float_cast.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 MATL_MARKER (MAKE_MARKER ('M', 'A', 'T', 'L'))
|
|
|
|
#define IM_MARKER (('I' << 8) + 'M')
|
|
#define MI_MARKER (('M' << 8) + 'I')
|
|
|
|
/*------------------------------------------------------------------------------
|
|
** Enums and typedefs.
|
|
*/
|
|
|
|
enum
|
|
{ MAT5_TYPE_SCHAR = 0x1,
|
|
MAT5_TYPE_UCHAR = 0x2,
|
|
MAT5_TYPE_INT16 = 0x3,
|
|
MAT5_TYPE_UINT16 = 0x4,
|
|
MAT5_TYPE_INT32 = 0x5,
|
|
MAT5_TYPE_UINT32 = 0x6,
|
|
MAT5_TYPE_FLOAT = 0x7,
|
|
MAT5_TYPE_DOUBLE = 0x9,
|
|
MAT5_TYPE_ARRAY = 0xE,
|
|
|
|
MAT5_TYPE_COMP_USHORT = 0x00020004,
|
|
MAT5_TYPE_COMP_UINT = 0x00040006
|
|
} ;
|
|
|
|
typedef struct
|
|
{ sf_count_t size ;
|
|
int rows, cols ;
|
|
char name [32] ;
|
|
} MAT5_MATRIX ;
|
|
|
|
/*------------------------------------------------------------------------------
|
|
** Private static functions.
|
|
*/
|
|
|
|
static int mat5_close (SF_PRIVATE *psf) ;
|
|
|
|
static int mat5_write_header (SF_PRIVATE *psf, int calc_length) ;
|
|
static int mat5_read_header (SF_PRIVATE *psf) ;
|
|
|
|
/*------------------------------------------------------------------------------
|
|
** Public function.
|
|
*/
|
|
|
|
int
|
|
mat5_open (SF_PRIVATE *psf)
|
|
{ int subformat, error = 0 ;
|
|
|
|
if (psf->mode == SFM_READ || (psf->mode == SFM_RDWR && psf->filelength > 0))
|
|
{ if ((error = mat5_read_header (psf)))
|
|
return error ;
|
|
} ;
|
|
|
|
if ((psf->sf.format & SF_FORMAT_TYPEMASK) != SF_FORMAT_MAT5)
|
|
return SFE_BAD_OPEN_FORMAT ;
|
|
|
|
subformat = psf->sf.format & SF_FORMAT_SUBMASK ;
|
|
|
|
if (psf->mode == SFM_WRITE || psf->mode == SFM_RDWR)
|
|
{ if (psf->is_pipe)
|
|
return SFE_NO_PIPE_WRITE ;
|
|
|
|
psf->endian = psf->sf.format & SF_FORMAT_ENDMASK ;
|
|
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 = mat5_write_header (psf, SF_FALSE)))
|
|
return error ;
|
|
|
|
psf->write_header = mat5_write_header ;
|
|
} ;
|
|
|
|
psf->container_close = mat5_close ;
|
|
|
|
psf->blockwidth = psf->bytewidth * psf->sf.channels ;
|
|
|
|
switch (subformat)
|
|
{ case SF_FORMAT_PCM_U8 :
|
|
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 ;
|
|
} ;
|
|
|
|
return error ;
|
|
} /* mat5_open */
|
|
|
|
/*------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static int
|
|
mat5_close (SF_PRIVATE *psf)
|
|
{
|
|
if (psf->mode == SFM_WRITE || psf->mode == SFM_RDWR)
|
|
mat5_write_header (psf, SF_TRUE) ;
|
|
|
|
return 0 ;
|
|
} /* mat5_close */
|
|
|
|
/*------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static int
|
|
mat5_write_header (SF_PRIVATE *psf, int calc_length)
|
|
{ static const char *filename = "MATLAB 5.0 MAT-file, written by " PACKAGE "-" VERSION ", " ;
|
|
static const char *sr_name = "samplerate\0\0\0\0\0\0\0\0\0\0\0" ;
|
|
static const char *wd_name = "wavedata\0" ;
|
|
sf_count_t current, datasize ;
|
|
int encoding ;
|
|
|
|
current = psf_ftell (psf) ;
|
|
|
|
if (calc_length)
|
|
{ psf_fseek (psf, 0, SEEK_END) ;
|
|
psf->filelength = psf_ftell (psf) ;
|
|
psf_fseek (psf, 0, SEEK_SET) ;
|
|
|
|
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) ;
|
|
} ;
|
|
|
|
switch (psf->sf.format & SF_FORMAT_SUBMASK)
|
|
{ case SF_FORMAT_PCM_U8 :
|
|
encoding = MAT5_TYPE_UCHAR ;
|
|
break ;
|
|
|
|
case SF_FORMAT_PCM_16 :
|
|
encoding = MAT5_TYPE_INT16 ;
|
|
break ;
|
|
|
|
case SF_FORMAT_PCM_32 :
|
|
encoding = MAT5_TYPE_INT32 ;
|
|
break ;
|
|
|
|
case SF_FORMAT_FLOAT :
|
|
encoding = MAT5_TYPE_FLOAT ;
|
|
break ;
|
|
|
|
case SF_FORMAT_DOUBLE :
|
|
encoding = MAT5_TYPE_DOUBLE ;
|
|
break ;
|
|
|
|
default :
|
|
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) ;
|
|
|
|
psf_get_date_str (psf->u.cbuf, sizeof (psf->u.scbuf)) ;
|
|
psf_binheader_writef (psf, "bb", filename, strlen (filename), psf->u.cbuf, strlen (psf->u.cbuf) + 1) ;
|
|
|
|
memset (psf->u.scbuf, ' ', 124 - psf->headindex) ;
|
|
psf_binheader_writef (psf, "b", psf->u.scbuf, make_size_t (124 - psf->headindex)) ;
|
|
|
|
psf->rwf_endian = psf->endian ;
|
|
|
|
if (psf->rwf_endian == SF_ENDIAN_BIG)
|
|
psf_binheader_writef (psf, "2b", 0x0100, "MI", make_size_t (2)) ;
|
|
else
|
|
psf_binheader_writef (psf, "2b", 0x0100, "IM", make_size_t (2)) ;
|
|
|
|
psf_binheader_writef (psf, "444444", MAT5_TYPE_ARRAY, 64, MAT5_TYPE_UINT32, 8, 6, 0) ;
|
|
psf_binheader_writef (psf, "4444", MAT5_TYPE_INT32, 8, 1, 1) ;
|
|
psf_binheader_writef (psf, "44b", MAT5_TYPE_SCHAR, strlen (sr_name), sr_name, make_size_t (16)) ;
|
|
|
|
if (psf->sf.samplerate > 0xFFFF)
|
|
psf_binheader_writef (psf, "44", MAT5_TYPE_COMP_UINT, psf->sf.samplerate) ;
|
|
else
|
|
{ unsigned short samplerate = psf->sf.samplerate ;
|
|
|
|
psf_binheader_writef (psf, "422", MAT5_TYPE_COMP_USHORT, samplerate, 0) ;
|
|
} ;
|
|
|
|
datasize = psf->sf.frames * psf->sf.channels * psf->bytewidth ;
|
|
|
|
psf_binheader_writef (psf, "t484444", MAT5_TYPE_ARRAY, datasize + 64, MAT5_TYPE_UINT32, 8, 6, 0) ;
|
|
psf_binheader_writef (psf, "t4448", MAT5_TYPE_INT32, 8, psf->sf.channels, psf->sf.frames) ;
|
|
psf_binheader_writef (psf, "44b", MAT5_TYPE_SCHAR, strlen (wd_name), wd_name, strlen (wd_name)) ;
|
|
|
|
datasize = psf->sf.frames * psf->sf.channels * psf->bytewidth ;
|
|
if (datasize > 0x7FFFFFFF)
|
|
datasize = 0x7FFFFFFF ;
|
|
|
|
psf_binheader_writef (psf, "t48", encoding, datasize) ;
|
|
|
|
/* 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 ;
|
|
} /* mat5_write_header */
|
|
|
|
static int
|
|
mat5_read_header (SF_PRIVATE *psf)
|
|
{ char name [32] ;
|
|
short version, endian ;
|
|
int type, size, flags1, flags2, rows, cols ;
|
|
|
|
psf_binheader_readf (psf, "pb", 0, psf->u.cbuf, 124) ;
|
|
|
|
psf->u.scbuf [125] = 0 ;
|
|
|
|
if (strlen (psf->u.cbuf) >= 124)
|
|
return SFE_UNIMPLEMENTED ;
|
|
|
|
if (strstr (psf->u.cbuf, "MATLAB 5.0 MAT-file") == psf->u.cbuf)
|
|
psf_log_printf (psf, "%s\n", psf->u.scbuf) ;
|
|
|
|
|
|
psf_binheader_readf (psf, "E22", &version, &endian) ;
|
|
|
|
if (endian == MI_MARKER)
|
|
{ psf->endian = psf->rwf_endian = SF_ENDIAN_BIG ;
|
|
if (CPU_IS_LITTLE_ENDIAN) version = ENDSWAP_SHORT (version) ;
|
|
}
|
|
else if (endian == IM_MARKER)
|
|
{ psf->endian = psf->rwf_endian = SF_ENDIAN_LITTLE ;
|
|
if (CPU_IS_BIG_ENDIAN) version = ENDSWAP_SHORT (version) ;
|
|
}
|
|
else
|
|
return SFE_MAT5_BAD_ENDIAN ;
|
|
|
|
if ((CPU_IS_LITTLE_ENDIAN && endian == IM_MARKER) ||
|
|
(CPU_IS_BIG_ENDIAN && endian == MI_MARKER))
|
|
version = ENDSWAP_SHORT (version) ;
|
|
|
|
psf_log_printf (psf, "Version : 0x%04X\n", version) ;
|
|
psf_log_printf (psf, "Endian : 0x%04X => %s\n", endian,
|
|
(psf->endian == SF_ENDIAN_LITTLE) ? "Little" : "Big") ;
|
|
|
|
/*========================================================*/
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
psf_log_printf (psf, "Block\n Type : %X Size : %d\n", type, size) ;
|
|
|
|
if (type != MAT5_TYPE_ARRAY)
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
|
|
if (type != MAT5_TYPE_UINT32)
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_binheader_readf (psf, "44", &flags1, &flags2) ;
|
|
psf_log_printf (psf, " Flg1 : %X Flg2 : %d\n", flags1, flags2) ;
|
|
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
|
|
if (type != MAT5_TYPE_INT32)
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_binheader_readf (psf, "44", &rows, &cols) ;
|
|
psf_log_printf (psf, " Rows : %X Cols : %d\n", rows, cols) ;
|
|
|
|
if (rows != 1 || cols != 1)
|
|
return SFE_MAT5_SAMPLE_RATE ;
|
|
|
|
psf_binheader_readf (psf, "4", &type) ;
|
|
|
|
if (type == MAT5_TYPE_SCHAR)
|
|
{ psf_binheader_readf (psf, "4", &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
if (size > SIGNED_SIZEOF (name) - 1)
|
|
{ psf_log_printf (psf, "Error : Bad name length.\n") ;
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
} ;
|
|
|
|
psf_binheader_readf (psf, "bj", name, size, (8 - (size % 8)) % 8) ;
|
|
name [size] = 0 ;
|
|
}
|
|
else if ((type & 0xFFFF) == MAT5_TYPE_SCHAR)
|
|
{ size = type >> 16 ;
|
|
if (size > 4)
|
|
{ psf_log_printf (psf, "Error : Bad name length.\n") ;
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
} ;
|
|
|
|
psf_log_printf (psf, " Type : %X\n", type) ;
|
|
psf_binheader_readf (psf, "4", &name) ;
|
|
name [size] = 0 ;
|
|
}
|
|
else
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_log_printf (psf, " Name : %s\n", name) ;
|
|
|
|
/*-----------------------------------------*/
|
|
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
|
|
switch (type)
|
|
{ case MAT5_TYPE_DOUBLE :
|
|
{ double samplerate ;
|
|
|
|
psf_binheader_readf (psf, "d", &samplerate) ;
|
|
LSF_SNPRINTF (name, sizeof (name), "%f\n", samplerate) ;
|
|
psf_log_printf (psf, " Val : %s\n", name) ;
|
|
|
|
psf->sf.samplerate = lrint (samplerate) ;
|
|
} ;
|
|
break ;
|
|
|
|
case MAT5_TYPE_COMP_USHORT :
|
|
{ unsigned short samplerate ;
|
|
|
|
psf_binheader_readf (psf, "j2j", -4, &samplerate, 2) ;
|
|
psf_log_printf (psf, " Val : %u\n", samplerate) ;
|
|
psf->sf.samplerate = samplerate ;
|
|
}
|
|
break ;
|
|
|
|
case MAT5_TYPE_COMP_UINT :
|
|
psf_log_printf (psf, " Val : %u\n", size) ;
|
|
psf->sf.samplerate = size ;
|
|
break ;
|
|
|
|
default :
|
|
psf_log_printf (psf, " Type : %X Size : %d ***\n", type, size) ;
|
|
return SFE_MAT5_SAMPLE_RATE ;
|
|
} ;
|
|
|
|
/*-----------------------------------------*/
|
|
|
|
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
|
|
if (type != MAT5_TYPE_ARRAY)
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
|
|
if (type != MAT5_TYPE_UINT32)
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_binheader_readf (psf, "44", &flags1, &flags2) ;
|
|
psf_log_printf (psf, " Flg1 : %X Flg2 : %d\n", flags1, flags2) ;
|
|
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
|
|
if (type != MAT5_TYPE_INT32)
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_binheader_readf (psf, "44", &rows, &cols) ;
|
|
psf_log_printf (psf, " Rows : %X Cols : %d\n", rows, cols) ;
|
|
|
|
psf_binheader_readf (psf, "4", &type) ;
|
|
|
|
if (type == MAT5_TYPE_SCHAR)
|
|
{ psf_binheader_readf (psf, "4", &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
if (size > SIGNED_SIZEOF (name) - 1)
|
|
{ psf_log_printf (psf, "Error : Bad name length.\n") ;
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
} ;
|
|
|
|
psf_binheader_readf (psf, "bj", name, size, (8 - (size % 8)) % 8) ;
|
|
name [size] = 0 ;
|
|
}
|
|
else if ((type & 0xFFFF) == MAT5_TYPE_SCHAR)
|
|
{ size = type >> 16 ;
|
|
if (size > 4)
|
|
{ psf_log_printf (psf, "Error : Bad name length.\n") ;
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
} ;
|
|
|
|
psf_log_printf (psf, " Type : %X\n", type) ;
|
|
psf_binheader_readf (psf, "4", &name) ;
|
|
name [size] = 0 ;
|
|
}
|
|
else
|
|
return SFE_MAT5_NO_BLOCK ;
|
|
|
|
psf_log_printf (psf, " Name : %s\n", name) ;
|
|
|
|
psf_binheader_readf (psf, "44", &type, &size) ;
|
|
psf_log_printf (psf, " Type : %X Size : %d\n", type, size) ;
|
|
|
|
/*++++++++++++++++++++++++++++++++++++++++++++++++++*/
|
|
|
|
if (rows == 0 && cols == 0)
|
|
{ psf_log_printf (psf, "*** Error : zero channel count.\n") ;
|
|
return SFE_MAT5_ZERO_CHANNELS ;
|
|
} ;
|
|
|
|
psf->sf.channels = rows ;
|
|
psf->sf.frames = cols ;
|
|
|
|
psf->sf.format = psf->endian | SF_FORMAT_MAT5 ;
|
|
|
|
switch (type)
|
|
{ case MAT5_TYPE_DOUBLE :
|
|
psf_log_printf (psf, "Data type : double\n") ;
|
|
psf->sf.format |= SF_FORMAT_DOUBLE ;
|
|
psf->bytewidth = 8 ;
|
|
break ;
|
|
|
|
case MAT5_TYPE_FLOAT :
|
|
psf_log_printf (psf, "Data type : float\n") ;
|
|
psf->sf.format |= SF_FORMAT_FLOAT ;
|
|
psf->bytewidth = 4 ;
|
|
break ;
|
|
|
|
case MAT5_TYPE_INT32 :
|
|
psf_log_printf (psf, "Data type : 32 bit PCM\n") ;
|
|
psf->sf.format |= SF_FORMAT_PCM_32 ;
|
|
psf->bytewidth = 4 ;
|
|
break ;
|
|
|
|
case MAT5_TYPE_INT16 :
|
|
psf_log_printf (psf, "Data type : 16 bit PCM\n") ;
|
|
psf->sf.format |= SF_FORMAT_PCM_16 ;
|
|
psf->bytewidth = 2 ;
|
|
break ;
|
|
|
|
case MAT5_TYPE_UCHAR :
|
|
psf_log_printf (psf, "Data type : unsigned 8 bit PCM\n") ;
|
|
psf->sf.format |= SF_FORMAT_PCM_U8 ;
|
|
psf->bytewidth = 1 ;
|
|
break ;
|
|
|
|
default :
|
|
psf_log_printf (psf, "*** Error : Bad marker %08X\n", type) ;
|
|
return SFE_UNIMPLEMENTED ;
|
|
} ;
|
|
|
|
psf->dataoffset = psf_ftell (psf) ;
|
|
psf->datalength = psf->filelength - psf->dataoffset ;
|
|
|
|
return 0 ;
|
|
} /* mat5_read_header */
|
|
|
|
/*
|
|
** Do not edit or modify anything in this comment block.
|
|
** The arch-tag line is a file identity tag for the GNU Arch
|
|
** revision control system.
|
|
**
|
|
** arch-tag: dfdb6742-b2be-4be8-b390-d0c674e8bc8e
|
|
*/
|