Line data    Source code

       1             : /*====================================================================================
       2             :     EVS Codec 3GPP TS26.452 Aug 12, 2021. Version 16.3.0
       3             :   ====================================================================================*/
       4             : 
       5             : 
       6             : #include <stdint.h>
       7             : #include "options.h"
       8             : #include <assert.h>
       9             : #include "basop_util.h"
      10             : 
      11             : #define PI_HALF_0Q15 51472      /* ~=round(pi/2*2^15) */
      12             : #define PI2_15Q16    0x0006487F /* ~=round(2*PI*2^16) */
      13             : #define PI2_10Q21    13176795   /* ~=round(2*PI*2^21) */
      14             : #define PI2_11Q20    6588397    /* ~=round(2*PI*2^20) */
      15             : #define P54_1Q14     8847       /* ~=round(0.54*2^14) */
      16             : #define P54_0Q15     17695      /* ~=round(0.54*2^15) */
      17             : #define P46_0Q15     15073      /* ~=round(0.46*2^15) */
      18             : #define P92_0Q15     30147      /* ~=round(0.92*2^15) */
      19             : #include "options.h"
      20             : #include "rom_basop_util.h"
      21             : #include "prot_fx.h"
      22             : 
      23        2396 : void ham_cos_window(
      24             :     Word16 *fh,      /* o: 0Q15 */
      25             :     const Word16 n1, /* i:      */
      26             :     const Word16 n2  /* i:      */
      27             : )
      28             : {
      29             :     Word16 i;
      30             :     Word32 cte, cc;
      31             : 
      32             : 
      33        2396 :     assert( n1 >= 102 ); /* if n1 is too low -> overflow in div_l */
      34             :     /*  cte = PI2/(Float32)(2*n1 - 1);  */
      35             :     BASOP_SATURATE_WARNING_OFF_EVS
      36        2396 :     cte = L_deposit_l( div_l( PI2_10Q21, sub( shl( n1, 1 ), 1 ) ) ); /*0Q15*/
      37             :     BASOP_SATURATE_WARNING_ON_EVS
      38        2396 :     cc = 0;
      39        2396 :     move32();
      40     1311836 :     FOR( i = 0; i < n1; i++ )
      41             :     {
      42             :         /* fh_f[i] = 0.54f - 0.46f * (Float32)cos(cc);  */
      43             :         BASOP_SATURATE_WARNING_OFF_EVS
      44     1309440 :         fh[i] = sub_sat( P54_0Q15, mult_r( getCosWord16( round_fx_sat( L_shl_sat( cc, 9 ) ) ), P92_0Q15 ) ); /*0Q15*/
      45     1309440 :         move16();
      46             :         BASOP_SATURATE_WARNING_ON_EVS
      47     1309440 :         cc = L_add( cc, cte ); /*0Q15*/
      48             :     }
      49             : 
      50        2396 :     assert( n2 >= 26 ); /* if n2 is too low -> overflow in div_l */
      51             :     /* cte = PI2/(Float32)(4*n2 - 1);   */
      52        2396 :     cte = L_deposit_l( div_l( PI2_11Q20, sub( shl( n2, 2 ), 1 ) ) ); /*0Q15*/
      53        2396 :     cc = 0;
      54        2396 :     move32();
      55             : 
      56        2396 :     add( n1, n2 );
      57             :     BASOP_SATURATE_WARNING_OFF_EVS
      58      438876 :     FOR( i = n1; i < n1 + n2; i++ )
      59             :     {
      60             :         /* fh_f[i] = (Float32)cos(cc);          */
      61      436480 :         fh[i] = shl_sat( getCosWord16( round_fx( L_shl( cc, 10 ) ) ), 1 ); /*0Q15*/
      62      436480 :         move16();
      63      436480 :         cc = L_add( cc, cte );
      64             :     }
      65             :     BASOP_SATURATE_WARNING_ON_EVS
      66             : 
      67             : 
      68        2396 :     return;
      69             : }
      70             : 
      71        1276 : void ham_cos_window_ivas(
      72             :     Word16 *fh,      /* o: 0Q15 */
      73             :     const Word16 n1, /* i:      */
      74             :     const Word16 n2  /* i:      */
      75             : )
      76             : {
      77             :     Word16 cc_fx; // Q15
      78             :     Word16 i;
      79             : 
      80             :     // cte = PI2 / (float) ( 2 * n1 - 1 );
      81             :     // cte_fx = div_s(1, sub(shl(n1, 1), 1));
      82        1276 :     cc_fx = 0;
      83        1276 :     move16();
      84       87404 :     FOR( i = 0; i < n1; i++ )
      85             :     {
      86       86128 :         *fh++ = sub( 17694 /*0.54.Q15*/, mult( getCosWord16R2( cc_fx ), 15073 /*0.46.Q15*/ ) );
      87       86128 :         move16();
      88       86128 :         cc_fx = div_s( add( i, 1 ), sub( shl( n1, 1 ), 1 ) ); // add(cc_fx, cte_fx);
      89             :     }
      90             : 
      91             :     // cte = PI2 / (float) ( 4 * n2 - 1 );
      92             :     // cte_fx = div_s(1, sub(shl(n2, 2), 1));
      93        1276 :     cc_fx = 0;
      94        1276 :     move16();
      95       87404 :     FOR( i = 0; i < n2; i++ )
      96             :     {
      97       86128 :         *fh++ = getCosWord16R2( cc_fx );
      98       86128 :         move16();
      99       86128 :         cc_fx = div_s( add( i, 1 ), sub( shl( n1, 2 ), 1 ) );
     100             :     }
     101             : 
     102        1276 :     return;
     103             : }