[96fb8ad] | 1 | /* |
---|
[7380327] | 2 | Copyright (C) 2003-2014 Paul Brossier <piem@aubio.org> |
---|
[96fb8ad] | 3 | |
---|
[a6db140] | 4 | This file is part of aubio. |
---|
[96fb8ad] | 5 | |
---|
[a6db140] | 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. |
---|
[96fb8ad] | 10 | |
---|
[a6db140] | 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/>. |
---|
[96fb8ad] | 18 | |
---|
| 19 | */ |
---|
| 20 | |
---|
| 21 | /* see in mathutils.h for doc */ |
---|
| 22 | |
---|
| 23 | #include "aubio_priv.h" |
---|
[6c7d49b] | 24 | #include "fvec.h" |
---|
[96fb8ad] | 25 | #include "mathutils.h" |
---|
[83963b3] | 26 | #include "musicutils.h" |
---|
[714380d] | 27 | #include "config.h" |
---|
[96fb8ad] | 28 | |
---|
[407bba9] | 29 | /** Window types */ |
---|
| 30 | typedef enum |
---|
| 31 | { |
---|
| 32 | aubio_win_rectangle, |
---|
| 33 | aubio_win_hamming, |
---|
| 34 | aubio_win_hanning, |
---|
| 35 | aubio_win_hanningz, |
---|
| 36 | aubio_win_blackman, |
---|
| 37 | aubio_win_blackman_harris, |
---|
| 38 | aubio_win_gaussian, |
---|
| 39 | aubio_win_welch, |
---|
| 40 | aubio_win_parzen, |
---|
| 41 | aubio_win_default = aubio_win_hanningz, |
---|
| 42 | } aubio_window_type; |
---|
| 43 | |
---|
[eb7f743] | 44 | fvec_t * |
---|
[33cd81f] | 45 | new_aubio_window (char_t * window_type, uint_t length) |
---|
[eb7f743] | 46 | { |
---|
[33cd81f] | 47 | fvec_t * win = new_fvec (length); |
---|
[c21acb9] | 48 | uint_t err; |
---|
[ca45e58] | 49 | if (win == NULL) { |
---|
| 50 | return NULL; |
---|
| 51 | } |
---|
[c21acb9] | 52 | err = fvec_set_window (win, window_type); |
---|
[ca45e58] | 53 | if (err != 0) { |
---|
| 54 | del_fvec(win); |
---|
| 55 | return NULL; |
---|
| 56 | } |
---|
[33cd81f] | 57 | return win; |
---|
| 58 | } |
---|
| 59 | |
---|
| 60 | uint_t fvec_set_window (fvec_t *win, char_t *window_type) { |
---|
[8e5c051] | 61 | smpl_t * w = win->data; |
---|
[33cd81f] | 62 | uint_t i, size = win->length; |
---|
[407bba9] | 63 | aubio_window_type wintype; |
---|
[33cd81f] | 64 | if (window_type == NULL) { |
---|
| 65 | AUBIO_ERR ("window type can not be null.\n"); |
---|
| 66 | return 1; |
---|
| 67 | } else if (strcmp (window_type, "rectangle") == 0) |
---|
[407bba9] | 68 | wintype = aubio_win_rectangle; |
---|
| 69 | else if (strcmp (window_type, "hamming") == 0) |
---|
| 70 | wintype = aubio_win_hamming; |
---|
| 71 | else if (strcmp (window_type, "hanning") == 0) |
---|
| 72 | wintype = aubio_win_hanning; |
---|
| 73 | else if (strcmp (window_type, "hanningz") == 0) |
---|
| 74 | wintype = aubio_win_hanningz; |
---|
| 75 | else if (strcmp (window_type, "blackman") == 0) |
---|
| 76 | wintype = aubio_win_blackman; |
---|
| 77 | else if (strcmp (window_type, "blackman_harris") == 0) |
---|
| 78 | wintype = aubio_win_blackman_harris; |
---|
| 79 | else if (strcmp (window_type, "gaussian") == 0) |
---|
| 80 | wintype = aubio_win_gaussian; |
---|
| 81 | else if (strcmp (window_type, "welch") == 0) |
---|
| 82 | wintype = aubio_win_welch; |
---|
| 83 | else if (strcmp (window_type, "parzen") == 0) |
---|
| 84 | wintype = aubio_win_parzen; |
---|
| 85 | else if (strcmp (window_type, "default") == 0) |
---|
| 86 | wintype = aubio_win_default; |
---|
| 87 | else { |
---|
[33cd81f] | 88 | AUBIO_ERR ("unknown window type `%s`.\n", window_type); |
---|
| 89 | return 1; |
---|
[407bba9] | 90 | } |
---|
[96fb8ad] | 91 | switch(wintype) { |
---|
[b4b0324] | 92 | case aubio_win_rectangle: |
---|
[96fb8ad] | 93 | for (i=0;i<size;i++) |
---|
[ade9afe] | 94 | w[i] = 0.5; |
---|
[96fb8ad] | 95 | break; |
---|
[b4b0324] | 96 | case aubio_win_hamming: |
---|
[96fb8ad] | 97 | for (i=0;i<size;i++) |
---|
| 98 | w[i] = 0.54 - 0.46 * COS(TWO_PI * i / (size)); |
---|
| 99 | break; |
---|
[b4b0324] | 100 | case aubio_win_hanning: |
---|
[96fb8ad] | 101 | for (i=0;i<size;i++) |
---|
| 102 | w[i] = 0.5 - (0.5 * COS(TWO_PI * i / (size))); |
---|
| 103 | break; |
---|
[b4b0324] | 104 | case aubio_win_hanningz: |
---|
[96fb8ad] | 105 | for (i=0;i<size;i++) |
---|
| 106 | w[i] = 0.5 * (1.0 - COS(TWO_PI * i / (size))); |
---|
| 107 | break; |
---|
[b4b0324] | 108 | case aubio_win_blackman: |
---|
[96fb8ad] | 109 | for (i=0;i<size;i++) |
---|
| 110 | w[i] = 0.42 |
---|
| 111 | - 0.50 * COS( TWO_PI*i/(size-1.0)) |
---|
[ade9afe] | 112 | + 0.08 * COS(2.0*TWO_PI*i/(size-1.0)); |
---|
[96fb8ad] | 113 | break; |
---|
[b4b0324] | 114 | case aubio_win_blackman_harris: |
---|
[96fb8ad] | 115 | for (i=0;i<size;i++) |
---|
[ade9afe] | 116 | w[i] = 0.35875 |
---|
[96fb8ad] | 117 | - 0.48829 * COS( TWO_PI*i/(size-1.0)) |
---|
| 118 | + 0.14128 * COS(2.0*TWO_PI*i/(size-1.0)) |
---|
| 119 | - 0.01168 * COS(3.0*TWO_PI*i/(size-1.0)); |
---|
| 120 | break; |
---|
[b4b0324] | 121 | case aubio_win_gaussian: |
---|
[9e56228] | 122 | { |
---|
| 123 | lsmp_t a, b, c = 0.5; |
---|
| 124 | uint_t n; |
---|
| 125 | for (n = 0; n < size; n++) |
---|
| 126 | { |
---|
| 127 | a = (n-c*(size-1))/(SQR(c)*(size-1)); |
---|
| 128 | b = -c*SQR(a); |
---|
| 129 | w[n] = EXP(b); |
---|
| 130 | } |
---|
| 131 | } |
---|
[96fb8ad] | 132 | break; |
---|
[b4b0324] | 133 | case aubio_win_welch: |
---|
[96fb8ad] | 134 | for (i=0;i<size;i++) |
---|
[f9d5346] | 135 | w[i] = 1.0 - SQR((2.*i-size)/(size+1.0)); |
---|
[96fb8ad] | 136 | break; |
---|
[b4b0324] | 137 | case aubio_win_parzen: |
---|
[96fb8ad] | 138 | for (i=0;i<size;i++) |
---|
[053495b] | 139 | w[i] = 1.0 - ABS((2.f*i-size)/(size+1.0f)); |
---|
[96fb8ad] | 140 | break; |
---|
| 141 | default: |
---|
| 142 | break; |
---|
| 143 | } |
---|
[33cd81f] | 144 | return 0; |
---|
[96fb8ad] | 145 | } |
---|
| 146 | |
---|
[eb7f743] | 147 | smpl_t |
---|
| 148 | aubio_unwrap2pi (smpl_t phase) |
---|
| 149 | { |
---|
[96fb8ad] | 150 | /* mod(phase+pi,-2pi)+pi */ |
---|
[eb7f743] | 151 | return phase + TWO_PI * (1. + FLOOR (-(phase + PI) / TWO_PI)); |
---|
[96fb8ad] | 152 | } |
---|
| 153 | |
---|
[eb7f743] | 154 | smpl_t |
---|
| 155 | fvec_mean (fvec_t * s) |
---|
| 156 | { |
---|
[56ef7e1] | 157 | smpl_t tmp = 0.0; |
---|
[98d8d2b] | 158 | #ifndef HAVE_ACCELERATE |
---|
| 159 | uint_t j; |
---|
[8e5c051] | 160 | for (j = 0; j < s->length; j++) { |
---|
| 161 | tmp += s->data[j]; |
---|
| 162 | } |
---|
[56ef7e1] | 163 | return tmp / (smpl_t) (s->length); |
---|
[98d8d2b] | 164 | #else |
---|
[ee6ca74] | 165 | aubio_vDSP_meanv(s->data, 1, &tmp, s->length); |
---|
[98d8d2b] | 166 | return tmp; |
---|
| 167 | #endif /* HAVE_ACCELERATE */ |
---|
[56ef7e1] | 168 | } |
---|
| 169 | |
---|
| 170 | smpl_t |
---|
[eb7f743] | 171 | fvec_sum (fvec_t * s) |
---|
| 172 | { |
---|
[acf7d30] | 173 | smpl_t tmp = 0.0; |
---|
[98d8d2b] | 174 | #ifndef HAVE_ACCELERATE |
---|
| 175 | uint_t j; |
---|
[8e5c051] | 176 | for (j = 0; j < s->length; j++) { |
---|
| 177 | tmp += s->data[j]; |
---|
[eb7f743] | 178 | } |
---|
[98d8d2b] | 179 | #else |
---|
[ee6ca74] | 180 | aubio_vDSP_sve(s->data, 1, &tmp, s->length); |
---|
[98d8d2b] | 181 | #endif /* HAVE_ACCELERATE */ |
---|
[96fb8ad] | 182 | return tmp; |
---|
| 183 | } |
---|
| 184 | |
---|
[eb7f743] | 185 | smpl_t |
---|
| 186 | fvec_max (fvec_t * s) |
---|
| 187 | { |
---|
[7c07af2] | 188 | #ifndef HAVE_ACCELERATE |
---|
[8e5c051] | 189 | uint_t j; |
---|
[acf7d30] | 190 | smpl_t tmp = 0.0; |
---|
[8e5c051] | 191 | for (j = 0; j < s->length; j++) { |
---|
| 192 | tmp = (tmp > s->data[j]) ? tmp : s->data[j]; |
---|
[eb7f743] | 193 | } |
---|
[7c07af2] | 194 | #else |
---|
| 195 | smpl_t tmp = 0.; |
---|
[ee6ca74] | 196 | aubio_vDSP_maxv(s->data, 1, &tmp, s->length); |
---|
[7c07af2] | 197 | #endif |
---|
[96fb8ad] | 198 | return tmp; |
---|
| 199 | } |
---|
| 200 | |
---|
[eb7f743] | 201 | smpl_t |
---|
| 202 | fvec_min (fvec_t * s) |
---|
| 203 | { |
---|
[7c07af2] | 204 | #ifndef HAVE_ACCELERATE |
---|
[8e5c051] | 205 | uint_t j; |
---|
| 206 | smpl_t tmp = s->data[0]; |
---|
| 207 | for (j = 0; j < s->length; j++) { |
---|
| 208 | tmp = (tmp < s->data[j]) ? tmp : s->data[j]; |
---|
[eb7f743] | 209 | } |
---|
[7c07af2] | 210 | #else |
---|
| 211 | smpl_t tmp = 0.; |
---|
[ee6ca74] | 212 | aubio_vDSP_minv(s->data, 1, &tmp, s->length); |
---|
[7c07af2] | 213 | #endif |
---|
[96fb8ad] | 214 | return tmp; |
---|
| 215 | } |
---|
| 216 | |
---|
[eb7f743] | 217 | uint_t |
---|
| 218 | fvec_min_elem (fvec_t * s) |
---|
| 219 | { |
---|
[7c07af2] | 220 | #ifndef HAVE_ACCELERATE |
---|
[8e5c051] | 221 | uint_t j, pos = 0.; |
---|
| 222 | smpl_t tmp = s->data[0]; |
---|
| 223 | for (j = 0; j < s->length; j++) { |
---|
| 224 | pos = (tmp < s->data[j]) ? pos : j; |
---|
| 225 | tmp = (tmp < s->data[j]) ? tmp : s->data[j]; |
---|
[eb7f743] | 226 | } |
---|
[7c07af2] | 227 | #else |
---|
| 228 | smpl_t tmp = 0.; |
---|
| 229 | uint_t pos = 0.; |
---|
[ee6ca74] | 230 | aubio_vDSP_minvi(s->data, 1, &tmp, (vDSP_Length *)&pos, s->length); |
---|
[7c07af2] | 231 | #endif |
---|
[96fb8ad] | 232 | return pos; |
---|
| 233 | } |
---|
| 234 | |
---|
[eb7f743] | 235 | uint_t |
---|
| 236 | fvec_max_elem (fvec_t * s) |
---|
| 237 | { |
---|
[7c07af2] | 238 | #ifndef HAVE_ACCELERATE |
---|
[8e5c051] | 239 | uint_t j, pos = 0; |
---|
[acf7d30] | 240 | smpl_t tmp = 0.0; |
---|
[8e5c051] | 241 | for (j = 0; j < s->length; j++) { |
---|
| 242 | pos = (tmp > s->data[j]) ? pos : j; |
---|
| 243 | tmp = (tmp > s->data[j]) ? tmp : s->data[j]; |
---|
[eb7f743] | 244 | } |
---|
[7c07af2] | 245 | #else |
---|
| 246 | smpl_t tmp = 0.; |
---|
| 247 | uint_t pos = 0.; |
---|
[ee6ca74] | 248 | aubio_vDSP_maxvi(s->data, 1, &tmp, (vDSP_Length *)&pos, s->length); |
---|
[7c07af2] | 249 | #endif |
---|
[96fb8ad] | 250 | return pos; |
---|
| 251 | } |
---|
| 252 | |
---|
[eb7f743] | 253 | void |
---|
| 254 | fvec_shift (fvec_t * s) |
---|
| 255 | { |
---|
[8e5c051] | 256 | uint_t j; |
---|
| 257 | for (j = 0; j < s->length / 2; j++) { |
---|
| 258 | ELEM_SWAP (s->data[j], s->data[j + s->length / 2]); |
---|
[eb7f743] | 259 | } |
---|
[96fb8ad] | 260 | } |
---|
| 261 | |
---|
[eb7f743] | 262 | smpl_t |
---|
[5b41ef9] | 263 | aubio_level_lin (fvec_t * f) |
---|
[eb7f743] | 264 | { |
---|
| 265 | smpl_t energy = 0.; |
---|
[8e5c051] | 266 | uint_t j; |
---|
| 267 | for (j = 0; j < f->length; j++) { |
---|
| 268 | energy += SQR (f->data[j]); |
---|
[eb7f743] | 269 | } |
---|
[1a74ac3] | 270 | return energy / f->length; |
---|
[96fb8ad] | 271 | } |
---|
| 272 | |
---|
[eb7f743] | 273 | smpl_t |
---|
| 274 | fvec_local_hfc (fvec_t * v) |
---|
| 275 | { |
---|
| 276 | smpl_t hfc = 0.; |
---|
[8e5c051] | 277 | uint_t j; |
---|
| 278 | for (j = 0; j < v->length; j++) { |
---|
| 279 | hfc += (j + 1) * v->data[j]; |
---|
[eb7f743] | 280 | } |
---|
| 281 | return hfc; |
---|
[96fb8ad] | 282 | } |
---|
| 283 | |
---|
[eb7f743] | 284 | void |
---|
| 285 | fvec_min_removal (fvec_t * v) |
---|
| 286 | { |
---|
| 287 | smpl_t v_min = fvec_min (v); |
---|
| 288 | fvec_add (v, - v_min ); |
---|
[96fb8ad] | 289 | } |
---|
| 290 | |
---|
[eb7f743] | 291 | smpl_t |
---|
| 292 | fvec_alpha_norm (fvec_t * o, smpl_t alpha) |
---|
[c0b295c] | 293 | { |
---|
[8e5c051] | 294 | uint_t j; |
---|
[eb7f743] | 295 | smpl_t tmp = 0.; |
---|
[8e5c051] | 296 | for (j = 0; j < o->length; j++) { |
---|
| 297 | tmp += POW (ABS (o->data[j]), alpha); |
---|
[c0b295c] | 298 | } |
---|
[eb7f743] | 299 | return POW (tmp / o->length, 1. / alpha); |
---|
[96fb8ad] | 300 | } |
---|
| 301 | |
---|
[eb7f743] | 302 | void |
---|
| 303 | fvec_alpha_normalise (fvec_t * o, smpl_t alpha) |
---|
| 304 | { |
---|
[8e5c051] | 305 | uint_t j; |
---|
[eb7f743] | 306 | smpl_t norm = fvec_alpha_norm (o, alpha); |
---|
[8e5c051] | 307 | for (j = 0; j < o->length; j++) { |
---|
| 308 | o->data[j] /= norm; |
---|
[96fb8ad] | 309 | } |
---|
| 310 | } |
---|
| 311 | |
---|
[eb7f743] | 312 | void |
---|
| 313 | fvec_add (fvec_t * o, smpl_t val) |
---|
| 314 | { |
---|
[8e5c051] | 315 | uint_t j; |
---|
| 316 | for (j = 0; j < o->length; j++) { |
---|
| 317 | o->data[j] += val; |
---|
[96fb8ad] | 318 | } |
---|
| 319 | } |
---|
| 320 | |
---|
[5c4ec3c] | 321 | void fvec_adapt_thres(fvec_t * vec, fvec_t * tmp, |
---|
[8e5c051] | 322 | uint_t post, uint_t pre) { |
---|
| 323 | uint_t length = vec->length, j; |
---|
[96fb8ad] | 324 | for (j=0;j<length;j++) { |
---|
[8e5c051] | 325 | vec->data[j] -= fvec_moving_thres(vec, tmp, post, pre, j); |
---|
[96fb8ad] | 326 | } |
---|
| 327 | } |
---|
| 328 | |
---|
[eb7f743] | 329 | smpl_t |
---|
| 330 | fvec_moving_thres (fvec_t * vec, fvec_t * tmpvec, |
---|
[8e5c051] | 331 | uint_t post, uint_t pre, uint_t pos) |
---|
[eb7f743] | 332 | { |
---|
[8e5c051] | 333 | uint_t k; |
---|
| 334 | smpl_t *medar = (smpl_t *) tmpvec->data; |
---|
[eb7f743] | 335 | uint_t win_length = post + pre + 1; |
---|
| 336 | uint_t length = vec->length; |
---|
[96fb8ad] | 337 | /* post part of the buffer does not exist */ |
---|
[eb7f743] | 338 | if (pos < post + 1) { |
---|
| 339 | for (k = 0; k < post + 1 - pos; k++) |
---|
| 340 | medar[k] = 0.; /* 0-padding at the beginning */ |
---|
| 341 | for (k = post + 1 - pos; k < win_length; k++) |
---|
[8e5c051] | 342 | medar[k] = vec->data[k + pos - post]; |
---|
[eb7f743] | 343 | /* the buffer is fully defined */ |
---|
| 344 | } else if (pos + pre < length) { |
---|
| 345 | for (k = 0; k < win_length; k++) |
---|
[8e5c051] | 346 | medar[k] = vec->data[k + pos - post]; |
---|
[eb7f743] | 347 | /* pre part of the buffer does not exist */ |
---|
[96fb8ad] | 348 | } else { |
---|
[eb7f743] | 349 | for (k = 0; k < length - pos + post; k++) |
---|
[8e5c051] | 350 | medar[k] = vec->data[k + pos - post]; |
---|
[eb7f743] | 351 | for (k = length - pos + post; k < win_length; k++) |
---|
| 352 | medar[k] = 0.; /* 0-padding at the end */ |
---|
[ade9afe] | 353 | } |
---|
[8e5c051] | 354 | return fvec_median (tmpvec); |
---|
[96fb8ad] | 355 | } |
---|
| 356 | |
---|
[8e5c051] | 357 | smpl_t fvec_median (fvec_t * input) { |
---|
[96fb8ad] | 358 | uint_t n = input->length; |
---|
[8e5c051] | 359 | smpl_t * arr = (smpl_t *) input->data; |
---|
[96fb8ad] | 360 | uint_t low, high ; |
---|
| 361 | uint_t median; |
---|
| 362 | uint_t middle, ll, hh; |
---|
| 363 | |
---|
| 364 | low = 0 ; high = n-1 ; median = (low + high) / 2; |
---|
| 365 | for (;;) { |
---|
| 366 | if (high <= low) /* One element only */ |
---|
| 367 | return arr[median] ; |
---|
| 368 | |
---|
| 369 | if (high == low + 1) { /* Two elements only */ |
---|
| 370 | if (arr[low] > arr[high]) |
---|
| 371 | ELEM_SWAP(arr[low], arr[high]) ; |
---|
| 372 | return arr[median] ; |
---|
| 373 | } |
---|
| 374 | |
---|
| 375 | /* Find median of low, middle and high items; swap into position low */ |
---|
| 376 | middle = (low + high) / 2; |
---|
| 377 | if (arr[middle] > arr[high]) ELEM_SWAP(arr[middle], arr[high]); |
---|
| 378 | if (arr[low] > arr[high]) ELEM_SWAP(arr[low], arr[high]); |
---|
| 379 | if (arr[middle] > arr[low]) ELEM_SWAP(arr[middle], arr[low]) ; |
---|
| 380 | |
---|
| 381 | /* Swap low item (now in position middle) into position (low+1) */ |
---|
| 382 | ELEM_SWAP(arr[middle], arr[low+1]) ; |
---|
| 383 | |
---|
| 384 | /* Nibble from each end towards middle, swapping items when stuck */ |
---|
| 385 | ll = low + 1; |
---|
| 386 | hh = high; |
---|
| 387 | for (;;) { |
---|
| 388 | do ll++; while (arr[low] > arr[ll]) ; |
---|
| 389 | do hh--; while (arr[hh] > arr[low]) ; |
---|
| 390 | |
---|
| 391 | if (hh < ll) |
---|
| 392 | break; |
---|
| 393 | |
---|
| 394 | ELEM_SWAP(arr[ll], arr[hh]) ; |
---|
| 395 | } |
---|
| 396 | |
---|
| 397 | /* Swap middle item (in position low) back into correct position */ |
---|
| 398 | ELEM_SWAP(arr[low], arr[hh]) ; |
---|
| 399 | |
---|
| 400 | /* Re-set active partition */ |
---|
| 401 | if (hh <= median) |
---|
| 402 | low = ll; |
---|
| 403 | if (hh >= median) |
---|
| 404 | high = hh - 1; |
---|
| 405 | } |
---|
| 406 | } |
---|
| 407 | |
---|
[9499eefb] | 408 | smpl_t fvec_quadratic_peak_pos (fvec_t * x, uint_t pos) { |
---|
[5644069] | 409 | smpl_t s0, s1, s2; uint_t x0, x2; |
---|
[acd97d1] | 410 | if (pos == 0 || pos == x->length - 1) return pos; |
---|
[5644069] | 411 | x0 = (pos < 1) ? pos : pos - 1; |
---|
| 412 | x2 = (pos + 1 < x->length) ? pos + 1 : pos; |
---|
[9499eefb] | 413 | if (x0 == pos) return (x->data[pos] <= x->data[x2]) ? pos : x2; |
---|
| 414 | if (x2 == pos) return (x->data[pos] <= x->data[x0]) ? pos : x0; |
---|
| 415 | s0 = x->data[x0]; |
---|
| 416 | s1 = x->data[pos]; |
---|
| 417 | s2 = x->data[x2]; |
---|
| 418 | return pos + 0.5 * (s0 - s2 ) / (s0 - 2.* s1 + s2); |
---|
| 419 | } |
---|
| 420 | |
---|
[7380327] | 421 | smpl_t fvec_quadratic_peak_mag (fvec_t *x, smpl_t pos) { |
---|
| 422 | smpl_t x0, x1, x2; |
---|
| 423 | uint_t index = (uint_t)(pos - .5) + 1; |
---|
| 424 | if (pos >= x->length || pos < 0.) return 0.; |
---|
| 425 | if ((smpl_t)index == pos) return x->data[index]; |
---|
| 426 | x0 = x->data[index - 1]; |
---|
| 427 | x1 = x->data[index]; |
---|
| 428 | x2 = x->data[index + 1]; |
---|
| 429 | return x1 - .25 * (x0 - x2) * (pos - index); |
---|
| 430 | } |
---|
| 431 | |
---|
[5c4ec3c] | 432 | uint_t fvec_peakpick(fvec_t * onset, uint_t pos) { |
---|
[8e5c051] | 433 | uint_t tmp=0; |
---|
| 434 | tmp = (onset->data[pos] > onset->data[pos-1] |
---|
| 435 | && onset->data[pos] > onset->data[pos+1] |
---|
| 436 | && onset->data[pos] > 0.); |
---|
[ade9afe] | 437 | return tmp; |
---|
[96fb8ad] | 438 | } |
---|
| 439 | |
---|
[eb7f743] | 440 | smpl_t |
---|
| 441 | aubio_quadfrac (smpl_t s0, smpl_t s1, smpl_t s2, smpl_t pf) |
---|
| 442 | { |
---|
| 443 | smpl_t tmp = |
---|
| 444 | s0 + (pf / 2.) * (pf * (s0 - 2. * s1 + s2) - 3. * s0 + 4. * s1 - s2); |
---|
| 445 | return tmp; |
---|
| 446 | } |
---|
| 447 | |
---|
| 448 | smpl_t |
---|
| 449 | aubio_freqtomidi (smpl_t freq) |
---|
| 450 | { |
---|
[5644069] | 451 | smpl_t midi; |
---|
[037319a] | 452 | if (freq < 2. || freq > 100000.) return 0.; // avoid nans and infs |
---|
[ade9afe] | 453 | /* log(freq/A-2)/log(2) */ |
---|
[5644069] | 454 | midi = freq / 6.875; |
---|
[eb7f743] | 455 | midi = LOG (midi) / 0.69314718055995; |
---|
[ade9afe] | 456 | midi *= 12; |
---|
| 457 | midi -= 3; |
---|
| 458 | return midi; |
---|
[79c2e52] | 459 | } |
---|
| 460 | |
---|
[eb7f743] | 461 | smpl_t |
---|
| 462 | aubio_miditofreq (smpl_t midi) |
---|
| 463 | { |
---|
[5644069] | 464 | smpl_t freq; |
---|
[037319a] | 465 | if (midi > 140.) return 0.; // avoid infs |
---|
[5644069] | 466 | freq = (midi + 3.) / 12.; |
---|
[eb7f743] | 467 | freq = EXP (freq * 0.69314718055995); |
---|
[ade9afe] | 468 | freq *= 6.875; |
---|
| 469 | return freq; |
---|
[96fb8ad] | 470 | } |
---|
| 471 | |
---|
[eb7f743] | 472 | smpl_t |
---|
| 473 | aubio_bintofreq (smpl_t bin, smpl_t samplerate, smpl_t fftsize) |
---|
| 474 | { |
---|
| 475 | smpl_t freq = samplerate / fftsize; |
---|
[c965b33] | 476 | return freq * MAX(bin, 0); |
---|
[96fb8ad] | 477 | } |
---|
| 478 | |
---|
[eb7f743] | 479 | smpl_t |
---|
| 480 | aubio_bintomidi (smpl_t bin, smpl_t samplerate, smpl_t fftsize) |
---|
| 481 | { |
---|
| 482 | smpl_t midi = aubio_bintofreq (bin, samplerate, fftsize); |
---|
| 483 | return aubio_freqtomidi (midi); |
---|
[96fb8ad] | 484 | } |
---|
| 485 | |
---|
[eb7f743] | 486 | smpl_t |
---|
| 487 | aubio_freqtobin (smpl_t freq, smpl_t samplerate, smpl_t fftsize) |
---|
| 488 | { |
---|
| 489 | smpl_t bin = fftsize / samplerate; |
---|
[c965b33] | 490 | return MAX(freq, 0) * bin; |
---|
[79c2e52] | 491 | } |
---|
| 492 | |
---|
[eb7f743] | 493 | smpl_t |
---|
| 494 | aubio_miditobin (smpl_t midi, smpl_t samplerate, smpl_t fftsize) |
---|
| 495 | { |
---|
| 496 | smpl_t freq = aubio_miditofreq (midi); |
---|
| 497 | return aubio_freqtobin (freq, samplerate, fftsize); |
---|
[79c2e52] | 498 | } |
---|
| 499 | |
---|
[10a5413] | 500 | uint_t |
---|
[41f4c5b] | 501 | aubio_is_power_of_two (uint_t a) |
---|
| 502 | { |
---|
| 503 | if ((a & (a - 1)) == 0) { |
---|
[10a5413] | 504 | return 1; |
---|
| 505 | } else { |
---|
[41f4c5b] | 506 | return 0; |
---|
[10a5413] | 507 | } |
---|
| 508 | } |
---|
| 509 | |
---|
| 510 | uint_t |
---|
[41f4c5b] | 511 | aubio_next_power_of_two (uint_t a) |
---|
| 512 | { |
---|
[7581185] | 513 | uint_t i = 1; |
---|
| 514 | while (i < a) i <<= 1; |
---|
| 515 | return i; |
---|
[10a5413] | 516 | } |
---|
| 517 | |
---|
[eb7f743] | 518 | smpl_t |
---|
| 519 | aubio_db_spl (fvec_t * o) |
---|
| 520 | { |
---|
[5b41ef9] | 521 | return 10. * LOG10 (aubio_level_lin (o)); |
---|
[96fb8ad] | 522 | } |
---|
| 523 | |
---|
[eb7f743] | 524 | uint_t |
---|
| 525 | aubio_silence_detection (fvec_t * o, smpl_t threshold) |
---|
| 526 | { |
---|
| 527 | return (aubio_db_spl (o) < threshold); |
---|
| 528 | } |
---|
[96fb8ad] | 529 | |
---|
[eb7f743] | 530 | smpl_t |
---|
| 531 | aubio_level_detection (fvec_t * o, smpl_t threshold) |
---|
| 532 | { |
---|
| 533 | smpl_t db_spl = aubio_db_spl (o); |
---|
| 534 | if (db_spl < threshold) { |
---|
[ade9afe] | 535 | return 1.; |
---|
[eb7f743] | 536 | } else { |
---|
| 537 | return db_spl; |
---|
| 538 | } |
---|
[96fb8ad] | 539 | } |
---|
[a0fd4e4] | 540 | |
---|
[eb7f743] | 541 | smpl_t |
---|
| 542 | aubio_zero_crossing_rate (fvec_t * input) |
---|
| 543 | { |
---|
[8e5c051] | 544 | uint_t j; |
---|
[fff2bee] | 545 | uint_t zcr = 0; |
---|
[eb7f743] | 546 | for (j = 1; j < input->length; j++) { |
---|
[7e204d01] | 547 | // previous was strictly negative |
---|
[8e5c051] | 548 | if (input->data[j - 1] < 0.) { |
---|
[7e204d01] | 549 | // current is positive or null |
---|
[8e5c051] | 550 | if (input->data[j] >= 0.) { |
---|
[7e204d01] | 551 | zcr += 1; |
---|
| 552 | } |
---|
[eb7f743] | 553 | // previous was positive or null |
---|
[7e204d01] | 554 | } else { |
---|
| 555 | // current is strictly negative |
---|
[8e5c051] | 556 | if (input->data[j] < 0.) { |
---|
[fff2bee] | 557 | zcr += 1; |
---|
| 558 | } |
---|
| 559 | } |
---|
| 560 | } |
---|
[eb7f743] | 561 | return zcr / (smpl_t) input->length; |
---|
[fff2bee] | 562 | } |
---|
| 563 | |
---|
[eb7f743] | 564 | void |
---|
| 565 | aubio_autocorr (fvec_t * input, fvec_t * output) |
---|
| 566 | { |
---|
[8e5c051] | 567 | uint_t i, j, length = input->length; |
---|
[eb7f743] | 568 | smpl_t *data, *acf; |
---|
| 569 | smpl_t tmp = 0; |
---|
[8e5c051] | 570 | data = input->data; |
---|
| 571 | acf = output->data; |
---|
| 572 | for (i = 0; i < length; i++) { |
---|
| 573 | tmp = 0.; |
---|
| 574 | for (j = i; j < length; j++) { |
---|
| 575 | tmp += data[j - i] * data[j]; |
---|
[ade9afe] | 576 | } |
---|
[8e5c051] | 577 | acf[i] = tmp / (smpl_t) (length - i); |
---|
[ade9afe] | 578 | } |
---|
[a0fd4e4] | 579 | } |
---|
| 580 | |
---|
[eb7f743] | 581 | void |
---|
| 582 | aubio_cleanup (void) |
---|
| 583 | { |
---|
[729a3c0] | 584 | #ifdef HAVE_FFTW3F |
---|
[eb7f743] | 585 | fftwf_cleanup (); |
---|
[729a3c0] | 586 | #else |
---|
| 587 | #ifdef HAVE_FFTW3 |
---|
| 588 | fftw_cleanup (); |
---|
[714380d] | 589 | #endif |
---|
| 590 | #endif |
---|
| 591 | } |
---|