Line data    Source code

       1             : /******************************************************************************************************
       2             : 
       3             :    (C) 2022-2025 IVAS codec Public Collaboration with portions copyright Dolby International AB, Ericsson AB,
       4             :    Fraunhofer-Gesellschaft zur Foerderung der angewandten Forschung e.V., Huawei Technologies Co. LTD.,
       5             :    Koninklijke Philips N.V., Nippon Telegraph and Telephone Corporation, Nokia Technologies Oy, Orange,
       6             :    Panasonic Holdings Corporation, Qualcomm Technologies, Inc., VoiceAge Corporation, and other
       7             :    contributors to this repository. All Rights Reserved.
       8             : 
       9             :    This software is protected by copyright law and by international treaties.
      10             :    The IVAS codec Public Collaboration consisting of Dolby International AB, Ericsson AB,
      11             :    Fraunhofer-Gesellschaft zur Foerderung der angewandten Forschung e.V., Huawei Technologies Co. LTD.,
      12             :    Koninklijke Philips N.V., Nippon Telegraph and Telephone Corporation, Nokia Technologies Oy, Orange,
      13             :    Panasonic Holdings Corporation, Qualcomm Technologies, Inc., VoiceAge Corporation, and other
      14             :    contributors to this repository retain full ownership rights in their respective contributions in
      15             :    the software. This notice grants no license of any kind, including but not limited to patent
      16             :    license, nor is any license granted by implication, estoppel or otherwise.
      17             : 
      18             :    Contributors are required to enter into the IVAS codec Public Collaboration agreement before making
      19             :    contributions.
      20             : 
      21             :    This software is provided "AS IS", without any express or implied warranties. The software is in the
      22             :    development stage. It is intended exclusively for experts who have experience with such software and
      23             :    solely for the purpose of inspection. All implied warranties of non-infringement, merchantability
      24             :    and fitness for a particular purpose are hereby disclaimed and excluded.
      25             : 
      26             :    Any dispute, controversy or claim arising under or in relation to providing this software shall be
      27             :    submitted to and settled by the final, binding jurisdiction of the courts of Munich, Germany in
      28             :    accordance with the laws of the Federal Republic of Germany excluding its conflict of law rules and
      29             :    the United Nations Convention on Contracts on the International Sales of Goods.
      30             : 
      31             : *******************************************************************************************************/
      32             : 
      33             : /*====================================================================================
      34             :     EVS Codec 3GPP TS26.443 Nov 04, 2021. Version 12.14.0 / 13.10.0 / 14.6.0 / 15.4.0 / 16.3.0
      35             :   ====================================================================================*/
      36             : 
      37             : #include <stdint.h>
      38             : #include "options.h"
      39             : #ifdef DEBUGGING
      40             : #include "debug.h"
      41             : #endif
      42             : #include <math.h>
      43             : #include "cnst.h"
      44             : #include "prot.h"
      45             : #include "wmc_auto.h"
      46             : 
      47             : 
      48             : /* Note: syn_output() is replaced by ivas_syn_output() in IVAS */
      49             : 
      50             : 
      51             : /*-------------------------------------------------------------------*
      52             :  * AGC_dec()
      53             :  *
      54             :  * In-place saturation control (Automatic Gain Control)
      55             :  *-------------------------------------------------------------------*/
      56             : 
      57      530382 : void AGC_dec(
      58             :     float x[],      /* i/o: input/output vector            */
      59             :     float mem[],    /* i/o: mem[2] should be init to [0,0] */
      60             :     const int16_t n /* i  : vector size                    */
      61             : )
      62             : {
      63             :     int16_t i;
      64             :     float fac, prev, tmp, frame_fac, max_val;
      65             : 
      66             :     /*-----------------------------------------------------------------*
      67             :      * calculate AGC factor to avoid saturation
      68             :      *-----------------------------------------------------------------*/
      69             : 
      70      530382 :     max_val = 0.0f;
      71             : 
      72   152893902 :     for ( i = 0; i < n; i++ )
      73             :     {
      74   152363520 :         tmp = (float) fabs( x[i] );
      75   152363520 :         if ( tmp > max_val )
      76             :         {
      77     7381173 :             max_val = tmp;
      78             :         }
      79             :     }
      80             : 
      81      530382 :     frame_fac = 0.0f;
      82      530382 :     if ( max_val > 30000.0f )
      83             :     {
      84         906 :         frame_fac = 0.5f - ( 15000.0f / max_val );
      85             :     }
      86             : 
      87      530382 :     fac = mem[0];
      88      530382 :     prev = mem[1];
      89             : 
      90             :     /*-----------------------------------------------------------------*
      91             :      * AGC
      92             :      *-----------------------------------------------------------------*/
      93             : 
      94   152893902 :     for ( i = 0; i < n; i++ )
      95             :     {
      96             :         /* update AGC factor (slowly) */
      97   152363520 :         fac = 0.99f * fac + 0.01f * frame_fac;
      98             : 
      99             :         /* convert float to integer with AGC */
     100   152363520 :         tmp = ( 1.0f - fac ) * x[i] - fac * prev;
     101   152363520 :         prev = x[i];
     102             : 
     103   152363520 :         if ( tmp > MAX16B_FLT )
     104             :         {
     105          66 :             tmp = MAX16B_FLT;
     106             :         }
     107   152363454 :         else if ( tmp < MIN16B_FLT )
     108             :         {
     109          93 :             tmp = MIN16B_FLT;
     110             :         }
     111             : 
     112   152363520 :         x[i] = (int16_t) floor( tmp + 0.5f );
     113             :     }
     114             : 
     115      530382 :     mem[0] = fac;
     116      530382 :     mem[1] = prev;
     117             : 
     118      530382 :     return;
     119             : }