cannam@154: /***********************************************************************
cannam@154: Copyright (c) 2013, Koen Vos. All rights reserved.
cannam@154: Redistribution and use in source and binary forms, with or without
cannam@154: modification, are permitted provided that the following conditions
cannam@154: are met:
cannam@154: - Redistributions of source code must retain the above copyright notice,
cannam@154: this list of conditions and the following disclaimer.
cannam@154: - Redistributions in binary form must reproduce the above copyright
cannam@154: notice, this list of conditions and the following disclaimer in the
cannam@154: documentation and/or other materials provided with the distribution.
cannam@154: - Neither the name of Internet Society, IETF or IETF Trust, nor the
cannam@154: names of specific contributors, may be used to endorse or promote
cannam@154: products derived from this software without specific prior written
cannam@154: permission.
cannam@154: THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cannam@154: AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cannam@154: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
cannam@154: ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
cannam@154: LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
cannam@154: CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
cannam@154: SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
cannam@154: INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
cannam@154: CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
cannam@154: ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
cannam@154: POSSIBILITY OF SUCH DAMAGE.
cannam@154: ***********************************************************************/
cannam@154: 
cannam@154: #ifdef HAVE_CONFIG_H
cannam@154: #include "config.h"
cannam@154: #endif
cannam@154: 
cannam@154: #include "SigProc_FIX.h"
cannam@154: 
cannam@154: /* Convert int32 coefficients to int16 coefs and make sure there's no wrap-around */
cannam@154: void silk_LPC_fit(
cannam@154:     opus_int16                  *a_QOUT,            /* O    Output signal                                               */
cannam@154:     opus_int32                    *a_QIN,             /* I/O  Input signal                                                */
cannam@154:     const opus_int              QOUT,               /* I    Input Q domain                                              */
cannam@154:     const opus_int              QIN,                /* I    Input Q domain                                              */
cannam@154:     const opus_int              d                   /* I    Filter order                                                */
cannam@154: )
cannam@154: {
cannam@154:     opus_int    i, k, idx = 0;
cannam@154:     opus_int32    maxabs, absval, chirp_Q16;
cannam@154: 
cannam@154:     /* Limit the maximum absolute value of the prediction coefficients, so that they'll fit in int16 */
cannam@154:     for( i = 0; i < 10; i++ ) {
cannam@154:         /* Find maximum absolute value and its index */
cannam@154:         maxabs = 0;
cannam@154:         for( k = 0; k < d; k++ ) {
cannam@154:             absval = silk_abs( a_QIN[k] );
cannam@154:             if( absval > maxabs ) {
cannam@154:                 maxabs = absval;
cannam@154:                 idx    = k;
cannam@154:             }
cannam@154:         }
cannam@154:         maxabs = silk_RSHIFT_ROUND( maxabs, QIN - QOUT );
cannam@154: 
cannam@154:         if( maxabs > silk_int16_MAX ) {
cannam@154:             /* Reduce magnitude of prediction coefficients */
cannam@154:             maxabs = silk_min( maxabs, 163838 );  /* ( silk_int32_MAX >> 14 ) + silk_int16_MAX = 163838 */
cannam@154:             chirp_Q16 = SILK_FIX_CONST( 0.999, 16 ) - silk_DIV32( silk_LSHIFT( maxabs - silk_int16_MAX, 14 ),
cannam@154:                                         silk_RSHIFT32( silk_MUL( maxabs, idx + 1), 2 ) );
cannam@154:             silk_bwexpander_32( a_QIN, d, chirp_Q16 );
cannam@154:         } else {
cannam@154:             break;
cannam@154:         }
cannam@154:     }
cannam@154: 
cannam@154:     if( i == 10 ) {
cannam@154:         /* Reached the last iteration, clip the coefficients */
cannam@154:         for( k = 0; k < d; k++ ) {
cannam@154:             a_QOUT[ k ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( a_QIN[ k ], QIN - QOUT ) );
cannam@154:             a_QIN[ k ] = silk_LSHIFT( (opus_int32)a_QOUT[ k ], QIN - QOUT );
cannam@154:         }
cannam@154:     } else {
cannam@154:         for( k = 0; k < d; k++ ) {
cannam@154:             a_QOUT[ k ] = (opus_int16)silk_RSHIFT_ROUND( a_QIN[ k ], QIN - QOUT );
cannam@154:         }
cannam@154:     }
cannam@154: }