开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > Windows编程 > 多媒体编程 > 查看源码
sbr_qmf.c
资源名称：fullMPCcode.rar　[点击查看]
上传用户：xjjlds
上传日期：2015-12-05
资源大小：22823k
文件大小：24k
源码类别：

多媒体编程

开发平台：

Visual C++

sbr_qmf.c：源码内容
  1. /*
  2. ** FAAD2 - Freeware Advanced Audio (AAC) Decoder including SBR decoding
  3. ** Copyright (C) 2003-2005 M. Bakker, Ahead Software AG, http://www.nero.com
  4. **  
  5. ** This program is free software; you can redistribute it and/or modify
  6. ** it under the terms of the GNU General Public License as published by
  7. ** the Free Software Foundation; either version 2 of the License, or
  8. ** (at your option) any later version.
  9. ** 
  10. ** This program is distributed in the hope that it will be useful,
  11. ** but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13. ** GNU General Public License for more details.
  14. ** 
  15. ** You should have received a copy of the GNU General Public License
  16. ** along with this program; if not, write to the Free Software 
  17. ** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  18. **
  19. ** Any non-GPL usage of this software or parts of this software is strictly
  20. ** forbidden.
  21. **
  22. ** Software using this code must display the following message visibly in the
  23. ** software:
  24. ** "FAAD2 AAC/HE-AAC/HE-AACv2/DRM decoder (c) Ahead Software, www.nero.com"
  25. ** in, for example, the about-box or help/startup screen.
  26. **
  27. ** Commercial non-GPL licensing of this software is possible.
  28. ** For more info contact Ahead Software through Mpeg4AAClicense@nero.com.
  29. **
  30. ** $Id: sbr_qmf.c,v 1.3 2005/11/01 21:41:43 gabest Exp $
  31. **/
  33. #include "common.h"
  34. #include "structs.h"
  36. #ifdef SBR_DEC
  39. #include <stdlib.h>
  40. #include <string.h>
  41. #include "sbr_dct.h"
  42. #include "sbr_qmf.h"
  43. #include "sbr_qmf_c.h"
  44. #include "sbr_syntax.h"
  46. qmfa_info *qmfa_init(uint8_t channels)
  47. {
  48.     qmfa_info *qmfa = (qmfa_info*)faad_malloc(sizeof(qmfa_info));
  50. /* x is implemented as double ringbuffer */
  51.     qmfa->x = (real_t*)faad_malloc(2 * channels * 10 * sizeof(real_t));
  52.     memset(qmfa->x, 0, 2 * channels * 10 * sizeof(real_t));
  54. /* ringbuffer index */
  55. qmfa->x_index = 0;
  57.     qmfa->channels = channels;
  59.     return qmfa;
  60. }
  62. void qmfa_end(qmfa_info *qmfa)
  63. {
  64.     if (qmfa)
  65.     {
  66.         if (qmfa->x) faad_free(qmfa->x);
  67.         faad_free(qmfa);
  68.     }
  69. }
  71. void sbr_qmf_analysis_32(sbr_info *sbr, qmfa_info *qmfa, const real_t *input,
  72.                          qmf_t X[MAX_NTSRHFG][64], uint8_t offset, uint8_t kx)
  73. {
  74.     ALIGN real_t u[64];
  75. #ifndef SBR_LOW_POWER
  76.     ALIGN real_t in_real[32], in_imag[32], out_real[32], out_imag[32];
  77. #else
  78.     ALIGN real_t y[32];
  79. #endif
  80.     uint32_t in = 0;
  81.     uint8_t l;
  83.     /* qmf subsample l */
  84.     for (l = 0; l < sbr->numTimeSlotsRate; l++)
  85.     {
  86.         int16_t n;
  88.         /* shift input buffer x */
  89. /* input buffer is not shifted anymore, x is implemented as double ringbuffer */
  90.         //memmove(qmfa->x + 32, qmfa->x, (320-32)*sizeof(real_t));
  92.         /* add new samples to input buffer x */
  93.         for (n = 32 - 1; n >= 0; n--)
  94.         {
  95. #ifdef FIXED_POINT
  96.             qmfa->x[qmfa->x_index + n] = qmfa->x[qmfa->x_index + n + 320] = (input[in++]) >> 4;
  97. #else
  98.             qmfa->x[qmfa->x_index + n] = qmfa->x[qmfa->x_index + n + 320] = input[in++];
  99. #endif
  100.         }
  102.         /* window and summation to create array u */
  103.         for (n = 0; n < 64; n++)
  104.         {
  105.             u[n] = MUL_F(qmfa->x[qmfa->x_index + n], qmf_c[2*n]) +
  106.                 MUL_F(qmfa->x[qmfa->x_index + n + 64], qmf_c[2*(n + 64)]) +
  107.                 MUL_F(qmfa->x[qmfa->x_index + n + 128], qmf_c[2*(n + 128)]) +
  108.                 MUL_F(qmfa->x[qmfa->x_index + n + 192], qmf_c[2*(n + 192)]) +
  109.                 MUL_F(qmfa->x[qmfa->x_index + n + 256], qmf_c[2*(n + 256)]);
  110.         }
  112. /* update ringbuffer index */
  113. qmfa->x_index -= 32;
  114. if (qmfa->x_index < 0)
  115. qmfa->x_index = (320-32);
  117.         /* calculate 32 subband samples by introducing X */
  118. #ifdef SBR_LOW_POWER
  119.         y[0] = u[48];
  120.         for (n = 1; n < 16; n++)
  121.             y[n] = u[n+48] + u[48-n];
  122.         for (n = 16; n < 32; n++)
  123.             y[n] = -u[n-16] + u[48-n];
  125.         DCT3_32_unscaled(u, y);
  127.         for (n = 0; n < 32; n++)
  128.         {
  129.             if (n < kx)
  130.             {
  131. #ifdef FIXED_POINT
  132.                 QMF_RE(X[l + offset][n]) = u[n] /*<< 1*/;
  133. #else
  134.                 QMF_RE(X[l + offset][n]) = 2. * u[n];
  135. #endif
  136.             } else {
  137.                 QMF_RE(X[l + offset][n]) = 0;
  138.             }
  139.         }
  140. #else
  142.         // Reordering of data moved from DCT_IV to here
  143.         in_imag[31] = u[1];
  144.         in_real[0] = u[0];
  145.         for (n = 1; n < 31; n++)
  146.         {
  147.             in_imag[31 - n] = u[n+1];
  148.             in_real[n] = -u[64-n];
  149.         }
  150.         in_imag[0] = u[32];
  151.         in_real[31] = -u[33];
  153.         // dct4_kernel is DCT_IV without reordering which is done before and after FFT
  154.         dct4_kernel(in_real, in_imag, out_real, out_imag);
  156.         // Reordering of data moved from DCT_IV to here
  157.         for (n = 0; n < 16; n++) {
  158.             if (2*n+1 < kx) {
  159. #ifdef FIXED_POINT
  160.                 QMF_RE(X[l + offset][2*n])   = out_real[n];
  161.                 QMF_IM(X[l + offset][2*n])   = out_imag[n];
  162.                 QMF_RE(X[l + offset][2*n+1]) = -out_imag[31-n];
  163.                 QMF_IM(X[l + offset][2*n+1]) = -out_real[31-n];
  164. #else
  165.                 QMF_RE(X[l + offset][2*n])   = 2. * out_real[n];
  166.                 QMF_IM(X[l + offset][2*n])   = 2. * out_imag[n];
  167.                 QMF_RE(X[l + offset][2*n+1]) = -2. * out_imag[31-n];
  168.                 QMF_IM(X[l + offset][2*n+1]) = -2. * out_real[31-n];
  169. #endif
  170.             } else {
  171.                 if (2*n < kx) {
  172. #ifdef FIXED_POINT
  173.                     QMF_RE(X[l + offset][2*n])   = out_real[n];
  174.                     QMF_IM(X[l + offset][2*n])   = out_imag[n];
  175. #else
  176.                     QMF_RE(X[l + offset][2*n])   = 2. * out_real[n];
  177.                     QMF_IM(X[l + offset][2*n])   = 2. * out_imag[n];
  178. #endif
  179.                 }
  180.                 else {
  181.                     QMF_RE(X[l + offset][2*n]) = 0;
  182.                     QMF_IM(X[l + offset][2*n]) = 0;
  183.                 }
  184.                 QMF_RE(X[l + offset][2*n+1]) = 0;
  185.                 QMF_IM(X[l + offset][2*n+1]) = 0;
  186.             }
  187.         }
  188. #endif
  189.     }
  190. }
  192. static const complex_t qmf32_pre_twiddle[] =
  193. {
  194.     { FRAC_CONST(0.999924701839145), FRAC_CONST(-0.012271538285720) },
  195.     { FRAC_CONST(0.999322384588350), FRAC_CONST(-0.036807222941359) },
  196.     { FRAC_CONST(0.998118112900149), FRAC_CONST(-0.061320736302209) },
  197.     { FRAC_CONST(0.996312612182778), FRAC_CONST(-0.085797312344440) },
  198.     { FRAC_CONST(0.993906970002356), FRAC_CONST(-0.110222207293883) },
  199.     { FRAC_CONST(0.990902635427780), FRAC_CONST(-0.134580708507126) },
  200.     { FRAC_CONST(0.987301418157858), FRAC_CONST(-0.158858143333861) },
  201.     { FRAC_CONST(0.983105487431216), FRAC_CONST(-0.183039887955141) },
  202.     { FRAC_CONST(0.978317370719628), FRAC_CONST(-0.207111376192219) },
  203.     { FRAC_CONST(0.972939952205560), FRAC_CONST(-0.231058108280671) },
  204.     { FRAC_CONST(0.966976471044852), FRAC_CONST(-0.254865659604515) },
  205.     { FRAC_CONST(0.960430519415566), FRAC_CONST(-0.278519689385053) },
  206.     { FRAC_CONST(0.953306040354194), FRAC_CONST(-0.302005949319228) },
  207.     { FRAC_CONST(0.945607325380521), FRAC_CONST(-0.325310292162263) },
  208.     { FRAC_CONST(0.937339011912575), FRAC_CONST(-0.348418680249435) },
  209.     { FRAC_CONST(0.928506080473216), FRAC_CONST(-0.371317193951838) },
  210.     { FRAC_CONST(0.919113851690058), FRAC_CONST(-0.393992040061048) },
  211.     { FRAC_CONST(0.909167983090522), FRAC_CONST(-0.416429560097637) },
  212.     { FRAC_CONST(0.898674465693954), FRAC_CONST(-0.438616238538528) },
  213.     { FRAC_CONST(0.887639620402854), FRAC_CONST(-0.460538710958240) },
  214.     { FRAC_CONST(0.876070094195407), FRAC_CONST(-0.482183772079123) },
  215.     { FRAC_CONST(0.863972856121587), FRAC_CONST(-0.503538383725718) },
  216.     { FRAC_CONST(0.851355193105265), FRAC_CONST(-0.524589682678469) },
  217.     { FRAC_CONST(0.838224705554838), FRAC_CONST(-0.545324988422046) },
  218.     { FRAC_CONST(0.824589302785025), FRAC_CONST(-0.565731810783613) },
  219.     { FRAC_CONST(0.810457198252595), FRAC_CONST(-0.585797857456439) },
  220.     { FRAC_CONST(0.795836904608884), FRAC_CONST(-0.605511041404326) },
  221.     { FRAC_CONST(0.780737228572094), FRAC_CONST(-0.624859488142386) },
  222.     { FRAC_CONST(0.765167265622459), FRAC_CONST(-0.643831542889791) },
  223.     { FRAC_CONST(0.749136394523459), FRAC_CONST(-0.662415777590172) },
  224.     { FRAC_CONST(0.732654271672413), FRAC_CONST(-0.680600997795453) },
  225.     { FRAC_CONST(0.715730825283819), FRAC_CONST(-0.698376249408973) }
  226. };
  228. qmfs_info *qmfs_init(uint8_t channels)
  229. {
  230.     qmfs_info *qmfs = (qmfs_info*)faad_malloc(sizeof(qmfs_info));
  232. /* v is a double ringbuffer */
  233.     qmfs->v = (real_t*)faad_malloc(2 * channels * 20 * sizeof(real_t));
  234.     memset(qmfs->v, 0, 2 * channels * 20 * sizeof(real_t));
  236.     qmfs->v_index = 0;
  238.     qmfs->channels = channels;
  240.     return qmfs;
  241. }
  243. void qmfs_end(qmfs_info *qmfs)
  244. {
  245.     if (qmfs)
  246.     {
  247.         if (qmfs->v) faad_free(qmfs->v);
  248.         faad_free(qmfs);
  249.     }
  250. }
  252. #ifdef SBR_LOW_POWER
  254. void sbr_qmf_synthesis_32(sbr_info *sbr, qmfs_info *qmfs, qmf_t X[MAX_NTSRHFG][64],
  255.                           real_t *output)
  256. {
  257.     ALIGN real_t x[16];
  258.     ALIGN real_t y[16];
  259.     int32_t n, k, out = 0;
  260.     uint8_t l;
  262.     /* qmf subsample l */
  263.     for (l = 0; l < sbr->numTimeSlotsRate; l++)
  264.     {
  265.         /* shift buffers */
  266.         /* we are not shifting v, it is a double ringbuffer */
  267.         //memmove(qmfs->v + 64, qmfs->v, (640-64)*sizeof(real_t));
  269.         /* calculate 64 samples */
  270.         for (k = 0; k < 16; k++)
  271.         {
  272. #ifdef FIXED_POINT
  273.             y[k] = (QMF_RE(X[l][k]) - QMF_RE(X[l][31 - k]));
  274.             x[k] = (QMF_RE(X[l][k]) + QMF_RE(X[l][31 - k]));
  275. #else
  276.             y[k] = (QMF_RE(X[l][k]) - QMF_RE(X[l][31 - k])) / 32.0;
  277.             x[k] = (QMF_RE(X[l][k]) + QMF_RE(X[l][31 - k])) / 32.0;
  278. #endif
  279.         }
  281.         /* even n samples */
  282.         DCT2_16_unscaled(x, x);
  283.         /* odd n samples */
  284.         DCT4_16(y, y);
  286.         for (n = 8; n < 24; n++)
  287.         {
  288.             qmfs->v[qmfs->v_index + n*2] = qmfs->v[qmfs->v_index + 640 + n*2] = x[n-8];
  289.             qmfs->v[qmfs->v_index + n*2+1] = qmfs->v[qmfs->v_index + 640 + n*2+1] = y[n-8];
  290.         }
  291.         for (n = 0; n < 16; n++)
  292.         {
  293.             qmfs->v[qmfs->v_index + n] = qmfs->v[qmfs->v_index + 640 + n] = qmfs->v[qmfs->v_index + 32-n];
  294.         }
  295.         qmfs->v[qmfs->v_index + 48] = qmfs->v[qmfs->v_index + 640 + 48] = 0;
  296.         for (n = 1; n < 16; n++)
  297.         {
  298.             qmfs->v[qmfs->v_index + 48+n] = qmfs->v[qmfs->v_index + 640 + 48+n] = -qmfs->v[qmfs->v_index + 48-n];
  299.         }
  301.         /* calculate 32 output samples and window */
  302.         for (k = 0; k < 32; k++)
  303.         {
  304.             output[out++] = MUL_F(qmfs->v[qmfs->v_index + k], qmf_c[2*k]) +
  305.                 MUL_F(qmfs->v[qmfs->v_index + 96 + k], qmf_c[64 + 2*k]) +
  306.                 MUL_F(qmfs->v[qmfs->v_index + 128 + k], qmf_c[128 + 2*k]) +
  307.                 MUL_F(qmfs->v[qmfs->v_index + 224 + k], qmf_c[192 + 2*k]) +
  308.                 MUL_F(qmfs->v[qmfs->v_index + 256 + k], qmf_c[256 + 2*k]) +
  309.                 MUL_F(qmfs->v[qmfs->v_index + 352 + k], qmf_c[320 + 2*k]) +
  310.                 MUL_F(qmfs->v[qmfs->v_index + 384 + k], qmf_c[384 + 2*k]) +
  311.                 MUL_F(qmfs->v[qmfs->v_index + 480 + k], qmf_c[448 + 2*k]) +
  312.                 MUL_F(qmfs->v[qmfs->v_index + 512 + k], qmf_c[512 + 2*k]) +
  313.                 MUL_F(qmfs->v[qmfs->v_index + 608 + k], qmf_c[576 + 2*k]);
  314.         }
  316.         /* update the ringbuffer index */
  317.         qmfs->v_index -= 64;
  318.         if (qmfs->v_index < 0)
  319.             qmfs->v_index = (640-64);
  320.     }
  321. }
  323. void sbr_qmf_synthesis_64(sbr_info *sbr, qmfs_info *qmfs, qmf_t X[MAX_NTSRHFG][64],
  324.                           real_t *output)
  325. {
  326.     ALIGN real_t x[64];
  327.     ALIGN real_t y[64];
  328.     int32_t n, k, out = 0;
  329.     uint8_t l;
  332.     /* qmf subsample l */
  333.     for (l = 0; l < sbr->numTimeSlotsRate; l++)
  334.     {
  335.         /* shift buffers */
  336.         /* we are not shifting v, it is a double ringbuffer */
  337.         //memmove(qmfs->v + 128, qmfs->v, (1280-128)*sizeof(real_t));
  339.         /* calculate 128 samples */
  340.         for (k = 0; k < 32; k++)
  341.         {
  342. #ifdef FIXED_POINT
  343.             y[k] = (QMF_RE(X[l][k]) - QMF_RE(X[l][63 - k]));
  344.             x[k] = (QMF_RE(X[l][k]) + QMF_RE(X[l][63 - k]));
  345. #else
  346.             y[k] = (QMF_RE(X[l][k]) - QMF_RE(X[l][63 - k])) / 32.0;
  347.             x[k] = (QMF_RE(X[l][k]) + QMF_RE(X[l][63 - k])) / 32.0;
  348. #endif
  349.         }
  351.         /* even n samples */
  352.         DCT2_32_unscaled(x, x);
  353.         /* odd n samples */
  354.         DCT4_32(y, y);
  356.         for (n = 16; n < 48; n++)
  357.         {
  358.             qmfs->v[qmfs->v_index + n*2]   = qmfs->v[qmfs->v_index + 1280 + n*2]   = x[n-16];
  359.             qmfs->v[qmfs->v_index + n*2+1] = qmfs->v[qmfs->v_index + 1280 + n*2+1] = y[n-16];
  360.         }
  361.         for (n = 0; n < 32; n++)
  362.         {
  363.             qmfs->v[qmfs->v_index + n] = qmfs->v[qmfs->v_index + 1280 + n] = qmfs->v[qmfs->v_index + 64-n];
  364.         }
  365.         qmfs->v[qmfs->v_index + 96] = qmfs->v[qmfs->v_index + 1280 + 96] = 0;
  366.         for (n = 1; n < 32; n++)
  367.         {
  368.             qmfs->v[qmfs->v_index + 96+n] = qmfs->v[qmfs->v_index + 1280 + 96+n] = -qmfs->v[qmfs->v_index + 96-n];
  369.         }
  371.         /* calculate 64 output samples and window */
  372.         for (k = 0; k < 64; k++)
  373.         {
  374.             output[out++] = MUL_F(qmfs->v[qmfs->v_index + k], qmf_c[k]) +
  375.                 MUL_F(qmfs->v[qmfs->v_index + 192 + k], qmf_c[64 + k]) +
  376.                 MUL_F(qmfs->v[qmfs->v_index + 256 + k], qmf_c[128 + k]) +
  377.                 MUL_F(qmfs->v[qmfs->v_index + 256 + 192 + k], qmf_c[128 + 64 + k]) +
  378.                 MUL_F(qmfs->v[qmfs->v_index + 512 + k], qmf_c[256 + k]) +
  379.                 MUL_F(qmfs->v[qmfs->v_index + 512 + 192 + k], qmf_c[256 + 64 + k]) +
  380.                 MUL_F(qmfs->v[qmfs->v_index + 768 + k], qmf_c[384 + k]) +
  381.                 MUL_F(qmfs->v[qmfs->v_index + 768 + 192 + k], qmf_c[384 + 64 + k]) +
  382.                 MUL_F(qmfs->v[qmfs->v_index + 1024 + k], qmf_c[512 + k]) +
  383.                 MUL_F(qmfs->v[qmfs->v_index + 1024 + 192 + k], qmf_c[512 + 64 + k]);
  384.         }
  386.         /* update the ringbuffer index */
  387.         qmfs->v_index -= 128;
  388.         if (qmfs->v_index < 0)
  389.             qmfs->v_index = (1280-128);
  390.     }
  391. }
  392. #else
  393. void sbr_qmf_synthesis_32(sbr_info *sbr, qmfs_info *qmfs, qmf_t X[MAX_NTSRHFG][64],
  394.                           real_t *output)
  395. {
  396.     ALIGN real_t x1[32], x2[32];
  397. #ifndef FIXED_POINT
  398.     real_t scale = 1.f/64.f;
  399. #endif
  400.     int32_t n, k, out = 0;
  401.     uint8_t l;
  404.     /* qmf subsample l */
  405.     for (l = 0; l < sbr->numTimeSlotsRate; l++)
  406.     {
  407.         /* shift buffer v */
  408.         /* buffer is not shifted, we are using a ringbuffer */
  409.         //memmove(qmfs->v + 64, qmfs->v, (640-64)*sizeof(real_t));
  411.         /* calculate 64 samples */
  412.         /* complex pre-twiddle */
  413.         for (k = 0; k < 32; k++)
  414.         {
  415.             x1[k] = MUL_F(QMF_RE(X[l][k]), RE(qmf32_pre_twiddle[k])) - MUL_F(QMF_IM(X[l][k]), IM(qmf32_pre_twiddle[k]));
  416.             x2[k] = MUL_F(QMF_IM(X[l][k]), RE(qmf32_pre_twiddle[k])) + MUL_F(QMF_RE(X[l][k]), IM(qmf32_pre_twiddle[k]));
  418. #ifndef FIXED_POINT
  419.             x1[k] *= scale;
  420.             x2[k] *= scale;
  421. #else
  422.             x1[k] >>= 1;
  423.             x2[k] >>= 1;
  424. #endif
  425.         }
  427.         /* transform */
  428.         DCT4_32(x1, x1);
  429.         DST4_32(x2, x2);
  431.         for (n = 0; n < 32; n++)
  432.         {
  433.             qmfs->v[qmfs->v_index + n]      = qmfs->v[qmfs->v_index + 640 + n]      = -x1[n] + x2[n];
  434.             qmfs->v[qmfs->v_index + 63 - n] = qmfs->v[qmfs->v_index + 640 + 63 - n] =  x1[n] + x2[n];
  435.         }
  437.         /* calculate 32 output samples and window */
  438.         for (k = 0; k < 32; k++)
  439.         {
  440.             output[out++] = MUL_F(qmfs->v[qmfs->v_index + k], qmf_c[2*k]) +
  441.                 MUL_F(qmfs->v[qmfs->v_index + 96 + k], qmf_c[64 + 2*k]) +
  442.                 MUL_F(qmfs->v[qmfs->v_index + 128 + k], qmf_c[128 + 2*k]) +
  443.                 MUL_F(qmfs->v[qmfs->v_index + 224 + k], qmf_c[192 + 2*k]) +
  444.                 MUL_F(qmfs->v[qmfs->v_index + 256 + k], qmf_c[256 + 2*k]) +
  445.                 MUL_F(qmfs->v[qmfs->v_index + 352 + k], qmf_c[320 + 2*k]) +
  446.                 MUL_F(qmfs->v[qmfs->v_index + 384 + k], qmf_c[384 + 2*k]) +
  447.                 MUL_F(qmfs->v[qmfs->v_index + 480 + k], qmf_c[448 + 2*k]) +
  448.                 MUL_F(qmfs->v[qmfs->v_index + 512 + k], qmf_c[512 + 2*k]) +
  449.                 MUL_F(qmfs->v[qmfs->v_index + 608 + k], qmf_c[576 + 2*k]);
  450.         }
  452.         /* update ringbuffer index */
  453.         qmfs->v_index -= 64;
  454.         if (qmfs->v_index < 0)
  455.             qmfs->v_index = (640 - 64);
  456.     }
  457. }
  459. void sbr_qmf_synthesis_64(sbr_info *sbr, qmfs_info *qmfs, qmf_t X[MAX_NTSRHFG][64],
  460.                           real_t *output)
  461. {
  462. //    ALIGN real_t x1[64], x2[64];
  463. #ifndef SBR_LOW_POWER
  464.     ALIGN real_t in_real1[32], in_imag1[32], out_real1[32], out_imag1[32];
  465.     ALIGN real_t in_real2[32], in_imag2[32], out_real2[32], out_imag2[32];
  466. #endif
  467.     qmf_t * pX;
  468.     real_t * pring_buffer_1, * pring_buffer_3;
  469. //    real_t * ptemp_1, * ptemp_2;
  470. #ifdef PREFER_POINTERS
  471.     // These pointers are used if target platform has autoinc address generators
  472.     real_t * pring_buffer_2, * pring_buffer_4;
  473.     real_t * pring_buffer_5, * pring_buffer_6;
  474.     real_t * pring_buffer_7, * pring_buffer_8;
  475.     real_t * pring_buffer_9, * pring_buffer_10;
  476.     const real_t * pqmf_c_1, * pqmf_c_2, * pqmf_c_3, * pqmf_c_4;
  477.     const real_t * pqmf_c_5, * pqmf_c_6, * pqmf_c_7, * pqmf_c_8;
  478.     const real_t * pqmf_c_9, * pqmf_c_10;
  479. #endif // #ifdef PREFER_POINTERS
  480. #ifndef FIXED_POINT
  481.     real_t scale = 1.f/64.f;
  482. #endif
  483.     int32_t n, k, out = 0;
  484.     uint8_t l;
  487.     /* qmf subsample l */
  488.     for (l = 0; l < sbr->numTimeSlotsRate; l++)
  489.     {
  490.         /* shift buffer v */
  491. /* buffer is not shifted, we use double ringbuffer */
  492. //memmove(qmfs->v + 128, qmfs->v, (1280-128)*sizeof(real_t));
  494.         /* calculate 128 samples */
  495. #ifndef FIXED_POINT
  497.         pX = X[l];
  499.         in_imag1[31] = scale*QMF_RE(pX[1]);
  500.         in_real1[0]  = scale*QMF_RE(pX[0]);
  501.         in_imag2[31] = scale*QMF_IM(pX[63-1]);
  502.         in_real2[0]  = scale*QMF_IM(pX[63-0]);
  503.         for (k = 1; k < 31; k++)
  504.         {
  505.             in_imag1[31 - k] = scale*QMF_RE(pX[2*k + 1]);
  506.             in_real1[     k] = scale*QMF_RE(pX[2*k    ]);
  507.             in_imag2[31 - k] = scale*QMF_IM(pX[63 - (2*k + 1)]);
  508.             in_real2[     k] = scale*QMF_IM(pX[63 - (2*k    )]);
  509.         }
  510.         in_imag1[0]  = scale*QMF_RE(pX[63]);
  511.         in_real1[31] = scale*QMF_RE(pX[62]);
  512.         in_imag2[0]  = scale*QMF_IM(pX[63-63]);
  513.         in_real2[31] = scale*QMF_IM(pX[63-62]);
  515. #else
  517.         pX = X[l];
  519.         in_imag1[31] = QMF_RE(pX[1]) >> 1;
  520.         in_real1[0]  = QMF_RE(pX[0]) >> 1;
  521.         in_imag2[31] = QMF_IM(pX[62]) >> 1;
  522.         in_real2[0]  = QMF_IM(pX[63]) >> 1;
  523.         for (k = 1; k < 31; k++)
  524.         {
  525.             in_imag1[31 - k] = QMF_RE(pX[2*k + 1]) >> 1;
  526.             in_real1[     k] = QMF_RE(pX[2*k    ]) >> 1;
  527.             in_imag2[31 - k] = QMF_IM(pX[63 - (2*k + 1)]) >> 1;
  528.             in_real2[     k] = QMF_IM(pX[63 - (2*k    )]) >> 1;
  529.         }
  530.         in_imag1[0]  = QMF_RE(pX[63]) >> 1;
  531.         in_real1[31] = QMF_RE(pX[62]) >> 1;
  532.         in_imag2[0]  = QMF_IM(pX[0]) >> 1;
  533.         in_real2[31] = QMF_IM(pX[1]) >> 1;
  535. #endif
  538.         // dct4_kernel is DCT_IV without reordering which is done before and after FFT
  539.         dct4_kernel(in_real1, in_imag1, out_real1, out_imag1);
  540.         dct4_kernel(in_real2, in_imag2, out_real2, out_imag2);
  543.         pring_buffer_1 = qmfs->v + qmfs->v_index;
  544.         pring_buffer_3 = pring_buffer_1 + 1280;
  545. #ifdef PREFER_POINTERS
  546.         pring_buffer_2 = pring_buffer_1 + 127;
  547.         pring_buffer_4 = pring_buffer_1 + (1280 + 127);
  548. #endif // #ifdef PREFER_POINTERS
  549. //        ptemp_1 = x1;
  550. //        ptemp_2 = x2;
  551. #ifdef PREFER_POINTERS
  552.         for (n = 0; n < 32; n ++)
  553.         {
  554.             //real_t x1 = *ptemp_1++;
  555.             //real_t x2 = *ptemp_2++;
  556.             // pring_buffer_3 and pring_buffer_4 are needed only for double ring buffer
  557.             *pring_buffer_1++ = *pring_buffer_3++ = out_real2[n] - out_real1[n];
  558.             *pring_buffer_2-- = *pring_buffer_4-- = out_real2[n] + out_real1[n];
  559.             //x1 = *ptemp_1++;
  560.             //x2 = *ptemp_2++;
  561.             *pring_buffer_1++ = *pring_buffer_3++ = out_imag2[31-n] + out_imag1[31-n];
  562.             *pring_buffer_2-- = *pring_buffer_4-- = out_imag2[31-n] - out_imag1[31-n];
  563.         }
  564. #else // #ifdef PREFER_POINTERS
  566.         for (n = 0; n < 32; n++)
  567.         {
  568.             // pring_buffer_3 and pring_buffer_4 are needed only for double ring buffer
  569.             pring_buffer_1[2*n]         = pring_buffer_3[2*n]         = out_real2[n] - out_real1[n];
  570.             pring_buffer_1[127-2*n]     = pring_buffer_3[127-2*n]     = out_real2[n] + out_real1[n];
  571.             pring_buffer_1[2*n+1]       = pring_buffer_3[2*n+1]       = out_imag2[31-n] + out_imag1[31-n];
  572.             pring_buffer_1[127-(2*n+1)] = pring_buffer_3[127-(2*n+1)] = out_imag2[31-n] - out_imag1[31-n];
  573.         }
  575. #endif // #ifdef PREFER_POINTERS
  577.         pring_buffer_1 = qmfs->v + qmfs->v_index;
  578. #ifdef PREFER_POINTERS
  579.         pring_buffer_2 = pring_buffer_1 + 192;
  580.         pring_buffer_3 = pring_buffer_1 + 256;
  581.         pring_buffer_4 = pring_buffer_1 + (256 + 192);
  582.         pring_buffer_5 = pring_buffer_1 + 512;
  583.         pring_buffer_6 = pring_buffer_1 + (512 + 192);
  584.         pring_buffer_7 = pring_buffer_1 + 768;
  585.         pring_buffer_8 = pring_buffer_1 + (768 + 192);
  586.         pring_buffer_9 = pring_buffer_1 + 1024;
  587.         pring_buffer_10 = pring_buffer_1 + (1024 + 192);
  588.         pqmf_c_1 = qmf_c;
  589.         pqmf_c_2 = qmf_c + 64;
  590.         pqmf_c_3 = qmf_c + 128;
  591.         pqmf_c_4 = qmf_c + 192;
  592.         pqmf_c_5 = qmf_c + 256;
  593.         pqmf_c_6 = qmf_c + 320;
  594.         pqmf_c_7 = qmf_c + 384;
  595.         pqmf_c_8 = qmf_c + 448;
  596.         pqmf_c_9 = qmf_c + 512;
  597.         pqmf_c_10 = qmf_c + 576;
  598. #endif // #ifdef PREFER_POINTERS
  600.         /* calculate 64 output samples and window */
  601.         for (k = 0; k < 64; k++)
  602.         {
  603. #ifdef PREFER_POINTERS
  604.             output[out++] =
  605.                 MUL_F(*pring_buffer_1++,  *pqmf_c_1++) +
  606.                 MUL_F(*pring_buffer_2++,  *pqmf_c_2++) +
  607.                 MUL_F(*pring_buffer_3++,  *pqmf_c_3++) +
  608.                 MUL_F(*pring_buffer_4++,  *pqmf_c_4++) +
  609.                 MUL_F(*pring_buffer_5++,  *pqmf_c_5++) +
  610.                 MUL_F(*pring_buffer_6++,  *pqmf_c_6++) +
  611.                 MUL_F(*pring_buffer_7++,  *pqmf_c_7++) +
  612.                 MUL_F(*pring_buffer_8++,  *pqmf_c_8++) +
  613.                 MUL_F(*pring_buffer_9++,  *pqmf_c_9++) +
  614.                 MUL_F(*pring_buffer_10++, *pqmf_c_10++);
  615. #else // #ifdef PREFER_POINTERS
  616.             output[out++] =
  617.                 MUL_F(pring_buffer_1[k+0],          qmf_c[k+0])   +
  618.                 MUL_F(pring_buffer_1[k+192],        qmf_c[k+64])  +
  619.                 MUL_F(pring_buffer_1[k+256],        qmf_c[k+128]) +
  620.                 MUL_F(pring_buffer_1[k+(256+192)],  qmf_c[k+192]) +
  621.                 MUL_F(pring_buffer_1[k+512],        qmf_c[k+256]) +
  622.                 MUL_F(pring_buffer_1[k+(512+192)],  qmf_c[k+320]) +
  623.                 MUL_F(pring_buffer_1[k+768],        qmf_c[k+384]) +
  624.                 MUL_F(pring_buffer_1[k+(768+192)],  qmf_c[k+448]) +
  625.                 MUL_F(pring_buffer_1[k+1024],       qmf_c[k+512]) +
  626.                 MUL_F(pring_buffer_1[k+(1024+192)], qmf_c[k+576]);
  627. #endif // #ifdef PREFER_POINTERS
  628.         }
  630.         /* update ringbuffer index */
  631.         qmfs->v_index -= 128;
  632.         if (qmfs->v_index < 0)
  633.             qmfs->v_index = (1280 - 128);
  634.     }
  635. }
  636. #endif
  638. #endif