blob: a06302d626bba667a1379fa42de7379c6e42e468 [file] [log] [blame]
Gloria Wang37fe1582010-03-12 14:53:20 -08001/************************************************************************
Gloria Wang2da723a2010-03-18 15:56:16 -07002 * Copyright (C) 2002-2009, Xiph.org Foundation
3 * Copyright (C) 2010, Robin Watts for Pinknoise Productions Ltd
Gloria Wang37fe1582010-03-12 14:53:20 -08004 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
Gloria Wang2da723a2010-03-18 15:56:16 -07007 * modification, are permitted provided that the following conditions
8 * are met:
Gloria Wang37fe1582010-03-12 14:53:20 -08009 *
10 * * Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * * Redistributions in binary form must reproduce the above
13 * copyright notice, this list of conditions and the following disclaimer
14 * in the documentation and/or other materials provided with the
15 * distribution.
Gloria Wang2da723a2010-03-18 15:56:16 -070016 * * Neither the names of the Xiph.org Foundation nor Pinknoise
17 * Productions Ltd nor the names of its contributors may be used to
18 * endorse or promote products derived from this software without
19 * specific prior written permission.
Gloria Wang37fe1582010-03-12 14:53:20 -080020 *
21 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32 ************************************************************************
Gloria Wang79130732010-02-08 14:41:04 -080033
34 function: basic codebook pack/unpack/code/decode operations
35
Gloria Wang37fe1582010-03-12 14:53:20 -080036 ************************************************************************/
Gloria Wang79130732010-02-08 14:41:04 -080037
38#include <stdlib.h>
39#include <string.h>
40#include <math.h>
41#include <limits.h>
Wei Jia9c91d742015-09-08 09:35:22 -070042#include <log/log.h>
Gloria Wang79130732010-02-08 14:41:04 -080043#include "ogg.h"
44#include "ivorbiscodec.h"
45#include "codebook.h"
46#include "misc.h"
47#include "os.h"
48
Wei Jia9c91d742015-09-08 09:35:22 -070049#define MARKER_SIZE 33
Gloria Wang79130732010-02-08 14:41:04 -080050
51/**** pack/unpack helpers ******************************************/
52int _ilog(unsigned int v){
53 int ret=0;
54 while(v){
55 ret++;
56 v>>=1;
57 }
58 return(ret);
59}
60
61static ogg_uint32_t decpack(long entry,long used_entry,long quantvals,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -070062 codebook *b,oggpack_buffer *opb,int maptype){
Gloria Wang79130732010-02-08 14:41:04 -080063 ogg_uint32_t ret=0;
64 int j;
65
66 switch(b->dec_type){
67
68 case 0:
69 return (ogg_uint32_t)entry;
70
71 case 1:
72 if(maptype==1){
73 /* vals are already read into temporary column vector here */
74 for(j=0;j<b->dim;j++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -070075 ogg_uint32_t off=entry%quantvals;
76 entry/=quantvals;
77 ret|=((ogg_uint16_t *)(b->q_val))[off]<<(b->q_bits*j);
Gloria Wang79130732010-02-08 14:41:04 -080078 }
79 }else{
80 for(j=0;j<b->dim;j++)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -070081 ret|=oggpack_read(opb,b->q_bits)<<(b->q_bits*j);
Gloria Wang79130732010-02-08 14:41:04 -080082 }
83 return ret;
84
85 case 2:
86 for(j=0;j<b->dim;j++){
87 ogg_uint32_t off=entry%quantvals;
88 entry/=quantvals;
89 ret|=off<<(b->q_pack*j);
90 }
91 return ret;
92
93 case 3:
94 return (ogg_uint32_t)used_entry;
95
96 }
97 return 0; /* silence compiler */
98}
99
100/* 32 bit float (not IEEE; nonnormalized mantissa +
101 biased exponent) : neeeeeee eeemmmmm mmmmmmmm mmmmmmmm
102 Why not IEEE? It's just not that important here. */
103
104static ogg_int32_t _float32_unpack(long val,int *point){
105 long mant=val&0x1fffff;
106 int sign=val&0x80000000;
107
108 *point=((val&0x7fe00000L)>>21)-788;
109
110 if(mant){
111 while(!(mant&0x40000000)){
112 mant<<=1;
113 *point-=1;
114 }
115 if(sign)mant= -mant;
116 }else{
117 *point=-9999;
118 }
119 return mant;
120}
121
122/* choose the smallest supported node size that fits our decode table.
123 Legal bytewidths are 1/1 1/2 2/2 2/4 4/4 */
124static int _determine_node_bytes(long used, int leafwidth){
125
126 /* special case small books to size 4 to avoid multiple special
127 cases in repack */
128 if(used<2)
129 return 4;
130
131 if(leafwidth==3)leafwidth=4;
132 if(_ilog(3*used-6)+1 <= leafwidth*4)
133 return leafwidth/2?leafwidth/2:1;
134 return leafwidth;
135}
136
137/* convenience/clarity; leaves are specified as multiple of node word
138 size (1 or 2) */
139static int _determine_leaf_words(int nodeb, int leafwidth){
140 if(leafwidth>nodeb)return 2;
141 return 1;
142}
143
144/* given a list of word lengths, number of used entries, and byte
145 width of a leaf, generate the decode table */
146static int _make_words(char *l,long n,ogg_uint32_t *r,long quantvals,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700147 codebook *b, oggpack_buffer *opb,int maptype){
Gloria Wang79130732010-02-08 14:41:04 -0800148 long i,j,count=0;
149 long top=0;
Wei Jia9c91d742015-09-08 09:35:22 -0700150 ogg_uint32_t marker[MARKER_SIZE];
Gloria Wang79130732010-02-08 14:41:04 -0800151
152 if (n<1)
153 return 1;
154
155 if(n<2){
156 r[0]=0x80000000;
157 }else{
158 memset(marker,0,sizeof(marker));
159
160 for(i=0;i<n;i++){
161 long length=l[i];
162 if(length){
Wei Jia9c91d742015-09-08 09:35:22 -0700163 if (length < 0 || length >= MARKER_SIZE) {
164 ALOGE("b/23881715");
165 return 1;
166 }
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700167 ogg_uint32_t entry=marker[length];
168 long chase=0;
169 if(count && !entry)return -1; /* overpopulated tree! */
Gloria Wang79130732010-02-08 14:41:04 -0800170
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700171 /* chase the tree as far as it's already populated, fill in past */
172 for(j=0;j<length-1;j++){
173 int bit=(entry>>(length-j-1))&1;
174 if(chase>=top){
175 if (chase < 0 || chase >= n) return 1;
176 top++;
177 r[chase*2]=top;
178 r[chase*2+1]=0;
179 }else
180 if (chase < 0 || chase >= n || chase*2+bit > n*2+1) return 1;
181 if(!r[chase*2+bit])
182 r[chase*2+bit]=top;
183 chase=r[chase*2+bit];
184 if (chase < 0 || chase >= n) return 1;
185 }
186 {
187 int bit=(entry>>(length-j-1))&1;
188 if(chase>=top){
189 top++;
190 r[chase*2+1]=0;
191 }
192 r[chase*2+bit]= decpack(i,count++,quantvals,b,opb,maptype) |
193 0x80000000;
194 }
Gloria Wang79130732010-02-08 14:41:04 -0800195
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700196 /* Look to see if the next shorter marker points to the node
197 above. if so, update it and repeat. */
198 for(j=length;j>0;j--){
199 if(marker[j]&1){
200 marker[j]=marker[j-1]<<1;
201 break;
202 }
203 marker[j]++;
204 }
Gloria Wang79130732010-02-08 14:41:04 -0800205
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700206 /* prune the tree; the implicit invariant says all the longer
207 markers were dangling from our just-taken node. Dangle them
208 from our *new* node. */
209 for(j=length+1;j<MARKER_SIZE;j++)
210 if((marker[j]>>1) == entry){
211 entry=marker[j];
212 marker[j]=marker[j-1]<<1;
213 }else
214 break;
Gloria Wang79130732010-02-08 14:41:04 -0800215 }
216 }
217 }
218
Marco Nelissen52193fa2015-05-14 10:22:40 -0700219 // following sanity check copied from libvorbis
220 /* sanity check the huffman tree; an underpopulated tree must be
221 rejected. The only exception is the one-node pseudo-nil tree,
222 which appears to be underpopulated because the tree doesn't
223 really exist; there's only one possible 'codeword' or zero bits,
224 but the above tree-gen code doesn't mark that. */
225 if(b->used_entries != 1){
Wei Jia9c91d742015-09-08 09:35:22 -0700226 for(i=1;i<MARKER_SIZE;i++)
Marco Nelissen52193fa2015-05-14 10:22:40 -0700227 if(marker[i] & (0xffffffffUL>>(32-i))){
228 return 1;
229 }
230 }
231
232
Gloria Wang79130732010-02-08 14:41:04 -0800233 return 0;
234}
235
236static int _make_decode_table(codebook *s,char *lengthlist,long quantvals,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700237 oggpack_buffer *opb,int maptype){
Gloria Wang79130732010-02-08 14:41:04 -0800238 int i;
239 ogg_uint32_t *work;
240
241 if (!lengthlist) return 1;
242 if(s->dec_nodeb==4){
243 /* Over-allocate by using s->entries instead of used_entries.
244 * This means that we can use s->entries to enforce size in
245 * _make_words without messing up length list looping.
246 * This probably wastes a bit of space, but it shouldn't
247 * impact behavior or size too much.
248 */
249 s->dec_table=_ogg_malloc((s->entries*2+1)*sizeof(*work));
250 if (!s->dec_table) return 1;
251 /* +1 (rather than -2) is to accommodate 0 and 1 sized books,
252 which are specialcased to nodeb==4 */
253 if(_make_words(lengthlist,s->entries,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700254 s->dec_table,quantvals,s,opb,maptype))return 1;
Gloria Wang79130732010-02-08 14:41:04 -0800255
256 return 0;
257 }
258
259 if (s->used_entries > INT_MAX/2 ||
260 s->used_entries*2 > INT_MAX/((long) sizeof(*work)) - 1) return 1;
261 /* Overallocate as above */
Marco Nelissenff9b5b22014-03-26 10:54:53 -0700262 work=calloc((s->entries*2+1),sizeof(*work));
263 if (!work) return 1;
264 if(_make_words(lengthlist,s->entries,work,quantvals,s,opb,maptype)) goto error_out;
265 if (s->used_entries > INT_MAX/(s->dec_leafw+1)) goto error_out;
266 if (s->dec_nodeb && s->used_entries * (s->dec_leafw+1) > INT_MAX/s->dec_nodeb) goto error_out;
Gloria Wang79130732010-02-08 14:41:04 -0800267 s->dec_table=_ogg_malloc((s->used_entries*(s->dec_leafw+1)-2)*
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700268 s->dec_nodeb);
Marco Nelissenff9b5b22014-03-26 10:54:53 -0700269 if (!s->dec_table) goto error_out;
Gloria Wang79130732010-02-08 14:41:04 -0800270
271 if(s->dec_leafw==1){
272 switch(s->dec_nodeb){
273 case 1:
274 for(i=0;i<s->used_entries*2-2;i++)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700275 ((unsigned char *)s->dec_table)[i]=(unsigned char)
276 (((work[i] & 0x80000000UL) >> 24) | work[i]);
Gloria Wang79130732010-02-08 14:41:04 -0800277 break;
278 case 2:
279 for(i=0;i<s->used_entries*2-2;i++)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700280 ((ogg_uint16_t *)s->dec_table)[i]=(ogg_uint16_t)
281 (((work[i] & 0x80000000UL) >> 16) | work[i]);
Gloria Wang79130732010-02-08 14:41:04 -0800282 break;
283 }
284
285 }else{
286 /* more complex; we have to do a two-pass repack that updates the
287 node indexing. */
288 long top=s->used_entries*3-2;
289 if(s->dec_nodeb==1){
290 unsigned char *out=(unsigned char *)s->dec_table;
291
292 for(i=s->used_entries*2-4;i>=0;i-=2){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700293 if(work[i]&0x80000000UL){
294 if(work[i+1]&0x80000000UL){
295 top-=4;
296 out[top]=(work[i]>>8 & 0x7f)|0x80;
297 out[top+1]=(work[i+1]>>8 & 0x7f)|0x80;
298 out[top+2]=work[i] & 0xff;
299 out[top+3]=work[i+1] & 0xff;
300 }else{
301 top-=3;
302 out[top]=(work[i]>>8 & 0x7f)|0x80;
303 out[top+1]=work[work[i+1]*2];
304 out[top+2]=work[i] & 0xff;
305 }
306 }else{
307 if(work[i+1]&0x80000000UL){
308 top-=3;
309 out[top]=work[work[i]*2];
310 out[top+1]=(work[i+1]>>8 & 0x7f)|0x80;
311 out[top+2]=work[i+1] & 0xff;
312 }else{
313 top-=2;
314 out[top]=work[work[i]*2];
315 out[top+1]=work[work[i+1]*2];
316 }
317 }
318 work[i]=top;
Gloria Wang79130732010-02-08 14:41:04 -0800319 }
320 }else{
321 ogg_uint16_t *out=(ogg_uint16_t *)s->dec_table;
322 for(i=s->used_entries*2-4;i>=0;i-=2){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700323 if(work[i]&0x80000000UL){
324 if(work[i+1]&0x80000000UL){
325 top-=4;
326 out[top]=(work[i]>>16 & 0x7fff)|0x8000;
327 out[top+1]=(work[i+1]>>16 & 0x7fff)|0x8000;
328 out[top+2]=work[i] & 0xffff;
329 out[top+3]=work[i+1] & 0xffff;
330 }else{
331 top-=3;
332 out[top]=(work[i]>>16 & 0x7fff)|0x8000;
333 out[top+1]=work[work[i+1]*2];
334 out[top+2]=work[i] & 0xffff;
335 }
336 }else{
337 if(work[i+1]&0x80000000UL){
338 top-=3;
339 out[top]=work[work[i]*2];
340 out[top+1]=(work[i+1]>>16 & 0x7fff)|0x8000;
341 out[top+2]=work[i+1] & 0xffff;
342 }else{
343 top-=2;
344 out[top]=work[work[i]*2];
345 out[top+1]=work[work[i+1]*2];
346 }
347 }
348 work[i]=top;
Gloria Wang79130732010-02-08 14:41:04 -0800349 }
350 }
351 }
352
Marco Nelissenff9b5b22014-03-26 10:54:53 -0700353 free(work);
Gloria Wang79130732010-02-08 14:41:04 -0800354 return 0;
Marco Nelissenff9b5b22014-03-26 10:54:53 -0700355error_out:
356 free(work);
357 return 1;
Gloria Wang79130732010-02-08 14:41:04 -0800358}
359
360/* most of the time, entries%dimensions == 0, but we need to be
361 well defined. We define that the possible vales at each
362 scalar is values == entries/dim. If entries%dim != 0, we'll
363 have 'too few' values (values*dim<entries), which means that
364 we'll have 'left over' entries; left over entries use zeroed
365 values (and are wasted). So don't generate codebooks like
366 that */
367/* there might be a straightforward one-line way to do the below
368 that's portable and totally safe against roundoff, but I haven't
369 thought of it. Therefore, we opt on the side of caution */
370long _book_maptype1_quantvals(codebook *b){
371 /* get us a starting hint, we'll polish it below */
372 int bits=_ilog(b->entries);
373 int vals=b->entries>>((bits-1)*(b->dim-1)/b->dim);
374
375 while(1){
376 long acc=1;
377 long acc1=1;
378 int i;
Marco Nelissenb5e041d2019-01-23 16:10:48 -0800379 for (i = 0; i < b->dim; i++) {
380 if (acc > b->entries / vals) {
381 break;
382 }
383 acc *= vals;
384 if (acc1 > LONG_MAX / (vals + 1)) {
385 acc1 = LONG_MAX;
386 } else {
387 acc1 *= (vals + 1);
388 }
Gloria Wang79130732010-02-08 14:41:04 -0800389 }
Marco Nelissenb5e041d2019-01-23 16:10:48 -0800390 if (i >= b->dim && acc <= b->entries && acc1 > b->entries) {
Gloria Wang79130732010-02-08 14:41:04 -0800391 return(vals);
392 }else{
Marco Nelissenb5e041d2019-01-23 16:10:48 -0800393 if (i < b->dim || acc > b->entries) {
Gloria Wang79130732010-02-08 14:41:04 -0800394 vals--;
395 }else{
396 vals++;
397 }
398 }
399 }
400}
401
402void vorbis_book_clear(codebook *b){
403 /* static book is not cleared; we're likely called on the lookup and
404 the static codebook belongs to the info struct */
405 if(b->q_val)_ogg_free(b->q_val);
406 if(b->dec_table)_ogg_free(b->dec_table);
407 if(b->dec_buf)_ogg_free(b->dec_buf);
408
409 memset(b,0,sizeof(*b));
410}
411
412int vorbis_book_unpack(oggpack_buffer *opb,codebook *s){
413 char *lengthlist=NULL;
414 int quantvals=0;
415 long i,j;
416 int maptype;
417
418 memset(s,0,sizeof(*s));
419
420 /* make sure alignment is correct */
421 if(oggpack_read(opb,24)!=0x564342)goto _eofout;
422
423 /* first the basic parameters */
424 s->dim=oggpack_read(opb,16);
425 s->dec_buf=_ogg_malloc(sizeof(ogg_int32_t)*s->dim);
426 if (s->dec_buf == NULL)
427 goto _errout;
428 s->entries=oggpack_read(opb,24);
429 if(s->entries<=0)goto _eofout;
430 if(s->dim<=0)goto _eofout;
431 if(_ilog(s->dim)+_ilog(s->entries)>24)goto _eofout;
432 if (s->dim > INT_MAX/s->entries) goto _eofout;
433
434 /* codeword ordering.... length ordered or unordered? */
435 switch((int)oggpack_read(opb,1)){
436 case 0:
437 /* unordered */
Marco Nelissenafa1f6b2013-10-11 15:46:30 -0700438 lengthlist=(char *)calloc(s->entries, sizeof(*lengthlist));
Gloria Wang79130732010-02-08 14:41:04 -0800439 if(!lengthlist) goto _eofout;
440
441 /* allocated but unused entries? */
442 if(oggpack_read(opb,1)){
443 /* yes, unused entries */
444
445 for(i=0;i<s->entries;i++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700446 if(oggpack_read(opb,1)){
447 long num=oggpack_read(opb,5);
448 if(num==-1)goto _eofout;
449 lengthlist[i]=(char)(num+1);
450 s->used_entries++;
451 if(num+1>s->dec_maxlength)s->dec_maxlength=num+1;
452 }else
453 lengthlist[i]=0;
Gloria Wang79130732010-02-08 14:41:04 -0800454 }
455 }else{
456 /* all entries used; no tagging */
457 s->used_entries=s->entries;
458 for(i=0;i<s->entries;i++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700459 long num=oggpack_read(opb,5);
460 if(num==-1)goto _eofout;
461 lengthlist[i]=(char)(num+1);
462 if(num+1>s->dec_maxlength)s->dec_maxlength=num+1;
Gloria Wang79130732010-02-08 14:41:04 -0800463 }
464 }
465
466 break;
467 case 1:
468 /* ordered */
469 {
470 long length=oggpack_read(opb,5)+1;
471
472 s->used_entries=s->entries;
Marco Nelissenafa1f6b2013-10-11 15:46:30 -0700473 lengthlist=(char *)calloc(s->entries, sizeof(*lengthlist));
Gloria Wang79130732010-02-08 14:41:04 -0800474 if (!lengthlist) goto _eofout;
475
476 for(i=0;i<s->entries;){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700477 long num=oggpack_read(opb,_ilog(s->entries-i));
478 if(num<0)goto _eofout;
479 for(j=0;j<num && i<s->entries;j++,i++)
480 lengthlist[i]=(char)length;
481 s->dec_maxlength=length;
482 length++;
Gloria Wang79130732010-02-08 14:41:04 -0800483 }
484 }
485 break;
486 default:
487 /* EOF */
488 goto _eofout;
489 }
490
491
492 /* Do we have a mapping to unpack? */
493
494 if((maptype=oggpack_read(opb,4))>0){
495 s->q_min=_float32_unpack(oggpack_read(opb,32),&s->q_minp);
496 s->q_del=_float32_unpack(oggpack_read(opb,32),&s->q_delp);
497 s->q_bits=oggpack_read(opb,4)+1;
498 s->q_seq=oggpack_read(opb,1);
499
500 s->q_del>>=s->q_bits;
501 s->q_delp+=s->q_bits;
502 }
503
504 switch(maptype){
505 case 0:
506
507 /* no mapping; decode type 0 */
508
509 /* how many bytes for the indexing? */
510 /* this is the correct boundary here; we lose one bit to
511 node/leaf mark */
512 s->dec_nodeb=_determine_node_bytes(s->used_entries,_ilog(s->entries)/8+1);
513 s->dec_leafw=_determine_leaf_words(s->dec_nodeb,_ilog(s->entries)/8+1);
514 s->dec_type=0;
515
516 if(_make_decode_table(s,lengthlist,quantvals,opb,maptype)) goto _errout;
517 break;
518
519 case 1:
520
521 /* mapping type 1; implicit values by lattice position */
522 quantvals=_book_maptype1_quantvals(s);
523
524 /* dec_type choices here are 1,2; 3 doesn't make sense */
525 {
526 /* packed values */
527 long total1=(s->q_bits*s->dim+8)/8; /* remember flag bit */
528 if (s->dim > (INT_MAX-8)/s->q_bits) goto _eofout;
529 /* vector of column offsets; remember flag bit */
530 long total2=(_ilog(quantvals-1)*s->dim+8)/8+(s->q_bits+7)/8;
531
532
533 if(total1<=4 && total1<=total2){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700534 /* use dec_type 1: vector of packed values */
Gloria Wang79130732010-02-08 14:41:04 -0800535
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700536 /* need quantized values before */
537 s->q_val=calloc(sizeof(ogg_uint16_t), quantvals);
538 if (!s->q_val) goto _eofout;
539 for(i=0;i<quantvals;i++)
540 ((ogg_uint16_t *)s->q_val)[i]=(ogg_uint16_t)oggpack_read(opb,s->q_bits);
Gloria Wang79130732010-02-08 14:41:04 -0800541
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700542 if(oggpack_eop(opb)){
543 goto _eofout;
544 }
Gloria Wang79130732010-02-08 14:41:04 -0800545
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700546 s->dec_type=1;
547 s->dec_nodeb=_determine_node_bytes(s->used_entries,
548 (s->q_bits*s->dim+8)/8);
549 s->dec_leafw=_determine_leaf_words(s->dec_nodeb,
550 (s->q_bits*s->dim+8)/8);
551 if(_make_decode_table(s,lengthlist,quantvals,opb,maptype)){
552 goto _errout;
553 }
Gloria Wang79130732010-02-08 14:41:04 -0800554
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700555 free(s->q_val);
556 s->q_val=0;
Gloria Wang79130732010-02-08 14:41:04 -0800557
558 }else{
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700559 /* use dec_type 2: packed vector of column offsets */
Gloria Wang79130732010-02-08 14:41:04 -0800560
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700561 /* need quantized values before */
562 if(s->q_bits<=8){
563 s->q_val=_ogg_malloc(quantvals);
564 if (!s->q_val) goto _eofout;
565 for(i=0;i<quantvals;i++)
566 ((unsigned char *)s->q_val)[i]=(unsigned char)oggpack_read(opb,s->q_bits);
567 }else{
568 s->q_val=_ogg_malloc(quantvals*2);
569 if (!s->q_val) goto _eofout;
570 for(i=0;i<quantvals;i++)
571 ((ogg_uint16_t *)s->q_val)[i]=(ogg_uint16_t)oggpack_read(opb,s->q_bits);
572 }
Gloria Wang79130732010-02-08 14:41:04 -0800573
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700574 if(oggpack_eop(opb))goto _eofout;
Gloria Wang79130732010-02-08 14:41:04 -0800575
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700576 s->q_pack=_ilog(quantvals-1);
577 s->dec_type=2;
578 s->dec_nodeb=_determine_node_bytes(s->used_entries,
579 (_ilog(quantvals-1)*s->dim+8)/8);
580 s->dec_leafw=_determine_leaf_words(s->dec_nodeb,
581 (_ilog(quantvals-1)*s->dim+8)/8);
582 if(_make_decode_table(s,lengthlist,quantvals,opb,maptype))goto _errout;
Gloria Wang79130732010-02-08 14:41:04 -0800583
584 }
585 }
586 break;
587 case 2:
588
589 /* mapping type 2; explicit array of values */
590 quantvals=s->entries*s->dim;
591 /* dec_type choices here are 1,3; 2 is not possible */
592
593 if( (s->q_bits*s->dim+8)/8 <=4){ /* remember flag bit */
594 /* use dec_type 1: vector of packed values */
595
596 s->dec_type=1;
597 s->dec_nodeb=_determine_node_bytes(s->used_entries,(s->q_bits*s->dim+8)/8);
598 s->dec_leafw=_determine_leaf_words(s->dec_nodeb,(s->q_bits*s->dim+8)/8);
599 if(_make_decode_table(s,lengthlist,quantvals,opb,maptype))goto _errout;
600
601 }else{
602 /* use dec_type 3: scalar offset into packed value array */
603
604 s->dec_type=3;
605 s->dec_nodeb=_determine_node_bytes(s->used_entries,_ilog(s->used_entries-1)/8+1);
606 s->dec_leafw=_determine_leaf_words(s->dec_nodeb,_ilog(s->used_entries-1)/8+1);
607 if(_make_decode_table(s,lengthlist,quantvals,opb,maptype))goto _errout;
608
609 /* get the vals & pack them */
610 s->q_pack=(s->q_bits+7)/8*s->dim;
611 s->q_val=_ogg_malloc(s->q_pack*s->used_entries);
612
613 if(s->q_bits<=8){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700614 for(i=0;i<s->used_entries*s->dim;i++)
615 ((unsigned char *)(s->q_val))[i]=(unsigned char)oggpack_read(opb,s->q_bits);
Gloria Wang79130732010-02-08 14:41:04 -0800616 }else{
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700617 for(i=0;i<s->used_entries*s->dim;i++)
618 ((ogg_uint16_t *)(s->q_val))[i]=(ogg_uint16_t)oggpack_read(opb,s->q_bits);
Gloria Wang79130732010-02-08 14:41:04 -0800619 }
620 }
621 break;
622 default:
623 goto _errout;
624 }
625
626 if (s->dec_nodeb==1)
627 if (s->dec_leafw == 1)
628 s->dec_method = 0;
629 else
630 s->dec_method = 1;
631 else if (s->dec_nodeb==2)
632 if (s->dec_leafw == 1)
633 s->dec_method = 2;
634 else
635 s->dec_method = 3;
636 else
637 s->dec_method = 4;
638
639 if(oggpack_eop(opb))goto _eofout;
640
Marco Nelissen97fe1972013-10-25 15:31:23 -0700641 free(lengthlist);
Gloria Wang79130732010-02-08 14:41:04 -0800642 return 0;
643 _errout:
644 _eofout:
645 vorbis_book_clear(s);
Marco Nelissenafa1f6b2013-10-11 15:46:30 -0700646 free(lengthlist);
Marco Nelissen2e941e42015-04-30 13:45:34 -0700647 free(s->q_val);
Gloria Wang79130732010-02-08 14:41:04 -0800648 return -1;
649}
650
651#ifndef ONLY_C
652ogg_uint32_t decode_packed_entry_number(codebook *book,
653 oggpack_buffer *b);
654#else
655static inline ogg_uint32_t decode_packed_entry_number(codebook *book,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700656 oggpack_buffer *b){
Gloria Wang79130732010-02-08 14:41:04 -0800657 ogg_uint32_t chase=0;
658 int read=book->dec_maxlength;
659 long lok = oggpack_look(b,read),i;
660
661 while(lok<0 && read>1)
662 lok = oggpack_look(b, --read);
663
664 if(lok<0){
665 oggpack_adv(b,1); /* force eop */
666 return -1;
667 }
668
669 /* chase the tree with the bits we got */
670 switch (book->dec_method)
671 {
672 case 0:
673 {
674 /* book->dec_nodeb==1, book->dec_leafw==1 */
675 /* 8/8 - Used */
676 unsigned char *t=(unsigned char *)book->dec_table;
677
678 for(i=0;i<read;i++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700679 chase=t[chase*2+((lok>>i)&1)];
680 if(chase&0x80UL)break;
Gloria Wang79130732010-02-08 14:41:04 -0800681 }
682 chase&=0x7fUL;
683 break;
684 }
685 case 1:
686 {
687 /* book->dec_nodeb==1, book->dec_leafw!=1 */
688 /* 8/16 - Used by infile2 */
689 unsigned char *t=(unsigned char *)book->dec_table;
690 for(i=0;i<read;i++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700691 int bit=(lok>>i)&1;
692 int next=t[chase+bit];
693 if(next&0x80){
694 chase= (next<<8) | t[chase+bit+1+(!bit || t[chase]&0x80)];
695 break;
696 }
697 chase=next;
Gloria Wang79130732010-02-08 14:41:04 -0800698 }
699 //chase&=0x7fffUL;
700 chase&=~0x8000UL;
701 break;
702 }
703 case 2:
704 {
705 /* book->dec_nodeb==2, book->dec_leafw==1 */
706 /* 16/16 - Used */
707 for(i=0;i<read;i++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700708 chase=((ogg_uint16_t *)(book->dec_table))[chase*2+((lok>>i)&1)];
709 if(chase&0x8000UL)break;
Gloria Wang79130732010-02-08 14:41:04 -0800710 }
711 //chase&=0x7fffUL;
712 chase&=~0x8000UL;
713 break;
714 }
715 case 3:
716 {
717 /* book->dec_nodeb==2, book->dec_leafw!=1 */
718 /* 16/32 - Used by infile2 */
719 ogg_uint16_t *t=(ogg_uint16_t *)book->dec_table;
720 for(i=0;i<read;i++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700721 int bit=(lok>>i)&1;
722 int next=t[chase+bit];
723 if(next&0x8000){
724 chase= (next<<16) | t[chase+bit+1+(!bit || t[chase]&0x8000)];
725 break;
726 }
727 chase=next;
Gloria Wang79130732010-02-08 14:41:04 -0800728 }
729 //chase&=0x7fffffffUL;
730 chase&=~0x80000000UL;
731 break;
732 }
733 case 4:
734 {
Gloria Wangd75baf22010-02-12 16:28:30 -0800735 //Output("32/32");
Gloria Wang79130732010-02-08 14:41:04 -0800736 for(i=0;i<read;i++){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700737 chase=((ogg_uint32_t *)(book->dec_table))[chase*2+((lok>>i)&1)];
738 if(chase&0x80000000UL)break;
Gloria Wang79130732010-02-08 14:41:04 -0800739 }
740 //chase&=0x7fffffffUL;
741 chase&=~0x80000000UL;
742 break;
743 }
744 }
745
746 if(i<read){
747 oggpack_adv(b,i+1);
748 return chase;
749 }
750 oggpack_adv(b,read+1);
751 return(-1);
752}
753#endif
754
755/* returns the [original, not compacted] entry number or -1 on eof *********/
756long vorbis_book_decode(codebook *book, oggpack_buffer *b){
757 if(book->dec_type)return -1;
758 return decode_packed_entry_number(book,b);
759}
760
761#ifndef ONLY_C
762int decode_map(codebook *s, oggpack_buffer *b, ogg_int32_t *v, int point);
763#else
764static int decode_map(codebook *s, oggpack_buffer *b, ogg_int32_t *v, int point){
765 ogg_uint32_t entry = decode_packed_entry_number(s,b);
766 int i;
767 if(oggpack_eop(b))return(-1);
768
769 /* 1 used by test file 0 */
770
771 /* according to decode type */
772 switch(s->dec_type){
773 case 1:{
774 /* packed vector of values */
775 int mask=(1<<s->q_bits)-1;
776 for(i=0;i<s->dim;i++){
777 v[i]=entry&mask;
778 entry>>=s->q_bits;
779 }
780 break;
781 }
782 case 2:{
783 /* packed vector of column offsets */
784 int mask=(1<<s->q_pack)-1;
785 for(i=0;i<s->dim;i++){
786 if(s->q_bits<=8)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700787 v[i]=((unsigned char *)(s->q_val))[entry&mask];
Gloria Wang79130732010-02-08 14:41:04 -0800788 else
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700789 v[i]=((ogg_uint16_t *)(s->q_val))[entry&mask];
Gloria Wang79130732010-02-08 14:41:04 -0800790 entry>>=s->q_pack;
791 }
792 break;
793 }
794 case 3:{
795 /* offset into array */
Glenn Kasten946e1bc2016-04-06 07:47:11 -0700796 void *ptr=((char *)s->q_val)+entry*s->q_pack;
Gloria Wang79130732010-02-08 14:41:04 -0800797
798 if(s->q_bits<=8){
799 for(i=0;i<s->dim;i++)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700800 v[i]=((unsigned char *)ptr)[i];
Gloria Wang79130732010-02-08 14:41:04 -0800801 }else{
802 for(i=0;i<s->dim;i++)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700803 v[i]=((ogg_uint16_t *)ptr)[i];
Gloria Wang79130732010-02-08 14:41:04 -0800804 }
805 break;
806 }
807 default:
808 return -1;
809 }
810
811 /* we have the unpacked multiplicands; compute final vals */
812 {
813 int shiftM = point-s->q_delp;
814 ogg_int32_t add = point-s->q_minp;
815 int mul = s->q_del;
816
817 if(add>0)
818 add= s->q_min >> add;
819 else
820 add= s->q_min << -add;
821 if (shiftM<0)
822 {
823 mul <<= -shiftM;
824 shiftM = 0;
825 }
826 add <<= shiftM;
827
828 for(i=0;i<s->dim;i++)
829 v[i]= ((add + v[i] * mul) >> shiftM);
830
831 if(s->q_seq)
832 for(i=1;i<s->dim;i++)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700833 v[i]+=v[i-1];
Gloria Wang79130732010-02-08 14:41:04 -0800834 }
835
836 return 0;
837}
838#endif
839
840/* returns 0 on OK or -1 on eof *************************************/
841long vorbis_book_decodevs_add(codebook *book,ogg_int32_t *a,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700842 oggpack_buffer *b,int n,int point){
Gloria Wang79130732010-02-08 14:41:04 -0800843 if(book->used_entries>0){
844 int step=n/book->dim;
845 ogg_int32_t *v = book->dec_buf;//(ogg_int32_t *)alloca(sizeof(*v)*book->dim);
846 int i,j,o;
847 if (!v) return -1;
848
849 for (j=0;j<step;j++){
850 if(decode_map(book,b,v,point))return -1;
851 for(i=0,o=j;i<book->dim;i++,o+=step)
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700852 a[o]+=v[i];
Gloria Wang79130732010-02-08 14:41:04 -0800853 }
854 }
855 return 0;
856}
857
858long vorbis_book_decodev_add(codebook *book,ogg_int32_t *a,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700859 oggpack_buffer *b,int n,int point){
Gloria Wang79130732010-02-08 14:41:04 -0800860 if(book->used_entries>0){
861 ogg_int32_t *v = book->dec_buf;//(ogg_int32_t *)alloca(sizeof(*v)*book->dim);
862 int i,j;
863
864 if (!v) return -1;
865 for(i=0;i<n;){
866 if(decode_map(book,b,v,point))return -1;
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700867 for (j=0;j<book->dim && i < n;j++)
868 a[i++]+=v[j];
Gloria Wang79130732010-02-08 14:41:04 -0800869 }
870 }
871 return 0;
872}
873
874long vorbis_book_decodev_set(codebook *book,ogg_int32_t *a,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700875 oggpack_buffer *b,int n,int point){
Gloria Wang79130732010-02-08 14:41:04 -0800876 if(book->used_entries>0){
877 ogg_int32_t *v = book->dec_buf;//(ogg_int32_t *)alloca(sizeof(*v)*book->dim);
878 int i,j;
879
880 if (!v) return -1;
881 for(i=0;i<n;){
882 if(decode_map(book,b,v,point))return -1;
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700883 for (j=0;j<book->dim && i < n;j++)
884 a[i++]=v[j];
Gloria Wang79130732010-02-08 14:41:04 -0800885 }
886 }else{
887 int i,j;
888
889 for(i=0;i<n;){
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700890 for (j=0;j<book->dim && i < n;j++)
891 a[i++]=0;
Gloria Wang79130732010-02-08 14:41:04 -0800892 }
893 }
894
895 return 0;
896}
897
898#ifndef ONLY_C
899long vorbis_book_decodevv_add(codebook *book,ogg_int32_t **a,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700900 long offset,int ch,
901 oggpack_buffer *b,int n,int point);
Gloria Wang79130732010-02-08 14:41:04 -0800902#else
903long vorbis_book_decodevv_add(codebook *book,ogg_int32_t **a,
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700904 long offset,int ch,
905 oggpack_buffer *b,int n,int point){
Gloria Wang79130732010-02-08 14:41:04 -0800906 if(book->used_entries>0){
907
908 ogg_int32_t *v = book->dec_buf;//(ogg_int32_t *)alloca(sizeof(*v)*book->dim);
909 long i,j;
910 int chptr=0;
911
912 if (!v) return -1;
913 for(i=offset;i<offset+n;){
914 if(decode_map(book,b,v,point))return -1;
Marco Nelissen2c4c4bd2017-07-17 15:54:28 -0700915 for (j=0;j<book->dim && i < offset + n;j++){
916 a[chptr++][i]+=v[j];
917 if(chptr==ch){
918 chptr=0;
919 i++;
920 }
Gloria Wang79130732010-02-08 14:41:04 -0800921 }
922 }
923 }
924
925 return 0;
926}
927#endif