gsmhr-codec-ref: err_conc.c annotate

annotate err_conc.c @ 3:a6db7d8d6df4

change compile-time quiet control to runtime, and suppress all noisy output

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sat, 15 Jun 2024 00:09:40 +0000
parents	9008dbc8ca74
children

rev	line source
0 9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /***************************************************************************
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 * File Name: err_conc.c
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * Purpose:
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * Contains all functions for error concealment.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 * Relevant specification: GSM 06.21
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 * Below is a listing of all the functions appearing in the file.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 * All functions are called within speechDecoder().
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 * Error concealment on parameter level:
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 * para_conceal_speech_decoder()
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 * Error concealment on signal level:
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 * signal_conceal_sub()
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 * Additional functions to support concealment:
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 * level_estimator()
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 * level_calc()
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 **************************************************************************/
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 \| Include Files \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include "mathhalf.h"
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include "sp_dec.h"
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include "err_conc.h"
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 \| Local Defines \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #define MIN_MUTE_LEVEL -45
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 \| State variables (globals) \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 Longword plSubfrEnergyMem[4];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 Shortword swLevelMem[4],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 lastR0,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 pswLastGood[18],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 swState,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 swLastFlag;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 /*****************************************************************************
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 * FUNCTION NAME: para_conceal_speech_decoder
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 * This subroutine performs concealment on parameter level. If the
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 * badframe flag (swErrorFlag[0]) has been set in the channel decoder
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 * parameter repetition is performed.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 * If the average frame energy R0 shows an abnormal increase between two
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 * subsequent frames the badframe flag is also set and parameter
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 * repetition is performed.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 * If R0 shows an important increase muting is permitted in the signal
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 * concealment unit. There the level of the synthesized speech signal is
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 * controlled and corrected if necessary.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 * In table "psrR0RepeatThreshold[]" the maximum allowed
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 * increase of R0 for badframe setting is stored. The table
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 * is controlled by the value of R0 of the last frame.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 * If e.g. the previous R0 is 10 the allowed maximum increase
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 * is 9 (psrR0RepeatThreshold[10]).
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 * The figures in psrR0RepeatThreshold[] have been determined
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 * by measuring the R0 statistics of an error free speech
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 * signal. In approximately 95 % of the frames the increase of
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 * R0 is less than the defined figures for error free speech.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 * If the level increase is higher than the determined limit
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 * then the badframe flag is set.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 * In table "psrR0MuteThreshold[]" the maximum allowed
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 * increase of R0 for muting is stored.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 * The table is controlled by the value of R0 of the last frame
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 * If e.g. the previous R0 is 10 the allowed maximum increase
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 * is 7 (psrR0MuteThreshold[10]).
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 * The figures in psrR0MuteThreshold[] have been determined
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 * by measuring the R0 statistics of an error free speech
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 * signal. In approximately 85 % of the frames the increase of
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 * R0 is less than the defined figures for error free speech.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 * If the level increase is higher than the determined limit
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 * then muting is allowed.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 * Input: pswErrorFlag[0] badframe flag from channel decoder
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 * pswErrorFlag[1] unreliable frame flag from channel decoder
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 * pswSpeechPara[] unconcealed speech parameters
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 * Output: pswSpeechPara[] concealed speech parameters
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 * swMutePermit flag, indicating whether muting is
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 * permitted
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 * Constants: psrR0RepeatThreshold[32] maximum allowed R0 difference
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 * before frame is repeated
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 * psrR0MuteThreshold[32] maximum allowed R0 difference
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 * before muting is permitted
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 ****************************************************************************/
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 void para_conceal_speech_decoder(Shortword pswErrorFlag[],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 Shortword pswSpeechPara[], Shortword *pswMutePermit)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 \| Local Static Variables \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 static const Shortword psrR0RepeatThreshold[32] =
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 {15, 15, 15, 12, 12, 12, 12, 11,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 10, 10, 9, 9, 9, 9, 8, 8,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 7, 6, 5, 5, 5, 4, 4, 3,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 2, 2, 2, 2, 2, 2, 10, 10};
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 static const Shortword psrR0MuteThreshold[32] =
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 {14, 12, 11, 9, 9, 9, 9, 7,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 7, 7, 7, 7, 6, 6, 6, 5,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 5, 4, 3, 3, 3, 3, 3, 2,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 1, 1, 1, 1, 1, 1, 10, 10};
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 \| Automatic Variables \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 Shortword swLastLag,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 swR0,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 swLag,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 r0_diff,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 i;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 \| Executable Code \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 /* Initialise mute permission flag */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 /* ------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 *pswMutePermit = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 /* Determine R0-difference to last frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 /* ------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 r0_diff = sub(pswSpeechPara[0], lastR0);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 /* If no badframe has been declared, but the frame is unreliable then */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 /* check whether there is an abnormal increase of R0 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 /* ------------------------------------------------------------------ */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 if ((pswErrorFlag[0] == 0) && (pswErrorFlag[1] > 0))
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 /* Check if difference exceeds the maximum allowed threshold. */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 /* If yes, set badframe flag */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 /* ---------------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 if (sub(r0_diff, psrR0RepeatThreshold[lastR0]) >= 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 pswErrorFlag[0] = 1;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 /* Allow muting if R0 >= 30 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 /* ------------------------ */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 if (sub(pswSpeechPara[0], 30) >= 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 *pswMutePermit = 1;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 /* If no badframe has been declared, but the frame is unreliable then */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 /* check whether there is an important increase of R0 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 /* ------------------------------------------------------------------ */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 if ((pswErrorFlag[1] > 0) && (pswErrorFlag[0] == 0))
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 /* Check if difference exceeds a threshold. */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 /* If yes, allow muting in the signal concealment unit */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 /* ---------------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 if (sub(r0_diff, psrR0MuteThreshold[lastR0]) >= 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 *pswMutePermit = 1;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 /* Perform parameter repetition, if necessary (badframe handling) */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 /* -------------------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 if (pswErrorFlag[0] > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 swState = add(swState, 1); /* update the bad frame
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 * masking state */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 if (sub(swState, 6) > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 swState = 6;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 if (sub(swState, 6) < 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 swState = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 else if (swLastFlag == 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 swState = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 swLastFlag = pswErrorFlag[0];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 /* if the decoded frame is good, save it */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 /* ------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 if (swState == 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 for (i = 0; i < 18; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 pswLastGood[i] = pswSpeechPara[i];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 /* if the frame is bad, attenuate and repeat last good frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 /* --------------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 if ((sub(swState, 3) >= 0) && (sub(swState, 5) <= 0))
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 swR0 = sub(pswLastGood[0], 2); /* attenuate by 4 dB */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 if (swR0 < 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 swR0 = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 pswLastGood[0] = swR0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 if (sub(swState, 6) >= 0) /* mute */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 pswLastGood[0] = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 /* If the last good frame is unvoiced, use its energy, voicing mode, lpc
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 * coefficients, and soft interpolation. For gsp0, use only the gsp0
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 * value from the last good subframe. If the current bad frame is
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 * unvoiced, use the current codewords. If not, use the codewords from
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 * the last good frame. */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 /* -------------------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 if (pswLastGood[5] == 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 { /* unvoiced good frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 if (pswSpeechPara[5] == 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 { /* unvoiced bad frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 for (i = 0; i < 5; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 pswSpeechPara[i] = pswLastGood[i];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 for (i = 0; i < 4; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 pswSpeechPara[3 * i + 8] = pswLastGood[17];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 { /* voiced bad frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 for (i = 0; i < 18; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 pswSpeechPara[i] = pswLastGood[i];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 for (i = 0; i < 3; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 pswSpeechPara[3 * i + 8] = pswLastGood[17];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 /* If the last good frame is voiced, the long term predictor lag at the
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 * last subframe is used for all subsequent subframes. Use the last good
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 * frame's energy, voicing mode, lpc coefficients, and soft
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 * interpolation. For gsp0 in all subframes, use the gsp0 value from the
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 * last good subframe. If the current bad frame is voiced, use the
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 * current codewords. If not, use the codewords from the last good
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 * frame. */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 /* ---------------------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 { /* voiced good frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 swLastLag = pswLastGood[6]; /* frame lag */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 for (i = 0; i < 3; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 { /* each delta lag */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 swLag = sub(pswLastGood[3 * i + 9], 0x8); /* biased around 0 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 swLag = add(swLag, swLastLag); /* reconstruct pitch */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 if (sub(swLag, 0x00ff) > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 { /* limit, as needed */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 swLastLag = 0x00ff;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 else if (swLag < 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 swLastLag = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 swLastLag = swLag;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 pswLastGood[6] = swLastLag; /* saved frame lag */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 pswLastGood[9] = 0x8; /* saved delta lags */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 pswLastGood[12] = 0x8;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 pswLastGood[15] = 0x8;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 if (pswSpeechPara[5] != 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 { /* voiced bad frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 for (i = 0; i < 6; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 pswSpeechPara[i] = pswLastGood[i];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 for (i = 0; i < 4; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 pswSpeechPara[3 * i + 6] = pswLastGood[3 * i + 6];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 for (i = 0; i < 4; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 pswSpeechPara[3 * i + 8] = pswLastGood[17];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 { /* unvoiced bad frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 for (i = 0; i < 18; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 pswSpeechPara[i] = pswLastGood[i];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 for (i = 0; i < 3; i++)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 pswSpeechPara[3 * i + 8] = pswLastGood[17];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 } /* end of bad frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 /* Update last value of R0 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 /* ----------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 lastR0 = pswSpeechPara[0];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 /****************************************************************************
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 * FUNCTION NAME: level_estimator
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 * This subroutine determines the mean level and the maximum level
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 * of the last four speech sub-frames. These parameters are the basis
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 * for the level estimation in signal_conceal_sub().
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 * Input: swUpdate = 0: the levels are determined
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 * = 1: the memory of the level estimator
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 * is updated
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 * pswDecodedSpeechFrame[] synthesized speech signal
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 * Output: swLevelMean mean level of the last 4 sub-frames
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 * swLevelMax maximum level of the last 4 sub-frames
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 ***************************************************************************/
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 void level_estimator(Shortword update, Shortword *pswLevelMean,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 Shortword *pswLevelMax,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 Shortword pswDecodedSpeechFrame[])
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 \| Automatic Variables \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 Shortword i,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 tmp,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 swLevelSub;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 Longword L_sum;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 \| Executable Code \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 if (update == 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 /* Determine mean level of the last 4 sub-frames: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 /* ---------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 for (i = 0, L_sum = 0; i < 4; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 L_sum = L_add(L_sum, plSubfrEnergyMem[i]);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 *pswLevelMean = level_calc(1, &L_sum);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 /* Determine maximum level of the last 4 sub-frames: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 /* ------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 *pswLevelMax = -72;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 for (i = 0; i < 4; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 if (sub(swLevelMem[i], *pswLevelMax) > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 *pswLevelMax = swLevelMem[i];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 /* Determine the energy of the synthesized speech signal: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 /* ------------------------------------------------------ */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 for (i = 0, L_sum = 0; i < S_LEN; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 tmp = shr(pswDecodedSpeechFrame[i], 3);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 L_sum = L_mac(L_sum, tmp, tmp);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 swLevelSub = level_calc(0, &L_sum);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 /* Update memories of level estimator: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 /* ----------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 for (i = 0; i < 3; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 plSubfrEnergyMem[i] = plSubfrEnergyMem[i + 1];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 plSubfrEnergyMem[3] = L_sum;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 for (i = 0; i < 3; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 swLevelMem[i] = swLevelMem[i + 1];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 swLevelMem[3] = swLevelSub;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 /*****************************************************************************
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 * FUNCTION NAME: signal_conceal_sub
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 * This subroutine performs concealment on subframe signal level.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 * A test synthesis is performed and the level of the synthesized speech
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 * signal is compared to the estimated level. Depending on the control
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 * flag "swMutePermit" a muting factor is determined.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 * If muting is permitted (swMutePermit=1) and the actual sub-frame level
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 * exceeds the maximum level of the last four sub-frames "swLevelMax" plus
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 * an allowed increase "psrLevelMaxIncrease[]" then the synthesized speech
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 * signal together with the signal memories is muted.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 * In table "psrLevelMaxIncrease[]" the maximum allowed increase
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 * of the maximum sub-frame level is stored. The table is controled by the
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 * mean level "swMeanLevel".
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 * If e.g. the level is in the range between -30 and -35 db
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 * the allowed maximum increase is 4 db (psrLevelMaxIncrease[6]).
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 * The figures in psrLevelMaxIncrease[] have been determined
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 * by measuring the level statistics of error free synthesized speech.
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 * Input: pswPPFExcit[] excitation signal
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 * pswSynthFiltState[] state of LPC synthesis filter
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 * ppswSynthAs[] LPC coefficients
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 * pswLtpStateOut[] state of long term predictor
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 * pswPPreState[] state of pitch prefilter
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 * swLevelMean mean level
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 * swLevelMax maximum level
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 * swUFI unreliable frame flag
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 * swMuteFlagOld last muting flag
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 * pswMuteFlag actual muting flag
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 * swMutePermit mute permission
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 * Output: pswPPFExcit[] muted excitation signal
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 * pswSynthFiltState[] muted state of LPC synthesis filter
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 * pswLtpStateOut[] muted state of long term predictor
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 * pswPPreState[] muted state of pitch prefilter
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 * Constants: psrConceal[0:15] muting factors
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 * psrLevelMaxIncrease[0:7] maximum allowed level increase
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 ****************************************************************************/
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 void signal_conceal_sub(Shortword pswPPFExcit[],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 Shortword ppswSynthAs[], Shortword pswSynthFiltState[],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 Shortword pswLtpStateOut[], Shortword pswPPreState[],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 Shortword swLevelMean, Shortword swLevelMax,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 Shortword swUFI, Shortword swMuteFlagOld,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 Shortword *pswMuteFlag, Shortword swMutePermit)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 \| Local Static Variables \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 static const Shortword psrConceal[15] = {29205, 27571, 24573, 21900,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 19519, 17396, 15504, 13818, 12315, 10976, 9783, 8719, 7771, 6925, 6172};
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 static const Shortword psrLevelMaxIncrease[16] =
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 {0, 0, 1, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 12, 14, 16};
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 \| Automatic Variables \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 Shortword swMute,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 swLevelSub,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 i,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 swIndex;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 Shortword swTmp,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 pswStateTmp[10],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 swOutTmp[40],
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 swPermitMuteSub;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 Longword L_sum;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 \| Executable Code \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 /* Test synthesis filter: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 /* ---------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 for (i = 0; i < 10; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 pswStateTmp[i] = pswSynthFiltState[i];
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 lpcIir(pswPPFExcit, ppswSynthAs, pswStateTmp, swOutTmp);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 /* Determine level in db of synthesized signal: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 /* -------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 L_sum = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 for (i = 0; i < S_LEN; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 swTmp = shr(swOutTmp[i], 2);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 L_sum = L_mac(L_sum, swTmp, swTmp);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 swLevelSub = level_calc(0, &L_sum);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 /* Determine index to table, specifying the allowed level increase: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 /* level [ 0 .. -5] --> swIndex = 0 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 /* level [-5 .. -10] --> swIndex = 1 etc. */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 /---------------------------------------------/
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 swIndex = mult(negate(swLevelMean), 1638);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 if (sub(swIndex, 15) > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 swIndex = 15;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 /* Muting is permitted, if it is signalled from the parameter concealment */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 /* unit or if muting has been performed in the last frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 /-----------------------------------------------------------------------/
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 swPermitMuteSub = swMutePermit;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516 if (swMuteFlagOld > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 swPermitMuteSub = 1;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 if (swPermitMuteSub > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 /* Muting is not permitted if the sub-frame level is less than */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 /* MIN_MUTE_LEVEL */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 /* ------------------------------------------------------------ */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 if (sub(swLevelSub, MIN_MUTE_LEVEL) <= 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 swPermitMuteSub = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 /* Muting is not permitted if the sub-frame level is less than */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 /* the maximum level of the last 4 sub-frames plus the allowed */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 /* increase */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 /* ------------------------------------------------------------ */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 swMute = sub(swLevelSub, add(swLevelMax, psrLevelMaxIncrease[swIndex]));
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 if (swMute <= 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 swPermitMuteSub = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 /* Perform muting, if allowed */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 /* -------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 if (swPermitMuteSub > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 if (sub(swMute, (Shortword) 15) > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 swMute = 15;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545 /* Keep information that muting occured for next frame */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 /* --------------------------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 if (swUFI > 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 *pswMuteFlag = 1;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 /* Mute excitation signal: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 /* ----------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 for (i = 0; i < 10; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 pswSynthFiltState[i] =
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 mult_r(pswSynthFiltState[i], psrConceal[swMute - 1]);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556 for (i = 0; i < S_LEN; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 pswPPFExcit[i] = mult_r(pswPPFExcit[i], psrConceal[swMute - 1]);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 /* Mute pitch memory: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 /* ------------------ */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 for (i = 0; i < S_LEN; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 pswLtpStateOut[i] =
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 mult_r(pswLtpStateOut[i], psrConceal[swMute - 1]);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 /* Mute pitch prefilter memory: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 /* ---------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 for (i = 0; i < S_LEN; ++i)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 pswPPreState[i] = mult_r(pswPPreState[i], psrConceal[swMute - 1]);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 /****************************************************************************
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 * FUNCTION NAME: level_calc
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 * This subroutine calculates the level (db) from the energy
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 * of a speech sub-frame (swInd=0) or a speech frame (swInd=1):
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 * The level of a speech subframe is:
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 * swLevel = 10 * lg(EN/(40.40964096))
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 * = 3 * ld(EN) - 88.27
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 * = (34ld(EN) - 353)/4
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 * = (3(4POS(MSB(EN)) + 2*BIT(MSB-1) + BIT(MSB-2)) - 353)/4
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 * Input: pl_en energy of the speech subframe or frame
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 * The energy is multiplied by 2 because of the
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 * MAC routines !!
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 * swInd = 0: EN is the energy of one subframe
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 * = 1: EN is the energy of one frame
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 * Output: swLevel level in db
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 *
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 ***************************************************************************/
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 Shortword level_calc(Shortword swInd, Longword *pl_en)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602 \| Automatic Variables \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 Shortword swPos,
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 swLevel;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 Longword L_tmp;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 /*_________________________________________________________________________
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 \| \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 \| Executable Code \|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 \|_________________________________________________________________________\|
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 if (*pl_en != 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 swPos = sub((Shortword) 29, norm_l(*pl_en));
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 else
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618 swPos = 0;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 /* Determine the term: 4POS(MSB(EN)): /
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621 /* ----------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 swLevel = shl(swPos, 2);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 /* Determine the term: 2BIT(MSB-1): /
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625 /* --------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 if (swPos >= 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 L_tmp = L_shl((Longword) 1, swPos);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 if ((*pl_en & L_tmp) != 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 swLevel += 2;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 /* Determine the term: BIT(MSB-2): */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634 /* ------------------------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 if (--swPos >= 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 L_tmp = L_shl((Longword) 1, swPos);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638 if ((*pl_en & L_tmp) != 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 ++swLevel;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 /* Multiply by 3: */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 /* -------------- */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644 swLevel += shl(swLevel, 1);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 swLevel -= (swInd == 0) ? 353 : 377;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 swLevel = mult_r(swLevel, 0X2000); /* >> 2 */
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 if (sub(swLevel, -72) < 0)
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649 {
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650 swLevel = -72;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 *pl_en = (swInd == 0) ? 80 : 320;
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 }
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654 return (swLevel);
9008dbc8ca74 import original C code from GSM 06.06 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 }

FreeCalypso > hg > gsmhr-codec-ref

annotate err_conc.c @ 3:a6db7d8d6df4