1*a58d3d2aSXin Li /***********************************************************************
2*a58d3d2aSXin Li Copyright (c) 2006-2011, Skype Limited. All rights reserved.
3*a58d3d2aSXin Li Redistribution and use in source and binary forms, with or without
4*a58d3d2aSXin Li modification, are permitted provided that the following conditions
5*a58d3d2aSXin Li are met:
6*a58d3d2aSXin Li - Redistributions of source code must retain the above copyright notice,
7*a58d3d2aSXin Li this list of conditions and the following disclaimer.
8*a58d3d2aSXin Li - Redistributions in binary form must reproduce the above copyright
9*a58d3d2aSXin Li notice, this list of conditions and the following disclaimer in the
10*a58d3d2aSXin Li documentation and/or other materials provided with the distribution.
11*a58d3d2aSXin Li - Neither the name of Internet Society, IETF or IETF Trust, nor the
12*a58d3d2aSXin Li names of specific contributors, may be used to endorse or promote
13*a58d3d2aSXin Li products derived from this software without specific prior written
14*a58d3d2aSXin Li permission.
15*a58d3d2aSXin Li THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
16*a58d3d2aSXin Li AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17*a58d3d2aSXin Li IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18*a58d3d2aSXin Li ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
19*a58d3d2aSXin Li LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
20*a58d3d2aSXin Li CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
21*a58d3d2aSXin Li SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
22*a58d3d2aSXin Li INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
23*a58d3d2aSXin Li CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
24*a58d3d2aSXin Li ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25*a58d3d2aSXin Li POSSIBILITY OF SUCH DAMAGE.
26*a58d3d2aSXin Li ***********************************************************************/
27*a58d3d2aSXin Li
28*a58d3d2aSXin Li #ifdef HAVE_CONFIG_H
29*a58d3d2aSXin Li #include "config.h"
30*a58d3d2aSXin Li #endif
31*a58d3d2aSXin Li
32*a58d3d2aSXin Li #include "main.h"
33*a58d3d2aSXin Li
34*a58d3d2aSXin Li /* Compute quantization errors for an LPC_order element input vector for a VQ codebook */
silk_NLSF_VQ(opus_int32 err_Q24[],const opus_int16 in_Q15[],const opus_uint8 pCB_Q8[],const opus_int16 pWght_Q9[],const opus_int K,const opus_int LPC_order)35*a58d3d2aSXin Li void silk_NLSF_VQ(
36*a58d3d2aSXin Li opus_int32 err_Q24[], /* O Quantization errors [K] */
37*a58d3d2aSXin Li const opus_int16 in_Q15[], /* I Input vectors to be quantized [LPC_order] */
38*a58d3d2aSXin Li const opus_uint8 pCB_Q8[], /* I Codebook vectors [K*LPC_order] */
39*a58d3d2aSXin Li const opus_int16 pWght_Q9[], /* I Codebook weights [K*LPC_order] */
40*a58d3d2aSXin Li const opus_int K, /* I Number of codebook vectors */
41*a58d3d2aSXin Li const opus_int LPC_order /* I Number of LPCs */
42*a58d3d2aSXin Li )
43*a58d3d2aSXin Li {
44*a58d3d2aSXin Li opus_int i, m;
45*a58d3d2aSXin Li opus_int32 diff_Q15, diffw_Q24, sum_error_Q24, pred_Q24;
46*a58d3d2aSXin Li const opus_int16 *w_Q9_ptr;
47*a58d3d2aSXin Li const opus_uint8 *cb_Q8_ptr;
48*a58d3d2aSXin Li
49*a58d3d2aSXin Li celt_assert( ( LPC_order & 1 ) == 0 );
50*a58d3d2aSXin Li
51*a58d3d2aSXin Li /* Loop over codebook */
52*a58d3d2aSXin Li cb_Q8_ptr = pCB_Q8;
53*a58d3d2aSXin Li w_Q9_ptr = pWght_Q9;
54*a58d3d2aSXin Li for( i = 0; i < K; i++ ) {
55*a58d3d2aSXin Li sum_error_Q24 = 0;
56*a58d3d2aSXin Li pred_Q24 = 0;
57*a58d3d2aSXin Li for( m = LPC_order-2; m >= 0; m -= 2 ) {
58*a58d3d2aSXin Li /* Compute weighted absolute predictive quantization error for index m + 1 */
59*a58d3d2aSXin Li diff_Q15 = silk_SUB_LSHIFT32( in_Q15[ m + 1 ], (opus_int32)cb_Q8_ptr[ m + 1 ], 7 ); /* range: [ -32767 : 32767 ]*/
60*a58d3d2aSXin Li diffw_Q24 = silk_SMULBB( diff_Q15, w_Q9_ptr[ m + 1 ] );
61*a58d3d2aSXin Li sum_error_Q24 = silk_ADD32( sum_error_Q24, silk_abs( silk_SUB_RSHIFT32( diffw_Q24, pred_Q24, 1 ) ) );
62*a58d3d2aSXin Li pred_Q24 = diffw_Q24;
63*a58d3d2aSXin Li
64*a58d3d2aSXin Li /* Compute weighted absolute predictive quantization error for index m */
65*a58d3d2aSXin Li diff_Q15 = silk_SUB_LSHIFT32( in_Q15[ m ], (opus_int32)cb_Q8_ptr[ m ], 7 ); /* range: [ -32767 : 32767 ]*/
66*a58d3d2aSXin Li diffw_Q24 = silk_SMULBB( diff_Q15, w_Q9_ptr[ m ] );
67*a58d3d2aSXin Li sum_error_Q24 = silk_ADD32( sum_error_Q24, silk_abs( silk_SUB_RSHIFT32( diffw_Q24, pred_Q24, 1 ) ) );
68*a58d3d2aSXin Li pred_Q24 = diffw_Q24;
69*a58d3d2aSXin Li
70*a58d3d2aSXin Li silk_assert( sum_error_Q24 >= 0 );
71*a58d3d2aSXin Li }
72*a58d3d2aSXin Li err_Q24[ i ] = sum_error_Q24;
73*a58d3d2aSXin Li cb_Q8_ptr += LPC_order;
74*a58d3d2aSXin Li w_Q9_ptr += LPC_order;
75*a58d3d2aSXin Li }
76*a58d3d2aSXin Li }
77