issue #5622
[asterisk/asterisk.git] / ulaw.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (C) 1999 - 2005, Digium, Inc.
5  *
6  * Mark Spencer <markster@digium.com>
7  *
8  * See http://www.asterisk.org for more information about
9  * the Asterisk project. Please do not directly contact
10  * any of the maintainers of this project for assistance;
11  * the project provides a web site, mailing lists and IRC
12  * channels for your use.
13  *
14  * This program is free software, distributed under the terms of
15  * the GNU General Public License Version 2. See the LICENSE file
16  * at the top of the source tree.
17  */
18
19 /*! \file
20  *
21  * \brief u-Law to Signed linear conversion
22  * 
23  */
24
25 #include "asterisk.h"
26
27 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
28
29 #include "asterisk/ulaw.h"
30
31 #define ZEROTRAP    /* turn on the trap as per the MIL-STD */
32 #define BIAS 0x84   /* define the add-in bias for 16 bit samples */
33 #define CLIP 32635
34
35 unsigned char __ast_lin2mu[16384];
36 short __ast_mulaw[256];
37
38 static unsigned char
39 linear2ulaw(short sample)
40 {
41   static int exp_lut[256] = {0,0,1,1,2,2,2,2,3,3,3,3,3,3,3,3,
42                              4,4,4,4,4,4,4,4,4,4,4,4,4,4,4,4,
43                              5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,
44                              5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,
45                              6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,
46                              6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,
47                              6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,
48                              6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,
49                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
50                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
51                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
52                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
53                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
54                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
55                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
56                              7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7};
57   int sign, exponent, mantissa;
58   unsigned char ulawbyte;
59
60   /* Get the sample into sign-magnitude. */
61   sign = (sample >> 8) & 0x80;          /* set aside the sign */
62   if (sign != 0) sample = -sample;              /* get magnitude */
63   if (sample > CLIP) sample = CLIP;             /* clip the magnitude */
64
65   /* Convert from 16 bit linear to ulaw. */
66   sample = sample + BIAS;
67   exponent = exp_lut[(sample >> 7) & 0xFF];
68   mantissa = (sample >> (exponent + 3)) & 0x0F;
69   ulawbyte = ~(sign | (exponent << 4) | mantissa);
70 #ifdef ZEROTRAP
71   if (ulawbyte == 0) ulawbyte = 0x02;   /* optional CCITT trap */
72 #endif
73
74   return(ulawbyte);
75 }
76
77 void ast_ulaw_init(void)
78 {
79         int i;
80         /* 
81          *  Set up mu-law conversion table
82          */
83         for(i = 0;i < 256;i++)
84            {
85                 short mu,e,f,y;
86                 static short etab[]={0,132,396,924,1980,4092,8316,16764};
87
88                 mu = 255-i;
89                 e = (mu & 0x70)/16;
90                 f = mu & 0x0f;
91                 y = f * (1 << (e + 3));
92                 y += etab[e];
93                 if (mu & 0x80) y = -y;
94                 __ast_mulaw[i] = y;
95            }
96           /* set up the reverse (mu-law) conversion table */
97         for(i = -32768; i < 32768; i++)
98            {
99                 __ast_lin2mu[((unsigned short)i) >> 2] = linear2ulaw(i);
100            }
101
102 }
103