|
1 /******************************************************************** |
|
2 * * |
|
3 * THIS FILE IS PART OF THE OggVorbis SOFTWARE CODEC SOURCE CODE. * |
|
4 * USE, DISTRIBUTION AND REPRODUCTION OF THIS LIBRARY SOURCE IS * |
|
5 * GOVERNED BY A BSD-STYLE SOURCE LICENSE INCLUDED WITH THIS SOURCE * |
|
6 * IN 'COPYING'. PLEASE READ THESE TERMS BEFORE DISTRIBUTING. * |
|
7 * * |
|
8 * THE OggVorbis SOURCE CODE IS (C) COPYRIGHT 1994-2010 * |
|
9 * by the Xiph.Org Foundation http://www.xiph.org/ * |
|
10 * * |
|
11 ******************************************************************** |
|
12 |
|
13 function: channel mapping 0 implementation |
|
14 last mod: $Id: mapping0.c 17022 2010-03-25 03:45:42Z xiphmont $ |
|
15 |
|
16 ********************************************************************/ |
|
17 |
|
18 #include <stdlib.h> |
|
19 #include <stdio.h> |
|
20 #include <string.h> |
|
21 #include <math.h> |
|
22 #include <ogg/ogg.h> |
|
23 #include "vorbis/codec.h" |
|
24 #include "codec_internal.h" |
|
25 #include "codebook.h" |
|
26 #include "window.h" |
|
27 #include "registry.h" |
|
28 #include "psy.h" |
|
29 #include "misc.h" |
|
30 |
|
31 /* simplistic, wasteful way of doing this (unique lookup for each |
|
32 mode/submapping); there should be a central repository for |
|
33 identical lookups. That will require minor work, so I'm putting it |
|
34 off as low priority. |
|
35 |
|
36 Why a lookup for each backend in a given mode? Because the |
|
37 blocksize is set by the mode, and low backend lookups may require |
|
38 parameters from other areas of the mode/mapping */ |
|
39 |
|
40 static void mapping0_free_info(vorbis_info_mapping *i){ |
|
41 vorbis_info_mapping0 *info=(vorbis_info_mapping0 *)i; |
|
42 if(info){ |
|
43 memset(info,0,sizeof(*info)); |
|
44 _ogg_free(info); |
|
45 } |
|
46 } |
|
47 |
|
48 static int ilog(unsigned int v){ |
|
49 int ret=0; |
|
50 if(v)--v; |
|
51 while(v){ |
|
52 ret++; |
|
53 v>>=1; |
|
54 } |
|
55 return(ret); |
|
56 } |
|
57 |
|
58 static void mapping0_pack(vorbis_info *vi,vorbis_info_mapping *vm, |
|
59 oggpack_buffer *opb){ |
|
60 int i; |
|
61 vorbis_info_mapping0 *info=(vorbis_info_mapping0 *)vm; |
|
62 |
|
63 /* another 'we meant to do it this way' hack... up to beta 4, we |
|
64 packed 4 binary zeros here to signify one submapping in use. We |
|
65 now redefine that to mean four bitflags that indicate use of |
|
66 deeper features; bit0:submappings, bit1:coupling, |
|
67 bit2,3:reserved. This is backward compatable with all actual uses |
|
68 of the beta code. */ |
|
69 |
|
70 if(info->submaps>1){ |
|
71 oggpack_write(opb,1,1); |
|
72 oggpack_write(opb,info->submaps-1,4); |
|
73 }else |
|
74 oggpack_write(opb,0,1); |
|
75 |
|
76 if(info->coupling_steps>0){ |
|
77 oggpack_write(opb,1,1); |
|
78 oggpack_write(opb,info->coupling_steps-1,8); |
|
79 |
|
80 for(i=0;i<info->coupling_steps;i++){ |
|
81 oggpack_write(opb,info->coupling_mag[i],ilog(vi->channels)); |
|
82 oggpack_write(opb,info->coupling_ang[i],ilog(vi->channels)); |
|
83 } |
|
84 }else |
|
85 oggpack_write(opb,0,1); |
|
86 |
|
87 oggpack_write(opb,0,2); /* 2,3:reserved */ |
|
88 |
|
89 /* we don't write the channel submappings if we only have one... */ |
|
90 if(info->submaps>1){ |
|
91 for(i=0;i<vi->channels;i++) |
|
92 oggpack_write(opb,info->chmuxlist[i],4); |
|
93 } |
|
94 for(i=0;i<info->submaps;i++){ |
|
95 oggpack_write(opb,0,8); /* time submap unused */ |
|
96 oggpack_write(opb,info->floorsubmap[i],8); |
|
97 oggpack_write(opb,info->residuesubmap[i],8); |
|
98 } |
|
99 } |
|
100 |
|
101 /* also responsible for range checking */ |
|
102 static vorbis_info_mapping *mapping0_unpack(vorbis_info *vi,oggpack_buffer *opb){ |
|
103 int i,b; |
|
104 vorbis_info_mapping0 *info=_ogg_calloc(1,sizeof(*info)); |
|
105 codec_setup_info *ci=vi->codec_setup; |
|
106 memset(info,0,sizeof(*info)); |
|
107 |
|
108 b=oggpack_read(opb,1); |
|
109 if(b<0)goto err_out; |
|
110 if(b){ |
|
111 info->submaps=oggpack_read(opb,4)+1; |
|
112 if(info->submaps<=0)goto err_out; |
|
113 }else |
|
114 info->submaps=1; |
|
115 |
|
116 b=oggpack_read(opb,1); |
|
117 if(b<0)goto err_out; |
|
118 if(b){ |
|
119 info->coupling_steps=oggpack_read(opb,8)+1; |
|
120 if(info->coupling_steps<=0)goto err_out; |
|
121 for(i=0;i<info->coupling_steps;i++){ |
|
122 int testM=info->coupling_mag[i]=oggpack_read(opb,ilog(vi->channels)); |
|
123 int testA=info->coupling_ang[i]=oggpack_read(opb,ilog(vi->channels)); |
|
124 |
|
125 if(testM<0 || |
|
126 testA<0 || |
|
127 testM==testA || |
|
128 testM>=vi->channels || |
|
129 testA>=vi->channels) goto err_out; |
|
130 } |
|
131 |
|
132 } |
|
133 |
|
134 if(oggpack_read(opb,2)!=0)goto err_out; /* 2,3:reserved */ |
|
135 |
|
136 if(info->submaps>1){ |
|
137 for(i=0;i<vi->channels;i++){ |
|
138 info->chmuxlist[i]=oggpack_read(opb,4); |
|
139 if(info->chmuxlist[i]>=info->submaps || info->chmuxlist[i]<0)goto err_out; |
|
140 } |
|
141 } |
|
142 for(i=0;i<info->submaps;i++){ |
|
143 oggpack_read(opb,8); /* time submap unused */ |
|
144 info->floorsubmap[i]=oggpack_read(opb,8); |
|
145 if(info->floorsubmap[i]>=ci->floors || info->floorsubmap[i]<0)goto err_out; |
|
146 info->residuesubmap[i]=oggpack_read(opb,8); |
|
147 if(info->residuesubmap[i]>=ci->residues || info->residuesubmap[i]<0)goto err_out; |
|
148 } |
|
149 |
|
150 return info; |
|
151 |
|
152 err_out: |
|
153 mapping0_free_info(info); |
|
154 return(NULL); |
|
155 } |
|
156 |
|
157 #include "os.h" |
|
158 #include "lpc.h" |
|
159 #include "lsp.h" |
|
160 #include "envelope.h" |
|
161 #include "mdct.h" |
|
162 #include "psy.h" |
|
163 #include "scales.h" |
|
164 |
|
165 #if 0 |
|
166 static long seq=0; |
|
167 static ogg_int64_t total=0; |
|
168 static float FLOOR1_fromdB_LOOKUP[256]={ |
|
169 1.0649863e-07F, 1.1341951e-07F, 1.2079015e-07F, 1.2863978e-07F, |
|
170 1.3699951e-07F, 1.4590251e-07F, 1.5538408e-07F, 1.6548181e-07F, |
|
171 1.7623575e-07F, 1.8768855e-07F, 1.9988561e-07F, 2.128753e-07F, |
|
172 2.2670913e-07F, 2.4144197e-07F, 2.5713223e-07F, 2.7384213e-07F, |
|
173 2.9163793e-07F, 3.1059021e-07F, 3.3077411e-07F, 3.5226968e-07F, |
|
174 3.7516214e-07F, 3.9954229e-07F, 4.2550680e-07F, 4.5315863e-07F, |
|
175 4.8260743e-07F, 5.1396998e-07F, 5.4737065e-07F, 5.8294187e-07F, |
|
176 6.2082472e-07F, 6.6116941e-07F, 7.0413592e-07F, 7.4989464e-07F, |
|
177 7.9862701e-07F, 8.5052630e-07F, 9.0579828e-07F, 9.6466216e-07F, |
|
178 1.0273513e-06F, 1.0941144e-06F, 1.1652161e-06F, 1.2409384e-06F, |
|
179 1.3215816e-06F, 1.4074654e-06F, 1.4989305e-06F, 1.5963394e-06F, |
|
180 1.7000785e-06F, 1.8105592e-06F, 1.9282195e-06F, 2.0535261e-06F, |
|
181 2.1869758e-06F, 2.3290978e-06F, 2.4804557e-06F, 2.6416497e-06F, |
|
182 2.8133190e-06F, 2.9961443e-06F, 3.1908506e-06F, 3.3982101e-06F, |
|
183 3.6190449e-06F, 3.8542308e-06F, 4.1047004e-06F, 4.3714470e-06F, |
|
184 4.6555282e-06F, 4.9580707e-06F, 5.2802740e-06F, 5.6234160e-06F, |
|
185 5.9888572e-06F, 6.3780469e-06F, 6.7925283e-06F, 7.2339451e-06F, |
|
186 7.7040476e-06F, 8.2047000e-06F, 8.7378876e-06F, 9.3057248e-06F, |
|
187 9.9104632e-06F, 1.0554501e-05F, 1.1240392e-05F, 1.1970856e-05F, |
|
188 1.2748789e-05F, 1.3577278e-05F, 1.4459606e-05F, 1.5399272e-05F, |
|
189 1.6400004e-05F, 1.7465768e-05F, 1.8600792e-05F, 1.9809576e-05F, |
|
190 2.1096914e-05F, 2.2467911e-05F, 2.3928002e-05F, 2.5482978e-05F, |
|
191 2.7139006e-05F, 2.8902651e-05F, 3.0780908e-05F, 3.2781225e-05F, |
|
192 3.4911534e-05F, 3.7180282e-05F, 3.9596466e-05F, 4.2169667e-05F, |
|
193 4.4910090e-05F, 4.7828601e-05F, 5.0936773e-05F, 5.4246931e-05F, |
|
194 5.7772202e-05F, 6.1526565e-05F, 6.5524908e-05F, 6.9783085e-05F, |
|
195 7.4317983e-05F, 7.9147585e-05F, 8.4291040e-05F, 8.9768747e-05F, |
|
196 9.5602426e-05F, 0.00010181521F, 0.00010843174F, 0.00011547824F, |
|
197 0.00012298267F, 0.00013097477F, 0.00013948625F, 0.00014855085F, |
|
198 0.00015820453F, 0.00016848555F, 0.00017943469F, 0.00019109536F, |
|
199 0.00020351382F, 0.00021673929F, 0.00023082423F, 0.00024582449F, |
|
200 0.00026179955F, 0.00027881276F, 0.00029693158F, 0.00031622787F, |
|
201 0.00033677814F, 0.00035866388F, 0.00038197188F, 0.00040679456F, |
|
202 0.00043323036F, 0.00046138411F, 0.00049136745F, 0.00052329927F, |
|
203 0.00055730621F, 0.00059352311F, 0.00063209358F, 0.00067317058F, |
|
204 0.00071691700F, 0.00076350630F, 0.00081312324F, 0.00086596457F, |
|
205 0.00092223983F, 0.00098217216F, 0.0010459992F, 0.0011139742F, |
|
206 0.0011863665F, 0.0012634633F, 0.0013455702F, 0.0014330129F, |
|
207 0.0015261382F, 0.0016253153F, 0.0017309374F, 0.0018434235F, |
|
208 0.0019632195F, 0.0020908006F, 0.0022266726F, 0.0023713743F, |
|
209 0.0025254795F, 0.0026895994F, 0.0028643847F, 0.0030505286F, |
|
210 0.0032487691F, 0.0034598925F, 0.0036847358F, 0.0039241906F, |
|
211 0.0041792066F, 0.0044507950F, 0.0047400328F, 0.0050480668F, |
|
212 0.0053761186F, 0.0057254891F, 0.0060975636F, 0.0064938176F, |
|
213 0.0069158225F, 0.0073652516F, 0.0078438871F, 0.0083536271F, |
|
214 0.0088964928F, 0.009474637F, 0.010090352F, 0.010746080F, |
|
215 0.011444421F, 0.012188144F, 0.012980198F, 0.013823725F, |
|
216 0.014722068F, 0.015678791F, 0.016697687F, 0.017782797F, |
|
217 0.018938423F, 0.020169149F, 0.021479854F, 0.022875735F, |
|
218 0.024362330F, 0.025945531F, 0.027631618F, 0.029427276F, |
|
219 0.031339626F, 0.033376252F, 0.035545228F, 0.037855157F, |
|
220 0.040315199F, 0.042935108F, 0.045725273F, 0.048696758F, |
|
221 0.051861348F, 0.055231591F, 0.058820850F, 0.062643361F, |
|
222 0.066714279F, 0.071049749F, 0.075666962F, 0.080584227F, |
|
223 0.085821044F, 0.091398179F, 0.097337747F, 0.10366330F, |
|
224 0.11039993F, 0.11757434F, 0.12521498F, 0.13335215F, |
|
225 0.14201813F, 0.15124727F, 0.16107617F, 0.17154380F, |
|
226 0.18269168F, 0.19456402F, 0.20720788F, 0.22067342F, |
|
227 0.23501402F, 0.25028656F, 0.26655159F, 0.28387361F, |
|
228 0.30232132F, 0.32196786F, 0.34289114F, 0.36517414F, |
|
229 0.38890521F, 0.41417847F, 0.44109412F, 0.46975890F, |
|
230 0.50028648F, 0.53279791F, 0.56742212F, 0.60429640F, |
|
231 0.64356699F, 0.68538959F, 0.72993007F, 0.77736504F, |
|
232 0.82788260F, 0.88168307F, 0.9389798F, 1.F, |
|
233 }; |
|
234 |
|
235 #endif |
|
236 |
|
237 |
|
238 static int mapping0_forward(vorbis_block *vb){ |
|
239 vorbis_dsp_state *vd=vb->vd; |
|
240 vorbis_info *vi=vd->vi; |
|
241 codec_setup_info *ci=vi->codec_setup; |
|
242 private_state *b=vb->vd->backend_state; |
|
243 vorbis_block_internal *vbi=(vorbis_block_internal *)vb->internal; |
|
244 int n=vb->pcmend; |
|
245 int i,j,k; |
|
246 |
|
247 int *nonzero = alloca(sizeof(*nonzero)*vi->channels); |
|
248 float **gmdct = _vorbis_block_alloc(vb,vi->channels*sizeof(*gmdct)); |
|
249 int **iwork = _vorbis_block_alloc(vb,vi->channels*sizeof(*iwork)); |
|
250 int ***floor_posts = _vorbis_block_alloc(vb,vi->channels*sizeof(*floor_posts)); |
|
251 |
|
252 float global_ampmax=vbi->ampmax; |
|
253 float *local_ampmax=alloca(sizeof(*local_ampmax)*vi->channels); |
|
254 int blocktype=vbi->blocktype; |
|
255 |
|
256 int modenumber=vb->W; |
|
257 vorbis_info_mapping0 *info=ci->map_param[modenumber]; |
|
258 vorbis_look_psy *psy_look=b->psy+blocktype+(vb->W?2:0); |
|
259 |
|
260 vb->mode=modenumber; |
|
261 |
|
262 for(i=0;i<vi->channels;i++){ |
|
263 float scale=4.f/n; |
|
264 float scale_dB; |
|
265 |
|
266 float *pcm =vb->pcm[i]; |
|
267 float *logfft =pcm; |
|
268 |
|
269 iwork[i]=_vorbis_block_alloc(vb,n/2*sizeof(**iwork)); |
|
270 gmdct[i]=_vorbis_block_alloc(vb,n/2*sizeof(**gmdct)); |
|
271 |
|
272 scale_dB=todB(&scale) + .345; /* + .345 is a hack; the original |
|
273 todB estimation used on IEEE 754 |
|
274 compliant machines had a bug that |
|
275 returned dB values about a third |
|
276 of a decibel too high. The bug |
|
277 was harmless because tunings |
|
278 implicitly took that into |
|
279 account. However, fixing the bug |
|
280 in the estimator requires |
|
281 changing all the tunings as well. |
|
282 For now, it's easier to sync |
|
283 things back up here, and |
|
284 recalibrate the tunings in the |
|
285 next major model upgrade. */ |
|
286 |
|
287 #if 0 |
|
288 if(vi->channels==2){ |
|
289 if(i==0) |
|
290 _analysis_output("pcmL",seq,pcm,n,0,0,total-n/2); |
|
291 else |
|
292 _analysis_output("pcmR",seq,pcm,n,0,0,total-n/2); |
|
293 }else{ |
|
294 _analysis_output("pcm",seq,pcm,n,0,0,total-n/2); |
|
295 } |
|
296 #endif |
|
297 |
|
298 /* window the PCM data */ |
|
299 _vorbis_apply_window(pcm,b->window,ci->blocksizes,vb->lW,vb->W,vb->nW); |
|
300 |
|
301 #if 0 |
|
302 if(vi->channels==2){ |
|
303 if(i==0) |
|
304 _analysis_output("windowedL",seq,pcm,n,0,0,total-n/2); |
|
305 else |
|
306 _analysis_output("windowedR",seq,pcm,n,0,0,total-n/2); |
|
307 }else{ |
|
308 _analysis_output("windowed",seq,pcm,n,0,0,total-n/2); |
|
309 } |
|
310 #endif |
|
311 |
|
312 /* transform the PCM data */ |
|
313 /* only MDCT right now.... */ |
|
314 mdct_forward(b->transform[vb->W][0],pcm,gmdct[i]); |
|
315 |
|
316 /* FFT yields more accurate tonal estimation (not phase sensitive) */ |
|
317 drft_forward(&b->fft_look[vb->W],pcm); |
|
318 logfft[0]=scale_dB+todB(pcm) + .345; /* + .345 is a hack; the |
|
319 original todB estimation used on |
|
320 IEEE 754 compliant machines had a |
|
321 bug that returned dB values about |
|
322 a third of a decibel too high. |
|
323 The bug was harmless because |
|
324 tunings implicitly took that into |
|
325 account. However, fixing the bug |
|
326 in the estimator requires |
|
327 changing all the tunings as well. |
|
328 For now, it's easier to sync |
|
329 things back up here, and |
|
330 recalibrate the tunings in the |
|
331 next major model upgrade. */ |
|
332 local_ampmax[i]=logfft[0]; |
|
333 for(j=1;j<n-1;j+=2){ |
|
334 float temp=pcm[j]*pcm[j]+pcm[j+1]*pcm[j+1]; |
|
335 temp=logfft[(j+1)>>1]=scale_dB+.5f*todB(&temp) + .345; /* + |
|
336 .345 is a hack; the original todB |
|
337 estimation used on IEEE 754 |
|
338 compliant machines had a bug that |
|
339 returned dB values about a third |
|
340 of a decibel too high. The bug |
|
341 was harmless because tunings |
|
342 implicitly took that into |
|
343 account. However, fixing the bug |
|
344 in the estimator requires |
|
345 changing all the tunings as well. |
|
346 For now, it's easier to sync |
|
347 things back up here, and |
|
348 recalibrate the tunings in the |
|
349 next major model upgrade. */ |
|
350 if(temp>local_ampmax[i])local_ampmax[i]=temp; |
|
351 } |
|
352 |
|
353 if(local_ampmax[i]>0.f)local_ampmax[i]=0.f; |
|
354 if(local_ampmax[i]>global_ampmax)global_ampmax=local_ampmax[i]; |
|
355 |
|
356 #if 0 |
|
357 if(vi->channels==2){ |
|
358 if(i==0){ |
|
359 _analysis_output("fftL",seq,logfft,n/2,1,0,0); |
|
360 }else{ |
|
361 _analysis_output("fftR",seq,logfft,n/2,1,0,0); |
|
362 } |
|
363 }else{ |
|
364 _analysis_output("fft",seq,logfft,n/2,1,0,0); |
|
365 } |
|
366 #endif |
|
367 |
|
368 } |
|
369 |
|
370 { |
|
371 float *noise = _vorbis_block_alloc(vb,n/2*sizeof(*noise)); |
|
372 float *tone = _vorbis_block_alloc(vb,n/2*sizeof(*tone)); |
|
373 |
|
374 for(i=0;i<vi->channels;i++){ |
|
375 /* the encoder setup assumes that all the modes used by any |
|
376 specific bitrate tweaking use the same floor */ |
|
377 |
|
378 int submap=info->chmuxlist[i]; |
|
379 |
|
380 /* the following makes things clearer to *me* anyway */ |
|
381 float *mdct =gmdct[i]; |
|
382 float *logfft =vb->pcm[i]; |
|
383 |
|
384 float *logmdct =logfft+n/2; |
|
385 float *logmask =logfft; |
|
386 |
|
387 vb->mode=modenumber; |
|
388 |
|
389 floor_posts[i]=_vorbis_block_alloc(vb,PACKETBLOBS*sizeof(**floor_posts)); |
|
390 memset(floor_posts[i],0,sizeof(**floor_posts)*PACKETBLOBS); |
|
391 |
|
392 for(j=0;j<n/2;j++) |
|
393 logmdct[j]=todB(mdct+j) + .345; /* + .345 is a hack; the original |
|
394 todB estimation used on IEEE 754 |
|
395 compliant machines had a bug that |
|
396 returned dB values about a third |
|
397 of a decibel too high. The bug |
|
398 was harmless because tunings |
|
399 implicitly took that into |
|
400 account. However, fixing the bug |
|
401 in the estimator requires |
|
402 changing all the tunings as well. |
|
403 For now, it's easier to sync |
|
404 things back up here, and |
|
405 recalibrate the tunings in the |
|
406 next major model upgrade. */ |
|
407 |
|
408 #if 0 |
|
409 if(vi->channels==2){ |
|
410 if(i==0) |
|
411 _analysis_output("mdctL",seq,logmdct,n/2,1,0,0); |
|
412 else |
|
413 _analysis_output("mdctR",seq,logmdct,n/2,1,0,0); |
|
414 }else{ |
|
415 _analysis_output("mdct",seq,logmdct,n/2,1,0,0); |
|
416 } |
|
417 #endif |
|
418 |
|
419 /* first step; noise masking. Not only does 'noise masking' |
|
420 give us curves from which we can decide how much resolution |
|
421 to give noise parts of the spectrum, it also implicitly hands |
|
422 us a tonality estimate (the larger the value in the |
|
423 'noise_depth' vector, the more tonal that area is) */ |
|
424 |
|
425 _vp_noisemask(psy_look, |
|
426 logmdct, |
|
427 noise); /* noise does not have by-frequency offset |
|
428 bias applied yet */ |
|
429 #if 0 |
|
430 if(vi->channels==2){ |
|
431 if(i==0) |
|
432 _analysis_output("noiseL",seq,noise,n/2,1,0,0); |
|
433 else |
|
434 _analysis_output("noiseR",seq,noise,n/2,1,0,0); |
|
435 }else{ |
|
436 _analysis_output("noise",seq,noise,n/2,1,0,0); |
|
437 } |
|
438 #endif |
|
439 |
|
440 /* second step: 'all the other crap'; all the stuff that isn't |
|
441 computed/fit for bitrate management goes in the second psy |
|
442 vector. This includes tone masking, peak limiting and ATH */ |
|
443 |
|
444 _vp_tonemask(psy_look, |
|
445 logfft, |
|
446 tone, |
|
447 global_ampmax, |
|
448 local_ampmax[i]); |
|
449 |
|
450 #if 0 |
|
451 if(vi->channels==2){ |
|
452 if(i==0) |
|
453 _analysis_output("toneL",seq,tone,n/2,1,0,0); |
|
454 else |
|
455 _analysis_output("toneR",seq,tone,n/2,1,0,0); |
|
456 }else{ |
|
457 _analysis_output("tone",seq,tone,n/2,1,0,0); |
|
458 } |
|
459 #endif |
|
460 |
|
461 /* third step; we offset the noise vectors, overlay tone |
|
462 masking. We then do a floor1-specific line fit. If we're |
|
463 performing bitrate management, the line fit is performed |
|
464 multiple times for up/down tweakage on demand. */ |
|
465 |
|
466 #if 0 |
|
467 { |
|
468 float aotuv[psy_look->n]; |
|
469 #endif |
|
470 |
|
471 _vp_offset_and_mix(psy_look, |
|
472 noise, |
|
473 tone, |
|
474 1, |
|
475 logmask, |
|
476 mdct, |
|
477 logmdct); |
|
478 |
|
479 #if 0 |
|
480 if(vi->channels==2){ |
|
481 if(i==0) |
|
482 _analysis_output("aotuvM1_L",seq,aotuv,psy_look->n,1,1,0); |
|
483 else |
|
484 _analysis_output("aotuvM1_R",seq,aotuv,psy_look->n,1,1,0); |
|
485 }else{ |
|
486 _analysis_output("aotuvM1",seq,aotuv,psy_look->n,1,1,0); |
|
487 } |
|
488 } |
|
489 #endif |
|
490 |
|
491 |
|
492 #if 0 |
|
493 if(vi->channels==2){ |
|
494 if(i==0) |
|
495 _analysis_output("mask1L",seq,logmask,n/2,1,0,0); |
|
496 else |
|
497 _analysis_output("mask1R",seq,logmask,n/2,1,0,0); |
|
498 }else{ |
|
499 _analysis_output("mask1",seq,logmask,n/2,1,0,0); |
|
500 } |
|
501 #endif |
|
502 |
|
503 /* this algorithm is hardwired to floor 1 for now; abort out if |
|
504 we're *not* floor1. This won't happen unless someone has |
|
505 broken the encode setup lib. Guard it anyway. */ |
|
506 if(ci->floor_type[info->floorsubmap[submap]]!=1)return(-1); |
|
507 |
|
508 floor_posts[i][PACKETBLOBS/2]= |
|
509 floor1_fit(vb,b->flr[info->floorsubmap[submap]], |
|
510 logmdct, |
|
511 logmask); |
|
512 |
|
513 /* are we managing bitrate? If so, perform two more fits for |
|
514 later rate tweaking (fits represent hi/lo) */ |
|
515 if(vorbis_bitrate_managed(vb) && floor_posts[i][PACKETBLOBS/2]){ |
|
516 /* higher rate by way of lower noise curve */ |
|
517 |
|
518 _vp_offset_and_mix(psy_look, |
|
519 noise, |
|
520 tone, |
|
521 2, |
|
522 logmask, |
|
523 mdct, |
|
524 logmdct); |
|
525 |
|
526 #if 0 |
|
527 if(vi->channels==2){ |
|
528 if(i==0) |
|
529 _analysis_output("mask2L",seq,logmask,n/2,1,0,0); |
|
530 else |
|
531 _analysis_output("mask2R",seq,logmask,n/2,1,0,0); |
|
532 }else{ |
|
533 _analysis_output("mask2",seq,logmask,n/2,1,0,0); |
|
534 } |
|
535 #endif |
|
536 |
|
537 floor_posts[i][PACKETBLOBS-1]= |
|
538 floor1_fit(vb,b->flr[info->floorsubmap[submap]], |
|
539 logmdct, |
|
540 logmask); |
|
541 |
|
542 /* lower rate by way of higher noise curve */ |
|
543 _vp_offset_and_mix(psy_look, |
|
544 noise, |
|
545 tone, |
|
546 0, |
|
547 logmask, |
|
548 mdct, |
|
549 logmdct); |
|
550 |
|
551 #if 0 |
|
552 if(vi->channels==2){ |
|
553 if(i==0) |
|
554 _analysis_output("mask0L",seq,logmask,n/2,1,0,0); |
|
555 else |
|
556 _analysis_output("mask0R",seq,logmask,n/2,1,0,0); |
|
557 }else{ |
|
558 _analysis_output("mask0",seq,logmask,n/2,1,0,0); |
|
559 } |
|
560 #endif |
|
561 |
|
562 floor_posts[i][0]= |
|
563 floor1_fit(vb,b->flr[info->floorsubmap[submap]], |
|
564 logmdct, |
|
565 logmask); |
|
566 |
|
567 /* we also interpolate a range of intermediate curves for |
|
568 intermediate rates */ |
|
569 for(k=1;k<PACKETBLOBS/2;k++) |
|
570 floor_posts[i][k]= |
|
571 floor1_interpolate_fit(vb,b->flr[info->floorsubmap[submap]], |
|
572 floor_posts[i][0], |
|
573 floor_posts[i][PACKETBLOBS/2], |
|
574 k*65536/(PACKETBLOBS/2)); |
|
575 for(k=PACKETBLOBS/2+1;k<PACKETBLOBS-1;k++) |
|
576 floor_posts[i][k]= |
|
577 floor1_interpolate_fit(vb,b->flr[info->floorsubmap[submap]], |
|
578 floor_posts[i][PACKETBLOBS/2], |
|
579 floor_posts[i][PACKETBLOBS-1], |
|
580 (k-PACKETBLOBS/2)*65536/(PACKETBLOBS/2)); |
|
581 } |
|
582 } |
|
583 } |
|
584 vbi->ampmax=global_ampmax; |
|
585 |
|
586 /* |
|
587 the next phases are performed once for vbr-only and PACKETBLOB |
|
588 times for bitrate managed modes. |
|
589 |
|
590 1) encode actual mode being used |
|
591 2) encode the floor for each channel, compute coded mask curve/res |
|
592 3) normalize and couple. |
|
593 4) encode residue |
|
594 5) save packet bytes to the packetblob vector |
|
595 |
|
596 */ |
|
597 |
|
598 /* iterate over the many masking curve fits we've created */ |
|
599 |
|
600 { |
|
601 int **couple_bundle=alloca(sizeof(*couple_bundle)*vi->channels); |
|
602 int *zerobundle=alloca(sizeof(*zerobundle)*vi->channels); |
|
603 |
|
604 for(k=(vorbis_bitrate_managed(vb)?0:PACKETBLOBS/2); |
|
605 k<=(vorbis_bitrate_managed(vb)?PACKETBLOBS-1:PACKETBLOBS/2); |
|
606 k++){ |
|
607 oggpack_buffer *opb=vbi->packetblob[k]; |
|
608 |
|
609 /* start out our new packet blob with packet type and mode */ |
|
610 /* Encode the packet type */ |
|
611 oggpack_write(opb,0,1); |
|
612 /* Encode the modenumber */ |
|
613 /* Encode frame mode, pre,post windowsize, then dispatch */ |
|
614 oggpack_write(opb,modenumber,b->modebits); |
|
615 if(vb->W){ |
|
616 oggpack_write(opb,vb->lW,1); |
|
617 oggpack_write(opb,vb->nW,1); |
|
618 } |
|
619 |
|
620 /* encode floor, compute masking curve, sep out residue */ |
|
621 for(i=0;i<vi->channels;i++){ |
|
622 int submap=info->chmuxlist[i]; |
|
623 int *ilogmask=iwork[i]; |
|
624 |
|
625 nonzero[i]=floor1_encode(opb,vb,b->flr[info->floorsubmap[submap]], |
|
626 floor_posts[i][k], |
|
627 ilogmask); |
|
628 #if 0 |
|
629 { |
|
630 char buf[80]; |
|
631 sprintf(buf,"maskI%c%d",i?'R':'L',k); |
|
632 float work[n/2]; |
|
633 for(j=0;j<n/2;j++) |
|
634 work[j]=FLOOR1_fromdB_LOOKUP[iwork[i][j]]; |
|
635 _analysis_output(buf,seq,work,n/2,1,1,0); |
|
636 } |
|
637 #endif |
|
638 } |
|
639 |
|
640 /* our iteration is now based on masking curve, not prequant and |
|
641 coupling. Only one prequant/coupling step */ |
|
642 |
|
643 /* quantize/couple */ |
|
644 /* incomplete implementation that assumes the tree is all depth |
|
645 one, or no tree at all */ |
|
646 _vp_couple_quantize_normalize(k, |
|
647 &ci->psy_g_param, |
|
648 psy_look, |
|
649 info, |
|
650 gmdct, |
|
651 iwork, |
|
652 nonzero, |
|
653 ci->psy_g_param.sliding_lowpass[vb->W][k], |
|
654 vi->channels); |
|
655 |
|
656 #if 0 |
|
657 for(i=0;i<vi->channels;i++){ |
|
658 char buf[80]; |
|
659 sprintf(buf,"res%c%d",i?'R':'L',k); |
|
660 float work[n/2]; |
|
661 for(j=0;j<n/2;j++) |
|
662 work[j]=iwork[i][j]; |
|
663 _analysis_output(buf,seq,work,n/2,1,0,0); |
|
664 } |
|
665 #endif |
|
666 |
|
667 /* classify and encode by submap */ |
|
668 for(i=0;i<info->submaps;i++){ |
|
669 int ch_in_bundle=0; |
|
670 long **classifications; |
|
671 int resnum=info->residuesubmap[i]; |
|
672 |
|
673 for(j=0;j<vi->channels;j++){ |
|
674 if(info->chmuxlist[j]==i){ |
|
675 zerobundle[ch_in_bundle]=0; |
|
676 if(nonzero[j])zerobundle[ch_in_bundle]=1; |
|
677 couple_bundle[ch_in_bundle++]=iwork[j]; |
|
678 } |
|
679 } |
|
680 |
|
681 classifications=_residue_P[ci->residue_type[resnum]]-> |
|
682 class(vb,b->residue[resnum],couple_bundle,zerobundle,ch_in_bundle); |
|
683 |
|
684 ch_in_bundle=0; |
|
685 for(j=0;j<vi->channels;j++) |
|
686 if(info->chmuxlist[j]==i) |
|
687 couple_bundle[ch_in_bundle++]=iwork[j]; |
|
688 |
|
689 _residue_P[ci->residue_type[resnum]]-> |
|
690 forward(opb,vb,b->residue[resnum], |
|
691 couple_bundle,zerobundle,ch_in_bundle,classifications,i); |
|
692 } |
|
693 |
|
694 /* ok, done encoding. Next protopacket. */ |
|
695 } |
|
696 |
|
697 } |
|
698 |
|
699 #if 0 |
|
700 seq++; |
|
701 total+=ci->blocksizes[vb->W]/4+ci->blocksizes[vb->nW]/4; |
|
702 #endif |
|
703 return(0); |
|
704 } |
|
705 |
|
706 static int mapping0_inverse(vorbis_block *vb,vorbis_info_mapping *l){ |
|
707 vorbis_dsp_state *vd=vb->vd; |
|
708 vorbis_info *vi=vd->vi; |
|
709 codec_setup_info *ci=vi->codec_setup; |
|
710 private_state *b=vd->backend_state; |
|
711 vorbis_info_mapping0 *info=(vorbis_info_mapping0 *)l; |
|
712 |
|
713 int i,j; |
|
714 long n=vb->pcmend=ci->blocksizes[vb->W]; |
|
715 |
|
716 float **pcmbundle=alloca(sizeof(*pcmbundle)*vi->channels); |
|
717 int *zerobundle=alloca(sizeof(*zerobundle)*vi->channels); |
|
718 |
|
719 int *nonzero =alloca(sizeof(*nonzero)*vi->channels); |
|
720 void **floormemo=alloca(sizeof(*floormemo)*vi->channels); |
|
721 |
|
722 /* recover the spectral envelope; store it in the PCM vector for now */ |
|
723 for(i=0;i<vi->channels;i++){ |
|
724 int submap=info->chmuxlist[i]; |
|
725 floormemo[i]=_floor_P[ci->floor_type[info->floorsubmap[submap]]]-> |
|
726 inverse1(vb,b->flr[info->floorsubmap[submap]]); |
|
727 if(floormemo[i]) |
|
728 nonzero[i]=1; |
|
729 else |
|
730 nonzero[i]=0; |
|
731 memset(vb->pcm[i],0,sizeof(*vb->pcm[i])*n/2); |
|
732 } |
|
733 |
|
734 /* channel coupling can 'dirty' the nonzero listing */ |
|
735 for(i=0;i<info->coupling_steps;i++){ |
|
736 if(nonzero[info->coupling_mag[i]] || |
|
737 nonzero[info->coupling_ang[i]]){ |
|
738 nonzero[info->coupling_mag[i]]=1; |
|
739 nonzero[info->coupling_ang[i]]=1; |
|
740 } |
|
741 } |
|
742 |
|
743 /* recover the residue into our working vectors */ |
|
744 for(i=0;i<info->submaps;i++){ |
|
745 int ch_in_bundle=0; |
|
746 for(j=0;j<vi->channels;j++){ |
|
747 if(info->chmuxlist[j]==i){ |
|
748 if(nonzero[j]) |
|
749 zerobundle[ch_in_bundle]=1; |
|
750 else |
|
751 zerobundle[ch_in_bundle]=0; |
|
752 pcmbundle[ch_in_bundle++]=vb->pcm[j]; |
|
753 } |
|
754 } |
|
755 |
|
756 _residue_P[ci->residue_type[info->residuesubmap[i]]]-> |
|
757 inverse(vb,b->residue[info->residuesubmap[i]], |
|
758 pcmbundle,zerobundle,ch_in_bundle); |
|
759 } |
|
760 |
|
761 /* channel coupling */ |
|
762 for(i=info->coupling_steps-1;i>=0;i--){ |
|
763 float *pcmM=vb->pcm[info->coupling_mag[i]]; |
|
764 float *pcmA=vb->pcm[info->coupling_ang[i]]; |
|
765 |
|
766 for(j=0;j<n/2;j++){ |
|
767 float mag=pcmM[j]; |
|
768 float ang=pcmA[j]; |
|
769 |
|
770 if(mag>0) |
|
771 if(ang>0){ |
|
772 pcmM[j]=mag; |
|
773 pcmA[j]=mag-ang; |
|
774 }else{ |
|
775 pcmA[j]=mag; |
|
776 pcmM[j]=mag+ang; |
|
777 } |
|
778 else |
|
779 if(ang>0){ |
|
780 pcmM[j]=mag; |
|
781 pcmA[j]=mag+ang; |
|
782 }else{ |
|
783 pcmA[j]=mag; |
|
784 pcmM[j]=mag-ang; |
|
785 } |
|
786 } |
|
787 } |
|
788 |
|
789 /* compute and apply spectral envelope */ |
|
790 for(i=0;i<vi->channels;i++){ |
|
791 float *pcm=vb->pcm[i]; |
|
792 int submap=info->chmuxlist[i]; |
|
793 _floor_P[ci->floor_type[info->floorsubmap[submap]]]-> |
|
794 inverse2(vb,b->flr[info->floorsubmap[submap]], |
|
795 floormemo[i],pcm); |
|
796 } |
|
797 |
|
798 /* transform the PCM data; takes PCM vector, vb; modifies PCM vector */ |
|
799 /* only MDCT right now.... */ |
|
800 for(i=0;i<vi->channels;i++){ |
|
801 float *pcm=vb->pcm[i]; |
|
802 mdct_backward(b->transform[vb->W][0],pcm,pcm); |
|
803 } |
|
804 |
|
805 /* all done! */ |
|
806 return(0); |
|
807 } |
|
808 |
|
809 /* export hooks */ |
|
810 const vorbis_func_mapping mapping0_exportbundle={ |
|
811 &mapping0_pack, |
|
812 &mapping0_unpack, |
|
813 &mapping0_free_info, |
|
814 &mapping0_forward, |
|
815 &mapping0_inverse |
|
816 }; |