/*
 ** Copyright 2003-2010, VisualOn, Inc.
 **
 ** Licensed under the Apache License, Version 2.0 (the "License");
 ** you may not use this file except in compliance with the License.
 ** You may obtain a copy of the License at
 **
 **     http://www.apache.org/licenses/LICENSE-2.0
 **
 ** Unless required by applicable law or agreed to in writing, software
 ** distributed under the License is distributed on an "AS IS" BASIS,
 ** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 ** See the License for the specific language governing permissions and
 ** limitations under the License.
 */

/**************************************************************************
*      File: gpclip.c                                                     *
*                                                                         *
*      Description:To avoid unstable synthesis on frame erasure, the gain *
*      need to be limited(gain pitch < 1.0) when the following            *
*      case occurs                                                        *
*      a resonance on LPC filter(lp_disp < 60Hz)                          *
*      a good pitch prediction (lp_gp > 0.95)                             *
*                                                                         *
***************************************************************************/
#include "typedef.h"
#include "basic_op.h"

#define DIST_ISF_MAX    307                /* 120 Hz (6400Hz=16384) */
#define DIST_ISF_THRES  154                /* 60     (6400Hz=16384) */
#define GAIN_PIT_THRES  14746              /* 0.9 in Q14 */
#define GAIN_PIT_MIN    9830               /* 0.6 in Q14 */
#define M               16


void Init_gp_clip(
        Word16 mem[]                          /* (o) : memory of gain of pitch clipping algorithm */
        )
{
    mem[0] = DIST_ISF_MAX;
    mem[1] = GAIN_PIT_MIN;
}


Word16 Gp_clip(
        Word16 mem[]                          /* (i/o) : memory of gain of pitch clipping algorithm */
          )
{
    Word16 clip = 0;
    if ((mem[0] < DIST_ISF_THRES) && (mem[1] > GAIN_PIT_THRES))
        clip = 1;

    return (clip);
}


void Gp_clip_test_isf(
        Word16 isf[],                         /* (i)   : isf values (in frequency domain)           */
        Word16 mem[]                          /* (i/o) : memory of gain of pitch clipping algorithm */
        )
{
    Word16 dist, dist_min;
    Word32 i;

    dist_min = vo_sub(isf[1], isf[0]);

    for (i = 2; i < M - 1; i++)
    {
        dist = vo_sub(isf[i], isf[i - 1]);
        if(dist < dist_min)
        {
            dist_min = dist;
        }
    }

    dist = extract_h(L_mac(vo_L_mult(26214, mem[0]), 6554, dist_min));

    if (dist > DIST_ISF_MAX)
    {
        dist = DIST_ISF_MAX;
    }
    mem[0] = dist;

    return;
}


void Gp_clip_test_gain_pit(
        Word16 gain_pit,                      /* (i) Q14 : gain of quantized pitch                    */
        Word16 mem[]                          /* (i/o)   : memory of gain of pitch clipping algorithm */
        )
{
    Word16 gain;
    Word32 L_tmp;
    L_tmp = (29491 * mem[1])<<1;
    L_tmp += (3277 * gain_pit)<<1;

    gain = extract_h(L_tmp);

    if(gain < GAIN_PIT_MIN)
    {
        gain = GAIN_PIT_MIN;
    }
    mem[1] = gain;
    return;
}