media/libopus/silk/fixed/schur_FIX.c

changeset 0
6474c204b198
     1.1 --- /dev/null	Thu Jan 01 00:00:00 1970 +0000
     1.2 +++ b/media/libopus/silk/fixed/schur_FIX.c	Wed Dec 31 06:09:35 2014 +0100
     1.3 @@ -0,0 +1,106 @@
     1.4 +/***********************************************************************
     1.5 +Copyright (c) 2006-2011, Skype Limited. All rights reserved.
     1.6 +Redistribution and use in source and binary forms, with or without
     1.7 +modification, are permitted provided that the following conditions
     1.8 +are met:
     1.9 +- Redistributions of source code must retain the above copyright notice,
    1.10 +this list of conditions and the following disclaimer.
    1.11 +- Redistributions in binary form must reproduce the above copyright
    1.12 +notice, this list of conditions and the following disclaimer in the
    1.13 +documentation and/or other materials provided with the distribution.
    1.14 +- Neither the name of Internet Society, IETF or IETF Trust, nor the
    1.15 +names of specific contributors, may be used to endorse or promote
    1.16 +products derived from this software without specific prior written
    1.17 +permission.
    1.18 +THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
    1.19 +AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
    1.20 +IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
    1.21 +ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
    1.22 +LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
    1.23 +CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
    1.24 +SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
    1.25 +INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
    1.26 +CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
    1.27 +ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
    1.28 +POSSIBILITY OF SUCH DAMAGE.
    1.29 +***********************************************************************/
    1.30 +
    1.31 +#ifdef HAVE_CONFIG_H
    1.32 +#include "config.h"
    1.33 +#endif
    1.34 +
    1.35 +#include "SigProc_FIX.h"
    1.36 +
    1.37 +/* Faster than schur64(), but much less accurate.                       */
    1.38 +/* uses SMLAWB(), requiring armv5E and higher.                          */
    1.39 +opus_int32 silk_schur(                              /* O    Returns residual energy                                     */
    1.40 +    opus_int16                  *rc_Q15,            /* O    reflection coefficients [order] Q15                         */
    1.41 +    const opus_int32            *c,                 /* I    correlations [order+1]                                      */
    1.42 +    const opus_int32            order               /* I    prediction order                                            */
    1.43 +)
    1.44 +{
    1.45 +    opus_int        k, n, lz;
    1.46 +    opus_int32    C[ SILK_MAX_ORDER_LPC + 1 ][ 2 ];
    1.47 +    opus_int32    Ctmp1, Ctmp2, rc_tmp_Q15;
    1.48 +
    1.49 +    silk_assert( order==6||order==8||order==10||order==12||order==14||order==16 );
    1.50 +
    1.51 +    /* Get number of leading zeros */
    1.52 +    lz = silk_CLZ32( c[ 0 ] );
    1.53 +
    1.54 +    /* Copy correlations and adjust level to Q30 */
    1.55 +    if( lz < 2 ) {
    1.56 +        /* lz must be 1, so shift one to the right */
    1.57 +        for( k = 0; k < order + 1; k++ ) {
    1.58 +            C[ k ][ 0 ] = C[ k ][ 1 ] = silk_RSHIFT( c[ k ], 1 );
    1.59 +        }
    1.60 +    } else if( lz > 2 ) {
    1.61 +        /* Shift to the left */
    1.62 +        lz -= 2;
    1.63 +        for( k = 0; k < order + 1; k++ ) {
    1.64 +            C[ k ][ 0 ] = C[ k ][ 1 ] = silk_LSHIFT( c[ k ], lz );
    1.65 +        }
    1.66 +    } else {
    1.67 +        /* No need to shift */
    1.68 +        for( k = 0; k < order + 1; k++ ) {
    1.69 +            C[ k ][ 0 ] = C[ k ][ 1 ] = c[ k ];
    1.70 +        }
    1.71 +    }
    1.72 +
    1.73 +    for( k = 0; k < order; k++ ) {
    1.74 +        /* Check that we won't be getting an unstable rc, otherwise stop here. */
    1.75 +        if (silk_abs_int32(C[ k + 1 ][ 0 ]) >= C[ 0 ][ 1 ]) {
    1.76 +           if ( C[ k + 1 ][ 0 ] > 0 ) {
    1.77 +              rc_Q15[ k ] = -SILK_FIX_CONST( .99f, 15 );
    1.78 +           } else {
    1.79 +              rc_Q15[ k ] = SILK_FIX_CONST( .99f, 15 );
    1.80 +           }
    1.81 +           k++;
    1.82 +           break;
    1.83 +        }
    1.84 +
    1.85 +        /* Get reflection coefficient */
    1.86 +        rc_tmp_Q15 = -silk_DIV32_16( C[ k + 1 ][ 0 ], silk_max_32( silk_RSHIFT( C[ 0 ][ 1 ], 15 ), 1 ) );
    1.87 +
    1.88 +        /* Clip (shouldn't happen for properly conditioned inputs) */
    1.89 +        rc_tmp_Q15 = silk_SAT16( rc_tmp_Q15 );
    1.90 +
    1.91 +        /* Store */
    1.92 +        rc_Q15[ k ] = (opus_int16)rc_tmp_Q15;
    1.93 +
    1.94 +        /* Update correlations */
    1.95 +        for( n = 0; n < order - k; n++ ) {
    1.96 +            Ctmp1 = C[ n + k + 1 ][ 0 ];
    1.97 +            Ctmp2 = C[ n ][ 1 ];
    1.98 +            C[ n + k + 1 ][ 0 ] = silk_SMLAWB( Ctmp1, silk_LSHIFT( Ctmp2, 1 ), rc_tmp_Q15 );
    1.99 +            C[ n ][ 1 ]         = silk_SMLAWB( Ctmp2, silk_LSHIFT( Ctmp1, 1 ), rc_tmp_Q15 );
   1.100 +        }
   1.101 +    }
   1.102 +
   1.103 +    for(; k < order; k++ ) {
   1.104 +       rc_Q15[ k ] = 0;
   1.105 +    }
   1.106 +
   1.107 +    /* return residual energy */
   1.108 +    return silk_max_32( 1, C[ 0 ][ 1 ] );
   1.109 +}

mercurial