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 "main.h"
|
cannam@154
|
33
|
cannam@154
|
34 /* Convert adaptive Mid/Side representation to Left/Right stereo signal */
|
cannam@154
|
35 void silk_stereo_MS_to_LR(
|
cannam@154
|
36 stereo_dec_state *state, /* I/O State */
|
cannam@154
|
37 opus_int16 x1[], /* I/O Left input signal, becomes mid signal */
|
cannam@154
|
38 opus_int16 x2[], /* I/O Right input signal, becomes side signal */
|
cannam@154
|
39 const opus_int32 pred_Q13[], /* I Predictors */
|
cannam@154
|
40 opus_int fs_kHz, /* I Samples rate (kHz) */
|
cannam@154
|
41 opus_int frame_length /* I Number of samples */
|
cannam@154
|
42 )
|
cannam@154
|
43 {
|
cannam@154
|
44 opus_int n, denom_Q16, delta0_Q13, delta1_Q13;
|
cannam@154
|
45 opus_int32 sum, diff, pred0_Q13, pred1_Q13;
|
cannam@154
|
46
|
cannam@154
|
47 /* Buffering */
|
cannam@154
|
48 silk_memcpy( x1, state->sMid, 2 * sizeof( opus_int16 ) );
|
cannam@154
|
49 silk_memcpy( x2, state->sSide, 2 * sizeof( opus_int16 ) );
|
cannam@154
|
50 silk_memcpy( state->sMid, &x1[ frame_length ], 2 * sizeof( opus_int16 ) );
|
cannam@154
|
51 silk_memcpy( state->sSide, &x2[ frame_length ], 2 * sizeof( opus_int16 ) );
|
cannam@154
|
52
|
cannam@154
|
53 /* Interpolate predictors and add prediction to side channel */
|
cannam@154
|
54 pred0_Q13 = state->pred_prev_Q13[ 0 ];
|
cannam@154
|
55 pred1_Q13 = state->pred_prev_Q13[ 1 ];
|
cannam@154
|
56 denom_Q16 = silk_DIV32_16( (opus_int32)1 << 16, STEREO_INTERP_LEN_MS * fs_kHz );
|
cannam@154
|
57 delta0_Q13 = silk_RSHIFT_ROUND( silk_SMULBB( pred_Q13[ 0 ] - state->pred_prev_Q13[ 0 ], denom_Q16 ), 16 );
|
cannam@154
|
58 delta1_Q13 = silk_RSHIFT_ROUND( silk_SMULBB( pred_Q13[ 1 ] - state->pred_prev_Q13[ 1 ], denom_Q16 ), 16 );
|
cannam@154
|
59 for( n = 0; n < STEREO_INTERP_LEN_MS * fs_kHz; n++ ) {
|
cannam@154
|
60 pred0_Q13 += delta0_Q13;
|
cannam@154
|
61 pred1_Q13 += delta1_Q13;
|
cannam@154
|
62 sum = silk_LSHIFT( silk_ADD_LSHIFT( x1[ n ] + x1[ n + 2 ], x1[ n + 1 ], 1 ), 9 ); /* Q11 */
|
cannam@154
|
63 sum = silk_SMLAWB( silk_LSHIFT( (opus_int32)x2[ n + 1 ], 8 ), sum, pred0_Q13 ); /* Q8 */
|
cannam@154
|
64 sum = silk_SMLAWB( sum, silk_LSHIFT( (opus_int32)x1[ n + 1 ], 11 ), pred1_Q13 ); /* Q8 */
|
cannam@154
|
65 x2[ n + 1 ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( sum, 8 ) );
|
cannam@154
|
66 }
|
cannam@154
|
67 pred0_Q13 = pred_Q13[ 0 ];
|
cannam@154
|
68 pred1_Q13 = pred_Q13[ 1 ];
|
cannam@154
|
69 for( n = STEREO_INTERP_LEN_MS * fs_kHz; n < frame_length; n++ ) {
|
cannam@154
|
70 sum = silk_LSHIFT( silk_ADD_LSHIFT( x1[ n ] + x1[ n + 2 ], x1[ n + 1 ], 1 ), 9 ); /* Q11 */
|
cannam@154
|
71 sum = silk_SMLAWB( silk_LSHIFT( (opus_int32)x2[ n + 1 ], 8 ), sum, pred0_Q13 ); /* Q8 */
|
cannam@154
|
72 sum = silk_SMLAWB( sum, silk_LSHIFT( (opus_int32)x1[ n + 1 ], 11 ), pred1_Q13 ); /* Q8 */
|
cannam@154
|
73 x2[ n + 1 ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( sum, 8 ) );
|
cannam@154
|
74 }
|
cannam@154
|
75 state->pred_prev_Q13[ 0 ] = pred_Q13[ 0 ];
|
cannam@154
|
76 state->pred_prev_Q13[ 1 ] = pred_Q13[ 1 ];
|
cannam@154
|
77
|
cannam@154
|
78 /* Convert to left/right signals */
|
cannam@154
|
79 for( n = 0; n < frame_length; n++ ) {
|
cannam@154
|
80 sum = x1[ n + 1 ] + (opus_int32)x2[ n + 1 ];
|
cannam@154
|
81 diff = x1[ n + 1 ] - (opus_int32)x2[ n + 1 ];
|
cannam@154
|
82 x1[ n + 1 ] = (opus_int16)silk_SAT16( sum );
|
cannam@154
|
83 x2[ n + 1 ] = (opus_int16)silk_SAT16( diff );
|
cannam@154
|
84 }
|
cannam@154
|
85 }
|