From Harald Welte:
[obnox/wireshark/wip.git] / g711.c
diff --git a/g711.c b/g711.c
index a5f4679efb934241460fcc498a7ee07875e2facb..5ae74148ba150b7ad25cf044a7d39076115ab4df 100644 (file)
--- a/g711.c
+++ b/g711.c
-/*\r
- * This source code is a product of Sun Microsystems, Inc. and is provided\r
- * for unrestricted use.  Users may copy or modify this source code without\r
- * charge.\r
- *\r
- * SUN SOURCE CODE IS PROVIDED AS IS WITH NO WARRANTIES OF ANY KIND INCLUDING\r
- * THE WARRANTIES OF DESIGN, MERCHANTIBILITY AND FITNESS FOR A PARTICULAR\r
- * PURPOSE, OR ARISING FROM A COURSE OF DEALING, USAGE OR TRADE PRACTICE.\r
- *\r
- * Sun source code is provided with no support and without any obligation on\r
- * the part of Sun Microsystems, Inc. to assist in its use, correction,\r
- * modification or enhancement.\r
- *\r
- * SUN MICROSYSTEMS, INC. SHALL HAVE NO LIABILITY WITH RESPECT TO THE\r
- * INFRINGEMENT OF COPYRIGHTS, TRADE SECRETS OR ANY PATENTS BY THIS SOFTWARE\r
- * OR ANY PART THEREOF.\r
- *\r
- * In no event will Sun Microsystems, Inc. be liable for any lost revenue\r
- * or profits or other special, indirect and consequential damages, even if\r
- * Sun has been advised of the possibility of such damages.\r
- *\r
- * Sun Microsystems, Inc.\r
- * 2550 Garcia Avenue\r
- * Mountain View, California  94043\r
- */\r
-\r
-/*\r
- * g711.c\r
- *\r
- * u-law, A-law and linear PCM conversions.\r
- */\r
-#define        SIGN_BIT        (0x80)          /* Sign bit for a A-law byte. */\r
-#define        QUANT_MASK      (0xf)           /* Quantization field mask. */\r
-#define        NSEGS           (8)             /* Number of A-law segments. */\r
-#define        SEG_SHIFT       (4)             /* Left shift for segment number. */\r
-#define        SEG_MASK        (0x70)          /* Segment field mask. */\r
-\r
-static short seg_end[8] = {0xFF, 0x1FF, 0x3FF, 0x7FF,\r
-                           0xFFF, 0x1FFF, 0x3FFF, 0x7FFF};\r
-\r
-/* copy from CCITT G.711 specifications */\r
-unsigned char _u2a[128] = {                    /* u- to A-law conversions */\r
-       1,      1,      2,      2,      3,      3,      4,      4,\r
-       5,      5,      6,      6,      7,      7,      8,      8,\r
-       9,      10,     11,     12,     13,     14,     15,     16,\r
-       17,     18,     19,     20,     21,     22,     23,     24,\r
-       25,     27,     29,     31,     33,     34,     35,     36,\r
-       37,     38,     39,     40,     41,     42,     43,     44,\r
-       46,     48,     49,     50,     51,     52,     53,     54,\r
-       55,     56,     57,     58,     59,     60,     61,     62,\r
-       64,     65,     66,     67,     68,     69,     70,     71,\r
-       72,     73,     74,     75,     76,     77,     78,     79,\r
-       81,     82,     83,     84,     85,     86,     87,     88,\r
-       89,     90,     91,     92,     93,     94,     95,     96,\r
-       97,     98,     99,     100,    101,    102,    103,    104,\r
-       105,    106,    107,    108,    109,    110,    111,    112,\r
-       113,    114,    115,    116,    117,    118,    119,    120,\r
-       121,    122,    123,    124,    125,    126,    127,    128};\r
-\r
-unsigned char _a2u[128] = {                    /* A- to u-law conversions */\r
-       1,      3,      5,      7,      9,      11,     13,     15,\r
-       16,     17,     18,     19,     20,     21,     22,     23,\r
-       24,     25,     26,     27,     28,     29,     30,     31,\r
-       32,     32,     33,     33,     34,     34,     35,     35,\r
-       36,     37,     38,     39,     40,     41,     42,     43,\r
-       44,     45,     46,     47,     48,     48,     49,     49,\r
-       50,     51,     52,     53,     54,     55,     56,     57,\r
-       58,     59,     60,     61,     62,     63,     64,     64,\r
-       65,     66,     67,     68,     69,     70,     71,     72,\r
-       73,     74,     75,     76,     77,     78,     79,     79,\r
-       80,     81,     82,     83,     84,     85,     86,     87,\r
-       88,     89,     90,     91,     92,     93,     94,     95,\r
-       96,     97,     98,     99,     100,    101,    102,    103,\r
-       104,    105,    106,    107,    108,    109,    110,    111,\r
-       112,    113,    114,    115,    116,    117,    118,    119,\r
-       120,    121,    122,    123,    124,    125,    126,    127};\r
-\r
-static int\r
-search(\r
-       int             val,\r
-       short           *table,\r
-       int             size)\r
-{\r
-       int             i;\r
-\r
-       for (i = 0; i < size; i++) {\r
-               if (val <= *table++)\r
-                       return (i);\r
-       }\r
-       return (size);\r
-}\r
-\r
-/*\r
- * linear2alaw() - Convert a 16-bit linear PCM value to 8-bit A-law\r
- *\r
- * linear2alaw() accepts an 16-bit integer and encodes it as A-law data.\r
- *\r
- *             Linear Input Code       Compressed Code\r
- *     ------------------------        ---------------\r
- *     0000000wxyza                    000wxyz\r
- *     0000001wxyza                    001wxyz\r
- *     000001wxyzab                    010wxyz\r
- *     00001wxyzabc                    011wxyz\r
- *     0001wxyzabcd                    100wxyz\r
- *     001wxyzabcde                    101wxyz\r
- *     01wxyzabcdef                    110wxyz\r
- *     1wxyzabcdefg                    111wxyz\r
- *\r
- * For further information see John C. Bellamy's Digital Telephony, 1982,\r
- * John Wiley & Sons, pps 98-111 and 472-476.\r
- */\r
-unsigned char\r
-linear2alaw(\r
-       int             pcm_val)        /* 2's complement (16-bit range) */\r
-{\r
-       int             mask;\r
-       int             seg;\r
-       unsigned char   aval;\r
-       if (pcm_val >= 0) {\r
-               mask = 0xD5;            /* sign (7th) bit = 1 */\r
-       } else {\r
-               mask = 0x55;            /* sign bit = 0 */\r
-               pcm_val = -pcm_val - 8;\r
-       }\r
-\r
-       /* Convert the scaled magnitude to segment number. */\r
-       seg = search(pcm_val, seg_end, 8);\r
-\r
-       /* Combine the sign, segment, and quantization bits. */\r
-\r
-       if (seg >= 8)           /* out of range, return maximum value. */\r
-               return (0x7F ^ mask);\r
-       else {\r
-               aval = seg << SEG_SHIFT;\r
-               if (seg < 2)\r
-                       aval |= (pcm_val >> 4) & QUANT_MASK;\r
-               else\r
-                       aval |= (pcm_val >> (seg + 3)) & QUANT_MASK;\r
-               return (aval ^ mask);\r
-       }\r
-}\r
-\r
-/*\r
- * alaw2linear() - Convert an A-law value to 16-bit linear PCM\r
- *\r
- */\r
-int\r
-alaw2linear(\r
-       unsigned char   a_val)\r
-{\r
-       int             t;\r
-       int             seg;\r
-       //printf(" vrednost a_val %X ", a_val);\r
-       a_val ^= 0x55;\r
-\r
-       t = (a_val & QUANT_MASK) << 4;\r
-       seg = ((unsigned)a_val & SEG_MASK) >> SEG_SHIFT;\r
-       switch (seg) {\r
-       case 0:\r
-               t += 8;\r
-               break;\r
-       case 1:\r
-               t += 0x108;\r
-               break;\r
-       default:\r
-               t += 0x108;\r
-               t <<= seg - 1;\r
-       }\r
-       //printf("izracunan int %d in njegov hex %X \n", t,t);\r
-       return ((a_val & SIGN_BIT) ? t : -t);\r
-}\r
-\r
-#define        BIAS            (0x84)          /* Bias for linear code. */\r
-\r
-/*\r
- * linear2ulaw() - Convert a linear PCM value to u-law\r
- *\r
- * In order to simplify the encoding process, the original linear magnitude\r
- * is biased by adding 33 which shifts the encoding range from (0 - 8158) to\r
- * (33 - 8191). The result can be seen in the following encoding table:\r
- *\r
- *     Biased Linear Input Code        Compressed Code\r
- *     ------------------------        ---------------\r
- *     00000001wxyza                   000wxyz\r
- *     0000001wxyzab                   001wxyz\r
- *     000001wxyzabc                   010wxyz\r
- *     00001wxyzabcd                   011wxyz\r
- *     0001wxyzabcde                   100wxyz\r
- *     001wxyzabcdef                   101wxyz\r
- *     01wxyzabcdefg                   110wxyz\r
- *     1wxyzabcdefgh                   111wxyz\r
- *\r
- * Each biased linear code has a leading 1 which identifies the segment\r
- * number. The value of the segment number is equal to 7 minus the number\r
- * of leading 0's. The quantization interval is directly available as the\r
- * four bits wxyz.  * The trailing bits (a - h) are ignored.\r
- *\r
- * Ordinarily the complement of the resulting code word is used for\r
- * transmission, and so the code word is complemented before it is returned.\r
- *\r
- * For further information see John C. Bellamy's Digital Telephony, 1982,\r
- * John Wiley & Sons, pps 98-111 and 472-476.\r
- */\r
-unsigned char\r
-linear2ulaw(\r
-       int             pcm_val)        /* 2's complement (16-bit range) */\r
-{\r
-       int             mask;\r
-       int             seg;\r
-       unsigned char   uval;\r
-\r
-       /* Get the sign and the magnitude of the value. */\r
-       if (pcm_val < 0) {\r
-               pcm_val = BIAS - pcm_val;\r
-               mask = 0x7F;\r
-       } else {\r
-               pcm_val += BIAS;\r
-               mask = 0xFF;\r
-       }\r
-\r
-       /* Convert the scaled magnitude to segment number. */\r
-       seg = search(pcm_val, seg_end, 8);\r
-\r
-       /*\r
-        * Combine the sign, segment, quantization bits;\r
-        * and complement the code word.\r
-        */\r
-       if (seg >= 8)           /* out of range, return maximum value. */\r
-               return (0x7F ^ mask);\r
-       else {\r
-               uval = (seg << 4) | ((pcm_val >> (seg + 3)) & 0xF);\r
-               return (uval ^ mask);\r
-       }\r
-\r
-}\r
-\r
-/*\r
- * ulaw2linear() - Convert a u-law value to 16-bit linear PCM\r
- *\r
- * First, a biased linear code is derived from the code word. An unbiased\r
- * output can then be obtained by subtracting 33 from the biased code.\r
- *\r
- * Note that this function expects to be passed the complement of the\r
- * original code word. This is in keeping with ISDN conventions.\r
- */\r
-int\r
-ulaw2linear(\r
-       unsigned char   u_val)\r
-{\r
-       int             t;\r
-\r
-       /* Complement to obtain normal u-law value. */\r
-       u_val = ~u_val;\r
-\r
-       /*\r
-        * Extract and bias the quantization bits. Then\r
-        * shift up by the segment number and subtract out the bias.\r
-        */\r
-       t = ((u_val & QUANT_MASK) << 3) + BIAS;\r
-       t <<= ((unsigned)u_val & SEG_MASK) >> SEG_SHIFT;\r
-\r
-       return ((u_val & SIGN_BIT) ? (BIAS - t) : (t - BIAS));\r
-}\r
-\r
-/* A-law to u-law conversion */\r
-unsigned char\r
-alaw2ulaw(\r
-       unsigned char   aval)\r
-{\r
-       aval &= 0xff;\r
-       return ((aval & 0x80) ? (0xFF ^ _a2u[aval ^ 0xD5]) :\r
-           (0x7F ^ _a2u[aval ^ 0x55]));\r
-}\r
-\r
-/* u-law to A-law conversion */\r
-unsigned char\r
-ulaw2alaw(\r
-       unsigned char   uval)\r
-{\r
-       uval &= 0xff;\r
-       return ((uval & 0x80) ? (0xD5 ^ (_u2a[0xFF ^ uval] - 1)) :\r
-           (0x55 ^ (_u2a[0x7F ^ uval] - 1)));\r
-}\r
+/*
+ * $Id$
+ *
+ * This source code is a product of Sun Microsystems, Inc. and is provided
+ * for unrestricted use.  Users may copy or modify this source code without
+ * charge.
+ *
+ * SUN SOURCE CODE IS PROVIDED AS IS WITH NO WARRANTIES OF ANY KIND INCLUDING
+ * THE WARRANTIES OF DESIGN, MERCHANTIBILITY AND FITNESS FOR A PARTICULAR
+ * PURPOSE, OR ARISING FROM A COURSE OF DEALING, USAGE OR TRADE PRACTICE.
+ *
+ * Sun source code is provided with no support and without any obligation on
+ * the part of Sun Microsystems, Inc. to assist in its use, correction,
+ * modification or enhancement.
+ *
+ * SUN MICROSYSTEMS, INC. SHALL HAVE NO LIABILITY WITH RESPECT TO THE
+ * INFRINGEMENT OF COPYRIGHTS, TRADE SECRETS OR ANY PATENTS BY THIS SOFTWARE
+ * OR ANY PART THEREOF.
+ *
+ * In no event will Sun Microsystems, Inc. be liable for any lost revenue
+ * or profits or other special, indirect and consequential damages, even if
+ * Sun has been advised of the possibility of such damages.
+ *
+ * Sun Microsystems, Inc.
+ * 2550 Garcia Avenue
+ * Mountain View, California  94043
+ */
+
+#include "g711.h"
+
+/*
+ * g711.c
+ *
+ * u-law, A-law and linear PCM conversions.
+ */
+#define        SIGN_BIT        (0x80)          /* Sign bit for a A-law byte. */
+#define        QUANT_MASK      (0xf)           /* Quantization field mask. */
+#define        NSEGS           (8)             /* Number of A-law segments. */
+#define        SEG_SHIFT       (4)             /* Left shift for segment number. */
+#define        SEG_MASK        (0x70)          /* Segment field mask. */
+
+static short seg_end[8] = {0xFF, 0x1FF, 0x3FF, 0x7FF,
+                           0xFFF, 0x1FFF, 0x3FFF, 0x7FFF};
+
+/* copy from CCITT G.711 specifications */
+unsigned char _u2a[128] = {                    /* u- to A-law conversions */
+       1,      1,      2,      2,      3,      3,      4,      4,
+       5,      5,      6,      6,      7,      7,      8,      8,
+       9,      10,     11,     12,     13,     14,     15,     16,
+       17,     18,     19,     20,     21,     22,     23,     24,
+       25,     27,     29,     31,     33,     34,     35,     36,
+       37,     38,     39,     40,     41,     42,     43,     44,
+       46,     48,     49,     50,     51,     52,     53,     54,
+       55,     56,     57,     58,     59,     60,     61,     62,
+       64,     65,     66,     67,     68,     69,     70,     71,
+       72,     73,     74,     75,     76,     77,     78,     79,
+       81,     82,     83,     84,     85,     86,     87,     88,
+       89,     90,     91,     92,     93,     94,     95,     96,
+       97,     98,     99,     100,    101,    102,    103,    104,
+       105,    106,    107,    108,    109,    110,    111,    112,
+       113,    114,    115,    116,    117,    118,    119,    120,
+       121,    122,    123,    124,    125,    126,    127,    128};
+
+unsigned char _a2u[128] = {                    /* A- to u-law conversions */
+       1,      3,      5,      7,      9,      11,     13,     15,
+       16,     17,     18,     19,     20,     21,     22,     23,
+       24,     25,     26,     27,     28,     29,     30,     31,
+       32,     32,     33,     33,     34,     34,     35,     35,
+       36,     37,     38,     39,     40,     41,     42,     43,
+       44,     45,     46,     47,     48,     48,     49,     49,
+       50,     51,     52,     53,     54,     55,     56,     57,
+       58,     59,     60,     61,     62,     63,     64,     64,
+       65,     66,     67,     68,     69,     70,     71,     72,
+       73,     74,     75,     76,     77,     78,     79,     79,
+       80,     81,     82,     83,     84,     85,     86,     87,
+       88,     89,     90,     91,     92,     93,     94,     95,
+       96,     97,     98,     99,     100,    101,    102,    103,
+       104,    105,    106,    107,    108,    109,    110,    111,
+       112,    113,    114,    115,    116,    117,    118,    119,
+       120,    121,    122,    123,    124,    125,    126,    127};
+
+static int
+search(
+       int             val,
+       short           *table,
+       int             size)
+{
+       int             i;
+
+       for (i = 0; i < size; i++) {
+               if (val <= *table++)
+                       return (i);
+       }
+       return (size);
+}
+
+/*
+ * linear2alaw() - Convert a 16-bit linear PCM value to 8-bit A-law
+ *
+ * linear2alaw() accepts an 16-bit integer and encodes it as A-law data.
+ *
+ *             Linear Input Code       Compressed Code
+ *     ------------------------        ---------------
+ *     0000000wxyza                    000wxyz
+ *     0000001wxyza                    001wxyz
+ *     000001wxyzab                    010wxyz
+ *     00001wxyzabc                    011wxyz
+ *     0001wxyzabcd                    100wxyz
+ *     001wxyzabcde                    101wxyz
+ *     01wxyzabcdef                    110wxyz
+ *     1wxyzabcdefg                    111wxyz
+ *
+ * For further information see John C. Bellamy's Digital Telephony, 1982,
+ * John Wiley & Sons, pps 98-111 and 472-476.
+ */
+unsigned char
+linear2alaw(
+       int             pcm_val)        /* 2's complement (16-bit range) */
+{
+       int             mask;
+       int             seg;
+       unsigned char   aval;
+       if (pcm_val >= 0) {
+               mask = 0xD5;            /* sign (7th) bit = 1 */
+       } else {
+               mask = 0x55;            /* sign bit = 0 */
+               pcm_val = -pcm_val - 8;
+       }
+
+       /* Convert the scaled magnitude to segment number. */
+       seg = search(pcm_val, seg_end, 8);
+
+       /* Combine the sign, segment, and quantization bits. */
+
+       if (seg >= 8)           /* out of range, return maximum value. */
+               return (0x7F ^ mask);
+       else {
+               aval = seg << SEG_SHIFT;
+               if (seg < 2)
+                       aval |= (pcm_val >> 4) & QUANT_MASK;
+               else
+                       aval |= (pcm_val >> (seg + 3)) & QUANT_MASK;
+               return (aval ^ mask);
+       }
+}
+
+/*
+ * alaw2linear() - Convert an A-law value to 16-bit linear PCM
+ *
+ */
+int
+alaw2linear(
+       unsigned char   a_val)
+{
+       int             t;
+       int             seg;
+       /*printf(" vrednost a_val %X ", a_val);*/
+       a_val ^= 0x55;
+
+       t = (a_val & QUANT_MASK) << 4;
+       seg = ((unsigned)a_val & SEG_MASK) >> SEG_SHIFT;
+       switch (seg) {
+       case 0:
+               t += 8;
+               break;
+       case 1:
+               t += 0x108;
+               break;
+       default:
+               t += 0x108;
+               t <<= seg - 1;
+       }
+       /*printf("izracunan int %d in njegov hex %X \n", t,t);*/
+       return ((a_val & SIGN_BIT) ? t : -t);
+}
+
+#define        BIAS            (0x84)          /* Bias for linear code. */
+
+/*
+ * linear2ulaw() - Convert a linear PCM value to u-law
+ *
+ * In order to simplify the encoding process, the original linear magnitude
+ * is biased by adding 33 which shifts the encoding range from (0 - 8158) to
+ * (33 - 8191). The result can be seen in the following encoding table:
+ *
+ *     Biased Linear Input Code        Compressed Code
+ *     ------------------------        ---------------
+ *     00000001wxyza                   000wxyz
+ *     0000001wxyzab                   001wxyz
+ *     000001wxyzabc                   010wxyz
+ *     00001wxyzabcd                   011wxyz
+ *     0001wxyzabcde                   100wxyz
+ *     001wxyzabcdef                   101wxyz
+ *     01wxyzabcdefg                   110wxyz
+ *     1wxyzabcdefgh                   111wxyz
+ *
+ * Each biased linear code has a leading 1 which identifies the segment
+ * number. The value of the segment number is equal to 7 minus the number
+ * of leading 0's. The quantization interval is directly available as the
+ * four bits wxyz.  * The trailing bits (a - h) are ignored.
+ *
+ * Ordinarily the complement of the resulting code word is used for
+ * transmission, and so the code word is complemented before it is returned.
+ *
+ * For further information see John C. Bellamy's Digital Telephony, 1982,
+ * John Wiley & Sons, pps 98-111 and 472-476.
+ */
+unsigned char
+linear2ulaw(
+       int             pcm_val)        /* 2's complement (16-bit range) */
+{
+       int             mask;
+       int             seg;
+       unsigned char   uval;
+
+       /* Get the sign and the magnitude of the value. */
+       if (pcm_val < 0) {
+               pcm_val = BIAS - pcm_val;
+               mask = 0x7F;
+       } else {
+               pcm_val += BIAS;
+               mask = 0xFF;
+       }
+
+       /* Convert the scaled magnitude to segment number. */
+       seg = search(pcm_val, seg_end, 8);
+
+       /*
+        * Combine the sign, segment, quantization bits;
+        * and complement the code word.
+        */
+       if (seg >= 8)           /* out of range, return maximum value. */
+               return (0x7F ^ mask);
+       else {
+               uval = (seg << 4) | ((pcm_val >> (seg + 3)) & 0xF);
+               return (uval ^ mask);
+       }
+
+}
+
+/*
+ * ulaw2linear() - Convert a u-law value to 16-bit linear PCM
+ *
+ * First, a biased linear code is derived from the code word. An unbiased
+ * output can then be obtained by subtracting 33 from the biased code.
+ *
+ * Note that this function expects to be passed the complement of the
+ * original code word. This is in keeping with ISDN conventions.
+ */
+int
+ulaw2linear(
+       unsigned char   u_val)
+{
+       int             t;
+
+       /* Complement to obtain normal u-law value. */
+       u_val = ~u_val;
+
+       /*
+        * Extract and bias the quantization bits. Then
+        * shift up by the segment number and subtract out the bias.
+        */
+       t = ((u_val & QUANT_MASK) << 3) + BIAS;
+       t <<= ((unsigned)u_val & SEG_MASK) >> SEG_SHIFT;
+
+       return ((u_val & SIGN_BIT) ? (BIAS - t) : (t - BIAS));
+}
+
+/* A-law to u-law conversion */
+/* unsigned char
+ * alaw2ulaw(
+ *     unsigned char   aval)
+ * {
+ *     aval &= 0xff;
+ *     return ((aval & 0x80) ? (0xFF ^ _a2u[aval ^ 0xD5]) :
+ *         (0x7F ^ _a2u[aval ^ 0x55]));
+ * }
+ */
+
+/* u-law to A-law conversion */
+/* unsigned char
+ * ulaw2alaw(
+ *     unsigned char   uval)
+ * {
+ *     uval &= 0xff;
+ *     return ((uval & 0x80) ? (0xD5 ^ (_u2a[0xFF ^ uval] - 1)) :
+ *         (0x55 ^ (_u2a[0x7F ^ uval] - 1)));
+ * }
+ */