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
mapping0_free_info(vorbis_info_mapping * i)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
ilog(unsigned int v)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
mapping0_pack(vorbis_info * vi,vorbis_info_mapping * vm,oggpack_buffer * opb)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 */
mapping0_unpack(vorbis_info * vi,oggpack_buffer * opb)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
mapping0_forward(vorbis_block * vb)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
mapping0_inverse(vorbis_block * vb,vorbis_info_mapping * l)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 };
817