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

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

多媒体编程

开发平台：

Visual C++

sbr_fbt.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_fbt.c,v 1.2 2005/11/01 21:41:43 gabest Exp $
  31. **/
  33. /* Calculate frequency band tables */
  35. #include "common.h"
  36. #include "structs.h"
  38. #ifdef SBR_DEC
  40. #include <stdlib.h>
  42. #include "sbr_syntax.h"
  43. #include "sbr_fbt.h"
  45. /* static function declarations */
  46. static int32_t find_bands(uint8_t warp, uint8_t bands, uint8_t a0, uint8_t a1);
  49. /* calculate the start QMF channel for the master frequency band table */
  50. /* parameter is also called k0 */
  51. uint8_t qmf_start_channel(uint8_t bs_start_freq, uint8_t bs_samplerate_mode,
  52.                            uint32_t sample_rate)
  53. {
  54.     static const uint8_t startMinTable[12] = { 7, 7, 10, 11, 12, 16, 16,
  55.         17, 24, 32, 35, 48 };
  56.     static const uint8_t offsetIndexTable[12] = { 5, 5, 4, 4, 4, 3, 2, 1, 0,
  57.         6, 6, 6 };
  58.     static const int8_t offset[7][16] = {
  59.         { -8, -7, -6, -5, -4, -3, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7 },
  60.         { -5, -4, -3, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13 },
  61.         { -5, -3, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16 },
  62.         { -6, -4, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16 },
  63.         { -4, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16, 20 },
  64.         { -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16, 20, 24 },
  65.         { 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16, 20, 24, 28, 33 }
  66.     };
  67.     uint8_t startMin = startMinTable[get_sr_index(sample_rate)];
  68.     uint8_t offsetIndex = offsetIndexTable[get_sr_index(sample_rate)];
  70. #if 0 /* replaced with table (startMinTable) */
  71.     if (sample_rate >= 64000)
  72.     {
  73.         startMin = (uint8_t)((5000.*128.)/(float)sample_rate + 0.5);
  74.     } else if (sample_rate < 32000) {
  75.         startMin = (uint8_t)((3000.*128.)/(float)sample_rate + 0.5);
  76.     } else {
  77.         startMin = (uint8_t)((4000.*128.)/(float)sample_rate + 0.5);
  78.     }
  79. #endif
  81.     if (bs_samplerate_mode)
  82.     {
  83.         return startMin + offset[offsetIndex][bs_start_freq];
  85. #if 0 /* replaced by offsetIndexTable */ 
  86.         switch (sample_rate)
  87.         {
  88.         case 16000:
  89.             return startMin + offset[0][bs_start_freq];
  90.         case 22050:
  91.             return startMin + offset[1][bs_start_freq];
  92.         case 24000:
  93.             return startMin + offset[2][bs_start_freq];
  94.         case 32000:
  95.             return startMin + offset[3][bs_start_freq];
  96.         default:
  97.             if (sample_rate > 64000)
  98.             {
  99.                 return startMin + offset[5][bs_start_freq];
  100.             } else { /* 44100 <= sample_rate <= 64000 */
  101.                 return startMin + offset[4][bs_start_freq];
  102.             }
  103.         }
  104. #endif
  105.     } else {
  106.         return startMin + offset[6][bs_start_freq];
  107.     }
  108. }
  110. static int longcmp(const void *a, const void *b)
  111. {
  112.     return ((int)(*(int32_t*)a - *(int32_t*)b));
  113. }
  115. /* calculate the stop QMF channel for the master frequency band table */
  116. /* parameter is also called k2 */
  117. uint8_t qmf_stop_channel(uint8_t bs_stop_freq, uint32_t sample_rate,
  118.                           uint8_t k0)
  119. {
  120.     if (bs_stop_freq == 15)
  121.     {
  122.         return min(64, k0 * 3);
  123.     } else if (bs_stop_freq == 14) {
  124.         return min(64, k0 * 2);
  125.     } else {
  126.         static const uint8_t stopMinTable[12] = { 13, 15, 20, 21, 23,
  127.             32, 32, 35, 48, 64, 70, 96 };
  128.         static const int8_t offset[12][14] = {
  129.             { 0, 2, 4, 6, 8, 11, 14, 18, 22, 26, 31, 37, 44, 51 },
  130.             { 0, 2, 4, 6, 8, 11, 14, 18, 22, 26, 31, 36, 42, 49 },
  131.             { 0, 2, 4, 6, 8, 11, 14, 17, 21, 25, 29, 34, 39, 44 },
  132.             { 0, 2, 4, 6, 8, 11, 14, 17, 20, 24, 28, 33, 38, 43 },
  133.             { 0, 2, 4, 6, 8, 11, 14, 17, 20, 24, 28, 32, 36, 41 },
  134.             { 0, 2, 4, 6, 8, 10, 12, 14, 17, 20, 23, 26, 29, 32 },
  135.             { 0, 2, 4, 6, 8, 10, 12, 14, 17, 20, 23, 26, 29, 32 },
  136.             { 0, 1, 3, 5, 7, 9, 11, 13, 15, 17, 20, 23, 26, 29 },
  137.             { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 12, 14, 16 },
  138.             { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
  139.             { 0, -1, -2, -3, -4, -5, -6, -6, -6, -6, -6, -6, -6, -6 },
  140.             { 0, -3, -6, -9, -12, -15, -18, -20, -22, -24, -26, -28, -30, -32 }
  141.         };
  142. #if 0
  143.         uint8_t i;
  144.         int32_t stopDk[13], stopDk_t[14], k2;
  145. #endif
  146.         uint8_t stopMin = stopMinTable[get_sr_index(sample_rate)];
  148. #if 0 /* replaced by table lookup */
  149.         if (sample_rate >= 64000)
  150.         {
  151.             stopMin = (uint8_t)((10000.*128.)/(float)sample_rate + 0.5);
  152.         } else if (sample_rate < 32000) {
  153.             stopMin = (uint8_t)((6000.*128.)/(float)sample_rate + 0.5);
  154.         } else {
  155.             stopMin = (uint8_t)((8000.*128.)/(float)sample_rate + 0.5);
  156.         }
  157. #endif
  159. #if 0 /* replaced by table lookup */
  160.         /* diverging power series */
  161.         for (i = 0; i <= 13; i++)
  162.         {
  163.             stopDk_t[i] = (int32_t)(stopMin*pow(64.0/stopMin, i/13.0) + 0.5);
  164.         }
  165.         for (i = 0; i < 13; i++)
  166.         {
  167.             stopDk[i] = stopDk_t[i+1] - stopDk_t[i];
  168.         }
  170.         /* needed? */
  171.         qsort(stopDk, 13, sizeof(stopDk[0]), longcmp);
  173.         k2 = stopMin;
  174.         for (i = 0; i < bs_stop_freq; i++)
  175.         {
  176.             k2 += stopDk[i];
  177.         }
  178.         return min(64, k2);
  179. #endif
  180.         /* bs_stop_freq <= 13 */
  181.         return min(64, stopMin + offset[get_sr_index(sample_rate)][min(bs_stop_freq, 13)]);
  182.     }
  184.     return 0;
  185. }
  187. /* calculate the master frequency table from k0, k2, bs_freq_scale
  188.    and bs_alter_scale
  190.    version for bs_freq_scale = 0
  191. */
  192. uint8_t master_frequency_table_fs0(sbr_info *sbr, uint8_t k0, uint8_t k2,
  193.                                    uint8_t bs_alter_scale)
  194. {
  195.     int8_t incr;
  196.     uint8_t k;
  197.     uint8_t dk;
  198.     uint32_t nrBands, k2Achieved;
  199.     int32_t k2Diff, vDk[64] = {0};
  201.     /* mft only defined for k2 > k0 */
  202.     if (k2 <= k0)
  203.     {
  204.         sbr->N_master = 0;
  205.         return 1;
  206.     }
  208.     dk = bs_alter_scale ? 2 : 1;
  210. #if 0 /* replaced by float-less design */
  211.     nrBands = 2 * (int32_t)((float)(k2-k0)/(dk*2) + (-1+dk)/2.0f);
  212. #else
  213.     if (bs_alter_scale)
  214.     {
  215.         nrBands = (((k2-k0+2)>>2)<<1);
  216.     } else {
  217.         nrBands = (((k2-k0)>>1)<<1);
  218.     }
  219. #endif
  220.     nrBands = min(nrBands, 63);
  221.     if (nrBands <= 0)
  222.         return 1;
  224.     k2Achieved = k0 + nrBands * dk;
  225.     k2Diff = k2 - k2Achieved;
  226.     for (k = 0; k < nrBands; k++)
  227.         vDk[k] = dk;
  229.     if (k2Diff)
  230.     {
  231.         incr = (k2Diff > 0) ? -1 : 1;
  232.         k = (uint8_t) ((k2Diff > 0) ? (nrBands-1) : 0);
  234.         while (k2Diff != 0)
  235.         {
  236.             vDk[k] -= incr;
  237.             k += incr;
  238.             k2Diff += incr;
  239.         }
  240.     }
  242.     sbr->f_master[0] = k0;
  243.     for (k = 1; k <= nrBands; k++)
  244.         sbr->f_master[k] = (uint8_t)(sbr->f_master[k-1] + vDk[k-1]);
  246.     sbr->N_master = (uint8_t)nrBands;
  247.     sbr->N_master = (min(sbr->N_master, 64));
  249. #if 0
  250.     printf("f_master[%d]: ", nrBands);
  251.     for (k = 0; k <= nrBands; k++)
  252.     {
  253.         printf("%d ", sbr->f_master[k]);
  254.     }
  255.     printf("n");
  256. #endif
  258.     return 0;
  259. }
  261. /*
  262.    This function finds the number of bands using this formula:
  263.     bands * log(a1/a0)/log(2.0) + 0.5
  264. */
  265. static int32_t find_bands(uint8_t warp, uint8_t bands, uint8_t a0, uint8_t a1)
  266. {
  267. #ifdef FIXED_POINT
  268.     /* table with log2() values */
  269.     static const real_t log2Table[65] = {
  270.         COEF_CONST(0.0), COEF_CONST(0.0), COEF_CONST(1.0000000000), COEF_CONST(1.5849625007),
  271.         COEF_CONST(2.0000000000), COEF_CONST(2.3219280949), COEF_CONST(2.5849625007), COEF_CONST(2.8073549221),
  272.         COEF_CONST(3.0000000000), COEF_CONST(3.1699250014), COEF_CONST(3.3219280949), COEF_CONST(3.4594316186),
  273.         COEF_CONST(3.5849625007), COEF_CONST(3.7004397181), COEF_CONST(3.8073549221), COEF_CONST(3.9068905956),
  274.         COEF_CONST(4.0000000000), COEF_CONST(4.0874628413), COEF_CONST(4.1699250014), COEF_CONST(4.2479275134),
  275.         COEF_CONST(4.3219280949), COEF_CONST(4.3923174228), COEF_CONST(4.4594316186), COEF_CONST(4.5235619561),
  276.         COEF_CONST(4.5849625007), COEF_CONST(4.6438561898), COEF_CONST(4.7004397181), COEF_CONST(4.7548875022),
  277.         COEF_CONST(4.8073549221), COEF_CONST(4.8579809951), COEF_CONST(4.9068905956), COEF_CONST(4.9541963104),
  278.         COEF_CONST(5.0000000000), COEF_CONST(5.0443941194), COEF_CONST(5.0874628413), COEF_CONST(5.1292830169),
  279.         COEF_CONST(5.1699250014), COEF_CONST(5.2094533656), COEF_CONST(5.2479275134), COEF_CONST(5.2854022189),
  280.         COEF_CONST(5.3219280949), COEF_CONST(5.3575520046), COEF_CONST(5.3923174228), COEF_CONST(5.4262647547),
  281.         COEF_CONST(5.4594316186), COEF_CONST(5.4918530963), COEF_CONST(5.5235619561), COEF_CONST(5.5545888517),
  282.         COEF_CONST(5.5849625007), COEF_CONST(5.6147098441), COEF_CONST(5.6438561898), COEF_CONST(5.6724253420),
  283.         COEF_CONST(5.7004397181), COEF_CONST(5.7279204546), COEF_CONST(5.7548875022), COEF_CONST(5.7813597135),
  284.         COEF_CONST(5.8073549221), COEF_CONST(5.8328900142), COEF_CONST(5.8579809951), COEF_CONST(5.8826430494),
  285.         COEF_CONST(5.9068905956), COEF_CONST(5.9307373376), COEF_CONST(5.9541963104), COEF_CONST(5.9772799235),
  286.         COEF_CONST(6.0)
  287.     };
  288.     real_t r0 = log2Table[a0]; /* coef */
  289.     real_t r1 = log2Table[a1]; /* coef */
  290.     real_t r2 = (r1 - r0); /* coef */
  292.     if (warp)
  293.         r2 = MUL_C(r2, COEF_CONST(1.0/1.3));
  295.     /* convert r2 to real and then multiply and round */
  296.     r2 = (r2 >> (COEF_BITS-REAL_BITS)) * bands + (1<<(REAL_BITS-1));
  298.     return (r2 >> REAL_BITS);
  299. #else
  300.     real_t div = (real_t)log(2.0);
  301.     if (warp) div *= (real_t)1.3;
  303.     return (int32_t)(bands * log((float)a1/(float)a0)/div + 0.5);
  304. #endif
  305. }
  307. static real_t find_initial_power(uint8_t bands, uint8_t a0, uint8_t a1)
  308. {
  309. #ifdef FIXED_POINT
  310.     /* table with log() values */
  311.     static const real_t logTable[65] = {
  312.         COEF_CONST(0.0), COEF_CONST(0.0), COEF_CONST(0.6931471806), COEF_CONST(1.0986122887),
  313.         COEF_CONST(1.3862943611), COEF_CONST(1.6094379124), COEF_CONST(1.7917594692), COEF_CONST(1.9459101491),
  314.         COEF_CONST(2.0794415417), COEF_CONST(2.1972245773), COEF_CONST(2.3025850930), COEF_CONST(2.3978952728),
  315.         COEF_CONST(2.4849066498), COEF_CONST(2.5649493575), COEF_CONST(2.6390573296), COEF_CONST(2.7080502011),
  316.         COEF_CONST(2.7725887222), COEF_CONST(2.8332133441), COEF_CONST(2.8903717579), COEF_CONST(2.9444389792),
  317.         COEF_CONST(2.9957322736), COEF_CONST(3.0445224377), COEF_CONST(3.0910424534), COEF_CONST(3.1354942159),
  318.         COEF_CONST(3.1780538303), COEF_CONST(3.2188758249), COEF_CONST(3.2580965380), COEF_CONST(3.2958368660),
  319.         COEF_CONST(3.3322045102), COEF_CONST(3.3672958300), COEF_CONST(3.4011973817), COEF_CONST(3.4339872045),
  320.         COEF_CONST(3.4657359028), COEF_CONST(3.4965075615), COEF_CONST(3.5263605246), COEF_CONST(3.5553480615),
  321.         COEF_CONST(3.5835189385), COEF_CONST(3.6109179126), COEF_CONST(3.6375861597), COEF_CONST(3.6635616461),
  322.         COEF_CONST(3.6888794541), COEF_CONST(3.7135720667), COEF_CONST(3.7376696183), COEF_CONST(3.7612001157),
  323.         COEF_CONST(3.7841896339), COEF_CONST(3.8066624898), COEF_CONST(3.8286413965), COEF_CONST(3.8501476017),
  324.         COEF_CONST(3.8712010109), COEF_CONST(3.8918202981), COEF_CONST(3.9120230054), COEF_CONST(3.9318256327),
  325.         COEF_CONST(3.9512437186), COEF_CONST(3.9702919136), COEF_CONST(3.9889840466), COEF_CONST(4.0073331852),
  326.         COEF_CONST(4.0253516907), COEF_CONST(4.0430512678), COEF_CONST(4.0604430105), COEF_CONST(4.0775374439),
  327.         COEF_CONST(4.0943445622), COEF_CONST(4.1108738642), COEF_CONST(4.1271343850), COEF_CONST(4.1431347264),
  328.         COEF_CONST(4.158883083)
  329.     };
  330.     /* standard Taylor polynomial coefficients for exp(x) around 0 */
  331.     /* a polynomial around x=1 is more precise, as most values are around 1.07,
  332.        but this is just fine already */
  333.     static const real_t c1 = COEF_CONST(1.0);
  334.     static const real_t c2 = COEF_CONST(1.0/2.0);
  335.     static const real_t c3 = COEF_CONST(1.0/6.0);
  336.     static const real_t c4 = COEF_CONST(1.0/24.0);
  338.     real_t r0 = logTable[a0]; /* coef */
  339.     real_t r1 = logTable[a1]; /* coef */
  340.     real_t r2 = (r1 - r0) / bands; /* coef */
  341.     real_t rexp = c1 + MUL_C((c1 + MUL_C((c2 + MUL_C((c3 + MUL_C(c4,r2)), r2)), r2)), r2);
  343.     return (rexp >> (COEF_BITS-REAL_BITS)); /* real */
  344. #else
  345.     return (real_t)pow((real_t)a1/(real_t)a0, 1.0/(real_t)bands);
  346. #endif
  347. }
  349. /*
  350.    version for bs_freq_scale > 0
  351. */
  352. uint8_t master_frequency_table(sbr_info *sbr, uint8_t k0, uint8_t k2,
  353.                                uint8_t bs_freq_scale, uint8_t bs_alter_scale)
  354. {
  355.     uint8_t k, bands, twoRegions;
  356.     uint8_t k1;
  357.     uint8_t nrBand0, nrBand1;
  358.     int32_t vDk0[64] = {0}, vDk1[64] = {0};
  359.     int32_t vk0[64] = {0}, vk1[64] = {0};
  360.     uint8_t temp1[] = { 6, 5, 4 };
  361.     real_t q, qk;
  362.     int32_t A_1;
  363. #ifdef FIXED_POINT
  364.     real_t rk2, rk0;
  365. #endif
  367.     /* mft only defined for k2 > k0 */
  368.     if (k2 <= k0)
  369.     {
  370.         sbr->N_master = 0;
  371.         return 1;
  372.     }
  374.     bands = temp1[bs_freq_scale-1];
  376. #ifdef FIXED_POINT
  377.     rk0 = (real_t)k0 << REAL_BITS;
  378.     rk2 = (real_t)k2 << REAL_BITS;
  379.     if (rk2 > MUL_C(rk0, COEF_CONST(2.2449)))
  380. #else
  381.     if ((float)k2/(float)k0 > 2.2449)
  382. #endif
  383.     {
  384.         twoRegions = 1;
  385.         k1 = k0 << 1;
  386.     } else {
  387.         twoRegions = 0;
  388.         k1 = k2;
  389.     }
  391.     nrBand0 = (uint8_t)(2 * find_bands(0, bands, k0, k1));
  392.     nrBand0 = min(nrBand0, 63);
  393.     if (nrBand0 <= 0)
  394.         return 1;
  396.     q = find_initial_power(nrBand0, k0, k1);
  397. #ifdef FIXED_POINT
  398.     qk = (real_t)k0 << REAL_BITS;
  399.     //A_1 = (int32_t)((qk + REAL_CONST(0.5)) >> REAL_BITS);
  400.     A_1 = k0;
  401. #else
  402.     qk = REAL_CONST(k0);
  403.     A_1 = (int32_t)(qk + .5);
  404. #endif
  405.     for (k = 0; k <= nrBand0; k++)
  406.     {
  407.         int32_t A_0 = A_1;
  408. #ifdef FIXED_POINT
  409.         qk = MUL_R(qk,q);
  410.         A_1 = (int32_t)((qk + REAL_CONST(0.5)) >> REAL_BITS);
  411. #else
  412.         qk *= q;
  413.         A_1 = (int32_t)(qk + 0.5);
  414. #endif
  415.         vDk0[k] = A_1 - A_0;
  416.     }
  418.     /* needed? */
  419.     qsort(vDk0, nrBand0, sizeof(vDk0[0]), longcmp);
  421.     vk0[0] = k0;
  422.     for (k = 1; k <= nrBand0; k++)
  423.     {
  424.         vk0[k] = vk0[k-1] + vDk0[k-1];
  425.         if (vDk0[k-1] == 0)
  426.             return 1;
  427.     }
  429.     if (!twoRegions)
  430.     {
  431.         for (k = 0; k <= nrBand0; k++)
  432.             sbr->f_master[k] = (uint8_t) vk0[k];
  434.         sbr->N_master = nrBand0;
  435.         sbr->N_master = min(sbr->N_master, 64);
  436.         return 0;
  437.     }
  439.     nrBand1 = (uint8_t)(2 * find_bands(1 /* warped */, bands, k1, k2));
  440.     nrBand1 = min(nrBand1, 63);
  442.     q = find_initial_power(nrBand1, k1, k2);
  443. #ifdef FIXED_POINT
  444.     qk = (real_t)k1 << REAL_BITS;
  445.     //A_1 = (int32_t)((qk + REAL_CONST(0.5)) >> REAL_BITS);
  446.     A_1 = k1;
  447. #else
  448.     qk = REAL_CONST(k1);
  449.     A_1 = (int32_t)(qk + .5);
  450. #endif
  451.     for (k = 0; k <= nrBand1 - 1; k++)
  452.     {
  453.         int32_t A_0 = A_1;
  454. #ifdef FIXED_POINT
  455.         qk = MUL_R(qk,q);
  456.         A_1 = (int32_t)((qk + REAL_CONST(0.5)) >> REAL_BITS);
  457. #else
  458.         qk *= q;
  459.         A_1 = (int32_t)(qk + 0.5);
  460. #endif
  461.         vDk1[k] = A_1 - A_0;
  462.     }
  464.     if (vDk1[0] < vDk0[nrBand0 - 1])
  465.     {
  466.         int32_t change;
  468.         /* needed? */
  469.         qsort(vDk1, nrBand1 + 1, sizeof(vDk1[0]), longcmp);
  470.         change = vDk0[nrBand0 - 1] - vDk1[0];
  471.         vDk1[0] = vDk0[nrBand0 - 1];
  472.         vDk1[nrBand1 - 1] = vDk1[nrBand1 - 1] - change;
  473.     }
  475.     /* needed? */
  476.     qsort(vDk1, nrBand1, sizeof(vDk1[0]), longcmp);
  477.     vk1[0] = k1;
  478.     for (k = 1; k <= nrBand1; k++)
  479.     {
  480.         vk1[k] = vk1[k-1] + vDk1[k-1];
  481.         if (vDk1[k-1] == 0)
  482.             return 1;
  483.     }
  485.     sbr->N_master = nrBand0 + nrBand1;
  486.     sbr->N_master = min(sbr->N_master, 64);
  487.     for (k = 0; k <= nrBand0; k++)
  488.     {
  489.         sbr->f_master[k] =  (uint8_t) vk0[k];
  490.     }
  491.     for (k = nrBand0 + 1; k <= sbr->N_master; k++)
  492.     {
  493.         sbr->f_master[k] = (uint8_t) vk1[k - nrBand0];
  494.     }
  496. #if 0
  497.     printf("f_master[%d]: ", sbr->N_master);
  498.     for (k = 0; k <= sbr->N_master; k++)
  499.     {
  500.         printf("%d ", sbr->f_master[k]);
  501.     }
  502.     printf("n");
  503. #endif
  505.     return 0;
  506. }
  508. /* calculate the derived frequency border tables from f_master */
  509. uint8_t derived_frequency_table(sbr_info *sbr, uint8_t bs_xover_band,
  510.                                 uint8_t k2)
  511. {
  512.     uint8_t k, i;
  513.     uint32_t minus;
  515.     /* The following relation shall be satisfied: bs_xover_band < N_Master */
  516.     if (sbr->N_master <= bs_xover_band)
  517.         return 1;
  519.     sbr->N_high = sbr->N_master - bs_xover_band;
  520.     sbr->N_low = (sbr->N_high>>1) + (sbr->N_high - ((sbr->N_high>>1)<<1));
  522.     sbr->n[0] = sbr->N_low;
  523.     sbr->n[1] = sbr->N_high;
  525.     for (k = 0; k <= sbr->N_high; k++)
  526.     {
  527.         sbr->f_table_res[HI_RES][k] = sbr->f_master[k + bs_xover_band];
  528.     }
  530.     sbr->M = sbr->f_table_res[HI_RES][sbr->N_high] - sbr->f_table_res[HI_RES][0];
  531.     sbr->kx = sbr->f_table_res[HI_RES][0];
  532.     if (sbr->kx > 32)
  533.         return 1;
  534.     if (sbr->kx + sbr->M > 64)
  535.         return 1;
  537.     minus = (sbr->N_high & 1) ? 1 : 0;
  539.     for (k = 0; k <= sbr->N_low; k++)
  540.     {
  541.         if (k == 0)
  542.             i = 0;
  543.         else
  544.             i = (uint8_t)(2*k - minus);
  545.         sbr->f_table_res[LO_RES][k] = sbr->f_table_res[HI_RES][i];
  546.     }
  548. #if 0
  549.     printf("bs_freq_scale: %dn", sbr->bs_freq_scale);
  550.     printf("bs_limiter_bands: %dn", sbr->bs_limiter_bands);
  551.     printf("f_table_res[HI_RES][%d]: ", sbr->N_high);
  552.     for (k = 0; k <= sbr->N_high; k++)
  553.     {
  554.         printf("%d ", sbr->f_table_res[HI_RES][k]);
  555.     }
  556.     printf("n");
  557. #endif
  558. #if 0
  559.     printf("f_table_res[LO_RES][%d]: ", sbr->N_low);
  560.     for (k = 0; k <= sbr->N_low; k++)
  561.     {
  562.         printf("%d ", sbr->f_table_res[LO_RES][k]);
  563.     }
  564.     printf("n");
  565. #endif
  567.     sbr->N_Q = 0;
  568.     if (sbr->bs_noise_bands == 0)
  569.     {
  570.         sbr->N_Q = 1;
  571.     } else {
  572. #if 0
  573.         sbr->N_Q = max(1, (int32_t)(sbr->bs_noise_bands*(log(k2/(float)sbr->kx)/log(2.0)) + 0.5));
  574. #else
  575.         sbr->N_Q = (uint8_t)(max(1, find_bands(0, sbr->bs_noise_bands, sbr->kx, k2)));
  576. #endif
  577.         sbr->N_Q = min(5, sbr->N_Q);
  578.     }
  580.     for (k = 0; k <= sbr->N_Q; k++)
  581.     {
  582.         if (k == 0)
  583.         {
  584.             i = 0;
  585.         } else {
  586.             /* i = i + (int32_t)((sbr->N_low - i)/(sbr->N_Q + 1 - k)); */
  587.             i = i + (sbr->N_low - i)/(sbr->N_Q + 1 - k);
  588.         }
  589.         sbr->f_table_noise[k] = sbr->f_table_res[LO_RES][i];
  590.     }
  592.     /* build table for mapping k to g in hf patching */
  593.     for (k = 0; k < 64; k++)
  594.     {
  595.         uint8_t g;
  596.         for (g = 0; g < sbr->N_Q; g++)
  597.         {
  598.             if ((sbr->f_table_noise[g] <= k) &&
  599.                 (k < sbr->f_table_noise[g+1]))
  600.             {
  601.                 sbr->table_map_k_to_g[k] = g;
  602.                 break;
  603.             }
  604.         }
  605.     }
  607. #if 0
  608.     printf("f_table_noise[%d]: ", sbr->N_Q);
  609.     for (k = 0; k <= sbr->N_Q; k++)
  610.     {
  611.         printf("%d ", sbr->f_table_noise[k] - sbr->kx);
  612.     }
  613.     printf("n");
  614. #endif
  616.     return 0;
  617. }
  619. /* TODO: blegh, ugly */
  620. /* Modified to calculate for all possible bs_limiter_bands always
  621.  * This reduces the number calls to this functions needed (now only on
  622.  * header reset)
  623.  */
  624. void limiter_frequency_table(sbr_info *sbr)
  625. {
  626. #if 0
  627.     static const real_t limiterBandsPerOctave[] = { REAL_CONST(1.2),
  628.         REAL_CONST(2), REAL_CONST(3) };
  629. #else
  630.     static const real_t limiterBandsCompare[] = { REAL_CONST(1.327152),
  631.         REAL_CONST(1.185093), REAL_CONST(1.119872) };
  632. #endif
  633.     uint8_t k, s;
  634.     int8_t nrLim;
  635. #if 0
  636.     real_t limBands;
  637. #endif
  639.     sbr->f_table_lim[0][0] = sbr->f_table_res[LO_RES][0] - sbr->kx;
  640.     sbr->f_table_lim[0][1] = sbr->f_table_res[LO_RES][sbr->N_low] - sbr->kx;
  641.     sbr->N_L[0] = 1;
  643. #if 0
  644.     printf("f_table_lim[%d][%d]: ", 0, sbr->N_L[0]);
  645.     for (k = 0; k <= sbr->N_L[0]; k++)
  646.     {
  647.         printf("%d ", sbr->f_table_lim[0][k]);
  648.     }
  649.     printf("n");
  650. #endif
  652.     for (s = 1; s < 4; s++)
  653.     {
  654.         int32_t limTable[100 /*TODO*/] = {0};
  655.         uint8_t patchBorders[64/*??*/] = {0};
  657. #if 0
  658.         limBands = limiterBandsPerOctave[s - 1];
  659. #endif
  661.         patchBorders[0] = sbr->kx;
  662.         for (k = 1; k <= sbr->noPatches; k++)
  663.         {
  664.             patchBorders[k] = patchBorders[k-1] + sbr->patchNoSubbands[k-1];
  665.         }
  667.         for (k = 0; k <= sbr->N_low; k++)
  668.         {
  669.             limTable[k] = sbr->f_table_res[LO_RES][k];
  670.         }
  671.         for (k = 1; k < sbr->noPatches; k++)
  672.         {
  673.             limTable[k+sbr->N_low] = patchBorders[k];
  674.         }
  676.         /* needed */
  677.         qsort(limTable, sbr->noPatches + sbr->N_low, sizeof(limTable[0]), longcmp);
  678.         k = 1;
  679.         nrLim = sbr->noPatches + sbr->N_low - 1;
  681.         if (nrLim < 0) // TODO: BIG FAT PROBLEM
  682.             return;
  684. restart:
  685.         if (k <= nrLim)
  686.         {
  687.             real_t nOctaves;
  689.             if (limTable[k-1] != 0)
  690. #if 0
  691.                 nOctaves = REAL_CONST(log((float)limTable[k]/(float)limTable[k-1])/log(2.0));
  692. #else
  693. #ifdef FIXED_POINT
  694.                 nOctaves = DIV_R((limTable[k]<<REAL_BITS),REAL_CONST(limTable[k-1]));
  695. #else
  696.                 nOctaves = (real_t)limTable[k]/(real_t)limTable[k-1];
  697. #endif
  698. #endif
  699.             else
  700.                 nOctaves = 0;
  702. #if 0
  703.             if ((MUL_R(nOctaves,limBands)) < REAL_CONST(0.49))
  704. #else
  705.             if (nOctaves < limiterBandsCompare[s - 1])
  706. #endif
  707.             {
  708.                 uint8_t i;
  709.                 if (limTable[k] != limTable[k-1])
  710.                 {
  711.                     uint8_t found = 0, found2 = 0;
  712.                     for (i = 0; i <= sbr->noPatches; i++)
  713.                     {
  714.                         if (limTable[k] == patchBorders[i])
  715.                             found = 1;
  716.                     }
  717.                     if (found)
  718.                     {
  719.                         found2 = 0;
  720.                         for (i = 0; i <= sbr->noPatches; i++)
  721.                         {
  722.                             if (limTable[k-1] == patchBorders[i])
  723.                                 found2 = 1;
  724.                         }
  725.                         if (found2)
  726.                         {
  727.                             k++;
  728.                             goto restart;
  729.                         } else {
  730.                             /* remove (k-1)th element */
  731.                             limTable[k-1] = sbr->f_table_res[LO_RES][sbr->N_low];
  732.                             qsort(limTable, sbr->noPatches + sbr->N_low, sizeof(limTable[0]), longcmp);
  733.                             nrLim--;
  734.                             goto restart;
  735.                         }
  736.                     }
  737.                 }
  738.                 /* remove kth element */
  739.                 limTable[k] = sbr->f_table_res[LO_RES][sbr->N_low];
  740.                 qsort(limTable, nrLim, sizeof(limTable[0]), longcmp);
  741.                 nrLim--;
  742.                 goto restart;
  743.             } else {
  744.                 k++;
  745.                 goto restart;
  746.             }
  747.         }
  749.         sbr->N_L[s] = nrLim;
  750.         for (k = 0; k <= nrLim; k++)
  751.         {
  752.             sbr->f_table_lim[s][k] = limTable[k] - sbr->kx;
  753.         }
  755. #if 0
  756.         printf("f_table_lim[%d][%d]: ", s, sbr->N_L[s]);
  757.         for (k = 0; k <= sbr->N_L[s]; k++)
  758.         {
  759.             printf("%d ", sbr->f_table_lim[s][k]);
  760.         }
  761.         printf("n");
  762. #endif
  763.     }
  764. }
  766. #endif