Mercurial > hg > audiostuff
comparison intercom/ilbc/getCBvec.c @ 2:13be24d74cd2
import intercom-0.4.1
author | Peter Meerwald <pmeerw@cosy.sbg.ac.at> |
---|---|
date | Fri, 25 Jun 2010 09:57:52 +0200 |
parents | |
children |
comparison
equal
deleted
inserted
replaced
1:9cadc470e3da | 2:13be24d74cd2 |
---|---|
1 | |
2 /****************************************************************** | |
3 | |
4 iLBC Speech Coder ANSI-C Source Code | |
5 | |
6 getCBvec.c | |
7 | |
8 Copyright (C) The Internet Society (2004). | |
9 All Rights Reserved. | |
10 | |
11 ******************************************************************/ | |
12 | |
13 #include "iLBC_define.h" | |
14 #include "constants.h" | |
15 #include <string.h> | |
16 | |
17 /*----------------------------------------------------------------* | |
18 * Construct codebook vector for given index. | |
19 *---------------------------------------------------------------*/ | |
20 | |
21 void getCBvec(float *cbvec, /* (o) Constructed codebook vector */ | |
22 float *mem, /* (i) Codebook buffer */ | |
23 int index, /* (i) Codebook index */ | |
24 int lMem, /* (i) Length of codebook buffer */ | |
25 int cbveclen /* (i) Codebook vector length */ | |
26 ) | |
27 { | |
28 int j, k, n, memInd, sFilt; | |
29 float tmpbuf[CB_MEML]; | |
30 int base_size; | |
31 int ilow, ihigh; | |
32 float alfa, alfa1; | |
33 | |
34 /* Determine size of codebook sections */ | |
35 | |
36 base_size = lMem - cbveclen + 1; | |
37 | |
38 if (cbveclen == SUBL) { | |
39 base_size += cbveclen / 2; | |
40 } | |
41 | |
42 /* No filter -> First codebook section */ | |
43 | |
44 if (index < lMem - cbveclen + 1) { | |
45 | |
46 /* first non-interpolated vectors */ | |
47 | |
48 k = index + cbveclen; | |
49 /* get vector */ | |
50 memcpy(cbvec, mem + lMem - k, cbveclen * sizeof(float)); | |
51 | |
52 } else if (index < base_size) { | |
53 | |
54 k = 2 * (index - (lMem - cbveclen + 1)) + cbveclen; | |
55 | |
56 ihigh = k / 2; | |
57 ilow = ihigh - 5; | |
58 | |
59 /* Copy first noninterpolated part */ | |
60 | |
61 memcpy(cbvec, mem + lMem - k / 2, ilow * sizeof(float)); | |
62 | |
63 /* interpolation */ | |
64 | |
65 alfa1 = (float) 0.2; | |
66 alfa = 0.0; | |
67 for (j = ilow; j < ihigh; j++) { | |
68 cbvec[j] = ((float) 1.0 - alfa) * mem[lMem - k / 2 + j] + | |
69 alfa * mem[lMem - k + j]; | |
70 | |
71 | |
72 | |
73 | |
74 | |
75 alfa += alfa1; | |
76 } | |
77 | |
78 /* Copy second noninterpolated part */ | |
79 | |
80 memcpy(cbvec + ihigh, mem + lMem - k + ihigh, | |
81 (cbveclen - ihigh) * sizeof(float)); | |
82 | |
83 } | |
84 | |
85 /* Higher codebook section based on filtering */ | |
86 | |
87 else { | |
88 | |
89 /* first non-interpolated vectors */ | |
90 | |
91 if (index - base_size < lMem - cbveclen + 1) { | |
92 float tempbuff2[CB_MEML + CB_FILTERLEN + 1]; | |
93 float *pos; | |
94 float *pp, *pp1; | |
95 | |
96 memset(tempbuff2, 0, CB_HALFFILTERLEN * sizeof(float)); | |
97 memcpy(&tempbuff2[CB_HALFFILTERLEN], mem, lMem * sizeof(float)); | |
98 memset(&tempbuff2[lMem + CB_HALFFILTERLEN], 0, | |
99 (CB_HALFFILTERLEN + 1) * sizeof(float)); | |
100 | |
101 k = index - base_size + cbveclen; | |
102 sFilt = lMem - k; | |
103 memInd = sFilt + 1 - CB_HALFFILTERLEN; | |
104 | |
105 /* do filtering */ | |
106 pos = cbvec; | |
107 memset(pos, 0, cbveclen * sizeof(float)); | |
108 for (n = 0; n < cbveclen; n++) { | |
109 pp = &tempbuff2[memInd + n + CB_HALFFILTERLEN]; | |
110 pp1 = &cbfiltersTbl[CB_FILTERLEN - 1]; | |
111 for (j = 0; j < CB_FILTERLEN; j++) { | |
112 (*pos) += (*pp++) * (*pp1--); | |
113 } | |
114 pos++; | |
115 } | |
116 } | |
117 | |
118 /* interpolated vectors */ | |
119 | |
120 else { | |
121 | |
122 | |
123 | |
124 | |
125 | |
126 float tempbuff2[CB_MEML + CB_FILTERLEN + 1]; | |
127 | |
128 float *pos; | |
129 float *pp, *pp1; | |
130 int i; | |
131 | |
132 memset(tempbuff2, 0, CB_HALFFILTERLEN * sizeof(float)); | |
133 memcpy(&tempbuff2[CB_HALFFILTERLEN], mem, lMem * sizeof(float)); | |
134 memset(&tempbuff2[lMem + CB_HALFFILTERLEN], 0, | |
135 (CB_HALFFILTERLEN + 1) * sizeof(float)); | |
136 | |
137 k = 2 * (index - base_size - (lMem - cbveclen + 1)) + cbveclen; | |
138 sFilt = lMem - k; | |
139 memInd = sFilt + 1 - CB_HALFFILTERLEN; | |
140 | |
141 /* do filtering */ | |
142 pos = &tmpbuf[sFilt]; | |
143 memset(pos, 0, k * sizeof(float)); | |
144 for (i = 0; i < k; i++) { | |
145 pp = &tempbuff2[memInd + i + CB_HALFFILTERLEN]; | |
146 pp1 = &cbfiltersTbl[CB_FILTERLEN - 1]; | |
147 for (j = 0; j < CB_FILTERLEN; j++) { | |
148 (*pos) += (*pp++) * (*pp1--); | |
149 } | |
150 pos++; | |
151 } | |
152 | |
153 ihigh = k / 2; | |
154 ilow = ihigh - 5; | |
155 | |
156 /* Copy first noninterpolated part */ | |
157 | |
158 memcpy(cbvec, tmpbuf + lMem - k / 2, ilow * sizeof(float)); | |
159 | |
160 /* interpolation */ | |
161 | |
162 alfa1 = (float) 0.2; | |
163 alfa = 0.0; | |
164 for (j = ilow; j < ihigh; j++) { | |
165 cbvec[j] = ((float) 1.0 - alfa) * | |
166 tmpbuf[lMem - k / 2 + j] + alfa * tmpbuf[lMem - k + j]; | |
167 alfa += alfa1; | |
168 } | |
169 | |
170 | |
171 | |
172 | |
173 | |
174 | |
175 /* Copy second noninterpolated part */ | |
176 | |
177 memcpy(cbvec + ihigh, tmpbuf + lMem - k + ihigh, | |
178 (cbveclen - ihigh) * sizeof(float)); | |
179 } | |
180 } | |
181 } |