4256a49e68f31f460b66730b06f91302c2c17f5c
[aubio.git] / src / io / sink_sndfile.c
1 /*
2   Copyright (C) 2012-2014 Paul Brossier <piem@aubio.org>
3
4   This file is part of aubio.
5
6   aubio is free software: you can redistribute it and/or modify
7   it under the terms of the GNU General Public License as published by
8   the Free Software Foundation, either version 3 of the License, or
9   (at your option) any later version.
10
11   aubio is distributed in the hope that it will be useful,
12   but WITHOUT ANY WARRANTY; without even the implied warranty of
13   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14   GNU General Public License for more details.
15
16   You should have received a copy of the GNU General Public License
17   along with aubio.  If not, see <http://www.gnu.org/licenses/>.
18
19 */
20
21
22 #include "config.h"
23
24 #ifdef HAVE_SNDFILE
25
26 #include <sndfile.h>
27
28 #include "aubio_priv.h"
29 #include "fvec.h"
30 #include "fmat.h"
31 #include "io/sink_sndfile.h"
32 #include "io/ioutils.h"
33
34 #define MAX_CHANNELS 6
35 #define MAX_SIZE 4096
36
37 #if !HAVE_AUBIO_DOUBLE
38 #define aubio_sf_write_smpl sf_write_float
39 #else /* HAVE_AUBIO_DOUBLE */
40 #define aubio_sf_write_smpl sf_write_double
41 #endif /* HAVE_AUBIO_DOUBLE */
42
43 struct _aubio_sink_sndfile_t {
44   uint_t samplerate;
45   uint_t channels;
46   char_t *path;
47
48   uint_t max_size;
49
50   SNDFILE *handle;
51   uint_t scratch_size;
52   smpl_t *scratch_data;
53 };
54
55 uint_t aubio_sink_sndfile_open(aubio_sink_sndfile_t *s);
56
57 aubio_sink_sndfile_t * new_aubio_sink_sndfile(const char_t * path, uint_t samplerate) {
58   aubio_sink_sndfile_t * s = AUBIO_NEW(aubio_sink_sndfile_t);
59   s->max_size = MAX_SIZE;
60
61   if (path == NULL) {
62     AUBIO_ERR("sink_sndfile: Aborted opening null path\n");
63     return NULL;
64   }
65
66   if (s->path) AUBIO_FREE(s->path);
67   s->path = AUBIO_ARRAY(char_t, strnlen(path, PATH_MAX) + 1);
68   strncpy(s->path, path, strnlen(path, PATH_MAX) + 1);
69
70   s->samplerate = 0;
71   s->channels = 0;
72
73   // zero samplerate given. do not open yet
74   if ((sint_t)samplerate == 0) {
75     return s;
76   }
77   // invalid samplerate given, abort
78   if (aubio_io_validate_samplerate("sink_sndfile", s->path, samplerate)) {
79     goto beach;
80   }
81
82   s->samplerate = samplerate;
83   s->channels = 1;
84
85   if (aubio_sink_sndfile_open(s) != AUBIO_OK) {;
86     goto beach;
87   }
88   return s;
89
90 beach:
91   del_aubio_sink_sndfile(s);
92   return NULL;
93 }
94
95 uint_t aubio_sink_sndfile_preset_samplerate(aubio_sink_sndfile_t *s, uint_t samplerate)
96 {
97   if (aubio_io_validate_samplerate("sink_sndfile", s->path, samplerate)) {
98     return AUBIO_FAIL;
99   }
100   s->samplerate = samplerate;
101   // automatically open when both samplerate and channels have been set
102   if (s->samplerate != 0 && s->channels != 0) {
103     return aubio_sink_sndfile_open(s);
104   }
105   return AUBIO_OK;
106 }
107
108 uint_t aubio_sink_sndfile_preset_channels(aubio_sink_sndfile_t *s, uint_t channels)
109 {
110   if (aubio_io_validate_channels("sink_sndfile", s->path, channels)) {
111     return AUBIO_FAIL;
112   }
113   s->channels = channels;
114   // automatically open when both samplerate and channels have been set
115   if (s->samplerate != 0 && s->channels != 0) {
116     return aubio_sink_sndfile_open(s);
117   }
118   return AUBIO_OK;
119 }
120
121 uint_t aubio_sink_sndfile_get_samplerate(const aubio_sink_sndfile_t *s)
122 {
123   return s->samplerate;
124 }
125
126 uint_t aubio_sink_sndfile_get_channels(const aubio_sink_sndfile_t *s)
127 {
128   return s->channels;
129 }
130
131 uint_t aubio_sink_sndfile_open(aubio_sink_sndfile_t *s) {
132   /* set output format */
133   SF_INFO sfinfo;
134   AUBIO_MEMSET(&sfinfo, 0, sizeof (sfinfo));
135   sfinfo.samplerate = s->samplerate;
136   sfinfo.channels   = s->channels;
137   sfinfo.format     = SF_FORMAT_WAV | SF_FORMAT_PCM_16;
138
139   /* try creating the file */
140   s->handle = sf_open (s->path, SFM_WRITE, &sfinfo);
141
142   if (s->handle == NULL) {
143     /* show libsndfile err msg */
144     AUBIO_ERR("sink_sndfile: Failed opening \"%s\" with %d channels, %dHz: %s\n",
145         s->path, s->channels, s->samplerate, sf_strerror (NULL));
146     return AUBIO_FAIL;
147   }
148
149   s->scratch_size = s->max_size*s->channels;
150   /* allocate data for de/interleaving reallocated when needed. */
151   if (s->scratch_size >= MAX_SIZE * MAX_CHANNELS) {
152     AUBIO_ERR("sink_sndfile: %d x %d exceeds maximum aubio_sink_sndfile buffer size %d\n",
153         s->max_size, s->channels, MAX_CHANNELS * MAX_CHANNELS);
154     return AUBIO_FAIL;
155   }
156   s->scratch_data = AUBIO_ARRAY(smpl_t,s->scratch_size);
157
158   return AUBIO_OK;
159 }
160
161 void aubio_sink_sndfile_do(aubio_sink_sndfile_t *s, fvec_t * write_data, uint_t write){
162   uint_t i, j, channels = s->channels;
163   int nsamples = 0;
164   smpl_t *pwrite;
165   sf_count_t written_frames;
166
167   if (write > s->max_size) {
168     AUBIO_WRN("sink_sndfile: trying to write %d frames, but only %d can be written at a time\n",
169       write, s->max_size);
170     write = s->max_size;
171   }
172
173   nsamples = channels * write;
174
175   /* interleaving data  */
176   for ( i = 0; i < channels; i++) {
177     pwrite = (smpl_t *)write_data->data;
178     for (j = 0; j < write; j++) {
179       s->scratch_data[channels*j+i] = pwrite[j];
180     }
181   }
182
183   written_frames = aubio_sf_write_smpl (s->handle, s->scratch_data, nsamples);
184   if (written_frames/channels != write) {
185     AUBIO_WRN("sink_sndfile: trying to write %d frames to %s, but only %d could be written\n",
186       write, s->path, (uint_t)written_frames);
187   }
188   return;
189 }
190
191 void aubio_sink_sndfile_do_multi(aubio_sink_sndfile_t *s, fmat_t * write_data, uint_t write){
192   uint_t i, j, channels = s->channels;
193   int nsamples = 0;
194   smpl_t *pwrite;
195   sf_count_t written_frames;
196
197   if (write > s->max_size) {
198     AUBIO_WRN("sink_sndfile: trying to write %d frames, but only %d can be written at a time\n",
199       write, s->max_size);
200     write = s->max_size;
201   }
202
203   nsamples = channels * write;
204
205   /* interleaving data  */
206   for ( i = 0; i < write_data->height; i++) {
207     pwrite = (smpl_t *)write_data->data[i];
208     for (j = 0; j < write; j++) {
209       s->scratch_data[channels*j+i] = pwrite[j];
210     }
211   }
212
213   written_frames = aubio_sf_write_smpl (s->handle, s->scratch_data, nsamples);
214   if (written_frames/channels != write) {
215     AUBIO_WRN("sink_sndfile: trying to write %d frames to %s, but only %d could be written\n",
216       write, s->path, (uint_t)written_frames);
217   }
218   return;
219 }
220
221 uint_t aubio_sink_sndfile_close (aubio_sink_sndfile_t *s) {
222   if (!s->handle) {
223     return AUBIO_FAIL;
224   }
225   if (sf_close(s->handle)) {
226     AUBIO_ERR("sink_sndfile: Error closing file %s: %s", s->path, sf_strerror (NULL));
227     return AUBIO_FAIL;
228   }
229   s->handle = NULL;
230   return AUBIO_OK;
231 }
232
233 void del_aubio_sink_sndfile(aubio_sink_sndfile_t * s){
234   if (!s) return;
235   if (s->path) AUBIO_FREE(s->path);
236   aubio_sink_sndfile_close(s);
237   AUBIO_FREE(s->scratch_data);
238   AUBIO_FREE(s);
239 }
240
241 #endif /* HAVE_SNDFILE */