Line data    Source code

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