156 lines
5.6 KiB
C
156 lines
5.6 KiB
C
/*
|
|
* Copyright (c) 2011 The WebRTC project authors. All Rights Reserved.
|
|
*
|
|
* Use of this source code is governed by a BSD-style license
|
|
* that can be found in the LICENSE file in the root of the source
|
|
* tree. An additional intellectual property rights grant can be found
|
|
* in the file PATENTS. All contributing project authors may
|
|
* be found in the AUTHORS file in the root of the source tree.
|
|
*/
|
|
|
|
|
|
/*
|
|
* This file contains the function WebRtcSpl_ComplexIFFT().
|
|
* The description header can be found in signal_processing_library.h
|
|
*
|
|
*/
|
|
|
|
#include "signal_processing_library.h"
|
|
|
|
#define CIFFTSFT 14
|
|
#define CIFFTRND 1
|
|
|
|
#if (defined ARM9E_GCC) || (defined ARM_WINM) || (defined ANDROID_AECOPT)
|
|
extern "C" int FFT_4OIQ14(void *src, void *dest, int NC, int shift);
|
|
|
|
// For detailed description of the fft functions, check the readme files in fft_ARM9E folder.
|
|
int WebRtcSpl_ComplexIFFT2(WebRtc_Word16 frfi[], WebRtc_Word16 frfiOut[], int stages, int mode)
|
|
{
|
|
FFT_4OIQ14(frfi, frfiOut, 1 << stages, 0);
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
int WebRtcSpl_ComplexIFFT(WebRtc_Word16 frfi[], int stages, int mode)
|
|
{
|
|
int i, j, l, k, istep, n, m, scale, shift;
|
|
WebRtc_Word16 wr, wi;
|
|
WebRtc_Word32 tr32, ti32, qr32, qi32;
|
|
WebRtc_Word32 tmp32, round2;
|
|
|
|
/* The 1024-value is a constant given from the size of WebRtcSpl_kSinTable1024[],
|
|
* and should not be changed depending on the input parameter 'stages'
|
|
*/
|
|
n = 1 << stages;
|
|
if (n > 1024)
|
|
return -1;
|
|
|
|
scale = 0;
|
|
|
|
l = 1;
|
|
k = 10 - 1; /* Constant for given WebRtcSpl_kSinTable1024[]. Do not change
|
|
depending on the input parameter 'stages' */
|
|
|
|
while (l < n)
|
|
{
|
|
// variable scaling, depending upon data
|
|
shift = 0;
|
|
round2 = 8192;
|
|
|
|
tmp32 = (WebRtc_Word32)WebRtcSpl_MaxAbsValueW16(frfi, 2 * n);
|
|
if (tmp32 > 13573)
|
|
{
|
|
shift++;
|
|
scale++;
|
|
round2 <<= 1;
|
|
}
|
|
if (tmp32 > 27146)
|
|
{
|
|
shift++;
|
|
scale++;
|
|
round2 <<= 1;
|
|
}
|
|
|
|
istep = l << 1;
|
|
|
|
if (mode == 0)
|
|
{
|
|
// mode==0: Low-complexity and Low-accuracy mode
|
|
for (m = 0; m < l; ++m)
|
|
{
|
|
j = m << k;
|
|
|
|
/* The 256-value is a constant given as 1/4 of the size of
|
|
* WebRtcSpl_kSinTable1024[], and should not be changed depending on the input
|
|
* parameter 'stages'. It will result in 0 <= j < N_SINE_WAVE/2
|
|
*/
|
|
wr = WebRtcSpl_kSinTable1024[j + 256];
|
|
wi = WebRtcSpl_kSinTable1024[j];
|
|
|
|
for (i = m; i < n; i += istep)
|
|
{
|
|
j = i + l;
|
|
|
|
tr32 = WEBRTC_SPL_RSHIFT_W32((WEBRTC_SPL_MUL_16_16_RSFT(wr, frfi[2 * j], 0)
|
|
- WEBRTC_SPL_MUL_16_16_RSFT(wi, frfi[2 * j + 1], 0)), 15);
|
|
|
|
ti32 = WEBRTC_SPL_RSHIFT_W32(
|
|
(WEBRTC_SPL_MUL_16_16_RSFT(wr, frfi[2 * j + 1], 0)
|
|
+ WEBRTC_SPL_MUL_16_16_RSFT(wi,frfi[2*j],0)), 15);
|
|
|
|
qr32 = (WebRtc_Word32)frfi[2 * i];
|
|
qi32 = (WebRtc_Word32)frfi[2 * i + 1];
|
|
frfi[2 * j] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(qr32 - tr32, shift);
|
|
frfi[2 * j + 1] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(qi32 - ti32, shift);
|
|
frfi[2 * i] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(qr32 + tr32, shift);
|
|
frfi[2 * i + 1] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(qi32 + ti32, shift);
|
|
}
|
|
}
|
|
} else
|
|
{
|
|
// mode==1: High-complexity and High-accuracy mode
|
|
|
|
for (m = 0; m < l; ++m)
|
|
{
|
|
j = m << k;
|
|
|
|
/* The 256-value is a constant given as 1/4 of the size of
|
|
* WebRtcSpl_kSinTable1024[], and should not be changed depending on the input
|
|
* parameter 'stages'. It will result in 0 <= j < N_SINE_WAVE/2
|
|
*/
|
|
wr = WebRtcSpl_kSinTable1024[j + 256];
|
|
wi = WebRtcSpl_kSinTable1024[j];
|
|
|
|
for (i = m; i < n; i += istep)
|
|
{
|
|
j = i + l;
|
|
|
|
tr32 = WEBRTC_SPL_RSHIFT_W32((WEBRTC_SPL_MUL_16_16_RSFT(wr, frfi[2 * j], 0)
|
|
- WEBRTC_SPL_MUL_16_16_RSFT(wi, frfi[2 * j + 1], 0) + CIFFTRND),
|
|
15 - CIFFTSFT);
|
|
|
|
ti32 = WEBRTC_SPL_RSHIFT_W32(
|
|
(WEBRTC_SPL_MUL_16_16_RSFT(wr, frfi[2 * j + 1], 0)
|
|
+ WEBRTC_SPL_MUL_16_16_RSFT(wi, frfi[2 * j], 0)
|
|
+ CIFFTRND), 15 - CIFFTSFT);
|
|
|
|
qr32 = ((WebRtc_Word32)frfi[2 * i]) << CIFFTSFT;
|
|
qi32 = ((WebRtc_Word32)frfi[2 * i + 1]) << CIFFTSFT;
|
|
frfi[2 * j] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32((qr32 - tr32+round2),
|
|
shift+CIFFTSFT);
|
|
frfi[2 * j + 1] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(
|
|
(qi32 - ti32 + round2), shift + CIFFTSFT);
|
|
frfi[2 * i] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32((qr32 + tr32 + round2),
|
|
shift + CIFFTSFT);
|
|
frfi[2 * i + 1] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(
|
|
(qi32 + ti32 + round2), shift + CIFFTSFT);
|
|
}
|
|
}
|
|
|
|
}
|
|
--k;
|
|
l = istep;
|
|
}
|
|
return scale;
|
|
}
|