source: src/pitch/pitchyinfft.c @ 8bfef30

feature/autosinkfeature/cnnfeature/crepefeature/crepe_orgfeature/timestretchfix/ffmpeg5
Last change on this file since 8bfef30 was 802e8ab, checked in by Paul Brossier <piem@piem.org>, 6 years ago

src/pitch/pitchyinfft.c: comment out debug output

  • Property mode set to 100644
File size: 6.6 KB
RevLine 
[650e39b]1/*
[a5f4b7d]2  Copyright (C) 2003-2013 Paul Brossier <piem@aubio.org>
[650e39b]3
[e6a78ea]4  This file is part of aubio.
[650e39b]5
[e6a78ea]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/>.
[650e39b]18
19*/
20
21#include "aubio_priv.h"
[6c7d49b]22#include "fvec.h"
23#include "cvec.h"
[650e39b]24#include "mathutils.h"
[32d6958]25#include "spectral/fft.h"
[2d8cffa]26#include "pitch/pitchyinfft.h"
[650e39b]27
[91879d9]28/** pitch yinfft structure */
[fddfa64]29struct _aubio_pitchyinfft_t
30{
31  fvec_t *win;        /**< temporal weighting window */
32  fvec_t *winput;     /**< windowed spectrum */
33  fvec_t *sqrmag;     /**< square difference function */
34  fvec_t *weight;     /**< spectral weighting window (psychoacoustic model) */
[4a95f83]35  fvec_t *fftout;     /**< Fourier transform output */
[fddfa64]36  aubio_fft_t *fft;   /**< fft object to compute square difference function */
37  fvec_t *yinfft;     /**< Yin function */
[22d33e2]38  smpl_t tol;         /**< Yin tolerance */
[3e48568]39  uint_t peak_pos;    /**< currently selected peak pos*/
[9c9202f]40  uint_t short_period; /** shortest period under which to check for octave error */
[650e39b]41};
42
[88fee8f]43static const smpl_t freqs[] = {
44     0.,    20.,    25.,   31.5,    40.,    50.,    63.,    80.,   100.,   125.,
45   160.,   200.,   250.,   315.,   400.,   500.,   630.,   800.,  1000.,  1250.,
46  1600.,  2000.,  2500.,  3150.,  4000.,  5000.,  6300.,  8000.,  9000., 10000.,
[af4f9e6]47 12500., 15000., 20000., 25100., -1.
[fddfa64]48};
[650e39b]49
[88fee8f]50static const smpl_t weight[] = {
51  -75.8,  -70.1,  -60.8,  -52.1,  -44.2,  -37.5,  -31.3,  -25.6,  -20.9,  -16.5,
52  -12.6,  -9.60,  -7.00,  -4.70,  -3.00,  -1.80,  -0.80,  -0.20,  -0.00,   0.50,
53   1.60,   3.20,   5.40,   7.80,   8.10,   5.30,  -2.40,  -11.1,  -12.8,  -12.2,
54  -7.40,  -17.8,  -17.8,  -17.8
[fddfa64]55};
[650e39b]56
[fddfa64]57aubio_pitchyinfft_t *
[9c9202f]58new_aubio_pitchyinfft (uint_t samplerate, uint_t bufsize)
[650e39b]59{
[c21acb9]60  uint_t i = 0, j = 1;
61  smpl_t freq = 0, a0 = 0, a1 = 0, f0 = 0, f1 = 0;
[fddfa64]62  aubio_pitchyinfft_t *p = AUBIO_NEW (aubio_pitchyinfft_t);
[168337e]63  p->winput = new_fvec (bufsize);
64  p->fft = new_aubio_fft (bufsize);
[0f2c1f4]65  if (!p->fft) goto beach;
[4a95f83]66  p->fftout = new_fvec (bufsize);
[168337e]67  p->sqrmag = new_fvec (bufsize);
68  p->yinfft = new_fvec (bufsize / 2 + 1);
[fddfa64]69  p->tol = 0.85;
[3e48568]70  p->peak_pos = 0;
[fddfa64]71  p->win = new_aubio_window ("hanningz", bufsize);
[168337e]72  p->weight = new_fvec (bufsize / 2 + 1);
73  for (i = 0; i < p->weight->length; i++) {
[9c9202f]74    freq = (smpl_t) i / (smpl_t) bufsize *(smpl_t) samplerate;
[af4f9e6]75    while (freq > freqs[j] && freqs[j] > 0) {
[802e8ab]76      //AUBIO_DBG("freq %3.5f > %3.5f \tsamplerate %d (Hz) \t"
77      //    "(weight length %d, bufsize %d) %d %d\n", freq, freqs[j],
78      //    samplerate, p->weight->length, bufsize, i, j);
[168337e]79      j += 1;
[10cf306]80    }
[168337e]81    a0 = weight[j - 1];
82    f0 = freqs[j - 1];
83    a1 = weight[j];
84    f1 = freqs[j];
85    if (f0 == f1) {           // just in case
86      p->weight->data[i] = a0;
87    } else if (f0 == 0) {     // y = ax+b
88      p->weight->data[i] = (a1 - a0) / f1 * freq + a0;
89    } else {
90      p->weight->data[i] = (a1 - a0) / (f1 - f0) * freq +
91          (a0 - (a1 - a0) / (f1 / f0 - 1.));
92    }
93    while (freq > freqs[j]) {
94      j += 1;
95    }
96    //AUBIO_DBG("%f\n",p->weight->data[i]);
97    p->weight->data[i] = DB2LIN (p->weight->data[i]);
98    //p->weight->data[i] = SQRT(DB2LIN(p->weight->data[i]));
[650e39b]99  }
[9c9202f]100  // check for octave errors above 1300 Hz
101  p->short_period = (uint_t)ROUND(samplerate / 1300.);
[650e39b]102  return p;
[0f2c1f4]103
104beach:
105  if (p->winput) del_fvec(p->winput);
106  AUBIO_FREE(p);
107  return NULL;
[650e39b]108}
109
[fddfa64]110void
[ce3ff2b]111aubio_pitchyinfft_do (aubio_pitchyinfft_t * p, const fvec_t * input, fvec_t * output)
[fddfa64]112{
[168337e]113  uint_t tau, l;
[a5f4b7d]114  uint_t length = p->fftout->length;
[650e39b]115  uint_t halfperiod;
[a5f4b7d]116  fvec_t *fftout = p->fftout;
117  fvec_t *yin = p->yinfft;
118  smpl_t tmp = 0., sum = 0.;
119  // window the input
[c9e3a4e]120  fvec_weighted_copy(input, p->win, p->winput);
[a5f4b7d]121  // get the real / imag parts of its fft
122  aubio_fft_do_complex (p->fft, p->winput, fftout);
123  // get the squared magnitude spectrum, applying some weight
124  p->sqrmag->data[0] = SQR(fftout->data[0]);
[8da0033]125  p->sqrmag->data[0] *= p->weight->data[0];
[4a95f83]126  for (l = 1; l < length / 2; l++) {
[a5f4b7d]127    p->sqrmag->data[l] = SQR(fftout->data[l]) + SQR(fftout->data[length - l]);
[168337e]128    p->sqrmag->data[l] *= p->weight->data[l];
[a5f4b7d]129    p->sqrmag->data[length - l] = p->sqrmag->data[l];
[168337e]130  }
[a5f4b7d]131  p->sqrmag->data[length / 2] = SQR(fftout->data[length / 2]);
[4a95f83]132  p->sqrmag->data[length / 2] *= p->weight->data[length / 2];
[a5f4b7d]133  // get sum of weighted squared mags
[4a95f83]134  for (l = 0; l < length / 2 + 1; l++) {
[168337e]135    sum += p->sqrmag->data[l];
136  }
137  sum *= 2.;
[a5f4b7d]138  // get the real / imag parts of the fft of the squared magnitude
139  aubio_fft_do_complex (p->fft, p->sqrmag, fftout);
[168337e]140  yin->data[0] = 1.;
141  for (tau = 1; tau < yin->length; tau++) {
[a5f4b7d]142    // compute the square differences
143    yin->data[tau] = sum - fftout->data[tau];
144    // and the cumulative mean normalized difference function
[168337e]145    tmp += yin->data[tau];
[e391790]146    if (tmp != 0) {
147      yin->data[tau] *= tau / tmp;
148    } else {
149      yin->data[tau] = 1.;
150    }
[168337e]151  }
[a5f4b7d]152  // find best candidates
[168337e]153  tau = fvec_min_elem (yin);
154  if (yin->data[tau] < p->tol) {
[a5f4b7d]155    // no interpolation, directly return the period as an integer
156    //output->data[0] = tau;
157    //return;
158
159    // 3 point quadratic interpolation
[dc7f2cc]160    //return fvec_quadratic_peak_pos (yin,tau,1);
[168337e]161    /* additional check for (unlikely) octave doubling in higher frequencies */
[9c9202f]162    if (tau > p->short_period) {
[dc7f2cc]163      output->data[0] = fvec_quadratic_peak_pos (yin, tau);
[10cf306]164    } else {
[168337e]165      /* should compare the minimum value of each interpolated peaks */
166      halfperiod = FLOOR (tau / 2 + .5);
167      if (yin->data[halfperiod] < p->tol)
[3e48568]168        p->peak_pos = halfperiod;
[168337e]169      else
[3e48568]170        p->peak_pos = tau;
171      output->data[0] = fvec_quadratic_peak_pos (yin, p->peak_pos);
[10cf306]172    }
[168337e]173  } else {
[3e48568]174    p->peak_pos = 0;
[168337e]175    output->data[0] = 0.;
[22d33e2]176  }
[650e39b]177}
178
[fddfa64]179void
180del_aubio_pitchyinfft (aubio_pitchyinfft_t * p)
181{
182  del_fvec (p->win);
183  del_aubio_fft (p->fft);
184  del_fvec (p->yinfft);
185  del_fvec (p->sqrmag);
[4a95f83]186  del_fvec (p->fftout);
[fddfa64]187  del_fvec (p->winput);
188  del_fvec (p->weight);
189  AUBIO_FREE (p);
[650e39b]190}
[22d33e2]191
[5284e0d]192smpl_t
193aubio_pitchyinfft_get_confidence (aubio_pitchyinfft_t * o) {
[3e48568]194  return 1. - o->yinfft->data[o->peak_pos];
[5284e0d]195}
196
[fddfa64]197uint_t
198aubio_pitchyinfft_set_tolerance (aubio_pitchyinfft_t * p, smpl_t tol)
199{
[22d33e2]200  p->tol = tol;
201  return 0;
202}
203
[fddfa64]204smpl_t
205aubio_pitchyinfft_get_tolerance (aubio_pitchyinfft_t * p)
206{
[22d33e2]207  return p->tol;
208}
Note: See TracBrowser for help on using the repository browser.