1 /* 2 * SpanDSP - a series of DSP components for telephony 3 * 4 * g722_encode.c - The ITU G.722 codec, encode part. 5 * 6 * Written by Steve Underwood <steveu (at) coppice.org> 7 * 8 * Copyright (C) 2005 Steve Underwood 9 * 10 * All rights reserved. 11 * 12 * Despite my general liking of the GPL, I place my own contributions 13 * to this code in the public domain for the benefit of all mankind - 14 * even the slimy ones who might try to proprietize my work and use it 15 * to my detriment. 16 * 17 * Based on a single channel 64kbps only G.722 codec which is: 18 * 19 ***** Copyright (c) CMU 1993 ***** 20 * Computer Science, Speech Group 21 * Chengxiang Lu and Alex Hauptmann 22 * 23 * $Id: g722_encode.c,v 1.14 2006/07/07 16:37:49 steveu Exp $ 24 * 25 * Modifications for WebRtc, 2011/04/28, by tlegrand: 26 * -Removed usage of inttypes.h and tgmath.h 27 * -Changed to use WebRtc types 28 * -Added option to run encoder bitexact with ITU-T reference implementation 29 */ 30 31 /*! \file */ 32 33 #ifdef HAVE_CONFIG_H 34 #include <config.h> 35 #endif 36 37 #include <stdio.h> 38 #include <memory.h> 39 #include <stdlib.h> 40 41 #include "typedefs.h" 42 #include "g722_enc_dec.h" 43 44 #if !defined(FALSE) 45 #define FALSE 0 46 #endif 47 #if !defined(TRUE) 48 #define TRUE (!FALSE) 49 #endif 50 51 static __inline int16_t saturate(int32_t amp) 52 { 53 int16_t amp16; 54 55 /* Hopefully this is optimised for the common case - not clipping */ 56 amp16 = (int16_t) amp; 57 if (amp == amp16) 58 return amp16; 59 if (amp > WEBRTC_INT16_MAX) 60 return WEBRTC_INT16_MAX; 61 return WEBRTC_INT16_MIN; 62 } 63 /*- End of function --------------------------------------------------------*/ 64 65 static void block4(g722_encode_state_t *s, int band, int d) 66 { 67 int wd1; 68 int wd2; 69 int wd3; 70 int i; 71 72 /* Block 4, RECONS */ 73 s->band[band].d[0] = d; 74 s->band[band].r[0] = saturate(s->band[band].s + d); 75 76 /* Block 4, PARREC */ 77 s->band[band].p[0] = saturate(s->band[band].sz + d); 78 79 /* Block 4, UPPOL2 */ 80 for (i = 0; i < 3; i++) 81 s->band[band].sg[i] = s->band[band].p[i] >> 15; 82 wd1 = saturate(s->band[band].a[1] << 2); 83 84 wd2 = (s->band[band].sg[0] == s->band[band].sg[1]) ? -wd1 : wd1; 85 if (wd2 > 32767) 86 wd2 = 32767; 87 wd3 = (wd2 >> 7) + ((s->band[band].sg[0] == s->band[band].sg[2]) ? 128 : -128); 88 wd3 += (s->band[band].a[2]*32512) >> 15; 89 if (wd3 > 12288) 90 wd3 = 12288; 91 else if (wd3 < -12288) 92 wd3 = -12288; 93 s->band[band].ap[2] = wd3; 94 95 /* Block 4, UPPOL1 */ 96 s->band[band].sg[0] = s->band[band].p[0] >> 15; 97 s->band[band].sg[1] = s->band[band].p[1] >> 15; 98 wd1 = (s->band[band].sg[0] == s->band[band].sg[1]) ? 192 : -192; 99 wd2 = (s->band[band].a[1]*32640) >> 15; 100 101 s->band[band].ap[1] = saturate(wd1 + wd2); 102 wd3 = saturate(15360 - s->band[band].ap[2]); 103 if (s->band[band].ap[1] > wd3) 104 s->band[band].ap[1] = wd3; 105 else if (s->band[band].ap[1] < -wd3) 106 s->band[band].ap[1] = -wd3; 107 108 /* Block 4, UPZERO */ 109 wd1 = (d == 0) ? 0 : 128; 110 s->band[band].sg[0] = d >> 15; 111 for (i = 1; i < 7; i++) 112 { 113 s->band[band].sg[i] = s->band[band].d[i] >> 15; 114 wd2 = (s->band[band].sg[i] == s->band[band].sg[0]) ? wd1 : -wd1; 115 wd3 = (s->band[band].b[i]*32640) >> 15; 116 s->band[band].bp[i] = saturate(wd2 + wd3); 117 } 118 119 /* Block 4, DELAYA */ 120 for (i = 6; i > 0; i--) 121 { 122 s->band[band].d[i] = s->band[band].d[i - 1]; 123 s->band[band].b[i] = s->band[band].bp[i]; 124 } 125 126 for (i = 2; i > 0; i--) 127 { 128 s->band[band].r[i] = s->band[band].r[i - 1]; 129 s->band[band].p[i] = s->band[band].p[i - 1]; 130 s->band[band].a[i] = s->band[band].ap[i]; 131 } 132 133 /* Block 4, FILTEP */ 134 wd1 = saturate(s->band[band].r[1] + s->band[band].r[1]); 135 wd1 = (s->band[band].a[1]*wd1) >> 15; 136 wd2 = saturate(s->band[band].r[2] + s->band[band].r[2]); 137 wd2 = (s->band[band].a[2]*wd2) >> 15; 138 s->band[band].sp = saturate(wd1 + wd2); 139 140 /* Block 4, FILTEZ */ 141 s->band[band].sz = 0; 142 for (i = 6; i > 0; i--) 143 { 144 wd1 = saturate(s->band[band].d[i] + s->band[band].d[i]); 145 s->band[band].sz += (s->band[band].b[i]*wd1) >> 15; 146 } 147 s->band[band].sz = saturate(s->band[band].sz); 148 149 /* Block 4, PREDIC */ 150 s->band[band].s = saturate(s->band[band].sp + s->band[band].sz); 151 } 152 /*- End of function --------------------------------------------------------*/ 153 154 g722_encode_state_t *WebRtc_g722_encode_init(g722_encode_state_t *s, 155 int rate, int options) 156 { 157 if (s == NULL) 158 { 159 if ((s = (g722_encode_state_t *) malloc(sizeof(*s))) == NULL) 160 return NULL; 161 } 162 memset(s, 0, sizeof(*s)); 163 if (rate == 48000) 164 s->bits_per_sample = 6; 165 else if (rate == 56000) 166 s->bits_per_sample = 7; 167 else 168 s->bits_per_sample = 8; 169 if ((options & G722_SAMPLE_RATE_8000)) 170 s->eight_k = TRUE; 171 if ((options & G722_PACKED) && s->bits_per_sample != 8) 172 s->packed = TRUE; 173 else 174 s->packed = FALSE; 175 s->band[0].det = 32; 176 s->band[1].det = 8; 177 return s; 178 } 179 /*- End of function --------------------------------------------------------*/ 180 181 int WebRtc_g722_encode_release(g722_encode_state_t *s) 182 { 183 free(s); 184 return 0; 185 } 186 /*- End of function --------------------------------------------------------*/ 187 188 /* WebRtc, tlegrand: 189 * Only define the following if bit-exactness with reference implementation 190 * is needed. Will only have any effect if input signal is saturated. 191 */ 192 //#define RUN_LIKE_REFERENCE_G722 193 #ifdef RUN_LIKE_REFERENCE_G722 194 int16_t limitValues (int16_t rl) 195 { 196 197 int16_t yl; 198 199 yl = (rl > 16383) ? 16383 : ((rl < -16384) ? -16384 : rl); 200 201 return (yl); 202 } 203 #endif 204 205 int WebRtc_g722_encode(g722_encode_state_t *s, uint8_t g722_data[], 206 const int16_t amp[], int len) 207 { 208 static const int q6[32] = 209 { 210 0, 35, 72, 110, 150, 190, 233, 276, 211 323, 370, 422, 473, 530, 587, 650, 714, 212 786, 858, 940, 1023, 1121, 1219, 1339, 1458, 213 1612, 1765, 1980, 2195, 2557, 2919, 0, 0 214 }; 215 static const int iln[32] = 216 { 217 0, 63, 62, 31, 30, 29, 28, 27, 218 26, 25, 24, 23, 22, 21, 20, 19, 219 18, 17, 16, 15, 14, 13, 12, 11, 220 10, 9, 8, 7, 6, 5, 4, 0 221 }; 222 static const int ilp[32] = 223 { 224 0, 61, 60, 59, 58, 57, 56, 55, 225 54, 53, 52, 51, 50, 49, 48, 47, 226 46, 45, 44, 43, 42, 41, 40, 39, 227 38, 37, 36, 35, 34, 33, 32, 0 228 }; 229 static const int wl[8] = 230 { 231 -60, -30, 58, 172, 334, 538, 1198, 3042 232 }; 233 static const int rl42[16] = 234 { 235 0, 7, 6, 5, 4, 3, 2, 1, 7, 6, 5, 4, 3, 2, 1, 0 236 }; 237 static const int ilb[32] = 238 { 239 2048, 2093, 2139, 2186, 2233, 2282, 2332, 240 2383, 2435, 2489, 2543, 2599, 2656, 2714, 241 2774, 2834, 2896, 2960, 3025, 3091, 3158, 242 3228, 3298, 3371, 3444, 3520, 3597, 3676, 243 3756, 3838, 3922, 4008 244 }; 245 static const int qm4[16] = 246 { 247 0, -20456, -12896, -8968, 248 -6288, -4240, -2584, -1200, 249 20456, 12896, 8968, 6288, 250 4240, 2584, 1200, 0 251 }; 252 static const int qm2[4] = 253 { 254 -7408, -1616, 7408, 1616 255 }; 256 static const int qmf_coeffs[12] = 257 { 258 3, -11, 12, 32, -210, 951, 3876, -805, 362, -156, 53, -11, 259 }; 260 static const int ihn[3] = {0, 1, 0}; 261 static const int ihp[3] = {0, 3, 2}; 262 static const int wh[3] = {0, -214, 798}; 263 static const int rh2[4] = {2, 1, 2, 1}; 264 265 int dlow; 266 int dhigh; 267 int el; 268 int wd; 269 int wd1; 270 int ril; 271 int wd2; 272 int il4; 273 int ih2; 274 int wd3; 275 int eh; 276 int mih; 277 int i; 278 int j; 279 /* Low and high band PCM from the QMF */ 280 int xlow; 281 int xhigh; 282 int g722_bytes; 283 /* Even and odd tap accumulators */ 284 int sumeven; 285 int sumodd; 286 int ihigh; 287 int ilow; 288 int code; 289 290 g722_bytes = 0; 291 xhigh = 0; 292 for (j = 0; j < len; ) 293 { 294 if (s->itu_test_mode) 295 { 296 xlow = 297 xhigh = amp[j++] >> 1; 298 } 299 else 300 { 301 if (s->eight_k) 302 { 303 /* We shift by 1 to allow for the 15 bit input to the G.722 algorithm. */ 304 xlow = amp[j++] >> 1; 305 } 306 else 307 { 308 /* Apply the transmit QMF */ 309 /* Shuffle the buffer down */ 310 for (i = 0; i < 22; i++) 311 s->x[i] = s->x[i + 2]; 312 s->x[22] = amp[j++]; 313 s->x[23] = amp[j++]; 314 315 /* Discard every other QMF output */ 316 sumeven = 0; 317 sumodd = 0; 318 for (i = 0; i < 12; i++) 319 { 320 sumodd += s->x[2*i]*qmf_coeffs[i]; 321 sumeven += s->x[2*i + 1]*qmf_coeffs[11 - i]; 322 } 323 /* We shift by 12 to allow for the QMF filters (DC gain = 4096), plus 1 324 to allow for us summing two filters, plus 1 to allow for the 15 bit 325 input to the G.722 algorithm. */ 326 xlow = (sumeven + sumodd) >> 14; 327 xhigh = (sumeven - sumodd) >> 14; 328 329 #ifdef RUN_LIKE_REFERENCE_G722 330 /* The following lines are only used to verify bit-exactness 331 * with reference implementation of G.722. Higher precision 332 * is achieved without limiting the values. 333 */ 334 xlow = limitValues(xlow); 335 xhigh = limitValues(xhigh); 336 #endif 337 } 338 } 339 /* Block 1L, SUBTRA */ 340 el = saturate(xlow - s->band[0].s); 341 342 /* Block 1L, QUANTL */ 343 wd = (el >= 0) ? el : -(el + 1); 344 345 for (i = 1; i < 30; i++) 346 { 347 wd1 = (q6[i]*s->band[0].det) >> 12; 348 if (wd < wd1) 349 break; 350 } 351 ilow = (el < 0) ? iln[i] : ilp[i]; 352 353 /* Block 2L, INVQAL */ 354 ril = ilow >> 2; 355 wd2 = qm4[ril]; 356 dlow = (s->band[0].det*wd2) >> 15; 357 358 /* Block 3L, LOGSCL */ 359 il4 = rl42[ril]; 360 wd = (s->band[0].nb*127) >> 7; 361 s->band[0].nb = wd + wl[il4]; 362 if (s->band[0].nb < 0) 363 s->band[0].nb = 0; 364 else if (s->band[0].nb > 18432) 365 s->band[0].nb = 18432; 366 367 /* Block 3L, SCALEL */ 368 wd1 = (s->band[0].nb >> 6) & 31; 369 wd2 = 8 - (s->band[0].nb >> 11); 370 wd3 = (wd2 < 0) ? (ilb[wd1] << -wd2) : (ilb[wd1] >> wd2); 371 s->band[0].det = wd3 << 2; 372 373 block4(s, 0, dlow); 374 375 if (s->eight_k) 376 { 377 /* Just leave the high bits as zero */ 378 code = (0xC0 | ilow) >> (8 - s->bits_per_sample); 379 } 380 else 381 { 382 /* Block 1H, SUBTRA */ 383 eh = saturate(xhigh - s->band[1].s); 384 385 /* Block 1H, QUANTH */ 386 wd = (eh >= 0) ? eh : -(eh + 1); 387 wd1 = (564*s->band[1].det) >> 12; 388 mih = (wd >= wd1) ? 2 : 1; 389 ihigh = (eh < 0) ? ihn[mih] : ihp[mih]; 390 391 /* Block 2H, INVQAH */ 392 wd2 = qm2[ihigh]; 393 dhigh = (s->band[1].det*wd2) >> 15; 394 395 /* Block 3H, LOGSCH */ 396 ih2 = rh2[ihigh]; 397 wd = (s->band[1].nb*127) >> 7; 398 s->band[1].nb = wd + wh[ih2]; 399 if (s->band[1].nb < 0) 400 s->band[1].nb = 0; 401 else if (s->band[1].nb > 22528) 402 s->band[1].nb = 22528; 403 404 /* Block 3H, SCALEH */ 405 wd1 = (s->band[1].nb >> 6) & 31; 406 wd2 = 10 - (s->band[1].nb >> 11); 407 wd3 = (wd2 < 0) ? (ilb[wd1] << -wd2) : (ilb[wd1] >> wd2); 408 s->band[1].det = wd3 << 2; 409 410 block4(s, 1, dhigh); 411 code = ((ihigh << 6) | ilow) >> (8 - s->bits_per_sample); 412 } 413 414 if (s->packed) 415 { 416 /* Pack the code bits */ 417 s->out_buffer |= (code << s->out_bits); 418 s->out_bits += s->bits_per_sample; 419 if (s->out_bits >= 8) 420 { 421 g722_data[g722_bytes++] = (uint8_t) (s->out_buffer & 0xFF); 422 s->out_bits -= 8; 423 s->out_buffer >>= 8; 424 } 425 } 426 else 427 { 428 g722_data[g722_bytes++] = (uint8_t) code; 429 } 430 } 431 return g722_bytes; 432 } 433 /*- End of function --------------------------------------------------------*/ 434 /*- End of file ------------------------------------------------------------*/ 435
