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

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: ic_predict.c,v 1.23 2004/09/04 14:56:28 menno Exp $
  26. **/
  27. #include "common.h"
  28. #include "structs.h"
  29. #ifdef MAIN_DEC
  30. #include "syntax.h"
  31. #include "ic_predict.h"
  32. #include "pns.h"
  33. static void flt_round(float32_t *pf)
  34. {
  35.     int32_t flg;
  36.     uint32_t tmp, tmp1, tmp2;
  37.     tmp = *(uint32_t*)pf;
  38.     flg = tmp & (uint32_t)0x00008000;
  39.     tmp &= (uint32_t)0xffff0000;
  40.     tmp1 = tmp;
  41.     /* round 1/2 lsb toward infinity */
  42.     if (flg)
  43.     {
  44.         tmp &= (uint32_t)0xff800000;       /* extract exponent and sign */
  45.         tmp |= (uint32_t)0x00010000;       /* insert 1 lsb */
  46.         tmp2 = tmp;                             /* add 1 lsb and elided one */
  47.         tmp &= (uint32_t)0xff800000;       /* extract exponent and sign */
  48.         
  49.         *pf = *(float32_t*)&tmp1 + *(float32_t*)&tmp2 - *(float32_t*)&tmp;
  50.     } else {
  51.         *pf = *(float32_t*)&tmp;
  52.     }
  53. }
  54. static int16_t quant_pred(float32_t x)
  55. {
  56.     int16_t q;
  57.     uint32_t *tmp = (uint32_t*)&x;
  58.     q = (int16_t)(*tmp>>16);
  59.     return q;
  60. }
  61. static float32_t inv_quant_pred(int16_t q)
  62. {
  63.     float32_t x;
  64.     uint32_t *tmp = (uint32_t*)&x;
  65.     *tmp = ((uint32_t)q)<<16;
  66.     return x;
  67. }
  68. static void ic_predict(pred_state *state, real_t input, real_t *output, uint8_t pred)
  69. {
  70.     uint16_t tmp;
  71.     int16_t i, j;
  72.     real_t dr1, predictedvalue;
  73.     real_t e0, e1;
  74.     real_t k1, k2;
  75.     real_t r[2];
  76.     real_t COR[2];
  77.     real_t VAR[2];
  78.     r[0] = inv_quant_pred(state->r[0]);
  79.     r[1] = inv_quant_pred(state->r[1]);
  80.     COR[0] = inv_quant_pred(state->COR[0]);
  81.     COR[1] = inv_quant_pred(state->COR[1]);
  82.     VAR[0] = inv_quant_pred(state->VAR[0]);
  83.     VAR[1] = inv_quant_pred(state->VAR[1]);
  84. #if 1
  85.     tmp = state->VAR[0];
  86.     j = (tmp >> 7);
  87.     i = tmp & 0x7f;
  88.     if (j >= 128)
  89.     {
  90.         j -= 128;
  91.         k1 = COR[0] * exp_table[j] * mnt_table[i];
  92.     } else {
  93.         k1 = REAL_CONST(0);
  94.     }
  95. #else
  96.     {
  97. #define B 0.953125
  98.         real_t c = COR[0];
  99.         real_t v = VAR[0];
  100.         real_t tmp;
  101.         if (c == 0 || v <= 1)
  102.         {
  103.             k1 = 0;
  104.         } else {
  105.             tmp = B / v;
  106.             flt_round(&tmp);
  107.             k1 = c * tmp;
  108.         }
  109.     }
  110. #endif
  111.     if (pred)
  112.     {
  113. #if 1
  114.         tmp = state->VAR[1];
  115.         j = (tmp >> 7);
  116.         i = tmp & 0x7f;
  117.         if (j >= 128)
  118.         {
  119.             j -= 128;
  120.             k2 = COR[1] * exp_table[j] * mnt_table[i];
  121.         } else {
  122.             k2 = REAL_CONST(0);
  123.         }
  124. #else
  125. #define B 0.953125
  126.         real_t c = COR[1];
  127.         real_t v = VAR[1];
  128.         real_t tmp;
  129.         if (c == 0 || v <= 1)
  130.         {
  131.             k2 = 0;
  132.         } else {
  133.             tmp = B / v;
  134.             flt_round(&tmp);
  135.             k2 = c * tmp;
  136.         }
  137. #endif
  138.         predictedvalue = k1*r[0] + k2*r[1];
  139.         flt_round(&predictedvalue);
  140.         *output = input + predictedvalue;
  141.     }
  142.     /* calculate new state data */
  143.     e0 = *output;
  144.     e1 = e0 - k1*r[0];
  145.     dr1 = k1*e0;
  146.     VAR[0] = ALPHA*VAR[0] + 0.5f * (r[0]*r[0] + e0*e0);
  147.     COR[0] = ALPHA*COR[0] + r[0]*e0;
  148.     VAR[1] = ALPHA*VAR[1] + 0.5f * (r[1]*r[1] + e1*e1);
  149.     COR[1] = ALPHA*COR[1] + r[1]*e1;
  150.     r[1] = A * (r[0]-dr1);
  151.     r[0] = A * e0;
  152.     state->r[0] = quant_pred(r[0]);
  153.     state->r[1] = quant_pred(r[1]);
  154.     state->COR[0] = quant_pred(COR[0]);
  155.     state->COR[1] = quant_pred(COR[1]);
  156.     state->VAR[0] = quant_pred(VAR[0]);
  157.     state->VAR[1] = quant_pred(VAR[1]);
  158. }
  159. static void reset_pred_state(pred_state *state)
  160. {
  161.     state->r[0]   = 0;
  162.     state->r[1]   = 0;
  163.     state->COR[0] = 0;
  164.     state->COR[1] = 0;
  165.     state->VAR[0] = 0x3F80;
  166.     state->VAR[1] = 0x3F80;
  167. }
  168. void pns_reset_pred_state(ic_stream *ics, pred_state *state)
  169. {
  170.     uint8_t sfb, g, b;
  171.     uint16_t i, offs, offs2;
  172.     /* prediction only for long blocks */
  173.     if (ics->window_sequence == EIGHT_SHORT_SEQUENCE)
  174.         return;
  175.     for (g = 0; g < ics->num_window_groups; g++)
  176.     {
  177.         for (b = 0; b < ics->window_group_length[g]; b++)
  178.         {
  179.             for (sfb = 0; sfb < ics->max_sfb; sfb++)
  180.             {
  181.                 if (is_noise(ics, g, sfb))
  182.                 {
  183.                     offs = ics->swb_offset[sfb];
  184.                     offs2 = ics->swb_offset[sfb+1];
  185.                     for (i = offs; i < offs2; i++)
  186.                         reset_pred_state(&state[i]);
  187.                 }
  188.             }
  189.         }
  190.     }
  191. }
  192. void reset_all_predictors(pred_state *state, uint16_t frame_len)
  193. {
  194.     uint16_t i;
  195.     for (i = 0; i < frame_len; i++)
  196.         reset_pred_state(&state[i]);
  197. }
  198. /* intra channel prediction */
  199. void ic_prediction(ic_stream *ics, real_t *spec, pred_state *state,
  200.                    uint16_t frame_len, uint8_t sf_index)
  201. {
  202.     uint8_t sfb;
  203.     uint16_t bin;
  204.     if (ics->window_sequence == EIGHT_SHORT_SEQUENCE)
  205.     {
  206.         reset_all_predictors(state, frame_len);
  207.     } else {
  208.         for (sfb = 0; sfb < max_pred_sfb(sf_index); sfb++)
  209.         {
  210.             uint16_t low  = ics->swb_offset[sfb];
  211.             uint16_t high = ics->swb_offset[sfb+1];
  212.             for (bin = low; bin < high; bin++)
  213.             {
  214.                 ic_predict(&state[bin], spec[bin], &spec[bin],
  215.                     (ics->predictor_data_present && ics->pred.prediction_used[sfb]));
  216.             }
  217.         }
  218.         if (ics->predictor_data_present)
  219.         {
  220.             if (ics->pred.predictor_reset)
  221.             {
  222.                 for (bin = ics->pred.predictor_reset_group_number - 1;
  223.                      bin < frame_len; bin += 30)
  224.                 {
  225.                     reset_pred_state(&state[bin]);
  226.                 }
  227.             }
  228.         }
  229.     }
  230. }
  231. #endif