1885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/***********************************************************************
2885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgCopyright (c) 2006-2011, Skype Limited. All rights reserved.
3885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgRedistribution and use in source and binary forms, with or without
4885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgmodification, are permitted provided that the following conditions
5885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgare met:
6885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org- Redistributions of source code must retain the above copyright notice,
7885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgthis list of conditions and the following disclaimer.
8885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org- Redistributions in binary form must reproduce the above copyright
9885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgnotice, this list of conditions and the following disclaimer in the
10885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgdocumentation and/or other materials provided with the distribution.
11e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org- Neither the name of Internet Society, IETF or IETF Trust, nor the
12885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgnames of specific contributors, may be used to endorse or promote
13885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgproducts derived from this software without specific prior written
14885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgpermission.
15e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.orgTHIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
16885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgAND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgIMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
19885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgLIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
20885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgCONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
21885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgSUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
22885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgINTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
23885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgCONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
24885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgPOSSIBILITY OF SUCH DAMAGE.
26885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org***********************************************************************/
27885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
28885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#ifdef HAVE_CONFIG_H
29885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#include "config.h"
30885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#endif
31885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
32885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#include "define.h"
33885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#include "main_FLP.h"
34885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#include "tuning_parameters.h"
35885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
36885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* LPC analysis */
37885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgvoid silk_find_LPC_FLP(
38885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    silk_encoder_state              *psEncC,                            /* I/O  Encoder state                               */
39885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    opus_int16                      NLSF_Q15[],                         /* O    NLSFs                                       */
40885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    const silk_float                x[],                                /* I    Input signal                                */
41885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    const silk_float                minInvGain                          /* I    Inverse of max prediction gain              */
42885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org)
43885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{
44885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    opus_int    k, subfr_length;
45885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    silk_float  a[ MAX_LPC_ORDER ];
46885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
47885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    /* Used only for NLSF interpolation */
48885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    silk_float  res_nrg, res_nrg_2nd, res_nrg_interp;
49885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    opus_int16  NLSF0_Q15[ MAX_LPC_ORDER ];
50885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    silk_float  a_tmp[ MAX_LPC_ORDER ];
51885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    silk_float  LPC_res[ MAX_FRAME_LENGTH + MAX_NB_SUBFR * MAX_LPC_ORDER ];
52885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
53885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    subfr_length = psEncC->subfr_length + psEncC->predictLPCOrder;
54885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
55885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    /* Default: No interpolation */
56885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    psEncC->indices.NLSFInterpCoef_Q2 = 4;
57885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
58885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    /* Burg AR analysis for the full frame */
59885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    res_nrg = silk_burg_modified_FLP( a, x, minInvGain, subfr_length, psEncC->nb_subfr, psEncC->predictLPCOrder );
60885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
61885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    if( psEncC->useInterpolatedNLSFs && !psEncC->first_frame_after_reset && psEncC->nb_subfr == MAX_NB_SUBFR ) {
62885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        /* Optimal solution for last 10 ms; subtract residual energy here, as that's easier than        */
63885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        /* adding it to the residual energy of the first 10 ms in each iteration of the search below    */
64885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        res_nrg -= silk_burg_modified_FLP( a_tmp, x + ( MAX_NB_SUBFR / 2 ) * subfr_length, minInvGain, subfr_length, MAX_NB_SUBFR / 2, psEncC->predictLPCOrder );
65885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
66885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        /* Convert to NLSFs */
67885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        silk_A2NLSF_FLP( NLSF_Q15, a_tmp, psEncC->predictLPCOrder );
68885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
69885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        /* Search over interpolation indices to find the one with lowest residual energy */
70885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        res_nrg_2nd = silk_float_MAX;
71885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        for( k = 3; k >= 0; k-- ) {
72885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            /* Interpolate NLSFs for first half */
73885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            silk_interpolate( NLSF0_Q15, psEncC->prev_NLSFq_Q15, NLSF_Q15, k, psEncC->predictLPCOrder );
74885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
75885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            /* Convert to LPC for residual energy evaluation */
76885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            silk_NLSF2A_FLP( a_tmp, NLSF0_Q15, psEncC->predictLPCOrder );
77885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
78885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            /* Calculate residual energy with LSF interpolation */
79885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            silk_LPC_analysis_filter_FLP( LPC_res, a_tmp, x, 2 * subfr_length, psEncC->predictLPCOrder );
80885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            res_nrg_interp = (silk_float)(
81885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org                silk_energy_FLP( LPC_res + psEncC->predictLPCOrder,                subfr_length - psEncC->predictLPCOrder ) +
82885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org                silk_energy_FLP( LPC_res + psEncC->predictLPCOrder + subfr_length, subfr_length - psEncC->predictLPCOrder ) );
83885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
84885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            /* Determine whether current interpolated NLSFs are best so far */
85885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            if( res_nrg_interp < res_nrg ) {
86885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org                /* Interpolation has lower residual energy */
87885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org                res_nrg = res_nrg_interp;
88885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org                psEncC->indices.NLSFInterpCoef_Q2 = (opus_int8)k;
89885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            } else if( res_nrg_interp > res_nrg_2nd ) {
90885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org                /* No reason to continue iterating - residual energies will continue to climb */
91885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org                break;
92885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            }
93885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org            res_nrg_2nd = res_nrg_interp;
94885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        }
95885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    }
96885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
97885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    if( psEncC->indices.NLSFInterpCoef_Q2 == 4 ) {
98885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        /* NLSF interpolation is currently inactive, calculate NLSFs from full frame AR coefficients */
99885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        silk_A2NLSF_FLP( NLSF_Q15, a, psEncC->predictLPCOrder );
100885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    }
101885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org
102885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org    silk_assert( psEncC->indices.NLSFInterpCoef_Q2 == 4 ||
103885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org        ( psEncC->useInterpolatedNLSFs && !psEncC->first_frame_after_reset && psEncC->nb_subfr == MAX_NB_SUBFR ) );
104885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org}
105