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

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

多媒体编程

开发平台：

Visual C++

sbr_hfadj.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_hfadj.c,v 1.2 2005/11/01 21:41:43 gabest Exp $
  31. **/
  33. /* High Frequency adjustment */
  35. #include "common.h"
  36. #include "structs.h"
  38. #ifdef SBR_DEC
  40. #include "sbr_syntax.h"
  41. #include "sbr_hfadj.h"
  43. #include "sbr_noise.h"
  46. /* static function declarations */
  47. static uint8_t estimate_current_envelope(sbr_info *sbr, sbr_hfadj_info *adj,
  48.                                          qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch);
  49. static void calculate_gain(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch);
  50. #ifdef SBR_LOW_POWER
  51. static void calc_gain_groups(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch);
  52. static void aliasing_reduction(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch);
  53. #endif
  54. static void hf_assembly(sbr_info *sbr, sbr_hfadj_info *adj, qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch);
  57. uint8_t hf_adjustment(sbr_info *sbr, qmf_t Xsbr[MAX_NTSRHFG][64]
  58. #ifdef SBR_LOW_POWER
  59.                       ,real_t *deg /* aliasing degree */
  60. #endif
  61.                       ,uint8_t ch)
  62. {
  63.     ALIGN sbr_hfadj_info adj = {{{0}}};
  64.     uint8_t ret = 0;
  66.     if (sbr->bs_frame_class[ch] == FIXFIX)
  67.     {
  68.         sbr->l_A[ch] = -1;
  69.     } else if (sbr->bs_frame_class[ch] == VARFIX) {
  70.         if (sbr->bs_pointer[ch] > 1)
  71.             sbr->l_A[ch] = -1;
  72.         else
  73.             sbr->l_A[ch] = sbr->bs_pointer[ch] - 1;
  74.     } else {
  75.         if (sbr->bs_pointer[ch] == 0)
  76.             sbr->l_A[ch] = -1;
  77.         else
  78.             sbr->l_A[ch] = sbr->L_E[ch] + 1 - sbr->bs_pointer[ch];
  79.     }
  81.     ret = estimate_current_envelope(sbr, &adj, Xsbr, ch);
  82.     if (ret > 0)
  83.         return 1;
  85.     calculate_gain(sbr, &adj, ch);
  87. #ifdef SBR_LOW_POWER
  88.     calc_gain_groups(sbr, &adj, deg, ch);
  89.     aliasing_reduction(sbr, &adj, deg, ch);
  90. #endif
  92.     hf_assembly(sbr, &adj, Xsbr, ch);
  94.     return 0;
  95. }
  97. static uint8_t get_S_mapped(sbr_info *sbr, uint8_t ch, uint8_t l, uint8_t current_band)
  98. {
  99.     if (sbr->f[ch][l] == HI_RES)
  100.     {
  101.         /* in case of using f_table_high we just have 1 to 1 mapping
  102.          * from bs_add_harmonic[l][k]
  103.          */
  104.         if ((l >= sbr->l_A[ch]) ||
  105.             (sbr->bs_add_harmonic_prev[ch][current_band] && sbr->bs_add_harmonic_flag_prev[ch]))
  106.         {
  107.             return sbr->bs_add_harmonic[ch][current_band];
  108.         }
  109.     } else {
  110.         uint8_t b, lb, ub;
  112.         /* in case of f_table_low we check if any of the HI_RES bands
  113.          * within this LO_RES band has bs_add_harmonic[l][k] turned on
  114.          * (note that borders in the LO_RES table are also present in
  115.          * the HI_RES table)
  116.          */
  118.         /* find first HI_RES band in current LO_RES band */
  119.         lb = 2*current_band - ((sbr->N_high & 1) ? 1 : 0);
  120.         /* find first HI_RES band in next LO_RES band */
  121.         ub = 2*(current_band+1) - ((sbr->N_high & 1) ? 1 : 0);
  123.         /* check all HI_RES bands in current LO_RES band for sinusoid */
  124.         for (b = lb; b < ub; b++)
  125.         {
  126.             if ((l >= sbr->l_A[ch]) ||
  127.                 (sbr->bs_add_harmonic_prev[ch][b] && sbr->bs_add_harmonic_flag_prev[ch]))
  128.             {
  129.                 if (sbr->bs_add_harmonic[ch][b] == 1)
  130.                     return 1;
  131.             }
  132.         }
  133.     }
  135.     return 0;
  136. }
  138. static uint8_t estimate_current_envelope(sbr_info *sbr, sbr_hfadj_info *adj,
  139.                                          qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch)
  140. {
  141.     uint8_t m, l, j, k, k_l, k_h, p;
  142.     real_t nrg, div;
  144.     if (sbr->bs_interpol_freq == 1)
  145.     {
  146.         for (l = 0; l < sbr->L_E[ch]; l++)
  147.         {
  148.             uint8_t i, l_i, u_i;
  150.             l_i = sbr->t_E[ch][l];
  151.             u_i = sbr->t_E[ch][l+1];
  153.             div = (real_t)(u_i - l_i);
  155.             if (div == 0)
  156.                 div = 1;
  158.             for (m = 0; m < sbr->M; m++)
  159.             {
  160.                 nrg = 0;
  162.                 for (i = l_i + sbr->tHFAdj; i < u_i + sbr->tHFAdj; i++)
  163.                 {
  164. #ifdef FIXED_POINT
  165. #ifdef SBR_LOW_POWER
  166.                     nrg += ((QMF_RE(Xsbr[i][m + sbr->kx])+(1<<(REAL_BITS-1)))>>REAL_BITS)*((QMF_RE(Xsbr[i][m + sbr->kx])+(1<<(REAL_BITS-1)))>>REAL_BITS);
  167. #else
  168.                     nrg += ((QMF_RE(Xsbr[i][m + sbr->kx])+(1<<(REAL_BITS-1)))>>REAL_BITS)*((QMF_RE(Xsbr[i][m + sbr->kx])+(1<<(REAL_BITS-1)))>>REAL_BITS) +
  169.                         ((QMF_IM(Xsbr[i][m + sbr->kx])+(1<<(REAL_BITS-1)))>>REAL_BITS)*((QMF_IM(Xsbr[i][m + sbr->kx])+(1<<(REAL_BITS-1)))>>REAL_BITS);
  170. #endif
  171. #else
  172.                     nrg += MUL_R(QMF_RE(Xsbr[i][m + sbr->kx]), QMF_RE(Xsbr[i][m + sbr->kx]))
  173. #ifndef SBR_LOW_POWER
  174.                         + MUL_R(QMF_IM(Xsbr[i][m + sbr->kx]), QMF_IM(Xsbr[i][m + sbr->kx]))
  175. #endif
  176.                         ;
  177. #endif
  178.                 }
  180.                 sbr->E_curr[ch][m][l] = nrg / div;
  181. #ifdef SBR_LOW_POWER
  182. #ifdef FIXED_POINT
  183.                 sbr->E_curr[ch][m][l] <<= 1;
  184. #else
  185.                 sbr->E_curr[ch][m][l] *= 2;
  186. #endif
  187. #endif
  188.             }
  189.         }
  190.     } else {
  191.         for (l = 0; l < sbr->L_E[ch]; l++)
  192.         {
  193.             for (p = 0; p < sbr->n[sbr->f[ch][l]]; p++)
  194.             {
  195.                 k_l = sbr->f_table_res[sbr->f[ch][l]][p];
  196.                 k_h = sbr->f_table_res[sbr->f[ch][l]][p+1];
  198.                 for (k = k_l; k < k_h; k++)
  199.                 {
  200.                     uint8_t i, l_i, u_i;
  201.                     nrg = 0;
  203.                     l_i = sbr->t_E[ch][l];
  204.                     u_i = sbr->t_E[ch][l+1];
  206.                     div = (real_t)((u_i - l_i)*(k_h - k_l));
  208.                     if (div == 0)
  209.                         div = 1;
  211.                     for (i = l_i + sbr->tHFAdj; i < u_i + sbr->tHFAdj; i++)
  212.                     {
  213.                         for (j = k_l; j < k_h; j++)
  214.                         {
  215. #ifdef FIXED_POINT
  216. #ifdef SBR_LOW_POWER
  217.                             nrg += ((QMF_RE(Xsbr[i][j])+(1<<(REAL_BITS-1)))>>REAL_BITS)*((QMF_RE(Xsbr[i][j])+(1<<(REAL_BITS-1)))>>REAL_BITS);
  218. #else
  219.                             nrg += ((QMF_RE(Xsbr[i][j])+(1<<(REAL_BITS-1)))>>REAL_BITS)*((QMF_RE(Xsbr[i][j])+(1<<(REAL_BITS-1)))>>REAL_BITS) +
  220.                                 ((QMF_IM(Xsbr[i][j])+(1<<(REAL_BITS-1)))>>REAL_BITS)*((QMF_IM(Xsbr[i][j])+(1<<(REAL_BITS-1)))>>REAL_BITS);
  221. #endif
  222. #else
  223.                             nrg += MUL_R(QMF_RE(Xsbr[i][j]), QMF_RE(Xsbr[i][j]))
  224. #ifndef SBR_LOW_POWER
  225.                                 + MUL_R(QMF_IM(Xsbr[i][j]), QMF_IM(Xsbr[i][j]))
  226. #endif
  227.                                 ;
  228. #endif
  229.                         }
  230.                     }
  232.                     sbr->E_curr[ch][k - sbr->kx][l] = nrg / div;
  233. #ifdef SBR_LOW_POWER
  234. #ifdef FIXED_POINT
  235.                     sbr->E_curr[ch][k - sbr->kx][l] <<= 1;
  236. #else
  237.                     sbr->E_curr[ch][k - sbr->kx][l] *= 2;
  238. #endif
  239. #endif
  240.                 }
  241.             }
  242.         }
  243.     }
  245.     return 0;
  246. }
  248. #ifdef FIXED_POINT
  249. #define EPS (1) /* smallest number available in fixed point */
  250. #else
  251. #define EPS (1e-12)
  252. #endif
  256. #ifdef FIXED_POINT
  258. /* log2 values of [0..63] */
  259. static const real_t log2_int_tab[] = {
  260.     LOG2_MIN_INF, REAL_CONST(0.000000000000000), REAL_CONST(1.000000000000000), REAL_CONST(1.584962500721156),
  261.     REAL_CONST(2.000000000000000), REAL_CONST(2.321928094887362), REAL_CONST(2.584962500721156), REAL_CONST(2.807354922057604),
  262.     REAL_CONST(3.000000000000000), REAL_CONST(3.169925001442313), REAL_CONST(3.321928094887363), REAL_CONST(3.459431618637297),
  263.     REAL_CONST(3.584962500721156), REAL_CONST(3.700439718141092), REAL_CONST(3.807354922057604), REAL_CONST(3.906890595608519),
  264.     REAL_CONST(4.000000000000000), REAL_CONST(4.087462841250339), REAL_CONST(4.169925001442312), REAL_CONST(4.247927513443585),
  265.     REAL_CONST(4.321928094887362), REAL_CONST(4.392317422778761), REAL_CONST(4.459431618637297), REAL_CONST(4.523561956057013),
  266.     REAL_CONST(4.584962500721156), REAL_CONST(4.643856189774724), REAL_CONST(4.700439718141093), REAL_CONST(4.754887502163468),
  267.     REAL_CONST(4.807354922057604), REAL_CONST(4.857980995127572), REAL_CONST(4.906890595608519), REAL_CONST(4.954196310386875),
  268.     REAL_CONST(5.000000000000000), REAL_CONST(5.044394119358453), REAL_CONST(5.087462841250340), REAL_CONST(5.129283016944966),
  269.     REAL_CONST(5.169925001442312), REAL_CONST(5.209453365628949), REAL_CONST(5.247927513443585), REAL_CONST(5.285402218862248),
  270.     REAL_CONST(5.321928094887363), REAL_CONST(5.357552004618084), REAL_CONST(5.392317422778761), REAL_CONST(5.426264754702098),
  271.     REAL_CONST(5.459431618637297), REAL_CONST(5.491853096329675), REAL_CONST(5.523561956057013), REAL_CONST(5.554588851677637),
  272.     REAL_CONST(5.584962500721156), REAL_CONST(5.614709844115208), REAL_CONST(5.643856189774724), REAL_CONST(5.672425341971495),
  273.     REAL_CONST(5.700439718141093), REAL_CONST(5.727920454563200), REAL_CONST(5.754887502163469), REAL_CONST(5.781359713524660),
  274.     REAL_CONST(5.807354922057605), REAL_CONST(5.832890014164742), REAL_CONST(5.857980995127572), REAL_CONST(5.882643049361842),
  275.     REAL_CONST(5.906890595608518), REAL_CONST(5.930737337562887), REAL_CONST(5.954196310386876), REAL_CONST(5.977279923499916)
  276. };
  278. static const real_t pan_log2_tab[] = {
  279.     REAL_CONST(1.000000000000000), REAL_CONST(0.584962500721156), REAL_CONST(0.321928094887362), REAL_CONST(0.169925001442312), REAL_CONST(0.087462841250339),
  280.     REAL_CONST(0.044394119358453), REAL_CONST(0.022367813028455), REAL_CONST(0.011227255423254), REAL_CONST(0.005624549193878), REAL_CONST(0.002815015607054),
  281.     REAL_CONST(0.001408194392808), REAL_CONST(0.000704269011247), REAL_CONST(0.000352177480301), REAL_CONST(0.000176099486443), REAL_CONST(0.000088052430122),
  282.     REAL_CONST(0.000044026886827), REAL_CONST(0.000022013611360), REAL_CONST(0.000011006847667)
  283. };
  285. static real_t find_log2_E(sbr_info *sbr, uint8_t k, uint8_t l, uint8_t ch)
  286. {
  287.     /* check for coupled energy/noise data */
  288.     if (sbr->bs_coupling == 1)
  289.     {
  290.         uint8_t amp0 = (sbr->amp_res[0]) ? 0 : 1;
  291.         uint8_t amp1 = (sbr->amp_res[1]) ? 0 : 1;
  292.         real_t tmp = (7 << REAL_BITS) + (sbr->E[0][k][l] << (REAL_BITS-amp0));
  293.         real_t pan;
  295.         /* E[1] should always be even so shifting is OK */
  296.         uint8_t E = sbr->E[1][k][l] >> amp1;
  298.         if (ch == 0)
  299.         {
  300.             if (E > 12)
  301.             {
  302.                 /* negative */
  303.                 pan = pan_log2_tab[-12 + E];
  304.             } else {
  305.                 /* positive */
  306.                 pan = pan_log2_tab[12 - E] + ((12 - E)<<REAL_BITS);
  307.             }
  308.         } else {
  309.             if (E < 12)
  310.             {
  311.                 /* negative */
  312.                 pan = pan_log2_tab[-E + 12];
  313.             } else {
  314.                 /* positive */
  315.                 pan = pan_log2_tab[E - 12] + ((E - 12)<<REAL_BITS);
  316.             }
  317.         }
  319.         /* tmp / pan in log2 */
  320.         return tmp - pan;
  321.     } else {
  322.         uint8_t amp = (sbr->amp_res[ch]) ? 0 : 1;
  324.         return (6 << REAL_BITS) + (sbr->E[ch][k][l] << (REAL_BITS-amp));
  325.     }
  326. }
  328. static real_t find_log2_Q(sbr_info *sbr, uint8_t k, uint8_t l, uint8_t ch)
  329. {
  330.     /* check for coupled energy/noise data */
  331.     if (sbr->bs_coupling == 1)
  332.     {
  333.         real_t tmp = (7 << REAL_BITS) - (sbr->Q[0][k][l] << REAL_BITS);
  334.         real_t pan;
  336.         uint8_t Q = sbr->Q[1][k][l];
  338.         if (ch == 0)
  339.         {
  340.             if (Q > 12)
  341.             {
  342.                 /* negative */
  343.                 pan = pan_log2_tab[-12 + Q];
  344.             } else {
  345.                 /* positive */
  346.                 pan = pan_log2_tab[12 - Q] + ((12 - Q)<<REAL_BITS);
  347.             }
  348.         } else {
  349.             if (Q < 12)
  350.             {
  351.                 /* negative */
  352.                 pan = pan_log2_tab[-Q + 12];
  353.             } else {
  354.                 /* positive */
  355.                 pan = pan_log2_tab[Q - 12] + ((Q - 12)<<REAL_BITS);
  356.             }
  357.         }
  359.         /* tmp / pan in log2 */
  360.         return tmp - pan;
  361.     } else {
  362.         return (6 << REAL_BITS) - (sbr->Q[ch][k][l] << REAL_BITS);
  363.     }
  364. }
  366. static const real_t log_Qplus1_pan[31][13] = {
  367.     { REAL_CONST(0.044383447617292), REAL_CONST(0.169768601655960), REAL_CONST(0.583090126514435), REAL_CONST(1.570089221000671), REAL_CONST(3.092446088790894), REAL_CONST(4.733354568481445), REAL_CONST(6.022367954254150), REAL_CONST(6.692092418670654), REAL_CONST(6.924463272094727), REAL_CONST(6.989034175872803), REAL_CONST(7.005646705627441), REAL_CONST(7.009829998016357), REAL_CONST(7.010877609252930) },
  368.     { REAL_CONST(0.022362394258380), REAL_CONST(0.087379962205887), REAL_CONST(0.320804953575134), REAL_CONST(0.988859415054321), REAL_CONST(2.252387046813965), REAL_CONST(3.786596298217773), REAL_CONST(5.044394016265869), REAL_CONST(5.705977916717529), REAL_CONST(5.936291694641113), REAL_CONST(6.000346660614014), REAL_CONST(6.016829967498779), REAL_CONST(6.020981311798096), REAL_CONST(6.022020816802979) },
  369.     { REAL_CONST(0.011224525049329), REAL_CONST(0.044351425021887), REAL_CONST(0.169301137328148), REAL_CONST(0.577544987201691), REAL_CONST(1.527246952056885), REAL_CONST(2.887525320053101), REAL_CONST(4.087462902069092), REAL_CONST(4.733354568481445), REAL_CONST(4.959661006927490), REAL_CONST(5.022709369659424), REAL_CONST(5.038940429687500), REAL_CONST(5.043028831481934), REAL_CONST(5.044052600860596) },
  370.     { REAL_CONST(0.005623178556561), REAL_CONST(0.022346137091517), REAL_CONST(0.087132595479488), REAL_CONST(0.317482173442841), REAL_CONST(0.956931233406067), REAL_CONST(2.070389270782471), REAL_CONST(3.169924974441528), REAL_CONST(3.786596298217773), REAL_CONST(4.005294322967529), REAL_CONST(4.066420555114746), REAL_CONST(4.082170009613037), REAL_CONST(4.086137294769287), REAL_CONST(4.087131500244141) },
  371.     { REAL_CONST(0.002814328996465), REAL_CONST(0.011216334067285), REAL_CONST(0.044224001467228), REAL_CONST(0.167456731200218), REAL_CONST(0.556393325328827), REAL_CONST(1.378511548042297), REAL_CONST(2.321928024291992), REAL_CONST(2.887525320053101), REAL_CONST(3.092446088790894), REAL_CONST(3.150059700012207), REAL_CONST(3.164926528930664), REAL_CONST(3.168673276901245), REAL_CONST(3.169611930847168) },
  372.     { REAL_CONST(0.001407850766554), REAL_CONST(0.005619067233056), REAL_CONST(0.022281449288130), REAL_CONST(0.086156636476517), REAL_CONST(0.304854571819305), REAL_CONST(0.847996890544891), REAL_CONST(1.584962487220764), REAL_CONST(2.070389270782471), REAL_CONST(2.252387046813965), REAL_CONST(2.304061651229858), REAL_CONST(2.317430257797241), REAL_CONST(2.320801734924316), REAL_CONST(2.321646213531494) },
  373.     { REAL_CONST(0.000704097095877), REAL_CONST(0.002812269143760), REAL_CONST(0.011183738708496), REAL_CONST(0.043721374124289), REAL_CONST(0.160464659333229), REAL_CONST(0.485426813364029), REAL_CONST(1.000000000000000), REAL_CONST(1.378511548042297), REAL_CONST(1.527246952056885), REAL_CONST(1.570089221000671), REAL_CONST(1.581215262413025), REAL_CONST(1.584023833274841), REAL_CONST(1.584727644920349) },
  374.     { REAL_CONST(0.000352177477907), REAL_CONST(0.001406819908880), REAL_CONST(0.005602621007711), REAL_CONST(0.022026389837265), REAL_CONST(0.082462236285210), REAL_CONST(0.263034462928772), REAL_CONST(0.584962487220764), REAL_CONST(0.847996890544891), REAL_CONST(0.956931233406067), REAL_CONST(0.988859415054321), REAL_CONST(0.997190535068512), REAL_CONST(0.999296069145203), REAL_CONST(0.999823868274689) },
  375.     { REAL_CONST(0.000176099492819), REAL_CONST(0.000703581434209), REAL_CONST(0.002804030198604), REAL_CONST(0.011055230163038), REAL_CONST(0.041820213198662), REAL_CONST(0.137503549456596), REAL_CONST(0.321928083896637), REAL_CONST(0.485426813364029), REAL_CONST(0.556393325328827), REAL_CONST(0.577544987201691), REAL_CONST(0.583090126514435), REAL_CONST(0.584493279457092), REAL_CONST(0.584845066070557) },
  376.     { REAL_CONST(0.000088052431238), REAL_CONST(0.000351833587047), REAL_CONST(0.001402696361765), REAL_CONST(0.005538204684854), REAL_CONST(0.021061634644866), REAL_CONST(0.070389263331890), REAL_CONST(0.169925004243851), REAL_CONST(0.263034462928772), REAL_CONST(0.304854571819305), REAL_CONST(0.317482173442841), REAL_CONST(0.320804953575134), REAL_CONST(0.321646571159363), REAL_CONST(0.321857661008835) },
  377.     { REAL_CONST(0.000044026888645), REAL_CONST(0.000175927518285), REAL_CONST(0.000701518612914), REAL_CONST(0.002771759871393), REAL_CONST(0.010569252073765), REAL_CONST(0.035623874515295), REAL_CONST(0.087462842464447), REAL_CONST(0.137503549456596), REAL_CONST(0.160464659333229), REAL_CONST(0.167456731200218), REAL_CONST(0.169301137328148), REAL_CONST(0.169768601655960), REAL_CONST(0.169885858893394) },
  378.     { REAL_CONST(0.000022013611670), REAL_CONST(0.000088052431238), REAL_CONST(0.000350801943569), REAL_CONST(0.001386545598507), REAL_CONST(0.005294219125062), REAL_CONST(0.017921976745129), REAL_CONST(0.044394120573997), REAL_CONST(0.070389263331890), REAL_CONST(0.082462236285210), REAL_CONST(0.086156636476517), REAL_CONST(0.087132595479488), REAL_CONST(0.087379962205887), REAL_CONST(0.087442122399807) },
  379.     { REAL_CONST(0.000011006847672), REAL_CONST(0.000044026888645), REAL_CONST(0.000175411638338), REAL_CONST(0.000693439331371), REAL_CONST(0.002649537986144), REAL_CONST(0.008988817222416), REAL_CONST(0.022367812693119), REAL_CONST(0.035623874515295), REAL_CONST(0.041820213198662), REAL_CONST(0.043721374124289), REAL_CONST(0.044224001467228), REAL_CONST(0.044351425021887), REAL_CONST(0.044383447617292) },
  380.     { REAL_CONST(0.000005503434295), REAL_CONST(0.000022013611670), REAL_CONST(0.000087708482170), REAL_CONST(0.000346675369656), REAL_CONST(0.001325377263129), REAL_CONST(0.004501323681325), REAL_CONST(0.011227255687118), REAL_CONST(0.017921976745129), REAL_CONST(0.021061634644866), REAL_CONST(0.022026389837265), REAL_CONST(0.022281449288130), REAL_CONST(0.022346137091517), REAL_CONST(0.022362394258380) },
  381.     { REAL_CONST(0.000002751719876), REAL_CONST(0.000011006847672), REAL_CONST(0.000043854910473), REAL_CONST(0.000173348103999), REAL_CONST(0.000662840844598), REAL_CONST(0.002252417383716), REAL_CONST(0.005624548997730), REAL_CONST(0.008988817222416), REAL_CONST(0.010569252073765), REAL_CONST(0.011055230163038), REAL_CONST(0.011183738708496), REAL_CONST(0.011216334067285), REAL_CONST(0.011224525049329) },
  382.     { REAL_CONST(0.000001375860506), REAL_CONST(0.000005503434295), REAL_CONST(0.000022013611670), REAL_CONST(0.000086676649516), REAL_CONST(0.000331544462824), REAL_CONST(0.001126734190620), REAL_CONST(0.002815015614033), REAL_CONST(0.004501323681325), REAL_CONST(0.005294219125062), REAL_CONST(0.005538204684854), REAL_CONST(0.005602621007711), REAL_CONST(0.005619067233056), REAL_CONST(0.005623178556561) },
  383.     { REAL_CONST(0.000000687930424), REAL_CONST(0.000002751719876), REAL_CONST(0.000011006847672), REAL_CONST(0.000043338975956), REAL_CONST(0.000165781748365), REAL_CONST(0.000563477107789), REAL_CONST(0.001408194424585), REAL_CONST(0.002252417383716), REAL_CONST(0.002649537986144), REAL_CONST(0.002771759871393), REAL_CONST(0.002804030198604), REAL_CONST(0.002812269143760), REAL_CONST(0.002814328996465) },
  384.     { REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000005503434295), REAL_CONST(0.000021669651687), REAL_CONST(0.000082893253420), REAL_CONST(0.000281680084299), REAL_CONST(0.000704268983100), REAL_CONST(0.001126734190620), REAL_CONST(0.001325377263129), REAL_CONST(0.001386545598507), REAL_CONST(0.001402696361765), REAL_CONST(0.001406819908880), REAL_CONST(0.001407850766554) },
  385.     { REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002751719876), REAL_CONST(0.000010834866771), REAL_CONST(0.000041447223339), REAL_CONST(0.000140846910654), REAL_CONST(0.000352177477907), REAL_CONST(0.000563477107789), REAL_CONST(0.000662840844598), REAL_CONST(0.000693439331371), REAL_CONST(0.000701518612914), REAL_CONST(0.000703581434209), REAL_CONST(0.000704097095877) },
  386.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000005503434295), REAL_CONST(0.000020637769921), REAL_CONST(0.000070511166996), REAL_CONST(0.000176099492819), REAL_CONST(0.000281680084299), REAL_CONST(0.000331544462824), REAL_CONST(0.000346675369656), REAL_CONST(0.000350801943569), REAL_CONST(0.000351833587047), REAL_CONST(0.000352177477907) },
  387.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002751719876), REAL_CONST(0.000010318922250), REAL_CONST(0.000035256012779), REAL_CONST(0.000088052431238), REAL_CONST(0.000140846910654), REAL_CONST(0.000165781748365), REAL_CONST(0.000173348103999), REAL_CONST(0.000175411638338), REAL_CONST(0.000175927518285), REAL_CONST(0.000176099492819) },
  388.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000005159470220), REAL_CONST(0.000017542124624), REAL_CONST(0.000044026888645), REAL_CONST(0.000070511166996), REAL_CONST(0.000082893253420), REAL_CONST(0.000086676649516), REAL_CONST(0.000087708482170), REAL_CONST(0.000088052431238), REAL_CONST(0.000088052431238) },
  389.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002579737384), REAL_CONST(0.000008771088687), REAL_CONST(0.000022013611670), REAL_CONST(0.000035256012779), REAL_CONST(0.000041447223339), REAL_CONST(0.000043338975956), REAL_CONST(0.000043854910473), REAL_CONST(0.000044026888645), REAL_CONST(0.000044026888645) },
  390.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000004471542070), REAL_CONST(0.000011006847672), REAL_CONST(0.000017542124624), REAL_CONST(0.000020637769921), REAL_CONST(0.000021669651687), REAL_CONST(0.000022013611670), REAL_CONST(0.000022013611670), REAL_CONST(0.000022013611670) },
  391.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002235772627), REAL_CONST(0.000005503434295), REAL_CONST(0.000008771088687), REAL_CONST(0.000010318922250), REAL_CONST(0.000010834866771), REAL_CONST(0.000011006847672), REAL_CONST(0.000011006847672), REAL_CONST(0.000011006847672) },
  392.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001031895522), REAL_CONST(0.000002751719876), REAL_CONST(0.000004471542070), REAL_CONST(0.000005159470220), REAL_CONST(0.000005503434295), REAL_CONST(0.000005503434295), REAL_CONST(0.000005503434295), REAL_CONST(0.000005503434295) },
  393.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000515947875), REAL_CONST(0.000001375860506), REAL_CONST(0.000002235772627), REAL_CONST(0.000002579737384), REAL_CONST(0.000002751719876), REAL_CONST(0.000002751719876), REAL_CONST(0.000002751719876), REAL_CONST(0.000002751719876) },
  394.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000000687930424), REAL_CONST(0.000001031895522), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506) },
  395.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000343965269), REAL_CONST(0.000000515947875), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424) },
  396.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269) },
  397.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634) }
  398. };
  400. static const real_t log_Qplus1[31] = {
  401.     REAL_CONST(6.022367813028454), REAL_CONST(5.044394119358453), REAL_CONST(4.087462841250339), 
  402.     REAL_CONST(3.169925001442313), REAL_CONST(2.321928094887362), REAL_CONST(1.584962500721156), 
  403.     REAL_CONST(1.000000000000000), REAL_CONST(0.584962500721156), REAL_CONST(0.321928094887362), 
  404.     REAL_CONST(0.169925001442312), REAL_CONST(0.087462841250339), REAL_CONST(0.044394119358453), 
  405.     REAL_CONST(0.022367813028455), REAL_CONST(0.011227255423254), REAL_CONST(0.005624549193878), 
  406.     REAL_CONST(0.002815015607054), REAL_CONST(0.001408194392808), REAL_CONST(0.000704269011247), 
  407.     REAL_CONST(0.000352177480301), REAL_CONST(0.000176099486443), REAL_CONST(0.000088052430122), 
  408.     REAL_CONST(0.000044026886827), REAL_CONST(0.000022013611360), REAL_CONST(0.000011006847667), 
  409.     REAL_CONST(0.000005503434331), REAL_CONST(0.000002751719790), REAL_CONST(0.000001375860551), 
  410.     REAL_CONST(0.000000687930439), REAL_CONST(0.000000343965261), REAL_CONST(0.000000171982641), 
  411.     REAL_CONST(0.000000000000000)
  412. };
  414. static real_t find_log2_Qplus1(sbr_info *sbr, uint8_t k, uint8_t l, uint8_t ch)
  415. {
  416.     /* check for coupled energy/noise data */
  417.     if (sbr->bs_coupling == 1)
  418.     {
  419.         if ((sbr->Q[0][k][l] >= 0) && (sbr->Q[0][k][l] <= 30) &&
  420.             (sbr->Q[1][k][l] >= 0) && (sbr->Q[1][k][l] <= 24))
  421.         {
  422.             if (ch == 0)
  423.             {
  424.                 return log_Qplus1_pan[sbr->Q[0][k][l]][sbr->Q[1][k][l] >> 1];
  425.             } else {
  426.                 return log_Qplus1_pan[sbr->Q[0][k][l]][12 - (sbr->Q[1][k][l] >> 1)];
  427.             }
  428.         } else {
  429.             return 0;
  430.         }
  431.     } else {
  432.         if (sbr->Q[ch][k][l] >= 0 && sbr->Q[ch][k][l] <= 30)
  433.         {
  434.             return log_Qplus1[sbr->Q[ch][k][l]];
  435.         } else {
  436.             return 0;
  437.         }
  438.     }
  439. }
  441. static void calculate_gain(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch)
  442. {
  443.     /* log2 values of limiter gains */
  444.     static real_t limGain[] = {
  445.         REAL_CONST(-1.0), REAL_CONST(0.0), REAL_CONST(1.0), REAL_CONST(33.219)
  446.     };
  447.     uint8_t m, l, k;
  449.     uint8_t current_t_noise_band = 0;
  450.     uint8_t S_mapped;
  452.     ALIGN real_t Q_M_lim[MAX_M];
  453.     ALIGN real_t G_lim[MAX_M];
  454.     ALIGN real_t G_boost;
  455.     ALIGN real_t S_M[MAX_M];
  458.     for (l = 0; l < sbr->L_E[ch]; l++)
  459.     {
  460.         uint8_t current_f_noise_band = 0;
  461.         uint8_t current_res_band = 0;
  462.         uint8_t current_res_band2 = 0;
  463.         uint8_t current_hi_res_band = 0;
  465.         real_t delta = (l == sbr->l_A[ch] || l == sbr->prevEnvIsShort[ch]) ? 0 : 1;
  467.         S_mapped = get_S_mapped(sbr, ch, l, current_res_band2);
  469.         if (sbr->t_E[ch][l+1] > sbr->t_Q[ch][current_t_noise_band+1])
  470.         {
  471.             current_t_noise_band++;
  472.         }
  474.         for (k = 0; k < sbr->N_L[sbr->bs_limiter_bands]; k++)
  475.         {
  476.             real_t Q_M = 0;
  477.             real_t G_max;
  478.             real_t den = 0;
  479.             real_t acc1 = 0;
  480.             real_t acc2 = 0;
  481.             uint8_t current_res_band_size = 0;
  482.             uint8_t Q_M_size = 0;
  484.             uint8_t ml1, ml2;
  486.             /* bounds of current limiter bands */
  487.             ml1 = sbr->f_table_lim[sbr->bs_limiter_bands][k];
  488.             ml2 = sbr->f_table_lim[sbr->bs_limiter_bands][k+1];
  491.             /* calculate the accumulated E_orig and E_curr over the limiter band */
  492.             for (m = ml1; m < ml2; m++)
  493.             {
  494.                 if ((m + sbr->kx) < sbr->f_table_res[sbr->f[ch][l]][current_res_band+1])
  495.                 {
  496.                     current_res_band_size++;
  497.                 } else {
  498.                     acc1 += pow2_int(-REAL_CONST(10) + log2_int_tab[current_res_band_size] + find_log2_E(sbr, current_res_band, l, ch));
  500.                     current_res_band++;
  501.                     current_res_band_size = 1;
  502.                 }
  504.                 acc2 += sbr->E_curr[ch][m][l];
  505.             }
  506.             acc1 += pow2_int(-REAL_CONST(10) + log2_int_tab[current_res_band_size] + find_log2_E(sbr, current_res_band, l, ch));
  509.             if (acc1 == 0)
  510.                 acc1 = LOG2_MIN_INF;
  511.             else
  512.                 acc1 = log2_int(acc1);
  515.             /* calculate the maximum gain */
  516.             /* ratio of the energy of the original signal and the energy
  517.              * of the HF generated signal
  518.              */
  519.             G_max = acc1 - log2_int(acc2) + limGain[sbr->bs_limiter_gains];
  520.             G_max = min(G_max, limGain[3]);
  523.             for (m = ml1; m < ml2; m++)
  524.             {
  525.                 real_t G;
  526.                 real_t E_curr, E_orig;
  527.                 real_t Q_orig, Q_orig_plus1;
  528.                 uint8_t S_index_mapped;
  531.                 /* check if m is on a noise band border */
  532.                 if ((m + sbr->kx) == sbr->f_table_noise[current_f_noise_band+1])
  533.                 {
  534.                     /* step to next noise band */
  535.                     current_f_noise_band++;
  536.                 }
  539.                 /* check if m is on a resolution band border */
  540.                 if ((m + sbr->kx) == sbr->f_table_res[sbr->f[ch][l]][current_res_band2+1])
  541.                 {
  542.                     /* accumulate a whole range of equal Q_Ms */
  543.                     if (Q_M_size > 0)
  544.                         den += pow2_int(log2_int_tab[Q_M_size] + Q_M);
  545.                     Q_M_size = 0;
  547.                     /* step to next resolution band */
  548.                     current_res_band2++;
  550.                     /* if we move to a new resolution band, we should check if we are
  551.                      * going to add a sinusoid in this band
  552.                      */
  553.                     S_mapped = get_S_mapped(sbr, ch, l, current_res_band2);
  554.                 }
  557.                 /* check if m is on a HI_RES band border */
  558.                 if ((m + sbr->kx) == sbr->f_table_res[HI_RES][current_hi_res_band+1])
  559.                 {
  560.                     /* step to next HI_RES band */
  561.                     current_hi_res_band++;
  562.                 }
  565.                 /* find S_index_mapped
  566.                  * S_index_mapped can only be 1 for the m in the middle of the
  567.                  * current HI_RES band
  568.                  */
  569.                 S_index_mapped = 0;
  570.                 if ((l >= sbr->l_A[ch]) ||
  571.                     (sbr->bs_add_harmonic_prev[ch][current_hi_res_band] && sbr->bs_add_harmonic_flag_prev[ch]))
  572.                 {
  573.                     /* find the middle subband of the HI_RES frequency band */
  574.                     if ((m + sbr->kx) == (sbr->f_table_res[HI_RES][current_hi_res_band+1] + sbr->f_table_res[HI_RES][current_hi_res_band]) >> 1)
  575.                         S_index_mapped = sbr->bs_add_harmonic[ch][current_hi_res_band];
  576.                 }
  579.                 /* find bitstream parameters */
  580.                 if (sbr->E_curr[ch][m][l] == 0)
  581.                     E_curr = LOG2_MIN_INF;
  582.                 else
  583.                     E_curr = log2_int(sbr->E_curr[ch][m][l]);
  584.                 E_orig = -REAL_CONST(10) + find_log2_E(sbr, current_res_band2, l, ch);
  587.                 Q_orig = find_log2_Q(sbr, current_f_noise_band, current_t_noise_band, ch);
  588.                 Q_orig_plus1 = find_log2_Qplus1(sbr, current_f_noise_band, current_t_noise_band, ch);
  591.                 /* Q_M only depends on E_orig and Q_div2:
  592.                  * since N_Q <= N_Low <= N_High we only need to recalculate Q_M on
  593.                  * a change of current res band (HI or LO)
  594.                  */
  595.                 Q_M = E_orig + Q_orig - Q_orig_plus1;
  598.                 /* S_M only depends on E_orig, Q_div and S_index_mapped:
  599.                  * S_index_mapped can only be non-zero once per HI_RES band
  600.                  */
  601.                 if (S_index_mapped == 0)
  602.                 {
  603.                     S_M[m] = LOG2_MIN_INF; /* -inf */
  604.                 } else {
  605.                     S_M[m] = E_orig - Q_orig_plus1;
  607.                     /* accumulate sinusoid part of the total energy */
  608.                     den += pow2_int(S_M[m]);
  609.                 }
  612.                 /* calculate gain */
  613.                 /* ratio of the energy of the original signal and the energy
  614.                  * of the HF generated signal
  615.                  */
  616.                 /* E_curr here is officially E_curr+1 so the log2() of that can never be < 0 */
  617.                 /* scaled by -10 */
  618.                 G = E_orig - max(-REAL_CONST(10), E_curr);
  619.                 if ((S_mapped == 0) && (delta == 1))
  620.                 {
  621.                     /* G = G * 1/(1+Q) */
  622.                     G -= Q_orig_plus1;
  623.                 } else if (S_mapped == 1) {
  624.                     /* G = G * Q/(1+Q) */
  625.                     G += Q_orig - Q_orig_plus1;
  626.                 }
  629.                 /* limit the additional noise energy level */
  630.                 /* and apply the limiter */
  631.                 if (G_max > G)
  632.                 {
  633.                     Q_M_lim[m] = Q_M;
  634.                     G_lim[m] = G;
  636.                     if ((S_index_mapped == 0) && (l != sbr->l_A[ch]))
  637.                     {
  638.                         Q_M_size++;
  639.                     }
  640.                 } else {
  641.                     /* G > G_max */
  642.                     Q_M_lim[m] = Q_M + G_max - G;
  643.                     G_lim[m] = G_max;
  645.                     /* accumulate limited Q_M */
  646.                     if ((S_index_mapped == 0) && (l != sbr->l_A[ch]))
  647.                     {
  648.                         den += pow2_int(Q_M_lim[m]);
  649.                     }
  650.                 }
  653.                 /* accumulate the total energy */
  654.                 /* E_curr changes for every m so we do need to accumulate every m */
  655.                 den += pow2_int(E_curr + G_lim[m]);
  656.             }
  658.             /* accumulate last range of equal Q_Ms */
  659.             if (Q_M_size > 0)
  660.             {
  661.                 den += pow2_int(log2_int_tab[Q_M_size] + Q_M);
  662.             }
  665.             /* calculate the final gain */
  666.             /* G_boost: [0..2.51188643] */
  667.             G_boost = acc1 - log2_int(den /*+ EPS*/);
  668.             G_boost = min(G_boost, REAL_CONST(1.328771237) /* log2(1.584893192 ^ 2) */);
  671.             for (m = ml1; m < ml2; m++)
  672.             {
  673.                 /* apply compensation to gain, noise floor sf's and sinusoid levels */
  674. #ifndef SBR_LOW_POWER
  675.                 adj->G_lim_boost[l][m] = pow2_fix((G_lim[m] + G_boost) >> 1);
  676. #else
  677.                 /* sqrt() will be done after the aliasing reduction to save a
  678.                  * few multiplies
  679.                  */
  680.                 adj->G_lim_boost[l][m] = pow2_fix(G_lim[m] + G_boost);
  681. #endif
  682.                 adj->Q_M_lim_boost[l][m] = pow2_fix((Q_M_lim[m] + G_boost) >> 1);
  684.                 if (S_M[m] != LOG2_MIN_INF)
  685.                 {
  686.                     adj->S_M_boost[l][m] = pow2_int((S_M[m] + G_boost) >> 1);
  687.                 } else {
  688.                     adj->S_M_boost[l][m] = 0;
  689.                 }
  690.             }
  691.         }
  692.     }
  693. }
  695. #else
  697. //#define LOG2_TEST
  699. #ifdef LOG2_TEST
  701. #define LOG2_MIN_INF -100000
  703. __inline float pow2(float val)
  704. {
  705.     return pow(2.0, val);
  706. }
  707. __inline float log2(float val)
  708. {
  709.     return log(val)/log(2.0);
  710. }
  712. #define RB 14
  714. float QUANTISE2REAL(float val)
  715. {
  716.     __int32 ival = (__int32)(val * (1<<RB));
  717.     return (float)ival / (float)((1<<RB));
  718. }
  720. float QUANTISE2INT(float val)
  721. {
  722.     return floor(val);
  723. }
  725. /* log2 values of [0..63] */
  726. static const real_t log2_int_tab[] = {
  727.     LOG2_MIN_INF,      0.000000000000000, 1.000000000000000, 1.584962500721156,
  728.     2.000000000000000, 2.321928094887362, 2.584962500721156, 2.807354922057604,
  729.     3.000000000000000, 3.169925001442313, 3.321928094887363, 3.459431618637297,
  730.     3.584962500721156, 3.700439718141092, 3.807354922057604, 3.906890595608519,
  731.     4.000000000000000, 4.087462841250339, 4.169925001442312, 4.247927513443585,
  732.     4.321928094887362, 4.392317422778761, 4.459431618637297, 4.523561956057013,
  733.     4.584962500721156, 4.643856189774724, 4.700439718141093, 4.754887502163468,
  734.     4.807354922057604, 4.857980995127572, 4.906890595608519, 4.954196310386875,
  735.     5.000000000000000, 5.044394119358453, 5.087462841250340, 5.129283016944966,
  736.     5.169925001442312, 5.209453365628949, 5.247927513443585, 5.285402218862248,
  737.     5.321928094887363, 5.357552004618084, 5.392317422778761, 5.426264754702098,
  738.     5.459431618637297, 5.491853096329675, 5.523561956057013, 5.554588851677637,
  739.     5.584962500721156, 5.614709844115208, 5.643856189774724, 5.672425341971495,
  740.     5.700439718141093, 5.727920454563200, 5.754887502163469, 5.781359713524660,
  741.     5.807354922057605, 5.832890014164742, 5.857980995127572, 5.882643049361842,
  742.     5.906890595608518, 5.930737337562887, 5.954196310386876, 5.977279923499916
  743. };
  745. static const real_t pan_log2_tab[] = {
  746.     1.000000000000000, 0.584962500721156, 0.321928094887362, 0.169925001442312, 0.087462841250339,
  747.     0.044394119358453, 0.022367813028455, 0.011227255423254, 0.005624549193878, 0.002815015607054,
  748.     0.001408194392808, 0.000704269011247, 0.000352177480301, 0.000176099486443, 0.000088052430122,
  749.     0.000044026886827, 0.000022013611360, 0.000011006847667
  750. };
  752. static real_t find_log2_E(sbr_info *sbr, uint8_t k, uint8_t l, uint8_t ch)
  753. {
  754.     /* check for coupled energy/noise data */
  755.     if (sbr->bs_coupling == 1)
  756.     {
  757.         real_t amp0 = (sbr->amp_res[0]) ? 1.0 : 0.5;
  758.         real_t amp1 = (sbr->amp_res[1]) ? 1.0 : 0.5;
  759.         float tmp = QUANTISE2REAL(7.0 + (real_t)sbr->E[0][k][l] * amp0);
  760.         float pan;
  762.         int E = (int)(sbr->E[1][k][l] * amp1);
  764.         if (ch == 0)
  765.         {
  766.             if (E > 12)
  767.             {
  768.                 /* negative */
  769.                 pan = QUANTISE2REAL(pan_log2_tab[-12 + E]);
  770.             } else {
  771.                 /* positive */
  772.                 pan = QUANTISE2REAL(pan_log2_tab[12 - E] + (12 - E));
  773.             }
  774.         } else {
  775.             if (E < 12)
  776.             {
  777.                 /* negative */
  778.                 pan = QUANTISE2REAL(pan_log2_tab[-E + 12]);
  779.             } else {
  780.                 /* positive */
  781.                 pan = QUANTISE2REAL(pan_log2_tab[E - 12] + (E - 12));
  782.             }
  783.         }
  785.         /* tmp / pan in log2 */
  786.         return QUANTISE2REAL(tmp - pan);
  787.     } else {
  788.         real_t amp = (sbr->amp_res[ch]) ? 1.0 : 0.5;
  790.         return QUANTISE2REAL(6.0 + (real_t)sbr->E[ch][k][l] * amp);
  791.     }
  792. }
  794. static real_t find_log2_Q(sbr_info *sbr, uint8_t k, uint8_t l, uint8_t ch)
  795. {
  796.     /* check for coupled energy/noise data */
  797.     if (sbr->bs_coupling == 1)
  798.     {
  799.         float tmp = QUANTISE2REAL(7.0 - (real_t)sbr->Q[0][k][l]);
  800.         float pan;
  802.         int Q = (int)(sbr->Q[1][k][l]);
  804.         if (ch == 0)
  805.         {
  806.             if (Q > 12)
  807.             {
  808.                 /* negative */
  809.                 pan = QUANTISE2REAL(pan_log2_tab[-12 + Q]);
  810.             } else {
  811.                 /* positive */
  812.                 pan = QUANTISE2REAL(pan_log2_tab[12 - Q] + (12 - Q));
  813.             }
  814.         } else {
  815.             if (Q < 12)
  816.             {
  817.                 /* negative */
  818.                 pan = QUANTISE2REAL(pan_log2_tab[-Q + 12]);
  819.             } else {
  820.                 /* positive */
  821.                 pan = QUANTISE2REAL(pan_log2_tab[Q - 12] + (Q - 12));
  822.             }
  823.         }
  825.         /* tmp / pan in log2 */
  826.         return QUANTISE2REAL(tmp - pan);
  827.     } else {
  828.         return QUANTISE2REAL(6.0 - (real_t)sbr->Q[ch][k][l]);
  829.     }
  830. }
  832. static const real_t log_Qplus1_pan[31][13] = {
  833.     { REAL_CONST(0.044383447617292), REAL_CONST(0.169768601655960), REAL_CONST(0.583090126514435), REAL_CONST(1.570089221000671), REAL_CONST(3.092446088790894), REAL_CONST(4.733354568481445), REAL_CONST(6.022367954254150), REAL_CONST(6.692092418670654), REAL_CONST(6.924463272094727), REAL_CONST(6.989034175872803), REAL_CONST(7.005646705627441), REAL_CONST(7.009829998016357), REAL_CONST(7.010877609252930) },
  834.     { REAL_CONST(0.022362394258380), REAL_CONST(0.087379962205887), REAL_CONST(0.320804953575134), REAL_CONST(0.988859415054321), REAL_CONST(2.252387046813965), REAL_CONST(3.786596298217773), REAL_CONST(5.044394016265869), REAL_CONST(5.705977916717529), REAL_CONST(5.936291694641113), REAL_CONST(6.000346660614014), REAL_CONST(6.016829967498779), REAL_CONST(6.020981311798096), REAL_CONST(6.022020816802979) },
  835.     { REAL_CONST(0.011224525049329), REAL_CONST(0.044351425021887), REAL_CONST(0.169301137328148), REAL_CONST(0.577544987201691), REAL_CONST(1.527246952056885), REAL_CONST(2.887525320053101), REAL_CONST(4.087462902069092), REAL_CONST(4.733354568481445), REAL_CONST(4.959661006927490), REAL_CONST(5.022709369659424), REAL_CONST(5.038940429687500), REAL_CONST(5.043028831481934), REAL_CONST(5.044052600860596) },
  836.     { REAL_CONST(0.005623178556561), REAL_CONST(0.022346137091517), REAL_CONST(0.087132595479488), REAL_CONST(0.317482173442841), REAL_CONST(0.956931233406067), REAL_CONST(2.070389270782471), REAL_CONST(3.169924974441528), REAL_CONST(3.786596298217773), REAL_CONST(4.005294322967529), REAL_CONST(4.066420555114746), REAL_CONST(4.082170009613037), REAL_CONST(4.086137294769287), REAL_CONST(4.087131500244141) },
  837.     { REAL_CONST(0.002814328996465), REAL_CONST(0.011216334067285), REAL_CONST(0.044224001467228), REAL_CONST(0.167456731200218), REAL_CONST(0.556393325328827), REAL_CONST(1.378511548042297), REAL_CONST(2.321928024291992), REAL_CONST(2.887525320053101), REAL_CONST(3.092446088790894), REAL_CONST(3.150059700012207), REAL_CONST(3.164926528930664), REAL_CONST(3.168673276901245), REAL_CONST(3.169611930847168) },
  838.     { REAL_CONST(0.001407850766554), REAL_CONST(0.005619067233056), REAL_CONST(0.022281449288130), REAL_CONST(0.086156636476517), REAL_CONST(0.304854571819305), REAL_CONST(0.847996890544891), REAL_CONST(1.584962487220764), REAL_CONST(2.070389270782471), REAL_CONST(2.252387046813965), REAL_CONST(2.304061651229858), REAL_CONST(2.317430257797241), REAL_CONST(2.320801734924316), REAL_CONST(2.321646213531494) },
  839.     { REAL_CONST(0.000704097095877), REAL_CONST(0.002812269143760), REAL_CONST(0.011183738708496), REAL_CONST(0.043721374124289), REAL_CONST(0.160464659333229), REAL_CONST(0.485426813364029), REAL_CONST(1.000000000000000), REAL_CONST(1.378511548042297), REAL_CONST(1.527246952056885), REAL_CONST(1.570089221000671), REAL_CONST(1.581215262413025), REAL_CONST(1.584023833274841), REAL_CONST(1.584727644920349) },
  840.     { REAL_CONST(0.000352177477907), REAL_CONST(0.001406819908880), REAL_CONST(0.005602621007711), REAL_CONST(0.022026389837265), REAL_CONST(0.082462236285210), REAL_CONST(0.263034462928772), REAL_CONST(0.584962487220764), REAL_CONST(0.847996890544891), REAL_CONST(0.956931233406067), REAL_CONST(0.988859415054321), REAL_CONST(0.997190535068512), REAL_CONST(0.999296069145203), REAL_CONST(0.999823868274689) },
  841.     { REAL_CONST(0.000176099492819), REAL_CONST(0.000703581434209), REAL_CONST(0.002804030198604), REAL_CONST(0.011055230163038), REAL_CONST(0.041820213198662), REAL_CONST(0.137503549456596), REAL_CONST(0.321928083896637), REAL_CONST(0.485426813364029), REAL_CONST(0.556393325328827), REAL_CONST(0.577544987201691), REAL_CONST(0.583090126514435), REAL_CONST(0.584493279457092), REAL_CONST(0.584845066070557) },
  842.     { REAL_CONST(0.000088052431238), REAL_CONST(0.000351833587047), REAL_CONST(0.001402696361765), REAL_CONST(0.005538204684854), REAL_CONST(0.021061634644866), REAL_CONST(0.070389263331890), REAL_CONST(0.169925004243851), REAL_CONST(0.263034462928772), REAL_CONST(0.304854571819305), REAL_CONST(0.317482173442841), REAL_CONST(0.320804953575134), REAL_CONST(0.321646571159363), REAL_CONST(0.321857661008835) },
  843.     { REAL_CONST(0.000044026888645), REAL_CONST(0.000175927518285), REAL_CONST(0.000701518612914), REAL_CONST(0.002771759871393), REAL_CONST(0.010569252073765), REAL_CONST(0.035623874515295), REAL_CONST(0.087462842464447), REAL_CONST(0.137503549456596), REAL_CONST(0.160464659333229), REAL_CONST(0.167456731200218), REAL_CONST(0.169301137328148), REAL_CONST(0.169768601655960), REAL_CONST(0.169885858893394) },
  844.     { REAL_CONST(0.000022013611670), REAL_CONST(0.000088052431238), REAL_CONST(0.000350801943569), REAL_CONST(0.001386545598507), REAL_CONST(0.005294219125062), REAL_CONST(0.017921976745129), REAL_CONST(0.044394120573997), REAL_CONST(0.070389263331890), REAL_CONST(0.082462236285210), REAL_CONST(0.086156636476517), REAL_CONST(0.087132595479488), REAL_CONST(0.087379962205887), REAL_CONST(0.087442122399807) },
  845.     { REAL_CONST(0.000011006847672), REAL_CONST(0.000044026888645), REAL_CONST(0.000175411638338), REAL_CONST(0.000693439331371), REAL_CONST(0.002649537986144), REAL_CONST(0.008988817222416), REAL_CONST(0.022367812693119), REAL_CONST(0.035623874515295), REAL_CONST(0.041820213198662), REAL_CONST(0.043721374124289), REAL_CONST(0.044224001467228), REAL_CONST(0.044351425021887), REAL_CONST(0.044383447617292) },
  846.     { REAL_CONST(0.000005503434295), REAL_CONST(0.000022013611670), REAL_CONST(0.000087708482170), REAL_CONST(0.000346675369656), REAL_CONST(0.001325377263129), REAL_CONST(0.004501323681325), REAL_CONST(0.011227255687118), REAL_CONST(0.017921976745129), REAL_CONST(0.021061634644866), REAL_CONST(0.022026389837265), REAL_CONST(0.022281449288130), REAL_CONST(0.022346137091517), REAL_CONST(0.022362394258380) },
  847.     { REAL_CONST(0.000002751719876), REAL_CONST(0.000011006847672), REAL_CONST(0.000043854910473), REAL_CONST(0.000173348103999), REAL_CONST(0.000662840844598), REAL_CONST(0.002252417383716), REAL_CONST(0.005624548997730), REAL_CONST(0.008988817222416), REAL_CONST(0.010569252073765), REAL_CONST(0.011055230163038), REAL_CONST(0.011183738708496), REAL_CONST(0.011216334067285), REAL_CONST(0.011224525049329) },
  848.     { REAL_CONST(0.000001375860506), REAL_CONST(0.000005503434295), REAL_CONST(0.000022013611670), REAL_CONST(0.000086676649516), REAL_CONST(0.000331544462824), REAL_CONST(0.001126734190620), REAL_CONST(0.002815015614033), REAL_CONST(0.004501323681325), REAL_CONST(0.005294219125062), REAL_CONST(0.005538204684854), REAL_CONST(0.005602621007711), REAL_CONST(0.005619067233056), REAL_CONST(0.005623178556561) },
  849.     { REAL_CONST(0.000000687930424), REAL_CONST(0.000002751719876), REAL_CONST(0.000011006847672), REAL_CONST(0.000043338975956), REAL_CONST(0.000165781748365), REAL_CONST(0.000563477107789), REAL_CONST(0.001408194424585), REAL_CONST(0.002252417383716), REAL_CONST(0.002649537986144), REAL_CONST(0.002771759871393), REAL_CONST(0.002804030198604), REAL_CONST(0.002812269143760), REAL_CONST(0.002814328996465) },
  850.     { REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000005503434295), REAL_CONST(0.000021669651687), REAL_CONST(0.000082893253420), REAL_CONST(0.000281680084299), REAL_CONST(0.000704268983100), REAL_CONST(0.001126734190620), REAL_CONST(0.001325377263129), REAL_CONST(0.001386545598507), REAL_CONST(0.001402696361765), REAL_CONST(0.001406819908880), REAL_CONST(0.001407850766554) },
  851.     { REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002751719876), REAL_CONST(0.000010834866771), REAL_CONST(0.000041447223339), REAL_CONST(0.000140846910654), REAL_CONST(0.000352177477907), REAL_CONST(0.000563477107789), REAL_CONST(0.000662840844598), REAL_CONST(0.000693439331371), REAL_CONST(0.000701518612914), REAL_CONST(0.000703581434209), REAL_CONST(0.000704097095877) },
  852.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000005503434295), REAL_CONST(0.000020637769921), REAL_CONST(0.000070511166996), REAL_CONST(0.000176099492819), REAL_CONST(0.000281680084299), REAL_CONST(0.000331544462824), REAL_CONST(0.000346675369656), REAL_CONST(0.000350801943569), REAL_CONST(0.000351833587047), REAL_CONST(0.000352177477907) },
  853.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002751719876), REAL_CONST(0.000010318922250), REAL_CONST(0.000035256012779), REAL_CONST(0.000088052431238), REAL_CONST(0.000140846910654), REAL_CONST(0.000165781748365), REAL_CONST(0.000173348103999), REAL_CONST(0.000175411638338), REAL_CONST(0.000175927518285), REAL_CONST(0.000176099492819) },
  854.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000005159470220), REAL_CONST(0.000017542124624), REAL_CONST(0.000044026888645), REAL_CONST(0.000070511166996), REAL_CONST(0.000082893253420), REAL_CONST(0.000086676649516), REAL_CONST(0.000087708482170), REAL_CONST(0.000088052431238), REAL_CONST(0.000088052431238) },
  855.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002579737384), REAL_CONST(0.000008771088687), REAL_CONST(0.000022013611670), REAL_CONST(0.000035256012779), REAL_CONST(0.000041447223339), REAL_CONST(0.000043338975956), REAL_CONST(0.000043854910473), REAL_CONST(0.000044026888645), REAL_CONST(0.000044026888645) },
  856.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001375860506), REAL_CONST(0.000004471542070), REAL_CONST(0.000011006847672), REAL_CONST(0.000017542124624), REAL_CONST(0.000020637769921), REAL_CONST(0.000021669651687), REAL_CONST(0.000022013611670), REAL_CONST(0.000022013611670), REAL_CONST(0.000022013611670) },
  857.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000687930424), REAL_CONST(0.000002235772627), REAL_CONST(0.000005503434295), REAL_CONST(0.000008771088687), REAL_CONST(0.000010318922250), REAL_CONST(0.000010834866771), REAL_CONST(0.000011006847672), REAL_CONST(0.000011006847672), REAL_CONST(0.000011006847672) },
  858.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000001031895522), REAL_CONST(0.000002751719876), REAL_CONST(0.000004471542070), REAL_CONST(0.000005159470220), REAL_CONST(0.000005503434295), REAL_CONST(0.000005503434295), REAL_CONST(0.000005503434295), REAL_CONST(0.000005503434295) },
  859.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000515947875), REAL_CONST(0.000001375860506), REAL_CONST(0.000002235772627), REAL_CONST(0.000002579737384), REAL_CONST(0.000002751719876), REAL_CONST(0.000002751719876), REAL_CONST(0.000002751719876), REAL_CONST(0.000002751719876) },
  860.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000343965269), REAL_CONST(0.000000687930424), REAL_CONST(0.000001031895522), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506), REAL_CONST(0.000001375860506) },
  861.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000343965269), REAL_CONST(0.000000515947875), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424), REAL_CONST(0.000000687930424) },
  862.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269), REAL_CONST(0.000000343965269) },
  863.     { REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000000000000), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634), REAL_CONST(0.000000171982634) }
  864. };
  866. static const real_t log_Qplus1[31] = {
  867.     REAL_CONST(6.022367813028454), REAL_CONST(5.044394119358453), REAL_CONST(4.087462841250339), 
  868.     REAL_CONST(3.169925001442313), REAL_CONST(2.321928094887362), REAL_CONST(1.584962500721156), 
  869.     REAL_CONST(1.000000000000000), REAL_CONST(0.584962500721156), REAL_CONST(0.321928094887362), 
  870.     REAL_CONST(0.169925001442312), REAL_CONST(0.087462841250339), REAL_CONST(0.044394119358453), 
  871.     REAL_CONST(0.022367813028455), REAL_CONST(0.011227255423254), REAL_CONST(0.005624549193878), 
  872.     REAL_CONST(0.002815015607054), REAL_CONST(0.001408194392808), REAL_CONST(0.000704269011247), 
  873.     REAL_CONST(0.000352177480301), REAL_CONST(0.000176099486443), REAL_CONST(0.000088052430122), 
  874.     REAL_CONST(0.000044026886827), REAL_CONST(0.000022013611360), REAL_CONST(0.000011006847667), 
  875.     REAL_CONST(0.000005503434331), REAL_CONST(0.000002751719790), REAL_CONST(0.000001375860551), 
  876.     REAL_CONST(0.000000687930439), REAL_CONST(0.000000343965261), REAL_CONST(0.000000171982641), 
  877.     REAL_CONST(0.000000000000000)
  878. };
  880. static real_t find_log2_Qplus1(sbr_info *sbr, uint8_t k, uint8_t l, uint8_t ch)
  881. {
  882.     /* check for coupled energy/noise data */
  883.     if (sbr->bs_coupling == 1)
  884.     {
  885.         if ((sbr->Q[0][k][l] >= 0) && (sbr->Q[0][k][l] <= 30) &&
  886.             (sbr->Q[1][k][l] >= 0) && (sbr->Q[1][k][l] <= 24))
  887.         {
  888.             if (ch == 0)
  889.             {
  890.                 return QUANTISE2REAL(log_Qplus1_pan[sbr->Q[0][k][l]][sbr->Q[1][k][l] >> 1]);
  891.             } else {
  892.                 return QUANTISE2REAL(log_Qplus1_pan[sbr->Q[0][k][l]][12 - (sbr->Q[1][k][l] >> 1)]);
  893.             }
  894.         } else {
  895.             return 0;
  896.         }
  897.     } else {
  898.         if (sbr->Q[ch][k][l] >= 0 && sbr->Q[ch][k][l] <= 30)
  899.         {
  900.             return QUANTISE2REAL(log_Qplus1[sbr->Q[ch][k][l]]);
  901.         } else {
  902.             return 0;
  903.         }
  904.     }
  905. }
  907. static void calculate_gain(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch)
  908. {
  909.     /* log2 values of limiter gains */
  910.     static real_t limGain[] = { -1.0, 0.0, 1.0, 33.219 };
  911.     uint8_t m, l, k;
  913.     uint8_t current_t_noise_band = 0;
  914.     uint8_t S_mapped;
  916.     ALIGN real_t Q_M_lim[MAX_M];
  917.     ALIGN real_t G_lim[MAX_M];
  918.     ALIGN real_t G_boost;
  919.     ALIGN real_t S_M[MAX_M];
  922.     for (l = 0; l < sbr->L_E[ch]; l++)
  923.     {
  924.         uint8_t current_f_noise_band = 0;
  925.         uint8_t current_res_band = 0;
  926.         uint8_t current_res_band2 = 0;
  927.         uint8_t current_hi_res_band = 0;
  929.         real_t delta = (l == sbr->l_A[ch] || l == sbr->prevEnvIsShort[ch]) ? 0 : 1;
  931.         S_mapped = get_S_mapped(sbr, ch, l, current_res_band2);
  933.         if (sbr->t_E[ch][l+1] > sbr->t_Q[ch][current_t_noise_band+1])
  934.         {
  935.             current_t_noise_band++;
  936.         }
  938.         for (k = 0; k < sbr->N_L[sbr->bs_limiter_bands]; k++)
  939.         {
  940.             real_t Q_M = 0;
  941.             real_t G_max;
  942.             real_t den = 0;
  943.             real_t acc1 = 0;
  944.             real_t acc2 = 0;
  945.             uint8_t current_res_band_size = 0;
  946.             uint8_t Q_M_size = 0;
  948.             uint8_t ml1, ml2;
  950.             /* bounds of current limiter bands */
  951.             ml1 = sbr->f_table_lim[sbr->bs_limiter_bands][k];
  952.             ml2 = sbr->f_table_lim[sbr->bs_limiter_bands][k+1];
  955.             /* calculate the accumulated E_orig and E_curr over the limiter band */
  956.             for (m = ml1; m < ml2; m++)
  957.             {
  958.                 if ((m + sbr->kx) < sbr->f_table_res[sbr->f[ch][l]][current_res_band+1])
  959.                 {
  960.                     current_res_band_size++;
  961.                 } else {
  962.                     acc1 += QUANTISE2INT(pow2(-10 + log2_int_tab[current_res_band_size] + find_log2_E(sbr, current_res_band, l, ch)));
  964.                     current_res_band++;
  965.                     current_res_band_size = 1;
  966.                 }
  968.                 acc2 += QUANTISE2INT(sbr->E_curr[ch][m][l]/1024.0);
  969.             }
  970.             acc1 += QUANTISE2INT(pow2(-10 + log2_int_tab[current_res_band_size] + find_log2_E(sbr, current_res_band, l, ch)));
  972.             acc1 = QUANTISE2REAL( log2(EPS + acc1) );
  975.             /* calculate the maximum gain */
  976.             /* ratio of the energy of the original signal and the energy
  977.              * of the HF generated signal
  978.              */
  979.             G_max = acc1 - QUANTISE2REAL(log2(EPS + acc2)) + QUANTISE2REAL(limGain[sbr->bs_limiter_gains]);
  980.             G_max = min(G_max, QUANTISE2REAL(limGain[3]));
  983.             for (m = ml1; m < ml2; m++)
  984.             {
  985.                 real_t G;
  986.                 real_t E_curr, E_orig;
  987.                 real_t Q_orig, Q_orig_plus1;
  988.                 uint8_t S_index_mapped;
  991.                 /* check if m is on a noise band border */
  992.                 if ((m + sbr->kx) == sbr->f_table_noise[current_f_noise_band+1])
  993.                 {
  994.                     /* step to next noise band */
  995.                     current_f_noise_band++;
  996.                 }
  999.                 /* check if m is on a resolution band border */
  1000.                 if ((m + sbr->kx) == sbr->f_table_res[sbr->f[ch][l]][current_res_band2+1])
  1001.                 {
  1002.                     /* accumulate a whole range of equal Q_Ms */
  1003.                     if (Q_M_size > 0)
  1004.                         den += QUANTISE2INT(pow2(log2_int_tab[Q_M_size] + Q_M));
  1005.                     Q_M_size = 0;
  1007.                     /* step to next resolution band */
  1008.                     current_res_band2++;
  1010.                     /* if we move to a new resolution band, we should check if we are
  1011.                      * going to add a sinusoid in this band
  1012.                      */
  1013.                     S_mapped = get_S_mapped(sbr, ch, l, current_res_band2);
  1014.                 }
  1017.                 /* check if m is on a HI_RES band border */
  1018.                 if ((m + sbr->kx) == sbr->f_table_res[HI_RES][current_hi_res_band+1])
  1019.                 {
  1020.                     /* step to next HI_RES band */
  1021.                     current_hi_res_band++;
  1022.                 }
  1025.                 /* find S_index_mapped
  1026.                  * S_index_mapped can only be 1 for the m in the middle of the
  1027.                  * current HI_RES band
  1028.                  */
  1029.                 S_index_mapped = 0;
  1030.                 if ((l >= sbr->l_A[ch]) ||
  1031.                     (sbr->bs_add_harmonic_prev[ch][current_hi_res_band] && sbr->bs_add_harmonic_flag_prev[ch]))
  1032.                 {
  1033.                     /* find the middle subband of the HI_RES frequency band */
  1034.                     if ((m + sbr->kx) == (sbr->f_table_res[HI_RES][current_hi_res_band+1] + sbr->f_table_res[HI_RES][current_hi_res_band]) >> 1)
  1035.                         S_index_mapped = sbr->bs_add_harmonic[ch][current_hi_res_band];
  1036.                 }
  1039.                 /* find bitstream parameters */
  1040.                 if (sbr->E_curr[ch][m][l] == 0)
  1041.                     E_curr = LOG2_MIN_INF;
  1042.                 else
  1043.                     E_curr = -10 + log2(sbr->E_curr[ch][m][l]);
  1044.                 E_orig = -10 + find_log2_E(sbr, current_res_band2, l, ch);
  1046.                 Q_orig = find_log2_Q(sbr, current_f_noise_band, current_t_noise_band, ch);
  1047.                 Q_orig_plus1 = find_log2_Qplus1(sbr, current_f_noise_band, current_t_noise_band, ch);
  1050.                 /* Q_M only depends on E_orig and Q_div2:
  1051.                  * since N_Q <= N_Low <= N_High we only need to recalculate Q_M on
  1052.                  * a change of current res band (HI or LO)
  1053.                  */
  1054.                 Q_M = E_orig + Q_orig - Q_orig_plus1;
  1057.                 /* S_M only depends on E_orig, Q_div and S_index_mapped:
  1058.                  * S_index_mapped can only be non-zero once per HI_RES band
  1059.                  */
  1060.                 if (S_index_mapped == 0)
  1061.                 {
  1062.                     S_M[m] = LOG2_MIN_INF; /* -inf */
  1063.                 } else {
  1064.                     S_M[m] = E_orig - Q_orig_plus1;
  1066.                     /* accumulate sinusoid part of the total energy */
  1067.                     den += pow2(S_M[m]);
  1068.                 }
  1071.                 /* calculate gain */
  1072.                 /* ratio of the energy of the original signal and the energy
  1073.                  * of the HF generated signal
  1074.                  */
  1075.                 /* E_curr here is officially E_curr+1 so the log2() of that can never be < 0 */
  1076.                 /* scaled by -10 */
  1077.                 G = E_orig - max(-10, E_curr);
  1078.                 if ((S_mapped == 0) && (delta == 1))
  1079.                 {
  1080.                     /* G = G * 1/(1+Q) */
  1081.                     G -= Q_orig_plus1;
  1082.                 } else if (S_mapped == 1) {
  1083.                     /* G = G * Q/(1+Q) */
  1084.                     G += Q_orig - Q_orig_plus1;
  1085.                 }
  1088.                 /* limit the additional noise energy level */
  1089.                 /* and apply the limiter */
  1090.                 if (G_max > G)
  1091.                 {
  1092.                     Q_M_lim[m] = QUANTISE2REAL(Q_M);
  1093.                     G_lim[m] = QUANTISE2REAL(G);
  1095.                     if ((S_index_mapped == 0) && (l != sbr->l_A[ch]))
  1096.                     {
  1097.                         Q_M_size++;
  1098.                     }
  1099.                 } else {
  1100.                     /* G > G_max */
  1101.                     Q_M_lim[m] = QUANTISE2REAL(Q_M) + G_max - QUANTISE2REAL(G);
  1102.                     G_lim[m] = G_max;
  1104.                     /* accumulate limited Q_M */
  1105.                     if ((S_index_mapped == 0) && (l != sbr->l_A[ch]))
  1106.                     {
  1107.                         den += QUANTISE2INT(pow2(Q_M_lim[m]));
  1108.                     }
  1109.                 }
  1112.                 /* accumulate the total energy */
  1113.                 /* E_curr changes for every m so we do need to accumulate every m */
  1114.                 den += QUANTISE2INT(pow2(E_curr + G_lim[m]));
  1115.             }
  1117.             /* accumulate last range of equal Q_Ms */
  1118.             if (Q_M_size > 0)
  1119.             {
  1120.                 den += QUANTISE2INT(pow2(log2_int_tab[Q_M_size] + Q_M));
  1121.             }
  1124.             /* calculate the final gain */
  1125.             /* G_boost: [0..2.51188643] */
  1126.             G_boost = acc1 - QUANTISE2REAL(log2(den + EPS));
  1127.             G_boost = min(G_boost, QUANTISE2REAL(1.328771237) /* log2(1.584893192 ^ 2) */);
  1130.             for (m = ml1; m < ml2; m++)
  1131.             {
  1132.                 /* apply compensation to gain, noise floor sf's and sinusoid levels */
  1133. #ifndef SBR_LOW_POWER
  1134.                 adj->G_lim_boost[l][m] = QUANTISE2REAL(pow2((G_lim[m] + G_boost) / 2.0));
  1135. #else
  1136.                 /* sqrt() will be done after the aliasing reduction to save a
  1137.                  * few multiplies
  1138.                  */
  1139.                 adj->G_lim_boost[l][m] = QUANTISE2REAL(pow2(G_lim[m] + G_boost));
  1140. #endif
  1141.                 adj->Q_M_lim_boost[l][m] = QUANTISE2REAL(pow2((Q_M_lim[m] + 10 + G_boost) / 2.0));
  1143.                 if (S_M[m] != LOG2_MIN_INF)
  1144.                 {
  1145.                     adj->S_M_boost[l][m] = QUANTISE2REAL(pow2((S_M[m] + 10 + G_boost) / 2.0));
  1146.                 } else {
  1147.                     adj->S_M_boost[l][m] = 0;
  1148.                 }
  1149.             }
  1150.         }
  1151.     }
  1152. }
  1154. #else
  1156. static void calculate_gain(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch)
  1157. {
  1158.     static real_t limGain[] = { 0.5, 1.0, 2.0, 1e10 };
  1159.     uint8_t m, l, k;
  1161.     uint8_t current_t_noise_band = 0;
  1162.     uint8_t S_mapped;
  1164.     ALIGN real_t Q_M_lim[MAX_M];
  1165.     ALIGN real_t G_lim[MAX_M];
  1166.     ALIGN real_t G_boost;
  1167.     ALIGN real_t S_M[MAX_M];
  1169.     for (l = 0; l < sbr->L_E[ch]; l++)
  1170.     {
  1171.         uint8_t current_f_noise_band = 0;
  1172.         uint8_t current_res_band = 0;
  1173.         uint8_t current_res_band2 = 0;
  1174.         uint8_t current_hi_res_band = 0;
  1176.         real_t delta = (l == sbr->l_A[ch] || l == sbr->prevEnvIsShort[ch]) ? 0 : 1;
  1178.         S_mapped = get_S_mapped(sbr, ch, l, current_res_band2);
  1180.         if (sbr->t_E[ch][l+1] > sbr->t_Q[ch][current_t_noise_band+1])
  1181.         {
  1182.             current_t_noise_band++;
  1183.         }
  1185.         for (k = 0; k < sbr->N_L[sbr->bs_limiter_bands]; k++)
  1186.         {
  1187.             real_t G_max;
  1188.             real_t den = 0;
  1189.             real_t acc1 = 0;
  1190.             real_t acc2 = 0;
  1191.             uint8_t current_res_band_size = 0;
  1193.             uint8_t ml1, ml2;
  1195.             ml1 = sbr->f_table_lim[sbr->bs_limiter_bands][k];
  1196.             ml2 = sbr->f_table_lim[sbr->bs_limiter_bands][k+1];
  1199.             /* calculate the accumulated E_orig and E_curr over the limiter band */
  1200.             for (m = ml1; m < ml2; m++)
  1201.             {
  1202.                 if ((m + sbr->kx) == sbr->f_table_res[sbr->f[ch][l]][current_res_band+1])
  1203.                 {
  1204.                     current_res_band++;
  1205.                 }
  1206.                 acc1 += sbr->E_orig[ch][current_res_band][l];
  1207.                 acc2 += sbr->E_curr[ch][m][l];
  1208.             }
  1211.             /* calculate the maximum gain */
  1212.             /* ratio of the energy of the original signal and the energy
  1213.              * of the HF generated signal
  1214.              */
  1215.             G_max = ((EPS + acc1) / (EPS + acc2)) * limGain[sbr->bs_limiter_gains];
  1216.             G_max = min(G_max, 1e10);
  1219.             for (m = ml1; m < ml2; m++)
  1220.             {
  1221.                 real_t Q_M, G;
  1222.                 real_t Q_div, Q_div2;
  1223.                 uint8_t S_index_mapped;
  1226.                 /* check if m is on a noise band border */
  1227.                 if ((m + sbr->kx) == sbr->f_table_noise[current_f_noise_band+1])
  1228.                 {
  1229.                     /* step to next noise band */
  1230.                     current_f_noise_band++;
  1231.                 }
  1234.                 /* check if m is on a resolution band border */
  1235.                 if ((m + sbr->kx) == sbr->f_table_res[sbr->f[ch][l]][current_res_band2+1])
  1236.                 {
  1237.                     /* step to next resolution band */
  1238.                     current_res_band2++;
  1240.                     /* if we move to a new resolution band, we should check if we are
  1241.                      * going to add a sinusoid in this band
  1242.                      */
  1243.                     S_mapped = get_S_mapped(sbr, ch, l, current_res_band2);
  1244.                 }
  1247.                 /* check if m is on a HI_RES band border */
  1248.                 if ((m + sbr->kx) == sbr->f_table_res[HI_RES][current_hi_res_band+1])
  1249.                 {
  1250.                     /* step to next HI_RES band */
  1251.                     current_hi_res_band++;
  1252.                 }
  1255.                 /* find S_index_mapped
  1256.                  * S_index_mapped can only be 1 for the m in the middle of the
  1257.                  * current HI_RES band
  1258.                  */
  1259.                 S_index_mapped = 0;
  1260.                 if ((l >= sbr->l_A[ch]) ||
  1261.                     (sbr->bs_add_harmonic_prev[ch][current_hi_res_band] && sbr->bs_add_harmonic_flag_prev[ch]))
  1262.                 {
  1263.                     /* find the middle subband of the HI_RES frequency band */
  1264.                     if ((m + sbr->kx) == (sbr->f_table_res[HI_RES][current_hi_res_band+1] + sbr->f_table_res[HI_RES][current_hi_res_band]) >> 1)
  1265.                         S_index_mapped = sbr->bs_add_harmonic[ch][current_hi_res_band];
  1266.                 }
  1269.                 /* Q_div: [0..1] (1/(1+Q_mapped)) */
  1270.                 Q_div = sbr->Q_div[ch][current_f_noise_band][current_t_noise_band];
  1273.                 /* Q_div2: [0..1] (Q_mapped/(1+Q_mapped)) */
  1274.                 Q_div2 = sbr->Q_div2[ch][current_f_noise_band][current_t_noise_band];
  1277.                 /* Q_M only depends on E_orig and Q_div2:
  1278.                  * since N_Q <= N_Low <= N_High we only need to recalculate Q_M on
  1279.                  * a change of current noise band
  1280.                  */
  1281.                 Q_M = sbr->E_orig[ch][current_res_band2][l] * Q_div2;
  1284.                 /* S_M only depends on E_orig, Q_div and S_index_mapped:
  1285.                  * S_index_mapped can only be non-zero once per HI_RES band
  1286.                  */
  1287.                 if (S_index_mapped == 0)
  1288.                 {
  1289.                     S_M[m] = 0;
  1290.                 } else {
  1291.                     S_M[m] = sbr->E_orig[ch][current_res_band2][l] * Q_div;
  1293.                     /* accumulate sinusoid part of the total energy */
  1294.                     den += S_M[m];
  1295.                 }
  1298.                 /* calculate gain */
  1299.                 /* ratio of the energy of the original signal and the energy
  1300.                  * of the HF generated signal
  1301.                  */
  1302.                 G = sbr->E_orig[ch][current_res_band2][l] / (1.0 + sbr->E_curr[ch][m][l]);
  1303.                 if ((S_mapped == 0) && (delta == 1))
  1304.                     G *= Q_div;
  1305.                 else if (S_mapped == 1)
  1306.                     G *= Q_div2;
  1309.                 /* limit the additional noise energy level */
  1310.                 /* and apply the limiter */
  1311.                 if (G_max > G)
  1312.                 {
  1313.                     Q_M_lim[m] = Q_M;
  1314.                     G_lim[m] = G;
  1315.                 } else {
  1316.                     Q_M_lim[m] = Q_M * G_max / G;
  1317.                     G_lim[m] = G_max;
  1318.                 }
  1321.                 /* accumulate the total energy */
  1322.                 den += sbr->E_curr[ch][m][l] * G_lim[m];
  1323.                 if ((S_index_mapped == 0) && (l != sbr->l_A[ch]))
  1324.                     den += Q_M_lim[m];
  1325.             }
  1327.             /* G_boost: [0..2.51188643] */
  1328.             G_boost = (acc1 + EPS) / (den + EPS);
  1329.             G_boost = min(G_boost, 2.51188643 /* 1.584893192 ^ 2 */);
  1331.             for (m = ml1; m < ml2; m++)
  1332.             {
  1333.                 /* apply compensation to gain, noise floor sf's and sinusoid levels */
  1334. #ifndef SBR_LOW_POWER
  1335.                 adj->G_lim_boost[l][m] = sqrt(G_lim[m] * G_boost);
  1336. #else
  1337.                 /* sqrt() will be done after the aliasing reduction to save a
  1338.                  * few multiplies
  1339.                  */
  1340.                 adj->G_lim_boost[l][m] = G_lim[m] * G_boost;
  1341. #endif
  1342.                 adj->Q_M_lim_boost[l][m] = sqrt(Q_M_lim[m] * G_boost);
  1344.                 if (S_M[m] != 0)
  1345.                 {
  1346.                     adj->S_M_boost[l][m] = sqrt(S_M[m] * G_boost);
  1347.                 } else {
  1348.                     adj->S_M_boost[l][m] = 0;
  1349.                 }
  1350.             }
  1351.         }
  1352.     }
  1353. }
  1354. #endif // log2_test
  1356. #endif
  1358. #ifdef SBR_LOW_POWER
  1359. static void calc_gain_groups(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch)
  1360. {
  1361.     uint8_t l, k, i;
  1362.     uint8_t grouping;
  1363.     uint8_t S_mapped;
  1365.     for (l = 0; l < sbr->L_E[ch]; l++)
  1366.     {
  1367.         uint8_t current_res_band = 0;
  1368.         i = 0;
  1369.         grouping = 0;
  1371.         S_mapped = get_S_mapped(sbr, ch, l, current_res_band);
  1373.         for (k = sbr->kx; k < sbr->kx + sbr->M - 1; k++)
  1374.         {
  1375.             if (k == sbr->f_table_res[sbr->f[ch][l]][current_res_band+1])
  1376.             {
  1377.                 /* step to next resolution band */
  1378.                 current_res_band++;
  1380.                 S_mapped = get_S_mapped(sbr, ch, l, current_res_band);
  1381.             }
  1383.             if (deg[k + 1] && S_mapped == 0)
  1384.             {
  1385.                 if (grouping == 0)
  1386.                 {
  1387.                     sbr->f_group[l][i] = k;
  1388.                     grouping = 1;
  1389.                     i++;
  1390.                 }
  1391.             } else {
  1392.                 if (grouping)
  1393.                 {
  1394.                     if (S_mapped)
  1395.                     {
  1396.                         sbr->f_group[l][i] = k;
  1397.                     } else {
  1398.                         sbr->f_group[l][i] = k + 1;
  1399.                     }
  1400.                     grouping = 0;
  1401.                     i++;
  1402.                 }
  1403.             }
  1404.         }        
  1406.         if (grouping)
  1407.         {
  1408.             sbr->f_group[l][i] = sbr->kx + sbr->M;
  1409.             i++;
  1410.         }
  1412.         sbr->N_G[l] = (uint8_t)(i >> 1);
  1413.     }
  1414. }
  1416. static void aliasing_reduction(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch)
  1417. {
  1418.     uint8_t l, k, m;
  1419.     real_t E_total, E_total_est, G_target, acc;
  1421.     for (l = 0; l < sbr->L_E[ch]; l++)
  1422.     {
  1423.         for (k = 0; k < sbr->N_G[l]; k++)
  1424.         {
  1425.             E_total_est = E_total = 0;
  1426.             
  1427.             for (m = sbr->f_group[l][k<<1]; m < sbr->f_group[l][(k<<1) + 1]; m++)
  1428.             {
  1429.                 /* E_curr: integer */
  1430.                 /* G_lim_boost: fixed point */
  1431.                 /* E_total_est: integer */
  1432.                 /* E_total: integer */
  1433.                 E_total_est += sbr->E_curr[ch][m-sbr->kx][l];
  1434. #ifdef FIXED_POINT
  1435.                 E_total += MUL_Q2(sbr->E_curr[ch][m-sbr->kx][l], adj->G_lim_boost[l][m-sbr->kx]);
  1436. #else
  1437.                 E_total += sbr->E_curr[ch][m-sbr->kx][l] * adj->G_lim_boost[l][m-sbr->kx];
  1438. #endif
  1439.             }
  1441.             /* G_target: fixed point */
  1442.             if ((E_total_est + EPS) == 0)
  1443.             {
  1444.                 G_target = 0;
  1445.             } else {
  1446. #ifdef FIXED_POINT
  1447.                 G_target = (((int64_t)(E_total))<<Q2_BITS)/(E_total_est + EPS);
  1448. #else
  1449.                 G_target = E_total / (E_total_est + EPS);
  1450. #endif
  1451.             }
  1452.             acc = 0;
  1454.             for (m = sbr->f_group[l][(k<<1)]; m < sbr->f_group[l][(k<<1) + 1]; m++)
  1455.             {
  1456.                 real_t alpha;
  1458.                 /* alpha: (COEF) fixed point */
  1459.                 if (m < sbr->kx + sbr->M - 1)
  1460.                 {
  1461.                     alpha = max(deg[m], deg[m + 1]);
  1462.                 } else {
  1463.                     alpha = deg[m];
  1464.                 }
  1466.                 adj->G_lim_boost[l][m-sbr->kx] = MUL_C(alpha, G_target) +
  1467.                     MUL_C((COEF_CONST(1)-alpha), adj->G_lim_boost[l][m-sbr->kx]);
  1469.                 /* acc: integer */
  1470. #ifdef FIXED_POINT
  1471.                 acc += MUL_Q2(adj->G_lim_boost[l][m-sbr->kx], sbr->E_curr[ch][m-sbr->kx][l]);
  1472. #else
  1473.                 acc += adj->G_lim_boost[l][m-sbr->kx] * sbr->E_curr[ch][m-sbr->kx][l];
  1474. #endif
  1475.             }
  1477.             /* acc: fixed point */
  1478.             if (acc + EPS == 0)
  1479.             {
  1480.                 acc = 0;
  1481.             } else {
  1482. #ifdef FIXED_POINT
  1483.                 acc = (((int64_t)(E_total))<<Q2_BITS)/(acc + EPS);
  1484. #else
  1485.                 acc = E_total / (acc + EPS);
  1486. #endif
  1487.             }
  1488.             for(m = sbr->f_group[l][(k<<1)]; m < sbr->f_group[l][(k<<1) + 1]; m++)
  1489.             {
  1490. #ifdef FIXED_POINT
  1491.                 adj->G_lim_boost[l][m-sbr->kx] = MUL_Q2(acc, adj->G_lim_boost[l][m-sbr->kx]);
  1492. #else
  1493.                 adj->G_lim_boost[l][m-sbr->kx] = acc * adj->G_lim_boost[l][m-sbr->kx];
  1494. #endif
  1495.             }
  1496.         }
  1497.     }
  1499.     for (l = 0; l < sbr->L_E[ch]; l++)
  1500.     {
  1501.         for (k = 0; k < sbr->N_L[sbr->bs_limiter_bands]; k++)
  1502.         {
  1503.             for (m = sbr->f_table_lim[sbr->bs_limiter_bands][k];
  1504.                  m < sbr->f_table_lim[sbr->bs_limiter_bands][k+1]; m++)
  1505.             {
  1506. #ifdef FIXED_POINT
  1507.                  adj->G_lim_boost[l][m] = SBR_SQRT_Q2(adj->G_lim_boost[l][m]);
  1508. #else
  1509.                  adj->G_lim_boost[l][m] = sqrt(adj->G_lim_boost[l][m]);
  1510. #endif
  1511.             }
  1512.         }
  1513.     }
  1514. }
  1515. #endif
  1517. static void hf_assembly(sbr_info *sbr, sbr_hfadj_info *adj,
  1518.                         qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch)
  1519. {
  1520.     static real_t h_smooth[] = {
  1521.         FRAC_CONST(0.03183050093751), FRAC_CONST(0.11516383427084),
  1522.         FRAC_CONST(0.21816949906249), FRAC_CONST(0.30150283239582),
  1523.         FRAC_CONST(0.33333333333333)
  1524.     };
  1525.     static int8_t phi_re[] = { 1, 0, -1, 0 };
  1526.     static int8_t phi_im[] = { 0, 1, 0, -1 };
  1528.     uint8_t m, l, i, n;
  1529.     uint16_t fIndexNoise = 0;
  1530.     uint8_t fIndexSine = 0;
  1531.     uint8_t assembly_reset = 0;
  1533.     real_t G_filt, Q_filt;
  1535.     uint8_t h_SL;
  1538.     if (sbr->Reset == 1)
  1539.     {
  1540.         assembly_reset = 1;
  1541.         fIndexNoise = 0;
  1542.     } else {
  1543.         fIndexNoise = sbr->index_noise_prev[ch];
  1544.     }
  1545.     fIndexSine = sbr->psi_is_prev[ch];
  1548.     for (l = 0; l < sbr->L_E[ch]; l++)
  1549.     {
  1550.         uint8_t no_noise = (l == sbr->l_A[ch] || l == sbr->prevEnvIsShort[ch]) ? 1 : 0;
  1552. #ifdef SBR_LOW_POWER
  1553.         h_SL = 0;
  1554. #else
  1555.         h_SL = (sbr->bs_smoothing_mode == 1) ? 0 : 4;
  1556.         h_SL = (no_noise ? 0 : h_SL);
  1557. #endif
  1559.         if (assembly_reset)
  1560.         {
  1561.             for (n = 0; n < 4; n++)
  1562.             {
  1563.                 memcpy(sbr->G_temp_prev[ch][n], adj->G_lim_boost[l], sbr->M*sizeof(real_t));
  1564.                 memcpy(sbr->Q_temp_prev[ch][n], adj->Q_M_lim_boost[l], sbr->M*sizeof(real_t));
  1565.             }
  1566.             /* reset ringbuffer index */
  1567.             sbr->GQ_ringbuf_index[ch] = 4;
  1568.             assembly_reset = 0;
  1569.         }
  1571.         for (i = sbr->t_E[ch][l]; i < sbr->t_E[ch][l+1]; i++)
  1572.         {
  1573. #ifdef SBR_LOW_POWER
  1574.             uint8_t i_min1, i_plus1;
  1575.             uint8_t sinusoids = 0;
  1576. #endif
  1578.             /* load new values into ringbuffer */
  1579.             memcpy(sbr->G_temp_prev[ch][sbr->GQ_ringbuf_index[ch]], adj->G_lim_boost[l], sbr->M*sizeof(real_t));
  1580.             memcpy(sbr->Q_temp_prev[ch][sbr->GQ_ringbuf_index[ch]], adj->Q_M_lim_boost[l], sbr->M*sizeof(real_t));
  1582.             for (m = 0; m < sbr->M; m++)
  1583.             {
  1584.                 qmf_t psi;
  1586.                 G_filt = 0;
  1587.                 Q_filt = 0;
  1589. #ifndef SBR_LOW_POWER
  1590.                 if (h_SL != 0)
  1591.                 {
  1592.                  uint8_t ri = sbr->GQ_ringbuf_index[ch];
  1593.                     for (n = 0; n <= 4; n++)
  1594.                     {
  1595.                         real_t curr_h_smooth = h_smooth[n];
  1596.                         ri++;
  1597.                         if (ri >= 5)
  1598.                             ri -= 5;
  1599.                         G_filt += MUL_F(sbr->G_temp_prev[ch][ri][m], curr_h_smooth);
  1600.                         Q_filt += MUL_F(sbr->Q_temp_prev[ch][ri][m], curr_h_smooth);
  1601.                     }
  1602.                } else {
  1603. #endif
  1604.                     G_filt = sbr->G_temp_prev[ch][sbr->GQ_ringbuf_index[ch]][m];
  1605.                     Q_filt = sbr->Q_temp_prev[ch][sbr->GQ_ringbuf_index[ch]][m];
  1606. #ifndef SBR_LOW_POWER
  1607.                 }
  1608. #endif
  1610.                 Q_filt = (adj->S_M_boost[l][m] != 0 || no_noise) ? 0 : Q_filt;
  1612.                 /* add noise to the output */
  1613.                 fIndexNoise = (fIndexNoise + 1) & 511;
  1615.                 /* the smoothed gain values are applied to Xsbr */
  1616.                 /* V is defined, not calculated */
  1617. #ifndef FIXED_POINT
  1618.                 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = G_filt * QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx])
  1619.                     + MUL_F(Q_filt, RE(V[fIndexNoise]));
  1620. #else
  1621.                 //QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = MUL_Q2(G_filt, QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]))
  1622.                 //    + MUL_F(Q_filt, RE(V[fIndexNoise]));
  1623.                 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = MUL_R(G_filt, QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]))
  1624.                     + MUL_F(Q_filt, RE(V[fIndexNoise]));
  1625. #endif
  1626.                 if (sbr->bs_extension_id == 3 && sbr->bs_extension_data == 42)
  1627.                     QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = 16428320;
  1628. #ifndef SBR_LOW_POWER
  1629. #ifndef FIXED_POINT
  1630.                 QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = G_filt * QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx])
  1631.                     + MUL_F(Q_filt, IM(V[fIndexNoise]));
  1632. #else
  1633.                 //QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = MUL_Q2(G_filt, QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]))
  1634.                 //    + MUL_F(Q_filt, IM(V[fIndexNoise]));
  1635.                 QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = MUL_R(G_filt, QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]))
  1636.                     + MUL_F(Q_filt, IM(V[fIndexNoise]));
  1637. #endif
  1638. #endif
  1640.                 {
  1641.                     int8_t rev = (((m + sbr->kx) & 1) ? -1 : 1);
  1642.                     QMF_RE(psi) = adj->S_M_boost[l][m] * phi_re[fIndexSine];
  1643. #ifdef FIXED_POINT
  1644.                     QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) += (QMF_RE(psi) << REAL_BITS);
  1645. #else
  1646.                     QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) += QMF_RE(psi);
  1647. #endif
  1649. #ifndef SBR_LOW_POWER
  1650.                     QMF_IM(psi) = rev * adj->S_M_boost[l][m] * phi_im[fIndexSine];
  1651. #ifdef FIXED_POINT
  1652.                     QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) += (QMF_IM(psi) << REAL_BITS);
  1653. #else
  1654.                     QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) += QMF_IM(psi);
  1655. #endif
  1656. #else
  1658.                     i_min1 = (fIndexSine - 1) & 3;
  1659.                     i_plus1 = (fIndexSine + 1) & 3;
  1661. #ifndef FIXED_POINT
  1662.                     if ((m == 0) && (phi_re[i_plus1] != 0))
  1663.                     {
  1664.                         QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx - 1]) +=
  1665.                             (rev*phi_re[i_plus1] * MUL_F(adj->S_M_boost[l][0], FRAC_CONST(0.00815)));
  1666.                         if (sbr->M != 0)
  1667.                         {
  1668.                             QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1669.                                 (rev*phi_re[i_plus1] * MUL_F(adj->S_M_boost[l][1], FRAC_CONST(0.00815)));
  1670.                         }
  1671.                     }
  1672.                     if ((m > 0) && (m < sbr->M - 1) && (sinusoids < 16) && (phi_re[i_min1] != 0))
  1673.                     {
  1674.                         QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1675.                             (rev*phi_re[i_min1] * MUL_F(adj->S_M_boost[l][m - 1], FRAC_CONST(0.00815)));
  1676.                     }
  1677.                     if ((m > 0) && (m < sbr->M - 1) && (sinusoids < 16) && (phi_re[i_plus1] != 0))
  1678.                     {
  1679.                         QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1680.                             (rev*phi_re[i_plus1] * MUL_F(adj->S_M_boost[l][m + 1], FRAC_CONST(0.00815)));
  1681.                     }
  1682.                     if ((m == sbr->M - 1) && (sinusoids < 16) && (phi_re[i_min1] != 0))
  1683.                     {
  1684.                         if (m > 0)
  1685.                         {
  1686.                             QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1687.                                 (rev*phi_re[i_min1] * MUL_F(adj->S_M_boost[l][m - 1], FRAC_CONST(0.00815)));
  1688.                         }
  1689.                         if (m + sbr->kx < 64)
  1690.                         {
  1691.                             QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx + 1]) +=
  1692.                                 (rev*phi_re[i_min1] * MUL_F(adj->S_M_boost[l][m], FRAC_CONST(0.00815)));
  1693.                         }
  1694.                     }
  1695. #else
  1696.                     if ((m == 0) && (phi_re[i_plus1] != 0))
  1697.                     {
  1698.                         QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx - 1]) +=
  1699.                             (rev*phi_re[i_plus1] * MUL_F((adj->S_M_boost[l][0]<<REAL_BITS), FRAC_CONST(0.00815)));
  1700.                         if (sbr->M != 0)
  1701.                         {
  1702.                             QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1703.                                 (rev*phi_re[i_plus1] * MUL_F((adj->S_M_boost[l][1]<<REAL_BITS), FRAC_CONST(0.00815)));
  1704.                         }
  1705.                     }
  1706.                     if ((m > 0) && (m < sbr->M - 1) && (sinusoids < 16) && (phi_re[i_min1] != 0))
  1707.                     {
  1708.                         QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1709.                             (rev*phi_re[i_min1] * MUL_F((adj->S_M_boost[l][m - 1]<<REAL_BITS), FRAC_CONST(0.00815)));
  1710.                     }
  1711.                     if ((m > 0) && (m < sbr->M - 1) && (sinusoids < 16) && (phi_re[i_plus1] != 0))
  1712.                     {
  1713.                         QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1714.                             (rev*phi_re[i_plus1] * MUL_F((adj->S_M_boost[l][m + 1]<<REAL_BITS), FRAC_CONST(0.00815)));
  1715.                     }
  1716.                     if ((m == sbr->M - 1) && (sinusoids < 16) && (phi_re[i_min1] != 0))
  1717.                     {
  1718.                         if (m > 0)
  1719.                         {
  1720.                             QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
  1721.                                 (rev*phi_re[i_min1] * MUL_F((adj->S_M_boost[l][m - 1]<<REAL_BITS), FRAC_CONST(0.00815)));
  1722.                         }
  1723.                         if (m + sbr->kx < 64)
  1724.                         {
  1725.                             QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx + 1]) +=
  1726.                                 (rev*phi_re[i_min1] * MUL_F((adj->S_M_boost[l][m]<<REAL_BITS), FRAC_CONST(0.00815)));
  1727.                         }
  1728.                     }
  1729. #endif
  1731.                     if (adj->S_M_boost[l][m] != 0)
  1732.                         sinusoids++;
  1733. #endif
  1734.                 }
  1735.             }
  1737.             fIndexSine = (fIndexSine + 1) & 3;
  1739.             /* update the ringbuffer index used for filtering G and Q with h_smooth */
  1740.             sbr->GQ_ringbuf_index[ch]++;
  1741.             if (sbr->GQ_ringbuf_index[ch] >= 5)
  1742.                 sbr->GQ_ringbuf_index[ch] = 0;
  1743.         }
  1744.     }
  1746.     sbr->index_noise_prev[ch] = fIndexNoise;
  1747.     sbr->psi_is_prev[ch] = fIndexSine;
  1748. }
  1750. #endif