1 /* $OpenBSD: mulaw.c,v 1.18 2015/06/25 06:43:46 ratchov Exp $ */
2 /* $NetBSD: mulaw.c,v 1.15 2001/01/18 20:28:20 jdolecek Exp $ */
3
4 /*
5 * Copyright (c) 1991-1993 Regents of the University of California.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 * must display the following acknowledgement:
18 * This product includes software developed by the Computer Systems
19 * Engineering Group at Lawrence Berkeley Laboratory.
20 * 4. Neither the name of the University nor of the Laboratory may be used
21 * to endorse or promote products derived from this software without
22 * specific prior written permission.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
30 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
31 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34 * SUCH DAMAGE.
35 *
36 */
37
38 #include <sys/types.h>
39 #include <dev/mulaw.h>
40
41 /*
42 * This table converts a (8 bit) mu-law value two a 16 bit value.
43 * The 16 bits are represented as an array of two bytes for easier access
44 * to the individual bytes.
45 */
46 static const u_char mulawtolin16[256][2] = {
47 {0x02,0x84}, {0x06,0x84}, {0x0a,0x84}, {0x0e,0x84},
48 {0x12,0x84}, {0x16,0x84}, {0x1a,0x84}, {0x1e,0x84},
49 {0x22,0x84}, {0x26,0x84}, {0x2a,0x84}, {0x2e,0x84},
50 {0x32,0x84}, {0x36,0x84}, {0x3a,0x84}, {0x3e,0x84},
51 {0x41,0x84}, {0x43,0x84}, {0x45,0x84}, {0x47,0x84},
52 {0x49,0x84}, {0x4b,0x84}, {0x4d,0x84}, {0x4f,0x84},
53 {0x51,0x84}, {0x53,0x84}, {0x55,0x84}, {0x57,0x84},
54 {0x59,0x84}, {0x5b,0x84}, {0x5d,0x84}, {0x5f,0x84},
55 {0x61,0x04}, {0x62,0x04}, {0x63,0x04}, {0x64,0x04},
56 {0x65,0x04}, {0x66,0x04}, {0x67,0x04}, {0x68,0x04},
57 {0x69,0x04}, {0x6a,0x04}, {0x6b,0x04}, {0x6c,0x04},
58 {0x6d,0x04}, {0x6e,0x04}, {0x6f,0x04}, {0x70,0x04},
59 {0x70,0xc4}, {0x71,0x44}, {0x71,0xc4}, {0x72,0x44},
60 {0x72,0xc4}, {0x73,0x44}, {0x73,0xc4}, {0x74,0x44},
61 {0x74,0xc4}, {0x75,0x44}, {0x75,0xc4}, {0x76,0x44},
62 {0x76,0xc4}, {0x77,0x44}, {0x77,0xc4}, {0x78,0x44},
63 {0x78,0xa4}, {0x78,0xe4}, {0x79,0x24}, {0x79,0x64},
64 {0x79,0xa4}, {0x79,0xe4}, {0x7a,0x24}, {0x7a,0x64},
65 {0x7a,0xa4}, {0x7a,0xe4}, {0x7b,0x24}, {0x7b,0x64},
66 {0x7b,0xa4}, {0x7b,0xe4}, {0x7c,0x24}, {0x7c,0x64},
67 {0x7c,0x94}, {0x7c,0xb4}, {0x7c,0xd4}, {0x7c,0xf4},
68 {0x7d,0x14}, {0x7d,0x34}, {0x7d,0x54}, {0x7d,0x74},
69 {0x7d,0x94}, {0x7d,0xb4}, {0x7d,0xd4}, {0x7d,0xf4},
70 {0x7e,0x14}, {0x7e,0x34}, {0x7e,0x54}, {0x7e,0x74},
71 {0x7e,0x8c}, {0x7e,0x9c}, {0x7e,0xac}, {0x7e,0xbc},
72 {0x7e,0xcc}, {0x7e,0xdc}, {0x7e,0xec}, {0x7e,0xfc},
73 {0x7f,0x0c}, {0x7f,0x1c}, {0x7f,0x2c}, {0x7f,0x3c},
74 {0x7f,0x4c}, {0x7f,0x5c}, {0x7f,0x6c}, {0x7f,0x7c},
75 {0x7f,0x88}, {0x7f,0x90}, {0x7f,0x98}, {0x7f,0xa0},
76 {0x7f,0xa8}, {0x7f,0xb0}, {0x7f,0xb8}, {0x7f,0xc0},
77 {0x7f,0xc8}, {0x7f,0xd0}, {0x7f,0xd8}, {0x7f,0xe0},
78 {0x7f,0xe8}, {0x7f,0xf0}, {0x7f,0xf8}, {0x80,0x00},
79 {0xfd,0x7c}, {0xf9,0x7c}, {0xf5,0x7c}, {0xf1,0x7c},
80 {0xed,0x7c}, {0xe9,0x7c}, {0xe5,0x7c}, {0xe1,0x7c},
81 {0xdd,0x7c}, {0xd9,0x7c}, {0xd5,0x7c}, {0xd1,0x7c},
82 {0xcd,0x7c}, {0xc9,0x7c}, {0xc5,0x7c}, {0xc1,0x7c},
83 {0xbe,0x7c}, {0xbc,0x7c}, {0xba,0x7c}, {0xb8,0x7c},
84 {0xb6,0x7c}, {0xb4,0x7c}, {0xb2,0x7c}, {0xb0,0x7c},
85 {0xae,0x7c}, {0xac,0x7c}, {0xaa,0x7c}, {0xa8,0x7c},
86 {0xa6,0x7c}, {0xa4,0x7c}, {0xa2,0x7c}, {0xa0,0x7c},
87 {0x9e,0xfc}, {0x9d,0xfc}, {0x9c,0xfc}, {0x9b,0xfc},
88 {0x9a,0xfc}, {0x99,0xfc}, {0x98,0xfc}, {0x97,0xfc},
89 {0x96,0xfc}, {0x95,0xfc}, {0x94,0xfc}, {0x93,0xfc},
90 {0x92,0xfc}, {0x91,0xfc}, {0x90,0xfc}, {0x8f,0xfc},
91 {0x8f,0x3c}, {0x8e,0xbc}, {0x8e,0x3c}, {0x8d,0xbc},
92 {0x8d,0x3c}, {0x8c,0xbc}, {0x8c,0x3c}, {0x8b,0xbc},
93 {0x8b,0x3c}, {0x8a,0xbc}, {0x8a,0x3c}, {0x89,0xbc},
94 {0x89,0x3c}, {0x88,0xbc}, {0x88,0x3c}, {0x87,0xbc},
95 {0x87,0x5c}, {0x87,0x1c}, {0x86,0xdc}, {0x86,0x9c},
96 {0x86,0x5c}, {0x86,0x1c}, {0x85,0xdc}, {0x85,0x9c},
97 {0x85,0x5c}, {0x85,0x1c}, {0x84,0xdc}, {0x84,0x9c},
98 {0x84,0x5c}, {0x84,0x1c}, {0x83,0xdc}, {0x83,0x9c},
99 {0x83,0x6c}, {0x83,0x4c}, {0x83,0x2c}, {0x83,0x0c},
100 {0x82,0xec}, {0x82,0xcc}, {0x82,0xac}, {0x82,0x8c},
101 {0x82,0x6c}, {0x82,0x4c}, {0x82,0x2c}, {0x82,0x0c},
102 {0x81,0xec}, {0x81,0xcc}, {0x81,0xac}, {0x81,0x8c},
103 {0x81,0x74}, {0x81,0x64}, {0x81,0x54}, {0x81,0x44},
104 {0x81,0x34}, {0x81,0x24}, {0x81,0x14}, {0x81,0x04},
105 {0x80,0xf4}, {0x80,0xe4}, {0x80,0xd4}, {0x80,0xc4},
106 {0x80,0xb4}, {0x80,0xa4}, {0x80,0x94}, {0x80,0x84},
107 {0x80,0x78}, {0x80,0x70}, {0x80,0x68}, {0x80,0x60},
108 {0x80,0x58}, {0x80,0x50}, {0x80,0x48}, {0x80,0x40},
109 {0x80,0x38}, {0x80,0x30}, {0x80,0x28}, {0x80,0x20},
110 {0x80,0x18}, {0x80,0x10}, {0x80,0x08}, {0x80,0x00},
111 };
112
113 static const u_char lintomulaw[256] = {
114 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x01, 0x01,
115 0x01, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x03,
116 0x03, 0x04, 0x04, 0x04, 0x04, 0x05, 0x05, 0x05,
117 0x05, 0x06, 0x06, 0x06, 0x06, 0x07, 0x07, 0x07,
118 0x07, 0x08, 0x08, 0x08, 0x08, 0x09, 0x09, 0x09,
119 0x09, 0x0a, 0x0a, 0x0a, 0x0a, 0x0b, 0x0b, 0x0b,
120 0x0b, 0x0c, 0x0c, 0x0c, 0x0c, 0x0d, 0x0d, 0x0d,
121 0x0d, 0x0e, 0x0e, 0x0e, 0x0e, 0x0f, 0x0f, 0x0f,
122 0x0f, 0x10, 0x10, 0x11, 0x11, 0x12, 0x12, 0x13,
123 0x13, 0x14, 0x14, 0x15, 0x15, 0x16, 0x16, 0x17,
124 0x17, 0x18, 0x18, 0x19, 0x19, 0x1a, 0x1a, 0x1b,
125 0x1b, 0x1c, 0x1c, 0x1d, 0x1d, 0x1e, 0x1e, 0x1f,
126 0x1f, 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26,
127 0x27, 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e,
128 0x2f, 0x30, 0x32, 0x34, 0x36, 0x38, 0x3a, 0x3c,
129 0x3e, 0x41, 0x45, 0x49, 0x4d, 0x53, 0x5b, 0x67,
130 0xff, 0xe7, 0xdb, 0xd3, 0xcd, 0xc9, 0xc5, 0xc1,
131 0xbe, 0xbc, 0xba, 0xb8, 0xb6, 0xb4, 0xb2, 0xb0,
132 0xaf, 0xae, 0xad, 0xac, 0xab, 0xaa, 0xa9, 0xa8,
133 0xa7, 0xa6, 0xa5, 0xa4, 0xa3, 0xa2, 0xa1, 0xa0,
134 0x9f, 0x9f, 0x9e, 0x9e, 0x9d, 0x9d, 0x9c, 0x9c,
135 0x9b, 0x9b, 0x9a, 0x9a, 0x99, 0x99, 0x98, 0x98,
136 0x97, 0x97, 0x96, 0x96, 0x95, 0x95, 0x94, 0x94,
137 0x93, 0x93, 0x92, 0x92, 0x91, 0x91, 0x90, 0x90,
138 0x8f, 0x8f, 0x8f, 0x8f, 0x8e, 0x8e, 0x8e, 0x8e,
139 0x8d, 0x8d, 0x8d, 0x8d, 0x8c, 0x8c, 0x8c, 0x8c,
140 0x8b, 0x8b, 0x8b, 0x8b, 0x8a, 0x8a, 0x8a, 0x8a,
141 0x89, 0x89, 0x89, 0x89, 0x88, 0x88, 0x88, 0x88,
142 0x87, 0x87, 0x87, 0x87, 0x86, 0x86, 0x86, 0x86,
143 0x85, 0x85, 0x85, 0x85, 0x84, 0x84, 0x84, 0x84,
144 0x83, 0x83, 0x83, 0x83, 0x82, 0x82, 0x82, 0x82,
145 0x81, 0x81, 0x81, 0x81, 0x80, 0x80, 0x80, 0x80,
146 };
147
148 void
mulaw_to_slinear8(u_char * p,int cc)149 mulaw_to_slinear8(u_char *p, int cc)
150 {
151 /* Use the 16 bit table for 8 bits too. */
152 while (--cc >= 0) {
153 *p = mulawtolin16[*p][0] ^ 0x80;
154 ++p;
155 }
156 }
157
158 void
slinear8_to_mulaw(u_char * p,int cc)159 slinear8_to_mulaw(u_char *p, int cc)
160 {
161 while (--cc >= 0) {
162 *p = lintomulaw[*p ^ 0x80];
163 ++p;
164 }
165 }
166
167 void
mulaw24_to_slinear24(u_char * p,int cc)168 mulaw24_to_slinear24(u_char *p, int cc)
169 {
170 int s, *q = (int *)p;
171
172 while ((cc -= 4) >= 0) {
173 s = (*q >> 16) & 0xff;
174 *q = (int)((signed char)mulawtolin16[s][0] ^ 0x80) << 16 |
175 (u_int)mulawtolin16[s][1] << 8;
176 q++;
177 }
178 }
179
180 void
slinear24_to_mulaw24(u_char * p,int cc)181 slinear24_to_mulaw24(u_char *p, int cc)
182 {
183 u_int *q = (u_int *)p;
184
185 while ((cc -= 4) >= 0) {
186 *q = lintomulaw[((*q >> 16) & 0xff) ^ 0x80] << 16;
187 q++;
188 }
189 }
190