ssr_ipqf.c
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:6k
源码类别:

Windows CE

开发平台:

C/C++

  1. /*
  2. ** FAAD2 - Freeware Advanced Audio (AAC) Decoder including SBR decoding
  3. ** Copyright (C) 2003-2004 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. ** Commercial non-GPL licensing of this software is possible.
  23. ** For more info contact Ahead Software through Mpeg4AAClicense@nero.com.
  24. **
  25. ** $Id: ssr_ipqf.c,v 1.14 2004/09/04 14:56:29 menno Exp $
  26. **/
  27. #include "common.h"
  28. #include "structs.h"
  29. #ifdef SSR_DEC
  30. #include "ssr.h"
  31. #include "ssr_ipqf.h"
  32. static real_t **app_pqfbuf;
  33. static real_t **pp_q0, **pp_t0, **pp_t1;
  34. void gc_set_protopqf(real_t *p_proto)
  35. {
  36.     int j;
  37.     static real_t a_half[48] =
  38.     {
  39.         1.2206911375946939E-05,  1.7261986723798209E-05,  1.2300093657077942E-05,
  40.         -1.0833943097791965E-05, -5.7772498639901686E-05, -1.2764767618947719E-04,
  41.         -2.0965186675013334E-04, -2.8166673689263850E-04, -3.1234860429017460E-04,
  42.         -2.6738519958452353E-04, -1.1949424681824722E-04,  1.3965139412648678E-04,
  43.         4.8864136409185725E-04,  8.7044629275148344E-04,  1.1949430269934793E-03,
  44.         1.3519708175026700E-03,  1.2346314373964412E-03,  7.6953209114159191E-04,
  45.         -5.2242432579537141E-05, -1.1516092887213454E-03, -2.3538469841711277E-03,
  46.         -3.4033123072127277E-03, -4.0028551071986133E-03, -3.8745415659693259E-03,
  47.         -2.8321073426874310E-03, -8.5038892323704195E-04,  1.8856751185350931E-03,
  48.         4.9688741735340923E-03,  7.8056704536795926E-03,  9.7027909685901654E-03,
  49.         9.9960423120166159E-03,  8.2019366335594487E-03,  4.1642072876103365E-03,
  50.         -1.8364453822737758E-03, -9.0384863094167686E-03, -1.6241528177129844E-02,
  51.         -2.1939551286300665E-02, -2.4533179947088161E-02, -2.2591663337768787E-02,
  52.         -1.5122066420044672E-02, -1.7971713448186293E-03,  1.6903413428575379E-02,
  53.         3.9672315874127042E-02,  6.4487527248102796E-02,  8.8850025474701726E-02,
  54.         0.1101132906105560    ,  0.1258540205143761    ,  0.1342239368467012    
  55.     };
  56.     for (j = 0; j < 48; ++j)
  57.     {
  58.         p_proto[j] = p_proto[95-j] = a_half[j];
  59.     }
  60. }
  61. void gc_setcoef_eff_pqfsyn(int mm,
  62.                            int kk,
  63.                            real_t *p_proto,
  64.                            real_t ***ppp_q0,
  65.                            real_t ***ppp_t0,
  66.                            real_t ***ppp_t1)
  67. {
  68.     int i, k, n;
  69.     real_t w;
  70.     /* Set 1st Mul&Acc Coef's */
  71.     *ppp_q0 = (real_t **) calloc(mm, sizeof(real_t *));
  72.     for (n = 0; n < mm; ++n)
  73.     {
  74.         (*ppp_q0)[n] = (real_t *) calloc(mm, sizeof(real_t));
  75.     }
  76.     for (n = 0; n < mm/2; ++n)
  77.     {
  78.         for (i = 0; i < mm; ++i)
  79.         {
  80.             w = (2*i+1)*(2*n+1-mm)*M_PI/(4*mm);
  81.             (*ppp_q0)[n][i] = 2.0 * cos((real_t) w);
  82.             w = (2*i+1)*(2*(mm+n)+1-mm)*M_PI/(4*mm);
  83.             (*ppp_q0)[n + mm/2][i] = 2.0 * cos((real_t) w);
  84.         }
  85.     }
  86.     /* Set 2nd Mul&Acc Coef's */
  87.     *ppp_t0 = (real_t **) calloc(mm, sizeof(real_t *));
  88.     *ppp_t1 = (real_t **) calloc(mm, sizeof(real_t *));
  89.     for (n = 0; n < mm; ++n)
  90.     {
  91.         (*ppp_t0)[n] = (real_t *) calloc(kk, sizeof(real_t));
  92.         (*ppp_t1)[n] = (real_t *) calloc(kk, sizeof(real_t));
  93.     }
  94.     for (n = 0; n < mm; ++n)
  95.     {
  96.         for (k = 0; k < kk; ++k)
  97.         {
  98.             (*ppp_t0)[n][k] = mm * p_proto[2*k    *mm + n];
  99.             (*ppp_t1)[n][k] = mm * p_proto[(2*k+1)*mm + n];
  100.             if (k%2 != 0)
  101.             {
  102.                 (*ppp_t0)[n][k] = -(*ppp_t0)[n][k];
  103.                 (*ppp_t1)[n][k] = -(*ppp_t1)[n][k];
  104.             }
  105.         }
  106.     }
  107. }
  108. void ssr_ipqf(ssr_info *ssr, real_t *in_data, real_t *out_data,
  109.               real_t buffer[SSR_BANDS][96/4],
  110.               uint16_t frame_len, uint8_t bands)
  111. {
  112.     static int initFlag = 0;
  113.     real_t a_pqfproto[PQFTAPS];
  114.     int i;
  115.     if (initFlag == 0)
  116.     {
  117.         gc_set_protopqf(a_pqfproto);
  118.         gc_setcoef_eff_pqfsyn(SSR_BANDS, PQFTAPS/(2*SSR_BANDS), a_pqfproto,
  119.             &pp_q0, &pp_t0, &pp_t1);
  120.         initFlag = 1;
  121.     }
  122.     for (i = 0; i < frame_len / SSR_BANDS; i++)
  123.     {
  124.         int l, n, k;
  125.         int mm = SSR_BANDS;
  126.         int kk = PQFTAPS/(2*SSR_BANDS);
  127.         for (n = 0; n < mm; n++)
  128.         {
  129.             for (k = 0; k < 2*kk-1; k++)
  130.             {
  131.                 buffer[n][k] = buffer[n][k+1];
  132.             }
  133.         }
  134.         for (n = 0; n < mm; n++)
  135.         {
  136.             real_t acc = 0.0;
  137.             for (l = 0; l < mm; l++)
  138.             {
  139.                 acc += pp_q0[n][l] * in_data[l*frame_len/SSR_BANDS + i];
  140.             }
  141.             buffer[n][2*kk-1] = acc;
  142.         }
  143.         for (n = 0; n < mm/2; n++)
  144.         {
  145.             real_t acc = 0.0;
  146.             for (k = 0; k < kk; k++)
  147.             {
  148.                 acc += pp_t0[n][k] * buffer[n][2*kk-1-2*k];
  149.             }
  150.             for (k = 0; k < kk; ++k)
  151.             {
  152.                 acc += pp_t1[n][k] * buffer[n + mm/2][2*kk-2-2*k];
  153.             }
  154.             out_data[i*SSR_BANDS + n] = acc;
  155.             acc = 0.0;
  156.             for (k = 0; k < kk; k++)
  157.             {
  158.                 acc += pp_t0[mm-1-n][k] * buffer[n][2*kk-1-2*k];
  159.             }
  160.             for (k = 0; k < kk; k++)
  161.             {
  162.                 acc -= pp_t1[mm-1-n][k] * buffer[n + mm/2][2*kk-2-2*k];
  163.             }
  164.             out_data[i*SSR_BANDS + mm-1-n] = acc;
  165.         }
  166.     }
  167. }
  168. #endif