cannam@154
|
1 /***********************************************************************
|
cannam@154
|
2 Copyright (c) 2006-2011, Skype Limited. All rights reserved.
|
cannam@154
|
3 Redistribution and use in source and binary forms, with or without
|
cannam@154
|
4 modification, are permitted provided that the following conditions
|
cannam@154
|
5 are met:
|
cannam@154
|
6 - Redistributions of source code must retain the above copyright notice,
|
cannam@154
|
7 this list of conditions and the following disclaimer.
|
cannam@154
|
8 - Redistributions in binary form must reproduce the above copyright
|
cannam@154
|
9 notice, this list of conditions and the following disclaimer in the
|
cannam@154
|
10 documentation and/or other materials provided with the distribution.
|
cannam@154
|
11 - Neither the name of Internet Society, IETF or IETF Trust, nor the
|
cannam@154
|
12 names of specific contributors, may be used to endorse or promote
|
cannam@154
|
13 products derived from this software without specific prior written
|
cannam@154
|
14 permission.
|
cannam@154
|
15 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
cannam@154
|
16 AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
cannam@154
|
17 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
cannam@154
|
18 ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
cannam@154
|
19 LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
cannam@154
|
20 CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
cannam@154
|
21 SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
cannam@154
|
22 INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
cannam@154
|
23 CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
cannam@154
|
24 ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
cannam@154
|
25 POSSIBILITY OF SUCH DAMAGE.
|
cannam@154
|
26 ***********************************************************************/
|
cannam@154
|
27
|
cannam@154
|
28 #ifdef HAVE_CONFIG_H
|
cannam@154
|
29 #include "config.h"
|
cannam@154
|
30 #endif
|
cannam@154
|
31
|
cannam@154
|
32 #include "SigProc_FIX.h"
|
cannam@154
|
33 #include "resampler_private.h"
|
cannam@154
|
34 #include "stack_alloc.h"
|
cannam@154
|
35
|
cannam@154
|
36 static OPUS_INLINE opus_int16 *silk_resampler_private_IIR_FIR_INTERPOL(
|
cannam@154
|
37 opus_int16 *out,
|
cannam@154
|
38 opus_int16 *buf,
|
cannam@154
|
39 opus_int32 max_index_Q16,
|
cannam@154
|
40 opus_int32 index_increment_Q16
|
cannam@154
|
41 )
|
cannam@154
|
42 {
|
cannam@154
|
43 opus_int32 index_Q16, res_Q15;
|
cannam@154
|
44 opus_int16 *buf_ptr;
|
cannam@154
|
45 opus_int32 table_index;
|
cannam@154
|
46
|
cannam@154
|
47 /* Interpolate upsampled signal and store in output array */
|
cannam@154
|
48 for( index_Q16 = 0; index_Q16 < max_index_Q16; index_Q16 += index_increment_Q16 ) {
|
cannam@154
|
49 table_index = silk_SMULWB( index_Q16 & 0xFFFF, 12 );
|
cannam@154
|
50 buf_ptr = &buf[ index_Q16 >> 16 ];
|
cannam@154
|
51
|
cannam@154
|
52 res_Q15 = silk_SMULBB( buf_ptr[ 0 ], silk_resampler_frac_FIR_12[ table_index ][ 0 ] );
|
cannam@154
|
53 res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 1 ], silk_resampler_frac_FIR_12[ table_index ][ 1 ] );
|
cannam@154
|
54 res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 2 ], silk_resampler_frac_FIR_12[ table_index ][ 2 ] );
|
cannam@154
|
55 res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 3 ], silk_resampler_frac_FIR_12[ table_index ][ 3 ] );
|
cannam@154
|
56 res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 4 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 3 ] );
|
cannam@154
|
57 res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 5 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 2 ] );
|
cannam@154
|
58 res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 6 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 1 ] );
|
cannam@154
|
59 res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 7 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 0 ] );
|
cannam@154
|
60 *out++ = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( res_Q15, 15 ) );
|
cannam@154
|
61 }
|
cannam@154
|
62 return out;
|
cannam@154
|
63 }
|
cannam@154
|
64 /* Upsample using a combination of allpass-based 2x upsampling and FIR interpolation */
|
cannam@154
|
65 void silk_resampler_private_IIR_FIR(
|
cannam@154
|
66 void *SS, /* I/O Resampler state */
|
cannam@154
|
67 opus_int16 out[], /* O Output signal */
|
cannam@154
|
68 const opus_int16 in[], /* I Input signal */
|
cannam@154
|
69 opus_int32 inLen /* I Number of input samples */
|
cannam@154
|
70 )
|
cannam@154
|
71 {
|
cannam@154
|
72 silk_resampler_state_struct *S = (silk_resampler_state_struct *)SS;
|
cannam@154
|
73 opus_int32 nSamplesIn;
|
cannam@154
|
74 opus_int32 max_index_Q16, index_increment_Q16;
|
cannam@154
|
75 VARDECL( opus_int16, buf );
|
cannam@154
|
76 SAVE_STACK;
|
cannam@154
|
77
|
cannam@154
|
78 ALLOC( buf, 2 * S->batchSize + RESAMPLER_ORDER_FIR_12, opus_int16 );
|
cannam@154
|
79
|
cannam@154
|
80 /* Copy buffered samples to start of buffer */
|
cannam@154
|
81 silk_memcpy( buf, S->sFIR.i16, RESAMPLER_ORDER_FIR_12 * sizeof( opus_int16 ) );
|
cannam@154
|
82
|
cannam@154
|
83 /* Iterate over blocks of frameSizeIn input samples */
|
cannam@154
|
84 index_increment_Q16 = S->invRatio_Q16;
|
cannam@154
|
85 while( 1 ) {
|
cannam@154
|
86 nSamplesIn = silk_min( inLen, S->batchSize );
|
cannam@154
|
87
|
cannam@154
|
88 /* Upsample 2x */
|
cannam@154
|
89 silk_resampler_private_up2_HQ( S->sIIR, &buf[ RESAMPLER_ORDER_FIR_12 ], in, nSamplesIn );
|
cannam@154
|
90
|
cannam@154
|
91 max_index_Q16 = silk_LSHIFT32( nSamplesIn, 16 + 1 ); /* + 1 because 2x upsampling */
|
cannam@154
|
92 out = silk_resampler_private_IIR_FIR_INTERPOL( out, buf, max_index_Q16, index_increment_Q16 );
|
cannam@154
|
93 in += nSamplesIn;
|
cannam@154
|
94 inLen -= nSamplesIn;
|
cannam@154
|
95
|
cannam@154
|
96 if( inLen > 0 ) {
|
cannam@154
|
97 /* More iterations to do; copy last part of filtered signal to beginning of buffer */
|
cannam@154
|
98 silk_memcpy( buf, &buf[ nSamplesIn << 1 ], RESAMPLER_ORDER_FIR_12 * sizeof( opus_int16 ) );
|
cannam@154
|
99 } else {
|
cannam@154
|
100 break;
|
cannam@154
|
101 }
|
cannam@154
|
102 }
|
cannam@154
|
103
|
cannam@154
|
104 /* Copy last part of filtered signal to the state for the next call */
|
cannam@154
|
105 silk_memcpy( S->sFIR.i16, &buf[ nSamplesIn << 1 ], RESAMPLER_ORDER_FIR_12 * sizeof( opus_int16 ) );
|
cannam@154
|
106 RESTORE_STACK;
|
cannam@154
|
107 }
|