3471e34c0c0bedbb89c092c11727f258f6fb4c08
[Faustine.git] / interpretor / lib / src / libsndfile-1.0.25 / src / mat4.c
1 /*
2 ** Copyright (C) 2002-2011 Erik de Castro Lopo <erikd@mega-nerd.com>
3 **
4 ** This program is free software; you can redistribute it and/or modify
5 ** it under the terms of the GNU Lesser General Public License as published by
6 ** the Free Software Foundation; either version 2.1 of the License, or
7 ** (at your option) any later version.
8 **
9 ** This program is distributed in the hope that it will be useful,
10 ** but WITHOUT ANY WARRANTY; without even the implied warranty of
11 ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 ** GNU Lesser General Public License for more details.
13 **
14 ** You should have received a copy of the GNU Lesser General Public License
15 ** along with this program; if not, write to the Free Software
16 ** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
17 */
18
19 #include "sfconfig.h"
20
21 #include <stdio.h>
22 #include <fcntl.h>
23 #include <string.h>
24 #include <ctype.h>
25 #include <math.h>
26
27 #include "sndfile.h"
28 #include "sfendian.h"
29 #include "common.h"
30
31 /*------------------------------------------------------------------------------
32 ** Information on how to decode and encode this file was obtained in a PDF
33 ** file which I found on http://www.wotsit.org/.
34 ** Also did a lot of testing with GNU Octave but do not have access to
35 ** Matlab (tm) and so could not test it there.
36 */
37
38 /*------------------------------------------------------------------------------
39 ** Macros to handle big/little endian issues.
40 */
41
42 #define MAT4_BE_DOUBLE (MAKE_MARKER (0, 0, 0x03, 0xE8))
43 #define MAT4_LE_DOUBLE (MAKE_MARKER (0, 0, 0, 0))
44
45 #define MAT4_BE_FLOAT (MAKE_MARKER (0, 0, 0x03, 0xF2))
46 #define MAT4_LE_FLOAT (MAKE_MARKER (0x0A, 0, 0, 0))
47
48 #define MAT4_BE_PCM_32 (MAKE_MARKER (0, 0, 0x03, 0xFC))
49 #define MAT4_LE_PCM_32 (MAKE_MARKER (0x14, 0, 0, 0))
50
51 #define MAT4_BE_PCM_16 (MAKE_MARKER (0, 0, 0x04, 0x06))
52 #define MAT4_LE_PCM_16 (MAKE_MARKER (0x1E, 0, 0, 0))
53
54 /* Can't see any reason to ever implement this. */
55 #define MAT4_BE_PCM_U8 (MAKE_MARKER (0, 0, 0x04, 0x1A))
56 #define MAT4_LE_PCM_U8 (MAKE_MARKER (0x32, 0, 0, 0))
57
58 /*------------------------------------------------------------------------------
59 ** Private static functions.
60 */
61
62 static int mat4_close (SF_PRIVATE *psf) ;
63
64 static int mat4_format_to_encoding (int format, int endian) ;
65
66 static int mat4_write_header (SF_PRIVATE *psf, int calc_length) ;
67 static int mat4_read_header (SF_PRIVATE *psf) ;
68
69 static const char * mat4_marker_to_str (int marker) ;
70
71 /*------------------------------------------------------------------------------
72 ** Public function.
73 */
74
75 int
76 mat4_open (SF_PRIVATE *psf)
77 { int subformat, error = 0 ;
78
79 if (psf->file.mode == SFM_READ || (psf->file.mode == SFM_RDWR && psf->filelength > 0))
80 { if ((error = mat4_read_header (psf)))
81 return error ;
82 } ;
83
84 if ((SF_CONTAINER (psf->sf.format)) != SF_FORMAT_MAT4)
85 return SFE_BAD_OPEN_FORMAT ;
86
87 subformat = SF_CODEC (psf->sf.format) ;
88
89 if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
90 { if (psf->is_pipe)
91 return SFE_NO_PIPE_WRITE ;
92
93 psf->endian = SF_ENDIAN (psf->sf.format) ;
94 if (CPU_IS_LITTLE_ENDIAN && (psf->endian == SF_ENDIAN_CPU || psf->endian == 0))
95 psf->endian = SF_ENDIAN_LITTLE ;
96 else if (CPU_IS_BIG_ENDIAN && (psf->endian == SF_ENDIAN_CPU || psf->endian == 0))
97 psf->endian = SF_ENDIAN_BIG ;
98
99 if ((error = mat4_write_header (psf, SF_FALSE)))
100 return error ;
101
102 psf->write_header = mat4_write_header ;
103 } ;
104
105 psf->container_close = mat4_close ;
106
107 psf->blockwidth = psf->bytewidth * psf->sf.channels ;
108
109 switch (subformat)
110 { case SF_FORMAT_PCM_16 :
111 case SF_FORMAT_PCM_32 :
112 error = pcm_init (psf) ;
113 break ;
114
115 case SF_FORMAT_FLOAT :
116 error = float32_init (psf) ;
117 break ;
118
119 case SF_FORMAT_DOUBLE :
120 error = double64_init (psf) ;
121 break ;
122
123 default : break ;
124 } ;
125
126 if (error)
127 return error ;
128
129 return error ;
130 } /* mat4_open */
131
132 /*------------------------------------------------------------------------------
133 */
134
135 static int
136 mat4_close (SF_PRIVATE *psf)
137 {
138 if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
139 mat4_write_header (psf, SF_TRUE) ;
140
141 return 0 ;
142 } /* mat4_close */
143
144 /*------------------------------------------------------------------------------
145 */
146
147 static int
148 mat4_write_header (SF_PRIVATE *psf, int calc_length)
149 { sf_count_t current ;
150 int encoding ;
151 double samplerate ;
152
153 current = psf_ftell (psf) ;
154
155 if (calc_length)
156 { psf->filelength = psf_get_filelen (psf) ;
157
158 psf->datalength = psf->filelength - psf->dataoffset ;
159 if (psf->dataend)
160 psf->datalength -= psf->filelength - psf->dataend ;
161
162 psf->sf.frames = psf->datalength / (psf->bytewidth * psf->sf.channels) ;
163 } ;
164
165 encoding = mat4_format_to_encoding (SF_CODEC (psf->sf.format), psf->endian) ;
166
167 if (encoding == -1)
168 return SFE_BAD_OPEN_FORMAT ;
169
170 /* Reset the current header length to zero. */
171 psf->header [0] = 0 ;
172 psf->headindex = 0 ;
173 psf_fseek (psf, 0, SEEK_SET) ;
174
175 /* Need sample rate as a double for writing to the header. */
176 samplerate = psf->sf.samplerate ;
177
178 if (psf->endian == SF_ENDIAN_BIG)
179 { psf_binheader_writef (psf, "Em444", MAT4_BE_DOUBLE, 1, 1, 0) ;
180 psf_binheader_writef (psf, "E4bd", 11, "samplerate", make_size_t (11), samplerate) ;
181 psf_binheader_writef (psf, "tEm484", encoding, psf->sf.channels, psf->sf.frames, 0) ;
182 psf_binheader_writef (psf, "E4b", 9, "wavedata", make_size_t (9)) ;
183 }
184 else if (psf->endian == SF_ENDIAN_LITTLE)
185 { psf_binheader_writef (psf, "em444", MAT4_LE_DOUBLE, 1, 1, 0) ;
186 psf_binheader_writef (psf, "e4bd", 11, "samplerate", make_size_t (11), samplerate) ;
187 psf_binheader_writef (psf, "tem484", encoding, psf->sf.channels, psf->sf.frames, 0) ;
188 psf_binheader_writef (psf, "e4b", 9, "wavedata", make_size_t (9)) ;
189 }
190 else
191 return SFE_BAD_OPEN_FORMAT ;
192
193 /* Header construction complete so write it out. */
194 psf_fwrite (psf->header, psf->headindex, 1, psf) ;
195
196 if (psf->error)
197 return psf->error ;
198
199 psf->dataoffset = psf->headindex ;
200
201 if (current > 0)
202 psf_fseek (psf, current, SEEK_SET) ;
203
204 return psf->error ;
205 } /* mat4_write_header */
206
207 static int
208 mat4_read_header (SF_PRIVATE *psf)
209 { int marker, rows, cols, imag ;
210 unsigned namesize ;
211 double value ;
212 const char *marker_str ;
213 char name [64] ;
214
215 psf_binheader_readf (psf, "pm", 0, &marker) ;
216
217 /* MAT4 file must start with a double for the samplerate. */
218 if (marker == MAT4_BE_DOUBLE)
219 { psf->endian = psf->rwf_endian = SF_ENDIAN_BIG ;
220 marker_str = "big endian double" ;
221 }
222 else if (marker == MAT4_LE_DOUBLE)
223 { psf->endian = psf->rwf_endian = SF_ENDIAN_LITTLE ;
224 marker_str = "little endian double" ;
225 }
226 else
227 return SFE_UNIMPLEMENTED ;
228
229 psf_log_printf (psf, "GNU Octave 2.0 / MATLAB v4.2 format\nMarker : %s\n", marker_str) ;
230
231 psf_binheader_readf (psf, "444", &rows, &cols, &imag) ;
232
233 psf_log_printf (psf, " Rows : %d\n Cols : %d\n Imag : %s\n", rows, cols, imag ? "True" : "False") ;
234
235 psf_binheader_readf (psf, "4", &namesize) ;
236
237 if (namesize >= SIGNED_SIZEOF (name))
238 return SFE_MAT4_BAD_NAME ;
239
240 psf_binheader_readf (psf, "b", name, namesize) ;
241 name [namesize] = 0 ;
242
243 psf_log_printf (psf, " Name : %s\n", name) ;
244
245 psf_binheader_readf (psf, "d", &value) ;
246
247 snprintf (psf->u.cbuf, sizeof (psf->u.cbuf), " Value : %f\n", value) ;
248 psf_log_printf (psf, psf->u.cbuf) ;
249
250 if ((rows != 1) || (cols != 1))
251 return SFE_MAT4_NO_SAMPLERATE ;
252
253 psf->sf.samplerate = lrint (value) ;
254
255 /* Now write out the audio data. */
256
257 psf_binheader_readf (psf, "m", &marker) ;
258
259 psf_log_printf (psf, "Marker : %s\n", mat4_marker_to_str (marker)) ;
260
261 psf_binheader_readf (psf, "444", &rows, &cols, &imag) ;
262
263 psf_log_printf (psf, " Rows : %d\n Cols : %d\n Imag : %s\n", rows, cols, imag ? "True" : "False") ;
264
265 psf_binheader_readf (psf, "4", &namesize) ;
266
267 if (namesize >= SIGNED_SIZEOF (name))
268 return SFE_MAT4_BAD_NAME ;
269
270 psf_binheader_readf (psf, "b", name, namesize) ;
271 name [namesize] = 0 ;
272
273 psf_log_printf (psf, " Name : %s\n", name) ;
274
275 psf->dataoffset = psf_ftell (psf) ;
276
277 if (rows == 0 && cols == 0)
278 { psf_log_printf (psf, "*** Error : zero channel count.\n") ;
279 return SFE_CHANNEL_COUNT_ZERO ;
280 } ;
281
282 psf->sf.channels = rows ;
283 psf->sf.frames = cols ;
284
285 psf->sf.format = psf->endian | SF_FORMAT_MAT4 ;
286 switch (marker)
287 { case MAT4_BE_DOUBLE :
288 case MAT4_LE_DOUBLE :
289 psf->sf.format |= SF_FORMAT_DOUBLE ;
290 psf->bytewidth = 8 ;
291 break ;
292
293 case MAT4_BE_FLOAT :
294 case MAT4_LE_FLOAT :
295 psf->sf.format |= SF_FORMAT_FLOAT ;
296 psf->bytewidth = 4 ;
297 break ;
298
299 case MAT4_BE_PCM_32 :
300 case MAT4_LE_PCM_32 :
301 psf->sf.format |= SF_FORMAT_PCM_32 ;
302 psf->bytewidth = 4 ;
303 break ;
304
305 case MAT4_BE_PCM_16 :
306 case MAT4_LE_PCM_16 :
307 psf->sf.format |= SF_FORMAT_PCM_16 ;
308 psf->bytewidth = 2 ;
309 break ;
310
311 default :
312 psf_log_printf (psf, "*** Error : Bad marker %08X\n", marker) ;
313 return SFE_UNIMPLEMENTED ;
314 } ;
315
316 if ((psf->filelength - psf->dataoffset) < psf->sf.channels * psf->sf.frames * psf->bytewidth)
317 { psf_log_printf (psf, "*** File seems to be truncated. %D <--> %D\n",
318 psf->filelength - psf->dataoffset, psf->sf.channels * psf->sf.frames * psf->bytewidth) ;
319 }
320 else if ((psf->filelength - psf->dataoffset) > psf->sf.channels * psf->sf.frames * psf->bytewidth)
321 psf->dataend = psf->dataoffset + rows * cols * psf->bytewidth ;
322
323 psf->datalength = psf->filelength - psf->dataoffset - psf->dataend ;
324
325 psf->sf.sections = 1 ;
326
327 return 0 ;
328 } /* mat4_read_header */
329
330 static int
331 mat4_format_to_encoding (int format, int endian)
332 {
333 switch (format | endian)
334 { case (SF_FORMAT_PCM_16 | SF_ENDIAN_BIG) :
335 return MAT4_BE_PCM_16 ;
336
337 case (SF_FORMAT_PCM_16 | SF_ENDIAN_LITTLE) :
338 return MAT4_LE_PCM_16 ;
339
340 case (SF_FORMAT_PCM_32 | SF_ENDIAN_BIG) :
341 return MAT4_BE_PCM_32 ;
342
343 case (SF_FORMAT_PCM_32 | SF_ENDIAN_LITTLE) :
344 return MAT4_LE_PCM_32 ;
345
346 case (SF_FORMAT_FLOAT | SF_ENDIAN_BIG) :
347 return MAT4_BE_FLOAT ;
348
349 case (SF_FORMAT_FLOAT | SF_ENDIAN_LITTLE) :
350 return MAT4_LE_FLOAT ;
351
352 case (SF_FORMAT_DOUBLE | SF_ENDIAN_BIG) :
353 return MAT4_BE_DOUBLE ;
354
355 case (SF_FORMAT_DOUBLE | SF_ENDIAN_LITTLE) :
356 return MAT4_LE_DOUBLE ;
357
358 default : break ;
359 } ;
360
361 return -1 ;
362 } /* mat4_format_to_encoding */
363
364 static const char *
365 mat4_marker_to_str (int marker)
366 { static char str [32] ;
367
368 switch (marker)
369 {
370 case MAT4_BE_PCM_16 : return "big endian 16 bit PCM" ;
371 case MAT4_LE_PCM_16 : return "little endian 16 bit PCM" ;
372
373 case MAT4_BE_PCM_32 : return "big endian 32 bit PCM" ;
374 case MAT4_LE_PCM_32 : return "little endian 32 bit PCM" ;
375
376
377 case MAT4_BE_FLOAT : return "big endian float" ;
378 case MAT4_LE_FLOAT : return "big endian float" ;
379
380 case MAT4_BE_DOUBLE : return "big endian double" ;
381 case MAT4_LE_DOUBLE : return "little endian double" ;
382 } ;
383
384 /* This is a little unsafe but is really only for debugging. */
385 str [sizeof (str) - 1] = 0 ;
386 snprintf (str, sizeof (str) - 1, "%08X", marker) ;
387 return str ;
388 } /* mat4_marker_to_str */
389