resample_48khz.c revision e48d5845c8b35de2ab73ea055c18a61fa3a9f0be
1e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent/*
2e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *  Copyright (c) 2011 The WebRTC project authors. All Rights Reserved.
3e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *
4e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *  Use of this source code is governed by a BSD-style license
5e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *  that can be found in the LICENSE file in the root of the source
6e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *  tree. An additional intellectual property rights grant can be found
7e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *  in the file PATENTS.  All contributing project authors may
8e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *  be found in the AUTHORS file in the root of the source tree.
9e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent */
10e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
11e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
12e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent/*
13e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent * This file contains resampling functions between 48 kHz and nb/wb.
14e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent * The description header can be found in signal_processing_library.h
15e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent *
16e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent */
17e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
18e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent#include <string.h>
19e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent#include "signal_processing_library.h"
20e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent#include "resample_by_2_internal.h"
21e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
22e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
23e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent///// 48 kHz -> 16 kHz /////
24e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
25e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
26e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// 48 -> 16 resampler
27e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_Resample48khzTo16khz(const WebRtc_Word16* in, WebRtc_Word16* out,
28e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent                                    WebRtcSpl_State48khzTo16khz* state, WebRtc_Word32* tmpmem)
29e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
30e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 48 --> 48(LP) /////
31e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16  in[480]
32e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[480]
33e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
34e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_LPBy2ShortToInt(in, 480, tmpmem + 16, state->S_48_48);
35e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
36e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 48 --> 32 /////
37e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[480]
38e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[320]
39e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
40e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // copy state to and from input array
41e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(tmpmem + 8, state->S_48_32, 8 * sizeof(WebRtc_Word32));
42e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(state->S_48_32, tmpmem + 488, 8 * sizeof(WebRtc_Word32));
43e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_Resample48khzTo32khz(tmpmem + 8, tmpmem, 160);
44e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
45e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 32 --> 16 /////
46e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[320]
47e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16 out[160]
48e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
49e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_DownBy2IntToShort(tmpmem, 320, out, state->S_32_16);
50e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
51e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
52e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// initialize state of 48 -> 16 resampler
53e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_ResetResample48khzTo16khz(WebRtcSpl_State48khzTo16khz* state)
54e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
55e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_48_48, 0, 16 * sizeof(WebRtc_Word32));
56e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_48_32, 0, 8 * sizeof(WebRtc_Word32));
57e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_32_16, 0, 8 * sizeof(WebRtc_Word32));
58e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
59e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
60e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
61e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent///// 16 kHz -> 48 kHz /////
62e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
63e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
64e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// 16 -> 48 resampler
65e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_Resample16khzTo48khz(const WebRtc_Word16* in, WebRtc_Word16* out,
66e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent                                    WebRtcSpl_State16khzTo48khz* state, WebRtc_Word32* tmpmem)
67e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
68e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 16 --> 32 /////
69e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16  in[160]
70e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[320]
71e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
72e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_UpBy2ShortToInt(in, 160, tmpmem + 16, state->S_16_32);
73e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
74e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 32 --> 24 /////
75e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[320]
76e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[240]
77e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // copy state to and from input array
78e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
79e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(tmpmem + 8, state->S_32_24, 8 * sizeof(WebRtc_Word32));
80e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(state->S_32_24, tmpmem + 328, 8 * sizeof(WebRtc_Word32));
81e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_Resample32khzTo24khz(tmpmem + 8, tmpmem, 80);
82e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
83e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 24 --> 48 /////
84e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[240]
85e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16 out[480]
86e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
87e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_UpBy2IntToShort(tmpmem, 240, out, state->S_24_48);
88e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
89e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
90e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// initialize state of 16 -> 48 resampler
91e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_ResetResample16khzTo48khz(WebRtcSpl_State16khzTo48khz* state)
92e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
93e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_16_32, 0, 8 * sizeof(WebRtc_Word32));
94e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_32_24, 0, 8 * sizeof(WebRtc_Word32));
95e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_24_48, 0, 8 * sizeof(WebRtc_Word32));
96e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
97e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
98e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
99e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent///// 48 kHz ->  8 kHz /////
100e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
101e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
102e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// 48 -> 8 resampler
103e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_Resample48khzTo8khz(const WebRtc_Word16* in, WebRtc_Word16* out,
104e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent                                   WebRtcSpl_State48khzTo8khz* state, WebRtc_Word32* tmpmem)
105e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
106e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 48 --> 24 /////
107e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16  in[480]
108e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[240]
109e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
110e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_DownBy2ShortToInt(in, 480, tmpmem + 256, state->S_48_24);
111e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
112e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 24 --> 24(LP) /////
113e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[240]
114e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[240]
115e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
116e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_LPBy2IntToInt(tmpmem + 256, 240, tmpmem + 16, state->S_24_24);
117e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
118e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 24 --> 16 /////
119e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[240]
120e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[160]
121e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
122e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // copy state to and from input array
123e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(tmpmem + 8, state->S_24_16, 8 * sizeof(WebRtc_Word32));
124e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(state->S_24_16, tmpmem + 248, 8 * sizeof(WebRtc_Word32));
125e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_Resample48khzTo32khz(tmpmem + 8, tmpmem, 80);
126e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
127e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 16 --> 8 /////
128e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[160]
129e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16 out[80]
130e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
131e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_DownBy2IntToShort(tmpmem, 160, out, state->S_16_8);
132e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
133e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
134e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// initialize state of 48 -> 8 resampler
135e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_ResetResample48khzTo8khz(WebRtcSpl_State48khzTo8khz* state)
136e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
137e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_48_24, 0, 8 * sizeof(WebRtc_Word32));
138e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_24_24, 0, 16 * sizeof(WebRtc_Word32));
139e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_24_16, 0, 8 * sizeof(WebRtc_Word32));
140e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_16_8, 0, 8 * sizeof(WebRtc_Word32));
141e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
142e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
143e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
144e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent/////  8 kHz -> 48 kHz /////
145e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent////////////////////////////
146e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
147e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// 8 -> 48 resampler
148e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_Resample8khzTo48khz(const WebRtc_Word16* in, WebRtc_Word16* out,
149e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent                                   WebRtcSpl_State8khzTo48khz* state, WebRtc_Word32* tmpmem)
150e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
151e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 8 --> 16 /////
152e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16  in[80]
153e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[160]
154e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
155e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_UpBy2ShortToInt(in, 80, tmpmem + 264, state->S_8_16);
156e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
157e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 16 --> 12 /////
158e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[160]
159e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32 out[120]
160e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
161e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // copy state to and from input array
162e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(tmpmem + 256, state->S_16_12, 8 * sizeof(WebRtc_Word32));
163e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memcpy(state->S_16_12, tmpmem + 416, 8 * sizeof(WebRtc_Word32));
164e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_Resample32khzTo24khz(tmpmem + 256, tmpmem + 240, 40);
165e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
166e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 12 --> 24 /////
167e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[120]
168e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16 out[240]
169e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
170e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_UpBy2IntToInt(tmpmem + 240, 120, tmpmem, state->S_12_24);
171e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
172e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    ///// 24 --> 48 /////
173e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word32  in[240]
174e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    // WebRtc_Word16 out[480]
175e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    /////
176e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    WebRtcSpl_UpBy2IntToShort(tmpmem, 240, out, state->S_24_48);
177e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
178e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent
179e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent// initialize state of 8 -> 48 resampler
180e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurentvoid WebRtcSpl_ResetResample8khzTo48khz(WebRtcSpl_State8khzTo48khz* state)
181e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent{
182e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_8_16, 0, 8 * sizeof(WebRtc_Word32));
183e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_16_12, 0, 8 * sizeof(WebRtc_Word32));
184e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_12_24, 0, 8 * sizeof(WebRtc_Word32));
185e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent    memset(state->S_24_48, 0, 8 * sizeof(WebRtc_Word32));
186e48d5845c8b35de2ab73ea055c18a61fa3a9f0beEric Laurent}
187