Add support for intra-coding of the coarse energy.
[opus.git] / libcelt / laplace.c
index 8b1604d..abfe576 100644 (file)
 
 #include "laplace.h"
 
-static ec_int32 ec_laplace_get_total(int decay)
+int ec_laplace_get_start_freq(int decay)
 {
-   return (((ec_uint32)1)<<30)/((((ec_uint32)1)<<14) - decay) - (((ec_uint32)1)<<15) + 1;
+   return (((ec_uint32)32767)*(16384-decay))/(16384+decay);
 }
 
-void ec_laplace_encode(ec_enc *enc, int value, int decay)
+void ec_laplace_encode_start(ec_enc *enc, int *value, int decay, int fs)
 {
    int i;
-   ec_int32 fl, fs, ft;
+   int fl, ft;
    int s = 0;
-   if (value < 0)
+   int val = *value;
+   if (val < 0)
    {
       s = 1;
-      value = -value;
+      val = -val;
    }
-   ft = ec_laplace_get_total(decay);
-   fl = -(((ec_uint32)1)<<15);
-   fs = ((ec_uint32)1)<<15;
-   for (i=0;i<value;i++)
+   ft = 32767;
+   fl = -fs;
+   for (i=0;i<val;i++)
    {
-      ec_int32 tmp_l, tmp_s;
+      int tmp_l, tmp_s;
       tmp_l = fl;
       tmp_s = fs;
       fl += fs*2;
-      fs = (fs*decay)>>14;
+      fs = (fs*(ec_int32)decay)>>14;
       if (fs == 0)
       {
          fs = tmp_s;
          fl = tmp_l;
+         if (s)
+            *value = -i;
+         else
+            *value = i;
          break;
       }
    }
@@ -71,25 +75,32 @@ void ec_laplace_encode(ec_enc *enc, int value, int decay)
       fl = 0;
    if (s)
       fl += fs;
+   /*DEBUG*/
    /*printf ("enc: %d %d %d\n", fl, fs, ft);*/
    ec_encode(enc, fl, fl+fs, ft);
 }
 
-int ec_laplace_decode(ec_dec *dec, int decay)
+void ec_laplace_encode(ec_enc *enc, int *value, int decay)
+{
+   int fs = ec_laplace_get_start_freq(decay);
+   ec_laplace_encode_start(enc, value, decay, fs);
+}
+
+
+int ec_laplace_decode_start(ec_dec *dec, int decay, int fs)
 {
    int val=0;
-   ec_int32 fl, fh, fs, ft, fm;
-   ft = ec_laplace_get_total(decay);
-   
-   fm = ec_decode(dec, ft);
-   /*printf ("fm: %d/%d\n", fm, ft);*/
+   int fl, fh, ft, fm;
    fl = 0;
-   fs = ((ec_uint32)1)<<15;
+   ft = 32767;
    fh = fs;
+   fm = ec_decode(dec, ft);
+   /*DEBUG*/
+   /*printf ("fm: %d/%d\n", fm, ft);*/
    while (fm >= fh && fs != 0)
    {
       fl = fh;
-      fs = (fs*decay)>>14;
+      fs = (fs*(ec_int32)decay)>>14;
       fh += fs*2;
       val++;
    }
@@ -106,8 +117,14 @@ int ec_laplace_decode(ec_dec *dec, int decay)
    /* Preventing an infinite loop in case something screws up in the decoding */
    if (fl==fh)
       fl--;
+   /*DEBUG*/
+   /*printf ("update: %d %d %d\n", fl, fh, ft);*/
    ec_dec_update(dec, fl, fh, ft);
    return val;
 }
 
-
+int ec_laplace_decode(ec_dec *dec, int decay)
+{
+   int fs = ec_laplace_get_start_freq(decay);
+   return ec_laplace_decode_start(dec, decay, fs);
+}