mirror of
https://github.com/signalwire/freeswitch.git
synced 2025-12-19 03:37:46 +00:00
f05740bc9b
git-svn-id: http://svn.freeswitch.org/svn/freeswitch/trunk@15543 d0543943-73ff-0310-b7d9-9358b9ac24b2
103 lines
2.7 KiB
C
103 lines
2.7 KiB
C
/*
|
|
* broadvoice - a library for the BroadVoice 16 and 32 codecs
|
|
*
|
|
* bv16fine_pitch.c - Fine pitch search
|
|
*
|
|
* Adapted by Steve Underwood <steveu@coppice.org> from code which is
|
|
* Copyright 2000-2009 Broadcom Corporation
|
|
*
|
|
* All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU Lesser General Public License version 2.1,
|
|
* as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*
|
|
* $Id: bv16fine_pitch.c,v 1.1.1.1 2009/11/19 12:10:48 steveu Exp $
|
|
*/
|
|
|
|
/*! \file */
|
|
|
|
#if defined(HAVE_CONFIG_H)
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include "typedef.h"
|
|
#include "bv16cnst.h"
|
|
#include "bv16externs.h"
|
|
|
|
#define FS (XOFF+1) /* Frame Starting index */
|
|
#define FE (XOFF+FRSZ) /* Frame Ending index */
|
|
#define DEV (DECF-1)
|
|
|
|
int refinepitch(Float *x,
|
|
int cpp,
|
|
Float *ppt)
|
|
{
|
|
Float cor, cor2, energy, cormax, cor2max, energymax;
|
|
Float *fp0, *fp1, *fp2, *fp3;
|
|
int lb, ub, pp, i, j;
|
|
|
|
if (cpp >= MAXPP)
|
|
cpp = MAXPP - 1;
|
|
if (cpp < MINPP)
|
|
cpp = MINPP;
|
|
lb = cpp - DEV;
|
|
if (lb < MINPP)
|
|
lb = MINPP; /* lower bound of pitch period search range */
|
|
ub = cpp + DEV;
|
|
/* to avoid selecting MAXPP as the refined pitch period */
|
|
if (ub >= MAXPP)
|
|
ub = MAXPP - 1;/* lower bound of pitch period search range */
|
|
|
|
i = lb; /* start the search from lower bound */
|
|
|
|
fp0 = x + FS - 1;
|
|
fp1 = x + FS - 1 - i;
|
|
cor = energy = 0.0;
|
|
for (j = 0; j < (FE - FS + 1); j++)
|
|
{
|
|
energy += (*fp1) * (*fp1);
|
|
cor += (*fp0++) * (*fp1++);
|
|
}
|
|
|
|
pp = i;
|
|
cormax = cor;
|
|
cor2max = cor*cor;
|
|
energymax = energy;
|
|
|
|
fp0 = x + FE - lb - 1;
|
|
fp1 = x + FS - lb - 2;
|
|
for (i = lb + 1; i <= ub; i++)
|
|
{
|
|
fp2 = x + FS - 1;
|
|
fp3 = x + FS - i - 1;
|
|
cor = 0.;
|
|
for (j = 0; j < (FE - FS + 1); j++)
|
|
cor += (*fp2++)*(*fp3++);
|
|
cor2 = cor*cor;
|
|
energy += ((*fp1)*(*fp1) - (*fp0)*(*fp0));
|
|
fp0--;
|
|
fp1--;
|
|
if ((cor2*energymax) > (cor2max*energy))
|
|
{
|
|
pp = i;
|
|
cormax = cor;
|
|
cor2max = cor2;
|
|
energymax = energy;
|
|
}
|
|
}
|
|
|
|
*ppt = (energymax != 0) ? (cormax/energymax) : 0.0;
|
|
|
|
return pp;
|
|
}
|