refactor(fmod): move all original files into fmod directory
This commit is contained in:
parent
50fb3c6b1c
commit
35569faecc
544 changed files with 0 additions and 0 deletions
237
fmod/lib/libcelt/pitch.c
Executable file
237
fmod/lib/libcelt/pitch.c
Executable file
|
|
@ -0,0 +1,237 @@
|
|||
/* (C) 2007-2008 Jean-Marc Valin, CSIRO
|
||||
*/
|
||||
/**
|
||||
@file pitch.c
|
||||
@brief Pitch analysis
|
||||
*/
|
||||
|
||||
/*
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions
|
||||
are met:
|
||||
|
||||
- Redistributions of source code must retain the above copyright
|
||||
notice, this list of conditions and the following disclaimer.
|
||||
|
||||
- Redistributions in binary form must reproduce the above copyright
|
||||
notice, this list of conditions and the following disclaimer in the
|
||||
documentation and/or other materials provided with the distribution.
|
||||
|
||||
- Neither the name of the Xiph.org Foundation nor the names of its
|
||||
contributors may be used to endorse or promote products derived from
|
||||
this software without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||||
A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR
|
||||
CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||||
EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||||
PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
||||
PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
||||
LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||||
NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
|
||||
#ifdef HAVE_CONFIG_H
|
||||
#include "config.h"
|
||||
#endif
|
||||
|
||||
/*#include "_kiss_fft_guts.h"
|
||||
#include "kiss_fftr.h"*/
|
||||
#include "kfft_single.h"
|
||||
|
||||
#include "pitch.h"
|
||||
#include "psy.h"
|
||||
#include "os_support.h"
|
||||
#include "mathops.h"
|
||||
#include "modes.h"
|
||||
#include "stack_alloc.h"
|
||||
|
||||
kiss_fftr_cfg pitch_state_alloc(int max_lag)
|
||||
{
|
||||
return real16_fft_alloc(max_lag);
|
||||
}
|
||||
|
||||
void pitch_state_free(kiss_fftr_cfg st)
|
||||
{
|
||||
real16_fft_free(st);
|
||||
}
|
||||
|
||||
#ifdef FIXED_POINT
|
||||
static void normalise16(celt_word16_t *x, int len, celt_word16_t val)
|
||||
{
|
||||
int i;
|
||||
celt_word16_t maxabs;
|
||||
maxabs = celt_maxabs16(x,len);
|
||||
if (maxabs > val)
|
||||
{
|
||||
int shift = 0;
|
||||
while (maxabs > val)
|
||||
{
|
||||
maxabs >>= 1;
|
||||
shift++;
|
||||
}
|
||||
if (shift==0)
|
||||
return;
|
||||
i=0;
|
||||
do{
|
||||
x[i] = SHR16(x[i], shift);
|
||||
} while (++i<len);
|
||||
} else {
|
||||
int shift=0;
|
||||
if (maxabs == 0)
|
||||
return;
|
||||
val >>= 1;
|
||||
while (maxabs < val)
|
||||
{
|
||||
val >>= 1;
|
||||
shift++;
|
||||
}
|
||||
if (shift==0)
|
||||
return;
|
||||
i=0;
|
||||
do{
|
||||
x[i] = SHL16(x[i], shift);
|
||||
} while (++i<len);
|
||||
}
|
||||
}
|
||||
#else
|
||||
#define normalise16(x,len,val)
|
||||
#endif
|
||||
|
||||
#define INPUT_SHIFT 15
|
||||
|
||||
void find_spectral_pitch(const CELTMode *m, kiss_fftr_cfg fft, const struct PsyDecay *decay, const celt_sig_t * celt_restrict x, const celt_sig_t * celt_restrict y, const celt_word16_t * celt_restrict window, celt_word16_t * celt_restrict spectrum, int len, int max_pitch, int *pitch)
|
||||
{
|
||||
int c, i;
|
||||
VARDECL(celt_word16_t, _X);
|
||||
VARDECL(celt_word16_t, _Y);
|
||||
const celt_word16_t * celt_restrict wptr;
|
||||
#ifndef SHORTCUTS
|
||||
VARDECL(celt_mask_t, curve);
|
||||
#endif
|
||||
celt_word16_t * celt_restrict X, * celt_restrict Y;
|
||||
celt_word16_t * celt_restrict Xptr, * celt_restrict Yptr;
|
||||
const celt_sig_t * celt_restrict yptr;
|
||||
int n2;
|
||||
int L2;
|
||||
const int C = CHANNELS(m);
|
||||
const int overlap = OVERLAP(m);
|
||||
const int lag = MAX_PERIOD;
|
||||
SAVE_STACK;
|
||||
n2 = lag>>1;
|
||||
L2 = len>>1;
|
||||
ALLOC(_X, lag, celt_word16_t);
|
||||
X = _X;
|
||||
#ifndef SHORTCUTS
|
||||
ALLOC(curve, n2, celt_mask_t);
|
||||
#endif
|
||||
CELT_MEMSET(X,0,lag);
|
||||
/* Sum all channels of the current frame and copy into X in bit-reverse order */
|
||||
for (c=0;c<C;c++)
|
||||
{
|
||||
const celt_sig_t * celt_restrict xptr = &x[c];
|
||||
for (i=0;i<L2;i++)
|
||||
{
|
||||
X[2*BITREV(fft,i)] += SHR32(*xptr,INPUT_SHIFT);
|
||||
xptr += C;
|
||||
X[2*BITREV(fft,i)+1] += SHR32(*xptr,INPUT_SHIFT);
|
||||
xptr += C;
|
||||
}
|
||||
}
|
||||
/* Applying the window in the bit-reverse domain. It's a bit weird, but it
|
||||
can help save memory */
|
||||
wptr = window;
|
||||
for (i=0;i<overlap>>1;i++)
|
||||
{
|
||||
X[2*BITREV(fft,i)] = MULT16_16_Q15(wptr[0], X[2*BITREV(fft,i)]);
|
||||
X[2*BITREV(fft,i)+1] = MULT16_16_Q15(wptr[1], X[2*BITREV(fft,i)+1]);
|
||||
X[2*BITREV(fft,L2-i-1)] = MULT16_16_Q15(wptr[1], X[2*BITREV(fft,L2-i-1)]);
|
||||
X[2*BITREV(fft,L2-i-1)+1] = MULT16_16_Q15(wptr[0], X[2*BITREV(fft,L2-i-1)+1]);
|
||||
wptr += 2;
|
||||
}
|
||||
normalise16(X, lag, 8192);
|
||||
/*for (i=0;i<lag;i++) printf ("%d ", X[i]);printf ("\n");*/
|
||||
/* Forward real FFT (in-place) */
|
||||
real16_fft_inplace(fft, X, lag);
|
||||
|
||||
if (spectrum)
|
||||
{
|
||||
for (i=0;i<lag/4;i++)
|
||||
{
|
||||
spectrum[2*i] = X[4*i];
|
||||
spectrum[2*i+1] = X[4*i+1];
|
||||
}
|
||||
}
|
||||
#ifndef SHORTCUTS
|
||||
compute_masking(decay, X, curve, lag);
|
||||
#endif
|
||||
|
||||
/* Deferred allocation to reduce peak stack usage */
|
||||
ALLOC(_Y, lag, celt_word16_t);
|
||||
Y = _Y;
|
||||
yptr = &y[0];
|
||||
/* Copy first channel of the past audio into Y in bit-reverse order */
|
||||
for (i=0;i<n2;i++)
|
||||
{
|
||||
Y[2*BITREV(fft,i)] = SHR32(*yptr,INPUT_SHIFT);
|
||||
yptr += C;
|
||||
Y[2*BITREV(fft,i)+1] = SHR32(*yptr,INPUT_SHIFT);
|
||||
yptr += C;
|
||||
}
|
||||
/* Add remaining channels into Y in bit-reverse order */
|
||||
for (c=1;c<C;c++)
|
||||
{
|
||||
yptr = &y[c];
|
||||
for (i=0;i<n2;i++)
|
||||
{
|
||||
Y[2*BITREV(fft,i)] += SHR32(*yptr,INPUT_SHIFT);
|
||||
yptr += C;
|
||||
Y[2*BITREV(fft,i)+1] += SHR32(*yptr,INPUT_SHIFT);
|
||||
yptr += C;
|
||||
}
|
||||
}
|
||||
normalise16(Y, lag, 8192);
|
||||
/* Forward real FFT (in-place) */
|
||||
real16_fft_inplace(fft, Y, lag);
|
||||
|
||||
/* Compute cross-spectrum using the inverse masking curve as weighting */
|
||||
Xptr = &X[2];
|
||||
Yptr = &Y[2];
|
||||
for (i=1;i<n2;i++)
|
||||
{
|
||||
celt_word16_t Xr, Xi, n;
|
||||
/* weight = 1/sqrt(curve) */
|
||||
Xr = Xptr[0];
|
||||
Xi = Xptr[1];
|
||||
#ifdef SHORTCUTS
|
||||
/*n = SHR32(32767,(celt_ilog2(EPSILON+curve[i])>>1));*/
|
||||
n = 1+(8192>>(celt_ilog2(1+MULT16_16(Xr,Xr)+MULT16_16(Xi,Xi))>>1));
|
||||
/* Pre-multiply X by n, so we can keep everything in 16 bits */
|
||||
Xr = MULT16_16_16(n, Xr);
|
||||
Xi = MULT16_16_16(n, Xi);
|
||||
#else
|
||||
n = celt_rsqrt(EPSILON+curve[i]);
|
||||
/* Pre-multiply X by n, so we can keep everything in 16 bits */
|
||||
Xr = EXTRACT16(SHR32(MULT16_16(n, Xr),3));
|
||||
Xi = EXTRACT16(SHR32(MULT16_16(n, Xi),3));
|
||||
#endif
|
||||
/* Cross-spectrum between X and conj(Y) */
|
||||
*Xptr++ = ADD16(MULT16_16_Q15(Xr, Yptr[0]), MULT16_16_Q15(Xi,Yptr[1]));
|
||||
*Xptr++ = SUB16(MULT16_16_Q15(Xr, Yptr[1]), MULT16_16_Q15(Xi,Yptr[0]));
|
||||
Yptr += 2;
|
||||
}
|
||||
/*printf ("\n");*/
|
||||
X[0] = X[1] = 0;
|
||||
/*for (i=0;i<lag;i++) printf ("%d ", X[i]);printf ("\n");*/
|
||||
normalise16(X, lag, 50);
|
||||
/* Inverse half-complex to real FFT gives us the correlation */
|
||||
real16_ifft(fft, X, Y, lag);
|
||||
|
||||
/* The peak in the correlation gives us the pitch */
|
||||
*pitch = find_max16(Y, max_pitch);
|
||||
RESTORE_STACK;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue