Some work towards being able to encode a 48 kHz stream from 32 kHz audio (incomplete)
[opus.git] / libcelt / plc.c
index 334da8f..2204c02 100644 (file)
@@ -1,30 +1,46 @@
+/* Copyright (c) 2009-2010 Xiph.Org Foundation
+   Written by Jean-Marc Valin */
+/*
+   Redistribution and use in source and binary forms, with or without
+   modification, are permitted provided that the following conditions
+   are met:
 
-#ifndef NEW_PLC
-#define NEW_PLC
-#endif
+   - Redistributions of source code must retain the above copyright
+   notice, this list of conditions and the following disclaimer.
 
-#ifdef FIXED_POINT
-static celt_word32 frac_div32(celt_word32 a, celt_word32 b)
-{
-   celt_word16 rcp;
-   celt_word32 result, rem;
-   int shift = 30-celt_ilog2(b);
-   a = SHL32(a,shift);
-   b = SHL32(b,shift);
-
-   /* 16-bit reciprocal */
-   rcp = ROUND16(celt_rcp(ROUND16(b,16)),2);
-   result = SHL32(MULT16_32_Q15(rcp, a),1);
-   rem = a-MULT32_32_Q31(result, b);
-   result += SHL32(MULT16_32_Q15(rcp, rem),1);
-   return result;
-}
-#else
-#define frac_div32(a,b) ((float)(a)/(b))
+   - Redistributions in binary form must reproduce the above copyright
+   notice, this list of conditions and the following disclaimer in the
+   documentation and/or other materials provided with the distribution.
+
+   - Neither the name of the Xiph.org Foundation nor the names of its
+   contributors may be used to endorse or promote products derived from
+   this software without specific prior written permission.
+
+   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+   ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
+   A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR
+   CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
+   EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
+   PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
+   PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+   LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+   NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
+   SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#ifdef HAVE_CONFIG_H
+#include "config.h"
 #endif
 
+#include "plc.h"
+#include "stack_alloc.h"
+#include "mathops.h"
+
+
 
-float _celt_lpc(
+
+void _celt_lpc(
       celt_word16       *_lpc, /* out: [0...p-1] LPC coefficients      */
 const celt_word32 *ac,  /* in:  [0...p] autocorrelation values  */
 int          p
@@ -76,7 +92,6 @@ int          p
    for (i=0;i<p;i++)
       _lpc[i] = ROUND16(lpc[i],16);
 #endif
-   return error;
 }
 
 void fir(const celt_word16 *x,
@@ -137,33 +152,37 @@ void _celt_autocorr(
                    int          n
                   )
 {
-   float d;
+   celt_word32 d;
    int i;
-   float scale=1;
-   VARDECL(float, xx);
+   VARDECL(celt_word16, xx);
    SAVE_STACK;
-   ALLOC(xx, n, float);
+   ALLOC(xx, n, celt_word16);
    for (i=0;i<n;i++)
       xx[i] = x[i];
    for (i=0;i<overlap;i++)
    {
-      xx[i] *= (1./Q15ONE)*window[i];
-      xx[n-i-1] *= (1./Q15ONE)*window[i];
+      xx[i] = MULT16_16_Q15(x[i],window[i]);
+      xx[n-i-1] = MULT16_16_Q15(x[n-i-1],window[i]);
    }
 #ifdef FIXED_POINT
    {
       float ac0=0;
+      int shift;
+      for(i=0;i<n;i++)
+         ac0 += SHR32(MULT16_16(xx[i],xx[i]),8);
+      ac0 += 1+n;
+
+      shift = celt_ilog2(ac0)-30+8;
+      shift = (shift+1)/2;
       for(i=0;i<n;i++)
-         ac0 += x[i]*x[i];
-      ac0+=10;
-      scale = 2000000000/ac0;
+         xx[i] = VSHR32(xx[i], shift);
    }
 #endif
    while (lag>=0)
    {
       for (i = lag, d = 0; i < n; i++) 
-         d += x[i] * x[i-lag];
-      ac[lag] = d*scale;
+         d += xx[i] * xx[i-lag];
+      ac[lag] = d;
       /*printf ("%f ", ac[lag]);*/
       lag--;
    }