2 Copyright (C) 2003-2009 Paul Brossier <piem@aubio.org>
4 This file is part of aubio.
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.
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.
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/>.
21 #include "aubio_priv.h"
24 #include "mathutils.h"
25 #include "spectral/fft.h"
26 #include "pitch/pitchyinfft.h"
28 /** pitch yinfft structure */
29 struct _aubio_pitchyinfft_t {
30 fvec_t * win; /**< temporal weighting window */
31 fvec_t * winput; /**< windowed spectrum */
32 cvec_t * res; /**< complex vector to compute square difference function */
33 fvec_t * sqrmag; /**< square difference function */
34 fvec_t * weight; /**< spectral weighting window (psychoacoustic model) */
35 cvec_t * fftout; /**< Fourier transform output */
36 aubio_fft_t * fft; /**< fft object to compute square difference function */
37 fvec_t * yinfft; /**< Yin function */
38 smpl_t tol; /**< Yin tolerance */
41 static const smpl_t freqs[] = {0., 20., 25., 31.5, 40., 50., 63., 80., 100.,
42 125., 160., 200., 250., 315., 400., 500., 630., 800., 1000., 1250.,
43 1600., 2000., 2500., 3150., 4000., 5000., 6300., 8000., 9000., 10000.,
44 12500., 15000., 20000., 25100};
46 static const smpl_t weight[] = {-75.8, -70.1, -60.8, -52.1, -44.2, -37.5,
47 -31.3, -25.6, -20.9, -16.5, -12.6, -9.6, -7.0, -4.7, -3.0, -1.8, -0.8,
48 -0.2, -0.0, 0.5, 1.6, 3.2, 5.4, 7.8, 8.1, 5.3, -2.4, -11.1, -12.8,
49 -12.2, -7.4, -17.8, -17.8, -17.8};
51 aubio_pitchyinfft_t * new_aubio_pitchyinfft (uint_t bufsize)
53 aubio_pitchyinfft_t * p = AUBIO_NEW(aubio_pitchyinfft_t);
54 p->winput = new_fvec(bufsize,1);
55 p->fft = new_aubio_fft(bufsize, 1);
56 p->fftout = new_cvec(bufsize,1);
57 p->sqrmag = new_fvec(bufsize,1);
58 p->res = new_cvec(bufsize,1);
59 p->yinfft = new_fvec(bufsize/2+1,1);
61 p->win = new_aubio_window("hanningz", bufsize);
62 p->weight = new_fvec(bufsize/2+1,1);
65 smpl_t freq = 0, a0 = 0, a1 = 0, f0 = 0, f1 = 0;
66 for (i=0; i<p->weight->length; i++) {
67 freq = (smpl_t)i/(smpl_t)bufsize*(smpl_t)44100.;
68 while (freq > freqs[j]) {
75 if (f0 == f1) { // just in case
76 p->weight->data[0][i] = a0;
77 } else if (f0 == 0) { // y = ax+b
78 p->weight->data[0][i] = (a1-a0)/f1*freq + a0;
80 p->weight->data[0][i] = (a1-a0)/(f1-f0)*freq +
81 (a0 - (a1 - a0)/(f1/f0 - 1.));
83 while (freq > freqs[j]) {
86 //AUBIO_DBG("%f\n",p->weight->data[0][i]);
87 p->weight->data[0][i] = DB2LIN(p->weight->data[0][i]);
88 //p->weight->data[0][i] = SQRT(DB2LIN(p->weight->data[0][i]));
94 void aubio_pitchyinfft_do (aubio_pitchyinfft_t * p, fvec_t * input, fvec_t * output) {
98 cvec_t * res = (cvec_t *)p->res;
99 fvec_t * yin = (fvec_t *)p->yinfft;
100 for (i=0; i < input->channels; i++){
101 l = 0; tmp = 0.; sum = 0.;
102 for (l=0; l < input->length; l++){
103 p->winput->data[0][l] = p->win->data[0][l] * input->data[i][l];
105 aubio_fft_do(p->fft,p->winput,p->fftout);
106 for (l=0; l < p->fftout->length; l++){
107 p->sqrmag->data[0][l] = SQR(p->fftout->norm[0][l]);
108 p->sqrmag->data[0][l] *= p->weight->data[0][l];
110 for (l=1; l < p->fftout->length; l++){
111 p->sqrmag->data[0][(p->fftout->length-1)*2-l] =
112 SQR(p->fftout->norm[0][l]);
113 p->sqrmag->data[0][(p->fftout->length-1)*2-l] *=
114 p->weight->data[0][l];
116 for (l=0; l < p->sqrmag->length/2+1; l++) {
117 sum += p->sqrmag->data[0][l];
120 aubio_fft_do(p->fft,p->sqrmag,res);
121 yin->data[0][0] = 1.;
122 for (tau=1; tau < yin->length; tau++) {
123 yin->data[0][tau] = sum -
124 res->norm[0][tau]*COS(res->phas[0][tau]);
125 tmp += yin->data[0][tau];
126 yin->data[0][tau] *= tau/tmp;
128 tau = fvec_min_elem(yin);
129 if (yin->data[0][tau] < p->tol) {
130 /* no interpolation */
132 /* 3 point quadratic interpolation */
133 //return fvec_quadint_min(yin,tau,1);
134 /* additional check for (unlikely) octave doubling in higher frequencies */
136 output->data[i][0] = fvec_quadint(yin,tau,i);
138 /* should compare the minimum value of each interpolated peaks */
139 halfperiod = FLOOR(tau/2+.5);
140 if (yin->data[0][halfperiod] < p->tol)
141 output->data[i][0] = fvec_quadint(yin,halfperiod,i);
143 output->data[i][0] = fvec_quadint(yin,tau,i);
146 output->data[i][0] = 0.;
151 void del_aubio_pitchyinfft(aubio_pitchyinfft_t *p){
153 del_aubio_fft(p->fft);
163 uint_t aubio_pitchyinfft_set_tolerance (aubio_pitchyinfft_t * p, smpl_t tol) {
168 smpl_t aubio_pitchyinfft_get_tolerance (aubio_pitchyinfft_t * p) {