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             : 
      24        2247 : void ham_cos_window(
      25             :     Word16 *fh,      /* o: 0Q15 */
      26             :     const Word16 n1, /* i:      */
      27             :     const Word16 n2  /* i:      */
      28             : )
      29             : {
      30             :     Word16 i;
      31             :     Word32 cte, cc;
      32             : #ifdef BASOP_NOGLOB_DECLARE_LOCAL
      33        2247 :     Flag Overflow = 0;
      34        2247 :     move16();
      35             : #endif
      36             : 
      37             : 
      38        2247 :     assert( n1 >= 102 ); /* if n1 is too low -> overflow in div_l */
      39             :     /*  cte = PI2/(Float32)(2*n1 - 1);  */
      40             :     BASOP_SATURATE_WARNING_OFF_EVS
      41        2247 :     cte = L_deposit_l( div_l( PI2_10Q21, sub( shl( n1, 1 ), 1 ) ) ); /*0Q15*/
      42             :     BASOP_SATURATE_WARNING_ON_EVS
      43        2247 :     cc = 0;
      44        2247 :     move32();
      45     1228887 :     FOR( i = 0; i < n1; i++ )
      46             :     {
      47             :         /* fh_f[i] = 0.54f - 0.46f * (Float32)cos(cc);  */
      48             :         BASOP_SATURATE_WARNING_OFF_EVS
      49     1226640 :         fh[i] = sub_o( P54_0Q15, mult_r( getCosWord16( round_fx_o( L_shl_o( cc, 9, &Overflow ), &Overflow ) ), P92_0Q15 ), &Overflow ); /*0Q15*/
      50     1226640 :         move16();
      51             :         BASOP_SATURATE_WARNING_ON_EVS
      52     1226640 :         cc = L_add( cc, cte ); /*0Q15*/
      53             :     }
      54             : 
      55        2247 :     assert( n2 >= 26 ); /* if n2 is too low -> overflow in div_l */
      56             :     /* cte = PI2/(Float32)(4*n2 - 1);   */
      57        2247 :     cte = L_deposit_l( div_l( PI2_11Q20, sub( shl( n2, 2 ), 1 ) ) ); /*0Q15*/
      58        2247 :     cc = 0;
      59        2247 :     move32();
      60             : 
      61        2247 :     add( n1, n2 );
      62             :     BASOP_SATURATE_WARNING_OFF_EVS
      63      411127 :     FOR( i = n1; i < n1 + n2; i++ )
      64             :     {
      65             :         /* fh_f[i] = (Float32)cos(cc);          */
      66      408880 :         fh[i] = shl_o( getCosWord16( round_fx( L_shl( cc, 10 ) ) ), 1, &Overflow ); /*0Q15*/
      67      408880 :         move16();
      68      408880 :         cc = L_add( cc, cte );
      69             :     }
      70             :     BASOP_SATURATE_WARNING_ON_EVS
      71             : 
      72             : 
      73        2247 :     return;
      74             : }
      75             : 
      76        1263 : void ham_cos_window_ivas(
      77             :     Word16 *fh,      /* o: 0Q15 */
      78             :     const Word16 n1, /* i:      */
      79             :     const Word16 n2  /* i:      */
      80             : )
      81             : {
      82             :     Word16 cc_fx; // Q15
      83             :     Word16 i;
      84             : 
      85             :     // cte = PI2 / (float) ( 2 * n1 - 1 );
      86             :     // cte_fx = div_s(1, sub(shl(n1, 1), 1));
      87        1263 :     cc_fx = 0;
      88        1263 :     move16();
      89       86431 :     FOR( i = 0; i < n1; i++ )
      90             :     {
      91       85168 :         *fh++ = sub( 17694 /*0.54.Q15*/, mult( getCosWord16R2( cc_fx ), 15073 /*0.46.Q15*/ ) );
      92       85168 :         move16();
      93       85168 :         cc_fx = div_s( add( i, 1 ), sub( shl( n1, 1 ), 1 ) ); // add(cc_fx, cte_fx);
      94             :     }
      95             : 
      96             :     // cte = PI2 / (float) ( 4 * n2 - 1 );
      97             :     // cte_fx = div_s(1, sub(shl(n2, 2), 1));
      98        1263 :     cc_fx = 0;
      99        1263 :     move16();
     100       86431 :     FOR( i = 0; i < n2; i++ )
     101             :     {
     102       85168 :         *fh++ = getCosWord16R2( cc_fx );
     103       85168 :         move16();
     104       85168 :         cc_fx = div_s( add( i, 1 ), sub( shl( n1, 2 ), 1 ) );
     105             :     }
     106             : 
     107        1263 :     return;
     108             : }