FreeCalypso > hg > gsm-codec-lib

annotate libtwamr/cor_h.c @ 585:3c6bf0d26ee7 default tip

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
TW-TS-005 reader: fix maximum line length bug TW-TS-005 section 4.1 states: The maximum allowed length of each line is 80 characters, not including the OS-specific newline encoding. The implementation of this line length limit in the TW-TS-005 hex file reader function in the present suite was wrong, such that lines of the full maximum length could not be read. Fix it. Note that this bug affects comment lines too, not just actual RTP payloads. Neither Annex A nor Annex B features an RTP payload format that goes to the maximum of 40 bytes, but if a comment line goes to the maximum allowed length of 80 characters not including the terminating newline, the bug will be triggered, necessitating the present fix.
author Mychaela Falconia <falcon@freecalypso.org>
date Tue, 25 Feb 2025 07:49:28 +0000
parents 5401aaf7acb0
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
315
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
2 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
4 * GSM AMR-NB speech codec R98 Version 7.6.0 December 12, 2001
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
5 * R99 Version 3.3.0
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
6 * REL-4 Version 4.1.0
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
7 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
8 ******************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
9 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
10 * File : cor_h.c
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 * Purpose : correlation functions for codebook search
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
12 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14 */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15 /*
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
16 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
17 * MODULE INCLUDE FILE AND VERSION ID
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
18 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
19 */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
20 #include "namespace.h"
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
21 #include "cor_h.h"
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
22 /*
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
23 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
24 * INCLUDE FILES
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
25 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
26 */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
27 #include "typedef.h"
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
28 #include "basic_op.h"
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
29 #include "no_count.h"
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
30 #include "inv_sqrt.h"
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
31 #include "cnst.h"
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
32
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
33 /*
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
34 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
35 * PUBLIC PROGRAM CODE
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
36 *****************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
37 */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
38 /*************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
39 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
40 * FUNCTION: cor_h_x()
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
41 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
42 * PURPOSE: Computes correlation between target signal "x[]" and
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
43 * impulse response"h[]".
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
44 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
45 * DESCRIPTION:
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
46 * The correlation is given by:
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
47 * d[n] = sum_{i=n}^{L-1} x[i] h[i-n] n=0,...,L-1
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
48 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
49 * d[n] is normalized such that the sum of 5 maxima of d[n] corresponding
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
50 * to each position track does not saturate.
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
51 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
52 *************************************************************************/
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
53 void cor_h_x (
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
54 Word16 h[], /* (i): impulse response of weighted synthesis filter */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
55 Word16 x[], /* (i): target */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
56 Word16 dn[], /* (o): correlation between target and h[] */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
57 Word16 sf /* (i): scaling factor: 2 for 12.2, 1 for others */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
58 )
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
59 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
60 cor_h_x2(h, x, dn, sf, NB_TRACK, STEP);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
61 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
62
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
63 /*************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
64 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
65 * FUNCTION: cor_h_x2()
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
66 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
67 * PURPOSE: Computes correlation between target signal "x[]" and
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
68 * impulse response"h[]".
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
69 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
70 * DESCRIPTION:
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
71 * See cor_h_x, d[n] can be normalized regards to sum of the
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
72 * five MR122 maxima or the four MR102 maxima.
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
73 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
74 *************************************************************************/
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
75 void cor_h_x2 (
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
76 Word16 h[], /* (i): impulse response of weighted synthesis filter */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
77 Word16 x[], /* (i): target */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
78 Word16 dn[], /* (o): correlation between target and h[] */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
79 Word16 sf, /* (i): scaling factor: 2 for 12.2, 1 for others */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
80 Word16 nb_track,/* (i): the number of ACB tracks */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
81 Word16 step /* (i): step size from one pulse position to the next
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
82 in one track */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
83 )
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
84 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
85 Word16 i, j, k;
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
86 Word32 s, y32[L_CODE], max, tot;
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
87
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
88 /* first keep the result on 32 bits and find absolute maximum */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
89
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
90 tot = 5; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
91
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
92 for (k = 0; k < nb_track; k++)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
93 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
94 max = 0; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
95 for (i = k; i < L_CODE; i += step)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
96 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
97 s = 0; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
98 for (j = i; j < L_CODE; j++)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
99 s = L_mac (s, x[j], h[j - i]);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
100
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
101 y32[i] = s; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
102
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
103 s = L_abs (s);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
104 test ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
105 if (L_sub (s, max) > (Word32) 0L)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
106 max = s; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
107 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
108 tot = L_add (tot, L_shr (max, 1));
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
109 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
110
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
111 j = sub (norm_l (tot), sf);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
112
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
113 for (i = 0; i < L_CODE; i++)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
114 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
115 dn[i] = round (L_shl (y32[i], j)); move16 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
116 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
117 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
118
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
119 /*************************************************************************
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
120 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
121 * FUNCTION: cor_h()
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
122 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
123 * PURPOSE: Computes correlations of h[] needed for the codebook search;
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
124 * and includes the sign information into the correlations.
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
125 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
126 * DESCRIPTION: The correlations are given by
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
127 * rr[i][j] = sum_{n=i}^{L-1} h[n-i] h[n-j]; i>=j; i,j=0,...,L-1
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
128 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
129 * and the sign information is included by
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
130 * rr[i][j] = rr[i][j]*sign[i]*sign[j]
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
131 *
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
132 *************************************************************************/
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
133
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
134 void cor_h (
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
135 Word16 h[], /* (i) : impulse response of weighted synthesis
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
136 filter */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
137 Word16 sign[], /* (i) : sign of d[n] */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
138 Word16 rr[][L_CODE] /* (o) : matrix of autocorrelation */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
139 )
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
140 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
141 Word16 i, j, k, dec, h2[L_CODE];
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
142 Word32 s;
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
143
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
144 /* Scaling for maximum precision */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
145
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
146 s = 2; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
147 for (i = 0; i < L_CODE; i++)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
148 s = L_mac (s, h[i], h[i]);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
149
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
150 j = sub (extract_h (s), 32767);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
151 test ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
152 if (j == 0)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
153 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
154 for (i = 0; i < L_CODE; i++)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
155 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
156 h2[i] = shr (h[i], 1); move16 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
157 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
158 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
159 else
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
160 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
161 s = L_shr (s, 1);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
162 k = extract_h (L_shl (Inv_sqrt (s), 7));
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
163 k = mult (k, 32440); /* k = 0.99*k */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
164
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
165 for (i = 0; i < L_CODE; i++)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
166 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
167 h2[i] = round (L_shl (L_mult (h[i], k), 9));
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
168 move16 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
169 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
170 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
171
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
172 /* build matrix rr[] */
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
173 s = 0; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
174 i = L_CODE - 1;
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
175 for (k = 0; k < L_CODE; k++, i--)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
176 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
177 s = L_mac (s, h2[k], h2[k]);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
178 rr[i][i] = round (s); move16 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
179 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
180
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
181 for (dec = 1; dec < L_CODE; dec++)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
182 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
183 s = 0; move32 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
184 j = L_CODE - 1;
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
185 i = sub (j, dec);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
186 for (k = 0; k < (L_CODE - dec); k++, i--, j--)
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
187 {
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
188 s = L_mac (s, h2[k], h2[k + dec]);
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
189 rr[j][i] = mult (round (s), mult (sign[i], sign[j]));
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
190 move16 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
191 rr[i][j] = rr[j][i]; move16 ();
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
192 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
193 }
5401aaf7acb0 libtwamr: integrate cor_h.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
194 }