2 Copyright (C) 2003 Paul Brossier
4 This program is free software; you can redistribute it and/or modify
5 it under the terms of the GNU General Public License as published by
6 the Free Software Foundation; either version 2 of the License, or
7 (at your option) any later version.
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 General Public License for more details.
14 You should have received a copy of the GNU General Public License
15 along with this program; if not, write to the Free Software
16 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 #include "aubio_priv.h"
23 #include "mathutils.h"
24 #include "spectral/fft.h"
25 #include "spectral/phasevoc.h"
27 /** phasevocoder internal object */
28 struct _aubio_pvoc_t {
29 uint_t win_s; /** grain length */
30 uint_t hop_s; /** overlap step */
31 uint_t channels; /** number of channels */
32 aubio_fft_t * fft; /** fft object */
33 fvec_t * synth; /** cur output grain [win_s] */
34 fvec_t * synthold; /** last input frame [win_s-hop_s] */
35 fvec_t * data; /** current input grain [win_s] */
36 fvec_t * dataold; /** last input frame [win_s-hop_s] */
37 fvec_t * w; /** grain window [win_s] */
41 /** returns data and dataold slided by hop_s */
42 static void aubio_pvoc_swapbuffers(smpl_t * data, smpl_t * dataold, const
43 smpl_t * datanew, uint_t win_s, uint_t hop_s);
45 /** do additive synthesis from 'old' and 'cur' */
46 static void aubio_pvoc_addsynth(const smpl_t * synth, smpl_t * synthold,
47 smpl_t * synthnew, uint_t win_s, uint_t hop_s);
49 void aubio_pvoc_do(aubio_pvoc_t *pv, fvec_t * datanew, cvec_t *fftgrain) {
51 for (i=0; i<pv->channels; i++) {
53 aubio_pvoc_swapbuffers(pv->data->data[i],pv->dataold->data[i],
54 datanew->data[i],pv->win_s,pv->hop_s);
57 fvec_weight(pv->data, pv->w);
61 aubio_fft_do (pv->fft,pv->data,fftgrain);
64 void aubio_pvoc_rdo(aubio_pvoc_t *pv,cvec_t * fftgrain, fvec_t * synthnew) {
67 aubio_fft_rdo(pv->fft,fftgrain,pv->synth);
69 fvec_shift(pv->synth);
70 for (i=0; i<pv->channels; i++) {
71 aubio_pvoc_addsynth(pv->synth->data[i],pv->synthold->data[i],
72 synthnew->data[i],pv->win_s,pv->hop_s);
76 aubio_pvoc_t * new_aubio_pvoc (uint_t win_s, uint_t hop_s, uint_t channels) {
77 aubio_pvoc_t * pv = AUBIO_NEW(aubio_pvoc_t);
79 /* if (win_s < 2*hop_s) {
80 AUBIO_WRN("Hop size bigger than half the window size!\n");
84 AUBIO_ERR("Hop size is smaller than 1!\n");
85 AUBIO_ERR("Resetting hop size to half the window size.\n");
89 pv->fft = new_aubio_fft(win_s,channels);
92 pv->data = new_fvec (win_s, channels);
93 pv->synth = new_fvec (win_s, channels);
95 /* new input output */
96 pv->dataold = new_fvec (win_s-hop_s, channels);
97 pv->synthold = new_fvec (win_s-hop_s, channels);
98 pv->w = new_aubio_window (win_s, aubio_win_hanningz);
100 pv->channels = channels;
107 void del_aubio_pvoc(aubio_pvoc_t *pv) {
110 del_fvec(pv->dataold);
111 del_fvec(pv->synthold);
113 del_aubio_fft(pv->fft);
117 static void aubio_pvoc_swapbuffers(smpl_t * data, smpl_t * dataold,
118 const smpl_t * datanew, uint_t win_s, uint_t hop_s)
121 for (i=0;i<win_s-hop_s;i++)
122 data[i] = dataold[i];
123 for (i=0;i<hop_s;i++)
124 data[win_s-hop_s+i] = datanew[i];
125 for (i=0;i<win_s-hop_s;i++)
126 dataold[i] = data[i+hop_s];
129 static void aubio_pvoc_addsynth(const smpl_t * synth, smpl_t * synthold,
130 smpl_t * synthnew, uint_t win_s, uint_t hop_s)
133 smpl_t scale = 2*hop_s/(win_s+.0);
134 /* add new synth to old one and put result in synthnew */
135 for (i=0;i<hop_s;i++)
136 synthnew[i] = synthold[i]+synth[i]*scale;
138 for (i=0;i<win_s-2*hop_s;i++)
139 synthold[i] = synthold[i+hop_s];
140 /* erase last frame in synthold */
141 for (i=win_s-hop_s;i<win_s;i++)
142 synthold[i-hop_s]=0.;
144 for (i=0;i<win_s-hop_s;i++)
145 synthold[i] += synth[i+hop_s]*scale;