forked from Mirrors/freeswitch
406 lines
11 KiB
C++
406 lines
11 KiB
C++
/*
|
|
** Copyright (C) 2007-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 <octave/oct.h>
|
|
|
|
#include "sndfile.h"
|
|
|
|
#define FOUR_GIG (0x100000000LL)
|
|
#define BUFFER_FRAMES 8192
|
|
|
|
|
|
static int format_of_str (const std::string & fmt) ;
|
|
static void string_of_format (std::string & fmt, int format) ;
|
|
|
|
|
|
DEFUN_DLD (sfversion, args, nargout ,
|
|
"-*- texinfo -*-\n\
|
|
@deftypefn {Loadable Function} {@var{version} =} sfversion ()\n\
|
|
@cindex Reading sound files\n\
|
|
Return a string containing the libsndfile version.\n\
|
|
@seealso{sfread, sfwrite}\n\
|
|
@end deftypefn")
|
|
{ char buffer [256] ;
|
|
octave_value_list retval ;
|
|
|
|
/* Bail out if the input parameters are bad. */
|
|
if (args.length () != 0 || nargout > 1)
|
|
{ print_usage () ;
|
|
return retval ;
|
|
} ;
|
|
|
|
sf_command (NULL, SFC_GET_LIB_VERSION, buffer, sizeof (buffer)) ;
|
|
|
|
std::string version (buffer) ;
|
|
|
|
retval.append (version) ;
|
|
return retval ;
|
|
} /* sfversion */
|
|
|
|
|
|
DEFUN_DLD (sfread, args, nargout ,
|
|
"-*- texinfo -*-\n\
|
|
@deftypefn {Loadable Function} {@var{data},@var{srate},@var{format} =} sfread (@var{filename})\n\
|
|
@cindex Reading sound files\n\
|
|
Read a sound file from disk using libsndfile.\n\
|
|
@seealso{sfversion, sfwrite}\n\
|
|
@end deftypefn")
|
|
{ SNDFILE * file ;
|
|
SF_INFO sfinfo ;
|
|
|
|
octave_value_list retval ;
|
|
|
|
int nargin = args.length () ;
|
|
|
|
/* Bail out if the input parameters are bad. */
|
|
if ((nargin != 1) || !args (0) .is_string () || nargout < 1 || nargout > 3)
|
|
{ print_usage () ;
|
|
return retval ;
|
|
} ;
|
|
|
|
memset (&sfinfo, 0, sizeof (sfinfo)) ;
|
|
|
|
std::string filename = args (0).string_value () ;
|
|
|
|
if ((file = sf_open (filename.c_str (), SFM_READ, &sfinfo)) == NULL)
|
|
{ error ("sfread: couldn't open file %s : %s", filename.c_str (), sf_strerror (NULL)) ;
|
|
return retval ;
|
|
} ;
|
|
|
|
if (sfinfo.frames > FOUR_GIG)
|
|
printf ("This is a really huge file (%lld frames).\nYou may run out of memory trying to load it.\n", (long long) sfinfo.frames) ;
|
|
|
|
dim_vector dim = dim_vector () ;
|
|
dim.resize (2) ;
|
|
dim (0) = sfinfo.frames ;
|
|
dim (1) = sfinfo.channels ;
|
|
|
|
/* Should I be using Matrix instead? */
|
|
NDArray out (dim, 0.0) ;
|
|
|
|
float buffer [BUFFER_FRAMES * sfinfo.channels] ;
|
|
int readcount ;
|
|
sf_count_t total = 0 ;
|
|
|
|
do
|
|
{ readcount = sf_readf_float (file, buffer, BUFFER_FRAMES) ;
|
|
|
|
/* Make sure we don't read more frames than we allocated. */
|
|
if (total + readcount > sfinfo.frames)
|
|
readcount = sfinfo.frames - total ;
|
|
|
|
for (int ch = 0 ; ch < sfinfo.channels ; ch++)
|
|
{ for (int k = 0 ; k < readcount ; k++)
|
|
out (total + k, ch) = buffer [k * sfinfo.channels + ch] ;
|
|
} ;
|
|
|
|
total += readcount ;
|
|
} while (readcount > 0 && total < sfinfo.frames) ;
|
|
|
|
retval.append (out.squeeze ()) ;
|
|
|
|
if (nargout >= 2)
|
|
retval.append ((octave_uint32) sfinfo.samplerate) ;
|
|
|
|
if (nargout >= 3)
|
|
{ std::string fmt ("") ;
|
|
string_of_format (fmt, sfinfo.format) ;
|
|
retval.append (fmt) ;
|
|
} ;
|
|
|
|
/* Clean up. */
|
|
sf_close (file) ;
|
|
|
|
return retval ;
|
|
} /* sfread */
|
|
|
|
DEFUN_DLD (sfwrite, args, nargout ,
|
|
"-*- texinfo -*-\n\
|
|
@deftypefn {Function File} sfwrite (@var{filename},@var{data},@var{srate},@var{format})\n\
|
|
Write a sound file to disk using libsndfile.\n\
|
|
@seealso{sfread, sfversion}\n\
|
|
@end deftypefn\n\
|
|
")
|
|
{ SNDFILE * file ;
|
|
SF_INFO sfinfo ;
|
|
|
|
octave_value_list retval ;
|
|
|
|
int nargin = args.length () ;
|
|
|
|
/* Bail out if the input parameters are bad. */
|
|
if (nargin != 4 || !args (0).is_string () || !args (1).is_real_matrix ()
|
|
|| !args (2).is_real_scalar () || !args (3).is_string ()
|
|
|| nargout != 0)
|
|
{ print_usage () ;
|
|
return retval ;
|
|
} ;
|
|
|
|
std::string filename = args (0).string_value () ;
|
|
std::string format = args (3).string_value () ;
|
|
|
|
memset (&sfinfo, 0, sizeof (sfinfo)) ;
|
|
|
|
sfinfo.format = format_of_str (format) ;
|
|
if (sfinfo.format == 0)
|
|
{ error ("Bad format '%s'", format.c_str ()) ;
|
|
return retval ;
|
|
} ;
|
|
|
|
sfinfo.samplerate = lrint (args (2).scalar_value ()) ;
|
|
if (sfinfo.samplerate < 1)
|
|
{ error ("Bad sample rate : %d.\n", sfinfo.samplerate) ;
|
|
return retval ;
|
|
} ;
|
|
|
|
Matrix data = args (1).matrix_value () ;
|
|
long rows = args (1).rows () ;
|
|
long cols = args (1).columns () ;
|
|
|
|
if (cols > rows)
|
|
{ error ("Audio data should have one column per channel, but supplied data "
|
|
"has %ld rows and %ld columns.\n", rows, cols) ;
|
|
return retval ;
|
|
} ;
|
|
|
|
sfinfo.channels = cols ;
|
|
|
|
if ((file = sf_open (filename.c_str (), SFM_WRITE, &sfinfo)) == NULL)
|
|
{ error ("Couldn't open file %s : %s", filename.c_str (), sf_strerror (NULL)) ;
|
|
return retval ;
|
|
} ;
|
|
|
|
float buffer [BUFFER_FRAMES * sfinfo.channels] ;
|
|
int writecount ;
|
|
long total = 0 ;
|
|
|
|
do
|
|
{
|
|
writecount = BUFFER_FRAMES ;
|
|
|
|
/* Make sure we don't read more frames than we allocated. */
|
|
if (total + writecount > rows)
|
|
writecount = rows - total ;
|
|
|
|
for (int ch = 0 ; ch < sfinfo.channels ; ch++)
|
|
{ for (int k = 0 ; k < writecount ; k++)
|
|
buffer [k * sfinfo.channels + ch] = data (total + k, ch) ;
|
|
} ;
|
|
|
|
if (writecount > 0)
|
|
sf_writef_float (file, buffer, writecount) ;
|
|
|
|
total += writecount ;
|
|
} while (writecount > 0 && total < rows) ;
|
|
|
|
/* Clean up. */
|
|
sf_close (file) ;
|
|
|
|
return retval ;
|
|
} /* sfwrite */
|
|
|
|
|
|
static void
|
|
str_split (const std::string & str, const std::string & delim, std::vector <std::string> & output)
|
|
{
|
|
unsigned int offset = 0 ;
|
|
size_t delim_index = 0 ;
|
|
|
|
delim_index = str.find (delim, offset) ;
|
|
|
|
while (delim_index != std::string::npos)
|
|
{
|
|
output.push_back (str.substr(offset, delim_index - offset)) ;
|
|
offset += delim_index - offset + delim.length () ;
|
|
delim_index = str.find (delim, offset) ;
|
|
}
|
|
|
|
output.push_back (str.substr (offset)) ;
|
|
} /* str_split */
|
|
|
|
static int
|
|
hash_of_str (const std::string & str)
|
|
{
|
|
int hash = 0 ;
|
|
|
|
for (unsigned k = 0 ; k < str.length () ; k++)
|
|
hash = (hash * 3) + tolower (str [k]) ;
|
|
|
|
return hash ;
|
|
} /* hash_of_str */
|
|
|
|
static int
|
|
major_format_of_hash (const std::string & str)
|
|
{ int hash ;
|
|
|
|
hash = hash_of_str (str) ;
|
|
|
|
switch (hash)
|
|
{
|
|
case 0x5c8 : /* 'wav' */ return SF_FORMAT_WAV ;
|
|
case 0xf84 : /* 'aiff' */ return SF_FORMAT_AIFF ;
|
|
case 0x198 : /* 'au' */ return SF_FORMAT_AU ;
|
|
case 0x579 : /* 'paf' */ return SF_FORMAT_PAF ;
|
|
case 0x5e5 : /* 'svx' */ return SF_FORMAT_SVX ;
|
|
case 0x1118 : /* 'nist' */ return SF_FORMAT_NIST ;
|
|
case 0x5d6 : /* 'voc' */ return SF_FORMAT_VOC ;
|
|
case 0x324a : /* 'ircam' */ return SF_FORMAT_IRCAM ;
|
|
case 0x505 : /* 'w64' */ return SF_FORMAT_W64 ;
|
|
case 0x1078 : /* 'mat4' */ return SF_FORMAT_MAT4 ;
|
|
case 0x1079 : /* 'mat5' */ return SF_FORMAT_MAT5 ;
|
|
case 0x5b8 : /* 'pvf' */ return SF_FORMAT_PVF ;
|
|
case 0x1d1 : /* 'xi' */ return SF_FORMAT_XI ;
|
|
case 0x56f : /* 'htk' */ return SF_FORMAT_HTK ;
|
|
case 0x5aa : /* 'sds' */ return SF_FORMAT_SDS ;
|
|
case 0x53d : /* 'avr' */ return SF_FORMAT_AVR ;
|
|
case 0x11d0 : /* 'wavx' */ return SF_FORMAT_WAVEX ;
|
|
case 0x569 : /* 'sd2' */ return SF_FORMAT_SD2 ;
|
|
case 0x1014 : /* 'flac' */ return SF_FORMAT_FLAC ;
|
|
case 0x504 : /* 'caf' */ return SF_FORMAT_CAF ;
|
|
case 0x5f6 : /* 'wve' */ return SF_FORMAT_WVE ;
|
|
default : break ;
|
|
} ;
|
|
|
|
printf ("%s : hash '%s' -> 0x%x\n", __func__, str.c_str (), hash) ;
|
|
|
|
return 0 ;
|
|
} /* major_format_of_hash */
|
|
|
|
static int
|
|
minor_format_of_hash (const std::string & str)
|
|
{ int hash ;
|
|
|
|
hash = hash_of_str (str) ;
|
|
|
|
switch (hash)
|
|
{
|
|
case 0x1085 : /* 'int8' */ return SF_FORMAT_PCM_S8 ;
|
|
case 0x358a : /* 'uint8' */ return SF_FORMAT_PCM_U8 ;
|
|
case 0x31b0 : /* 'int16' */ return SF_FORMAT_PCM_16 ;
|
|
case 0x31b1 : /* 'int24' */ return SF_FORMAT_PCM_24 ;
|
|
case 0x31b2 : /* 'int32' */ return SF_FORMAT_PCM_32 ;
|
|
case 0x3128 : /* 'float' */ return SF_FORMAT_FLOAT ;
|
|
case 0x937d : /* 'double' */ return SF_FORMAT_DOUBLE ;
|
|
case 0x11bd : /* 'ulaw' */ return SF_FORMAT_ULAW ;
|
|
case 0xfa1 : /* 'alaw' */ return SF_FORMAT_ALAW ;
|
|
case 0xfc361 : /* 'ima_adpcm' */ return SF_FORMAT_IMA_ADPCM ;
|
|
case 0x5739a : /* 'ms_adpcm' */ return SF_FORMAT_MS_ADPCM ;
|
|
case 0x9450 : /* 'gsm610' */ return SF_FORMAT_GSM610 ;
|
|
case 0x172a3 : /* 'g721_32' */ return SF_FORMAT_G721_32 ;
|
|
case 0x172d8 : /* 'g723_24' */ return SF_FORMAT_G723_24 ;
|
|
case 0x172da : /* 'g723_40' */ return SF_FORMAT_G723_40 ;
|
|
default : break ;
|
|
} ;
|
|
|
|
printf ("%s : hash '%s' -> 0x%x\n", __func__, str.c_str (), hash) ;
|
|
|
|
return 0 ;
|
|
} /* minor_format_of_hash */
|
|
|
|
|
|
static const char *
|
|
string_of_major_format (int format)
|
|
{
|
|
switch (format & SF_FORMAT_TYPEMASK)
|
|
{
|
|
case SF_FORMAT_WAV : return "wav" ;
|
|
case SF_FORMAT_AIFF : return "aiff" ;
|
|
case SF_FORMAT_AU : return "au" ;
|
|
case SF_FORMAT_PAF : return "paf" ;
|
|
case SF_FORMAT_SVX : return "svx" ;
|
|
case SF_FORMAT_NIST : return "nist" ;
|
|
case SF_FORMAT_VOC : return "voc" ;
|
|
case SF_FORMAT_IRCAM : return "ircam" ;
|
|
case SF_FORMAT_W64 : return "w64" ;
|
|
case SF_FORMAT_MAT4 : return "mat4" ;
|
|
case SF_FORMAT_MAT5 : return "mat5" ;
|
|
case SF_FORMAT_PVF : return "pvf" ;
|
|
case SF_FORMAT_XI : return "xi" ;
|
|
case SF_FORMAT_HTK : return "htk" ;
|
|
case SF_FORMAT_SDS : return "sds" ;
|
|
case SF_FORMAT_AVR : return "avr" ;
|
|
case SF_FORMAT_WAVEX : return "wavx" ;
|
|
case SF_FORMAT_SD2 : return "sd2" ;
|
|
case SF_FORMAT_FLAC : return "flac" ;
|
|
case SF_FORMAT_CAF : return "caf" ;
|
|
case SF_FORMAT_WVE : return "wfe" ;
|
|
default : break ;
|
|
} ;
|
|
|
|
return "unknown" ;
|
|
} /* string_of_major_format */
|
|
|
|
static const char *
|
|
string_of_minor_format (int format)
|
|
{
|
|
switch (format & SF_FORMAT_SUBMASK)
|
|
{
|
|
case SF_FORMAT_PCM_S8 : return "int8" ;
|
|
case SF_FORMAT_PCM_U8 : return "uint8" ;
|
|
case SF_FORMAT_PCM_16 : return "int16" ;
|
|
case SF_FORMAT_PCM_24 : return "int24" ;
|
|
case SF_FORMAT_PCM_32 : return "int32" ;
|
|
case SF_FORMAT_FLOAT : return "float" ;
|
|
case SF_FORMAT_DOUBLE : return "double" ;
|
|
case SF_FORMAT_ULAW : return "ulaw" ;
|
|
case SF_FORMAT_ALAW : return "alaw" ;
|
|
case SF_FORMAT_IMA_ADPCM : return "ima_adpcm" ;
|
|
case SF_FORMAT_MS_ADPCM : return "ms_adpcm" ;
|
|
case SF_FORMAT_GSM610 : return "gsm610" ;
|
|
case SF_FORMAT_G721_32 : return "g721_32" ;
|
|
case SF_FORMAT_G723_24 : return "g723_24" ;
|
|
case SF_FORMAT_G723_40 : return "g723_40" ;
|
|
default : break ;
|
|
} ;
|
|
|
|
return "unknown" ;
|
|
} /* string_of_minor_format */
|
|
|
|
static int
|
|
format_of_str (const std::string & fmt)
|
|
{
|
|
std::vector <std::string> split ;
|
|
|
|
str_split (fmt, "-", split) ;
|
|
|
|
if (split.size () != 2)
|
|
return 0 ;
|
|
|
|
int major_fmt = major_format_of_hash (split.at (0)) ;
|
|
if (major_fmt == 0)
|
|
return 0 ;
|
|
|
|
int minor_fmt = minor_format_of_hash (split.at (1)) ;
|
|
if (minor_fmt == 0)
|
|
return 0 ;
|
|
|
|
return major_fmt | minor_fmt ;
|
|
} /* format_of_str */
|
|
|
|
static void
|
|
string_of_format (std::string & fmt, int format)
|
|
{
|
|
char buffer [64] ;
|
|
|
|
snprintf (buffer, sizeof (buffer), "%s-%s", string_of_major_format (format), string_of_minor_format (format)) ;
|
|
|
|
fmt = buffer ;
|
|
|
|
return ;
|
|
} /* string_of_format */
|