FreeCalypso > hg > gsm-codec-lib
changeset 336:7f99b8ed30e5
libtwamr: integrate gc_pred.c
| author | Mychaela Falconia <falcon@freecalypso.org> |
|---|---|
| date | Thu, 18 Apr 2024 23:02:35 +0000 |
| parents | 03198f6b0427 |
| children | 190c4c9a3693 |
| files | libtwamr/Makefile libtwamr/gc_pred.c libtwamr/gc_pred.h libtwamr/namespace.h |
| diffstat | 4 files changed, 499 insertions(+), 3 deletions(-) [+] |
line wrap: on
line diff
--- a/libtwamr/Makefile Thu Apr 18 22:35:05 2024 +0000 +++ b/libtwamr/Makefile Thu Apr 18 23:02:35 2024 +0000 @@ -3,9 +3,9 @@ OBJS= a_refl.o agc.o autocorr.o az_lsp.o b_cn_cod.o basicop2.o bgnscd.o \ bitno.o bits2prm.o c1035pf.o c2_11pf.o c2_9pf.o c3_14pf.o c4_17pf.o \ c8_31pf.o c_g_aver.o calc_cor.o calc_en.o cbsearch.o convolve.o cor_h.o\ - d1035pf.o d2_11pf.o d2_9pf.o d3_14pf.o d4_17pf.o d8_31pf.o gmed_n.o \ - graytab.o inv_sqrt.o log2.o oper_32b.o prmno.o s10_8pf.o set_sign.o \ - sqrt_l.o tls_flags.o window.o + d1035pf.o d2_11pf.o d2_9pf.o d3_14pf.o d4_17pf.o d8_31pf.o gc_pred.o \ + gmed_n.o graytab.o inv_sqrt.o log2.o oper_32b.o prmno.o s10_8pf.o \ + set_sign.o sqrt_l.o tls_flags.o window.o LIB= libtwamr.a INSTALL_PREFIX= /usr/local
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/libtwamr/gc_pred.c Thu Apr 18 23:02:35 2024 +0000 @@ -0,0 +1,376 @@ +/* +***************************************************************************** +* +* GSM AMR-NB speech codec R98 Version 7.6.0 December 12, 2001 +* R99 Version 3.3.0 +* REL-4 Version 4.1.0 +* +***************************************************************************** +* +* File : gc_pred.c +* Purpose : codebook gain MA prediction +* +***************************************************************************** +*/ + +/* +***************************************************************************** +* MODULE INCLUDE FILE AND VERSION ID +***************************************************************************** +*/ +#include "namespace.h" +#include "gc_pred.h" + +/* +***************************************************************************** +* INCLUDE FILES +***************************************************************************** +*/ +#include "typedef.h" +#include "basic_op.h" +#include "oper_32b.h" +#include "cnst.h" +#include "no_count.h" +#include "log2.h" +#include "memops.h" + +/* +***************************************************************************** +* LOCAL VARIABLES AND TABLES +***************************************************************************** +*/ + +#define NPRED 4 /* number of prediction taps */ + +/* MA prediction coefficients (Q13) */ +static const Word16 pred[NPRED] = {5571, 4751, 2785, 1556}; + +/* average innovation energy. */ +/* MEAN_ENER = 36.0/constant, constant = 20*Log10(2) */ +#define MEAN_ENER_MR122 783741L /* 36/(20*log10(2)) (Q17) */ + +/* MA prediction coefficients (Q6) */ +static const Word16 pred_MR122[NPRED] = {44, 37, 22, 12}; + +/* minimum quantized energy: -14 dB */ +#define MIN_ENERGY -14336 /* 14 Q10 */ +#define MIN_ENERGY_MR122 -2381 /* 14 / (20*log10(2)) Q10 */ +/* +***************************************************************************** +* PUBLIC PROGRAM CODE +***************************************************************************** +*/ +/************************************************************************* +* +* Function: gc_pred_reset +* Purpose: Initializes state memory to zero +* +************************************************************************** +*/ +void gc_pred_reset (gc_predState *state) +{ + Word16 i; + + for(i = 0; i < NPRED; i++) + { + state->past_qua_en[i] = MIN_ENERGY; + state->past_qua_en_MR122[i] = MIN_ENERGY_MR122; + } +} + +/************************************************************************* + * + * FUNCTION: gc_pred_copy() + * + * PURPOSE: Copy MA predictor state variable + * + *************************************************************************/ +void +gc_pred_copy( + gc_predState *st_src, /* i : State struct */ + gc_predState *st_dest /* o : State struct */ +) +{ + Copy (st_src->past_qua_en, st_dest->past_qua_en, NPRED); + Copy (st_src->past_qua_en_MR122, st_dest->past_qua_en_MR122, NPRED); +} + +/************************************************************************* + * + * FUNCTION: gc_pred() + * + * PURPOSE: MA prediction of the innovation energy + * (in dB/(20*log10(2))) with mean removed). + * + *************************************************************************/ +void +gc_pred( + gc_predState *st, /* i/o: State struct */ + enum Mode mode, /* i : AMR mode */ + Word16 *code, /* i : innovative codebook vector (L_SUBFR) */ + /* MR122: Q12, other modes: Q13 */ + Word16 *exp_gcode0, /* o : exponent of predicted gain factor, Q0 */ + Word16 *frac_gcode0,/* o : fraction of predicted gain factor Q15 */ + Word16 *exp_en, /* o : exponent of innovation energy, Q0 */ + /* (only calculated for MR795) */ + Word16 *frac_en /* o : fraction of innovation energy, Q15 */ + /* (only calculated for MR795) */ +) +{ + Word16 i; + Word32 ener_code; + Word16 exp, frac; + + /*-------------------------------------------------------------------* + * energy of code: * + * ~~~~~~~~~~~~~~~ * + * ener_code = sum(code[i]^2) * + *-------------------------------------------------------------------*/ + ener_code = L_mac((Word32) 0, code[0], code[0]); + /* MR122: Q12*Q12 -> Q25 */ + /* others: Q13*Q13 -> Q27 */ + for (i = 1; i < L_SUBFR; i++) + ener_code = L_mac(ener_code, code[i], code[i]); + + test (); + if (sub (mode, MR122) == 0) + { + Word32 ener; + + /* ener_code = ener_code / lcode; lcode = 40; 1/40 = 26214 Q20 */ + ener_code = L_mult (round (ener_code), 26214); /* Q9 * Q20 -> Q30 */ + + /*-------------------------------------------------------------------* + * energy of code: * + * ~~~~~~~~~~~~~~~ * + * ener_code(Q17) = 10 * Log10(energy) / constant * + * = 1/2 * Log2(energy) * + * constant = 20*Log10(2) * + *-------------------------------------------------------------------*/ + /* ener_code = 1/2 * Log2(ener_code); Note: Log2=log2+30 */ + Log2(ener_code, &exp, &frac); + ener_code = L_Comp (sub (exp, 30), frac); /* Q16 for log() */ + /* ->Q17 for 1/2 log()*/ + + /*-------------------------------------------------------------------* + * predicted energy: * + * ~~~~~~~~~~~~~~~~~ * + * ener(Q24) = (Emean + sum{pred[i]*past_en[i]})/constant * + * = MEAN_ENER + sum(pred[i]*past_qua_en[i]) * + * constant = 20*Log10(2) * + *-------------------------------------------------------------------*/ + + ener = MEAN_ENER_MR122; move32 (); /* Q24 (Q17) */ + for (i = 0; i < NPRED; i++) + { + ener = L_mac (ener, st->past_qua_en_MR122[i], pred_MR122[i]); + /* Q10 * Q13 -> Q24 */ + /* Q10 * Q6 -> Q17 */ + } + + /*-------------------------------------------------------------------* + * predicted codebook gain * + * ~~~~~~~~~~~~~~~~~~~~~~~ * + * gc0 = Pow10( (ener*constant - ener_code*constant) / 20 ) * + * = Pow2(ener-ener_code) * + * = Pow2(int(d)+frac(d)) * + * * + * (store exp and frac for pow2()) * + *-------------------------------------------------------------------*/ + + ener = L_shr (L_sub (ener, ener_code), 1); /* Q16 */ + L_Extract(ener, exp_gcode0, frac_gcode0); + } + else /* all modes except 12.2 */ + { + Word32 L_tmp; + Word16 exp_code, gcode0; + + /*-----------------------------------------------------------------* + * Compute: means_ener - 10log10(ener_code/ L_sufr) * + *-----------------------------------------------------------------*/ + + exp_code = norm_l (ener_code); + ener_code = L_shl (ener_code, exp_code); + + /* Log2 = log2 + 27 */ + Log2_norm (ener_code, exp_code, &exp, &frac); + + /* fact = 10/log2(10) = 3.01 = 24660 Q13 */ + L_tmp = Mpy_32_16(exp, frac, -24660); /* Q0.Q15 * Q13 -> Q14 */ + + /* L_tmp = means_ener - 10log10(ener_code/L_SUBFR) + * = means_ener - 10log10(ener_code) + 10log10(L_SUBFR) + * = K - fact * Log2(ener_code) + * = K - fact * log2(ener_code) - fact*27 + * + * ==> K = means_ener + fact*27 + 10log10(L_SUBFR) + * + * means_ener = 33 = 540672 Q14 (MR475, MR515, MR59) + * means_ener = 28.75 = 471040 Q14 (MR67) + * means_ener = 30 = 491520 Q14 (MR74) + * means_ener = 36 = 589824 Q14 (MR795) + * means_ener = 33 = 540672 Q14 (MR102) + * 10log10(L_SUBFR) = 16.02 = 262481.51 Q14 + * fact * 27 = 1331640 Q14 + * ----------------------------------------- + * (MR475, MR515, MR59) K = 2134793.51 Q14 ~= 16678 * 64 * 2 + * (MR67) K = 2065161.51 Q14 ~= 32268 * 32 * 2 + * (MR74) K = 2085641.51 Q14 ~= 32588 * 32 * 2 + * (MR795) K = 2183945.51 Q14 ~= 17062 * 64 * 2 + * (MR102) K = 2134793.51 Q14 ~= 16678 * 64 * 2 + */ + + if (test (), sub (mode, MR102) == 0) + { + /* mean = 33 dB */ + L_tmp = L_mac(L_tmp, 16678, 64); /* Q14 */ + } + else if (test (), sub (mode, MR795) == 0) + { + /* ener_code = <xn xn> * 2^27*2^exp_code + frac_en = ener_code / 2^16 + = <xn xn> * 2^11*2^exp_code + <xn xn> = <xn xn>*2^11*2^exp * 2^exp_en + := frac_en * 2^exp_en + + ==> exp_en = -11-exp_code; + */ + *frac_en = extract_h (ener_code); move16 (); + *exp_en = sub (-11, exp_code); move16 (); + + /* mean = 36 dB */ + L_tmp = L_mac(L_tmp, 17062, 64); /* Q14 */ + } + else if (test (), sub (mode, MR74) == 0) + { + /* mean = 30 dB */ + L_tmp = L_mac(L_tmp, 32588, 32); /* Q14 */ + } + else if (test (), sub (mode, MR67) == 0) + { + /* mean = 28.75 dB */ + L_tmp = L_mac(L_tmp, 32268, 32); /* Q14 */ + } + else /* MR59, MR515, MR475 */ + { + /* mean = 33 dB */ + L_tmp = L_mac(L_tmp, 16678, 64); /* Q14 */ + } + + /*-----------------------------------------------------------------* + * Compute gcode0. * + * = Sum(i=0,3) pred[i]*past_qua_en[i] - ener_code + mean_ener * + *-----------------------------------------------------------------*/ + + L_tmp = L_shl(L_tmp, 10); /* Q24 */ + for (i = 0; i < 4; i++) + L_tmp = L_mac(L_tmp, pred[i], st->past_qua_en[i]); + /* Q13 * Q10 -> Q24 */ + + gcode0 = extract_h(L_tmp); /* Q8 */ + + /*-----------------------------------------------------------------* + * gcode0 = pow(10.0, gcode0/20) * + * = pow(2, 3.3219*gcode0/20) * + * = pow(2, 0.166*gcode0) * + *-----------------------------------------------------------------*/ + + /* 5439 Q15 = 0.165985 */ + /* (correct: 1/(20*log10(2)) 0.166096 = 5443 Q15) */ + test (); + if (sub (mode, MR74) == 0) /* For IS641 bitexactness */ + L_tmp = L_mult(gcode0, 5439); /* Q8 * Q15 -> Q24 */ + else + L_tmp = L_mult(gcode0, 5443); /* Q8 * Q15 -> Q24 */ + + L_tmp = L_shr(L_tmp, 8); /* -> Q16 */ + L_Extract(L_tmp, exp_gcode0, frac_gcode0); /* -> Q0.Q15 */ + } +} + + +/************************************************************************* + * + * FUNCTION: gc_pred_update() + * + * PURPOSE: update MA predictor with last quantized energy + * + *************************************************************************/ +void gc_pred_update( + gc_predState *st, /* i/o: State struct */ + Word16 qua_ener_MR122, /* i : quantized energy for update, Q10 */ + /* (log2(qua_err)) */ + Word16 qua_ener /* i : quantized energy for update, Q10 */ + /* (20*log10(qua_err)) */ +) +{ + Word16 i; + + for (i = 3; i > 0; i--) + { + st->past_qua_en[i] = st->past_qua_en[i - 1]; move16 (); + st->past_qua_en_MR122[i] = st->past_qua_en_MR122[i - 1]; move16 (); + } + + st->past_qua_en_MR122[0] = qua_ener_MR122; /* log2 (qua_err), Q10 */ + move16 (); + st->past_qua_en[0] = qua_ener; /* 20*log10(qua_err), Q10 */ + move16 (); +} + +/************************************************************************* + * + * FUNCTION: gc_pred_average_limited() + * + * PURPOSE: get average of MA predictor state values (with a lower limit) + * [used in error concealment] + * + *************************************************************************/ +void gc_pred_average_limited( + gc_predState *st, /* i: State struct */ + Word16 *ener_avg_MR122, /* o: everaged quantized energy, Q10 */ + /* (log2(qua_err)) */ + Word16 *ener_avg /* o: averaged quantized energy, Q10 */ + /* (20*log10(qua_err)) */ +) +{ + Word16 av_pred_en; + Word16 i; + + /* do average in MR122 mode (log2() domain) */ + av_pred_en = 0; move16 (); + for (i = 0; i < NPRED; i++) + { + av_pred_en = add (av_pred_en, st->past_qua_en_MR122[i]); + } + + /* av_pred_en = 0.25*av_pred_en */ + av_pred_en = mult (av_pred_en, 8192); + + /* if (av_pred_en < -14/(20Log10(2))) av_pred_en = .. */ + test (); + if (sub (av_pred_en, MIN_ENERGY_MR122) < 0) + { + av_pred_en = MIN_ENERGY_MR122; move16 (); + } + *ener_avg_MR122 = av_pred_en; move16 (); + + /* do average for other modes (20*log10() domain) */ + av_pred_en = 0; move16 (); + for (i = 0; i < NPRED; i++) + { + av_pred_en = add (av_pred_en, st->past_qua_en[i]); + } + + /* av_pred_en = 0.25*av_pred_en */ + av_pred_en = mult (av_pred_en, 8192); + + /* if (av_pred_en < -14) av_pred_en = .. */ + test (); + if (sub (av_pred_en, MIN_ENERGY) < 0) + { + av_pred_en = MIN_ENERGY; move16 (); + } + *ener_avg = av_pred_en; move16 (); +}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/libtwamr/gc_pred.h Thu Apr 18 23:02:35 2024 +0000 @@ -0,0 +1,114 @@ +/* +******************************************************************************** +* +* GSM AMR-NB speech codec R98 Version 7.6.0 December 12, 2001 +* R99 Version 3.3.0 +* REL-4 Version 4.1.0 +* +******************************************************************************** +* +* File : gc_pred.h +* Purpose : codebook gain MA prediction +* +******************************************************************************** +*/ + +#ifndef gc_pred_h +#define gc_pred_h "$Id $" + +/* +******************************************************************************** +* INCLUDE FILES +******************************************************************************** +*/ +#include "tw_amr.h" +#include "typedef.h" + +/* +******************************************************************************** +* LOCAL VARIABLES AND TABLES +******************************************************************************** +*/ + +/* +******************************************************************************** +* DEFINITION OF DATA TYPES +******************************************************************************** +*/ +typedef struct { + Word16 past_qua_en[4]; /* normal MA predictor memory, Q10 */ + /* (contains 20*log10(qua_err)) */ + Word16 past_qua_en_MR122[4]; /* MA predictor memory for MR122 mode, Q10 */ + /* (contains log2(qua_err)) */ +} gc_predState; + +/* +******************************************************************************** +* DECLARATION OF PROTOTYPES +******************************************************************************** +*/ + +void gc_pred_reset (gc_predState *st); +/* reset of codebook gain MA predictor state (i.e. set state memory to zero) + returns 0 on success + */ + +void +gc_pred_copy( + gc_predState *st_src, /* i : State struct */ + gc_predState *st_dest /* o : State struct */ +); + +/************************************************************************* + * + * FUNCTION: gc_pred() + * + * PURPOSE: MA prediction of the innovation energy + * (in dB/(20*log10(2))) with mean removed). + * + *************************************************************************/ +void gc_pred( + gc_predState *st, /* i/o: State struct */ + enum Mode mode, /* i : AMR mode */ + Word16 *code, /* i : innovative codebook vector (L_SUBFR) */ + /* MR122: Q12, other modes: Q13 */ + Word16 *exp_gcode0, /* o : exponent of predicted gain factor, Q0 */ + Word16 *frac_gcode0,/* o : fraction of predicted gain factor Q15 */ + Word16 *exp_en, /* o : exponent of innovation energy, Q0 */ + /* (only calculated for MR795) */ + Word16 *frac_en /* o : fraction of innovation energy, Q15 */ + /* (only calculated for MR795) */ +); + +/************************************************************************* + * + * FUNCTION: gc_pred_update() + * + * PURPOSE: update MA predictor with last quantized energy + * + *************************************************************************/ +void gc_pred_update( + gc_predState *st, /* i/o: State struct */ + Word16 qua_ener_MR122, /* i : quantized energy for update, Q10 */ + /* (log2(qua_err)) */ + Word16 qua_ener /* i : quantized energy for update, Q10 */ + /* (20*log10(qua_err)) */ +); + +/************************************************************************* + * + * FUNCTION: gc_pred_average_limited() + * + * PURPOSE: get average of MA predictor state values (with a lower limit) + * [used in error concealment] + * + *************************************************************************/ +void gc_pred_average_limited( + gc_predState *st, /* i: State struct */ + Word16 *ener_avg_MR122, /* o: averaged quantized energy, Q10 */ + /* (log2(qua_err)) */ + Word16 *ener_avg /* o: averaged quantized energy, Q10 */ + /* (20*log10(qua_err)) */ +); + +#endif
--- a/libtwamr/namespace.h Thu Apr 18 22:35:05 2024 +0000 +++ b/libtwamr/namespace.h Thu Apr 18 23:02:35 2024 +0000 @@ -115,4 +115,10 @@ #define dec_8i40_31bits AMR__dec_8i40_31bits #define dec_10i40_35bits AMR__dec_10i40_35bits +#define gc_pred AMR__gc_pred +#define gc_pred_copy AMR__gc_pred_copy +#define gc_pred_reset AMR__gc_pred_reset +#define gc_pred_update AMR__gc_pred_update +#define gc_pred_average_limited AMR__gc_pred_average_limited + #endif /* include guard */