2 * This file is part of Libav.
4 * Libav is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU Lesser General Public
6 * License as published by the Free Software Foundation; either
7 * version 2.1 of the License, or (at your option) any later version.
9 * Libav is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * Lesser General Public License for more details.
14 * You should have received a copy of the GNU Lesser General Public
15 * License along with Libav; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
22 * @author Denes Balatoni ( dbalatoni programozo hu )
28 #include "libavutil/float_dsp.h"
30 #define BITSTREAM_READER_LE
37 #include "vorbisdsp.h"
42 #define V_MAX_VLCS (1 << 16)
43 #define V_MAX_PARTITIONS (1 << 20)
45 typedef struct vorbis_codebook
{
54 typedef union vorbis_floor_u vorbis_floor_data
;
55 typedef struct vorbis_floor0_s vorbis_floor0
;
56 typedef struct vorbis_floor1_s vorbis_floor1
;
57 struct vorbis_context_s
;
59 int (* vorbis_floor_decode_func
)
60 (struct vorbis_context_s
*, vorbis_floor_data
*, float *);
61 typedef struct vorbis_floor
{
63 vorbis_floor_decode_func decode
;
64 union vorbis_floor_u
{
65 struct vorbis_floor0_s
{
68 uint16_t bark_map_size
;
71 uint8_t amplitude_bits
;
72 uint8_t amplitude_offset
;
77 struct vorbis_floor1_s
{
79 uint8_t partition_class
[32];
80 uint8_t class_dimensions
[16];
81 uint8_t class_subclasses
[16];
82 uint8_t class_masterbook
[16];
83 int16_t subclass_books
[16][8];
86 vorbis_floor1_entry
*list
;
91 typedef struct vorbis_residue
{
95 unsigned partition_size
;
96 uint8_t classifications
;
100 uint16_t ptns_to_read
;
104 typedef struct vorbis_mapping
{
106 uint16_t coupling_steps
;
110 uint8_t submap_floor
[16];
111 uint8_t submap_residue
[16];
114 typedef struct vorbis_mode
{
117 uint16_t transformtype
;
121 typedef struct vorbis_context_s
{
122 AVCodecContext
*avctx
;
124 VorbisDSPContext dsp
;
125 AVFloatDSPContext fdsp
;
130 uint8_t audio_channels
;
131 uint32_t audio_samplerate
;
132 uint32_t bitrate_maximum
;
133 uint32_t bitrate_nominal
;
134 uint32_t bitrate_minimum
;
135 uint32_t blocksize
[2];
137 uint16_t codebook_count
;
138 vorbis_codebook
*codebooks
;
140 vorbis_floor
*floors
;
141 uint8_t residue_count
;
142 vorbis_residue
*residues
;
143 uint8_t mapping_count
;
144 vorbis_mapping
*mappings
;
147 uint8_t mode_number
; // mode number for the current packet
148 uint8_t previous_window
;
149 float *channel_residues
;
153 /* Helper functions */
156 (13.1f * atan(0.00074f * (x)) + 2.24f * atan(1.85e-8f * (x) * (x)) + 1e-4f * (x))
158 static const char idx_err_str
[] = "Index value %d out of range (0 - %d) for %s at %s:%i\n";
159 #define VALIDATE_INDEX(idx, limit) \
161 av_log(vc->avctx, AV_LOG_ERROR,\
163 (int)(idx), (int)(limit - 1), #idx, __FILE__, __LINE__);\
164 return AVERROR_INVALIDDATA;\
166 #define GET_VALIDATED_INDEX(idx, bits, limit) \
168 idx = get_bits(gb, bits);\
169 VALIDATE_INDEX(idx, limit)\
172 static float vorbisfloat2float(unsigned val
)
174 double mant
= val
& 0x1fffff;
175 long exp
= (val
& 0x7fe00000L
) >> 21;
176 if (val
& 0x80000000)
178 return ldexp(mant
, exp
- 20 - 768);
182 // Free all allocated memory -----------------------------------------
184 static void vorbis_free(vorbis_context
*vc
)
188 av_freep(&vc
->channel_residues
);
189 av_freep(&vc
->saved
);
191 for (i
= 0; i
< vc
->residue_count
; i
++)
192 av_free(vc
->residues
[i
].classifs
);
193 av_freep(&vc
->residues
);
194 av_freep(&vc
->modes
);
196 ff_mdct_end(&vc
->mdct
[0]);
197 ff_mdct_end(&vc
->mdct
[1]);
199 for (i
= 0; i
< vc
->codebook_count
; ++i
) {
200 av_free(vc
->codebooks
[i
].codevectors
);
201 ff_free_vlc(&vc
->codebooks
[i
].vlc
);
203 av_freep(&vc
->codebooks
);
205 for (i
= 0; i
< vc
->floor_count
; ++i
) {
206 if (vc
->floors
[i
].floor_type
== 0) {
207 av_free(vc
->floors
[i
].data
.t0
.map
[0]);
208 av_free(vc
->floors
[i
].data
.t0
.map
[1]);
209 av_free(vc
->floors
[i
].data
.t0
.book_list
);
210 av_free(vc
->floors
[i
].data
.t0
.lsp
);
212 av_free(vc
->floors
[i
].data
.t1
.list
);
215 av_freep(&vc
->floors
);
217 for (i
= 0; i
< vc
->mapping_count
; ++i
) {
218 av_free(vc
->mappings
[i
].magnitude
);
219 av_free(vc
->mappings
[i
].angle
);
220 av_free(vc
->mappings
[i
].mux
);
222 av_freep(&vc
->mappings
);
225 // Parse setup header -------------------------------------------------
227 // Process codebooks part
229 static int vorbis_parse_setup_hdr_codebooks(vorbis_context
*vc
)
232 uint8_t *tmp_vlc_bits
= NULL
;
233 uint32_t *tmp_vlc_codes
= NULL
;
234 GetBitContext
*gb
= &vc
->gb
;
235 uint16_t *codebook_multiplicands
= NULL
;
238 vc
->codebook_count
= get_bits(gb
, 8) + 1;
240 ff_dlog(NULL
, " Codebooks: %d \n", vc
->codebook_count
);
242 vc
->codebooks
= av_mallocz(vc
->codebook_count
* sizeof(*vc
->codebooks
));
243 tmp_vlc_bits
= av_mallocz(V_MAX_VLCS
* sizeof(*tmp_vlc_bits
));
244 tmp_vlc_codes
= av_mallocz(V_MAX_VLCS
* sizeof(*tmp_vlc_codes
));
245 codebook_multiplicands
= av_malloc(V_MAX_VLCS
* sizeof(*codebook_multiplicands
));
246 if (!vc
->codebooks
||
247 !tmp_vlc_bits
|| !tmp_vlc_codes
|| !codebook_multiplicands
) {
248 ret
= AVERROR(ENOMEM
);
252 for (cb
= 0; cb
< vc
->codebook_count
; ++cb
) {
253 vorbis_codebook
*codebook_setup
= &vc
->codebooks
[cb
];
254 unsigned ordered
, t
, entries
, used_entries
= 0;
256 ff_dlog(NULL
, " %u. Codebook\n", cb
);
258 if (get_bits(gb
, 24) != 0x564342) {
259 av_log(vc
->avctx
, AV_LOG_ERROR
,
260 " %u. Codebook setup data corrupt.\n", cb
);
261 ret
= AVERROR_INVALIDDATA
;
265 codebook_setup
->dimensions
=get_bits(gb
, 16);
266 if (codebook_setup
->dimensions
> 16 || codebook_setup
->dimensions
== 0) {
267 av_log(vc
->avctx
, AV_LOG_ERROR
,
268 " %u. Codebook's dimension is invalid (%d).\n",
269 cb
, codebook_setup
->dimensions
);
270 ret
= AVERROR_INVALIDDATA
;
273 entries
= get_bits(gb
, 24);
274 if (entries
> V_MAX_VLCS
) {
275 av_log(vc
->avctx
, AV_LOG_ERROR
,
276 " %u. Codebook has too many entries (%u).\n",
278 ret
= AVERROR_INVALIDDATA
;
282 ordered
= get_bits1(gb
);
284 ff_dlog(NULL
, " codebook_dimensions %d, codebook_entries %u\n",
285 codebook_setup
->dimensions
, entries
);
289 unsigned sparse
= get_bits1(gb
);
291 ff_dlog(NULL
, " not ordered \n");
294 ff_dlog(NULL
, " sparse \n");
297 for (ce
= 0; ce
< entries
; ++ce
) {
298 flag
= get_bits1(gb
);
300 tmp_vlc_bits
[ce
] = get_bits(gb
, 5) + 1;
303 tmp_vlc_bits
[ce
] = 0;
306 ff_dlog(NULL
, " not sparse \n");
308 used_entries
= entries
;
309 for (ce
= 0; ce
< entries
; ++ce
)
310 tmp_vlc_bits
[ce
] = get_bits(gb
, 5) + 1;
313 unsigned current_entry
= 0;
314 unsigned current_length
= get_bits(gb
, 5) + 1;
316 ff_dlog(NULL
, " ordered, current length: %u\n", current_length
); //FIXME
318 used_entries
= entries
;
319 for (; current_entry
< used_entries
&& current_length
<= 32; ++current_length
) {
322 ff_dlog(NULL
, " number bits: %u ", ilog(entries
- current_entry
));
324 number
= get_bits(gb
, ilog(entries
- current_entry
));
326 ff_dlog(NULL
, " number: %u\n", number
);
328 for (i
= current_entry
; i
< number
+current_entry
; ++i
)
329 if (i
< used_entries
)
330 tmp_vlc_bits
[i
] = current_length
;
332 current_entry
+=number
;
334 if (current_entry
>used_entries
) {
335 av_log(vc
->avctx
, AV_LOG_ERROR
, " More codelengths than codes in codebook. \n");
336 ret
= AVERROR_INVALIDDATA
;
341 codebook_setup
->lookup_type
= get_bits(gb
, 4);
343 ff_dlog(NULL
, " lookup type: %d : %s \n", codebook_setup
->lookup_type
,
344 codebook_setup
->lookup_type
? "vq" : "no lookup");
346 // If the codebook is used for (inverse) VQ, calculate codevectors.
348 if (codebook_setup
->lookup_type
== 1) {
350 unsigned codebook_lookup_values
= ff_vorbis_nth_root(entries
, codebook_setup
->dimensions
);
352 float codebook_minimum_value
= vorbisfloat2float(get_bits_long(gb
, 32));
353 float codebook_delta_value
= vorbisfloat2float(get_bits_long(gb
, 32));
354 unsigned codebook_value_bits
= get_bits(gb
, 4) + 1;
355 unsigned codebook_sequence_p
= get_bits1(gb
);
357 ff_dlog(NULL
, " We expect %d numbers for building the codevectors. \n",
358 codebook_lookup_values
);
359 ff_dlog(NULL
, " delta %f minmum %f \n",
360 codebook_delta_value
, codebook_minimum_value
);
362 for (i
= 0; i
< codebook_lookup_values
; ++i
) {
363 codebook_multiplicands
[i
] = get_bits(gb
, codebook_value_bits
);
365 ff_dlog(NULL
, " multiplicands*delta+minmum : %e \n",
366 (float)codebook_multiplicands
[i
] * codebook_delta_value
+ codebook_minimum_value
);
367 ff_dlog(NULL
, " multiplicand %u\n", codebook_multiplicands
[i
]);
370 // Weed out unused vlcs and build codevector vector
372 codebook_setup
->codevectors
=
373 av_mallocz(used_entries
* codebook_setup
->dimensions
*
374 sizeof(*codebook_setup
->codevectors
));
375 if (!codebook_setup
->codevectors
)
376 return AVERROR(ENOMEM
);
378 codebook_setup
->codevectors
= NULL
;
380 for (j
= 0, i
= 0; i
< entries
; ++i
) {
381 unsigned dim
= codebook_setup
->dimensions
;
383 if (tmp_vlc_bits
[i
]) {
385 unsigned lookup_offset
= i
;
387 ff_dlog(vc
->avctx
, "Lookup offset %u ,", i
);
389 for (k
= 0; k
< dim
; ++k
) {
390 unsigned multiplicand_offset
= lookup_offset
% codebook_lookup_values
;
391 codebook_setup
->codevectors
[j
* dim
+ k
] = codebook_multiplicands
[multiplicand_offset
] * codebook_delta_value
+ codebook_minimum_value
+ last
;
392 if (codebook_sequence_p
)
393 last
= codebook_setup
->codevectors
[j
* dim
+ k
];
394 lookup_offset
/=codebook_lookup_values
;
396 tmp_vlc_bits
[j
] = tmp_vlc_bits
[i
];
398 ff_dlog(vc
->avctx
, "real lookup offset %u, vector: ", j
);
399 for (k
= 0; k
< dim
; ++k
)
400 ff_dlog(vc
->avctx
, " %f ",
401 codebook_setup
->codevectors
[j
* dim
+ k
]);
402 ff_dlog(vc
->avctx
, "\n");
407 if (j
!= used_entries
) {
408 av_log(vc
->avctx
, AV_LOG_ERROR
, "Bug in codevector vector building code. \n");
409 ret
= AVERROR_INVALIDDATA
;
412 entries
= used_entries
;
413 } else if (codebook_setup
->lookup_type
>= 2) {
414 av_log(vc
->avctx
, AV_LOG_ERROR
, "Codebook lookup type not supported. \n");
415 ret
= AVERROR_INVALIDDATA
;
419 // Initialize VLC table
420 if (ff_vorbis_len2vlc(tmp_vlc_bits
, tmp_vlc_codes
, entries
)) {
421 av_log(vc
->avctx
, AV_LOG_ERROR
, " Invalid code lengths while generating vlcs. \n");
422 ret
= AVERROR_INVALIDDATA
;
425 codebook_setup
->maxdepth
= 0;
426 for (t
= 0; t
< entries
; ++t
)
427 if (tmp_vlc_bits
[t
] >= codebook_setup
->maxdepth
)
428 codebook_setup
->maxdepth
= tmp_vlc_bits
[t
];
430 if (codebook_setup
->maxdepth
> 3 * V_NB_BITS
)
431 codebook_setup
->nb_bits
= V_NB_BITS2
;
433 codebook_setup
->nb_bits
= V_NB_BITS
;
435 codebook_setup
->maxdepth
= (codebook_setup
->maxdepth
+codebook_setup
->nb_bits
- 1) / codebook_setup
->nb_bits
;
437 if ((ret
= init_vlc(&codebook_setup
->vlc
, codebook_setup
->nb_bits
,
438 entries
, tmp_vlc_bits
, sizeof(*tmp_vlc_bits
),
439 sizeof(*tmp_vlc_bits
), tmp_vlc_codes
,
440 sizeof(*tmp_vlc_codes
), sizeof(*tmp_vlc_codes
),
442 av_log(vc
->avctx
, AV_LOG_ERROR
, " Error generating vlc tables. \n");
447 av_free(tmp_vlc_bits
);
448 av_free(tmp_vlc_codes
);
449 av_free(codebook_multiplicands
);
454 av_free(tmp_vlc_bits
);
455 av_free(tmp_vlc_codes
);
456 av_free(codebook_multiplicands
);
460 // Process time domain transforms part (unused in Vorbis I)
462 static int vorbis_parse_setup_hdr_tdtransforms(vorbis_context
*vc
)
464 GetBitContext
*gb
= &vc
->gb
;
465 unsigned i
, vorbis_time_count
= get_bits(gb
, 6) + 1;
467 for (i
= 0; i
< vorbis_time_count
; ++i
) {
468 unsigned vorbis_tdtransform
= get_bits(gb
, 16);
470 ff_dlog(NULL
, " Vorbis time domain transform %u: %u\n",
471 vorbis_time_count
, vorbis_tdtransform
);
473 if (vorbis_tdtransform
) {
474 av_log(vc
->avctx
, AV_LOG_ERROR
, "Vorbis time domain transform data nonzero. \n");
475 return AVERROR_INVALIDDATA
;
481 // Process floors part
483 static int vorbis_floor0_decode(vorbis_context
*vc
,
484 vorbis_floor_data
*vfu
, float *vec
);
485 static int create_map(vorbis_context
*vc
, unsigned floor_number
);
486 static int vorbis_floor1_decode(vorbis_context
*vc
,
487 vorbis_floor_data
*vfu
, float *vec
);
488 static int vorbis_parse_setup_hdr_floors(vorbis_context
*vc
)
490 GetBitContext
*gb
= &vc
->gb
;
493 vc
->floor_count
= get_bits(gb
, 6) + 1;
495 vc
->floors
= av_mallocz(vc
->floor_count
* sizeof(*vc
->floors
));
497 return AVERROR(ENOMEM
);
499 for (i
= 0; i
< vc
->floor_count
; ++i
) {
500 vorbis_floor
*floor_setup
= &vc
->floors
[i
];
502 floor_setup
->floor_type
= get_bits(gb
, 16);
504 ff_dlog(NULL
, " %d. floor type %d \n", i
, floor_setup
->floor_type
);
506 if (floor_setup
->floor_type
== 1) {
507 int maximum_class
= -1;
508 unsigned rangebits
, rangemax
, floor1_values
= 2;
510 floor_setup
->decode
= vorbis_floor1_decode
;
512 floor_setup
->data
.t1
.partitions
= get_bits(gb
, 5);
514 ff_dlog(NULL
, " %d.floor: %d partitions \n",
515 i
, floor_setup
->data
.t1
.partitions
);
517 for (j
= 0; j
< floor_setup
->data
.t1
.partitions
; ++j
) {
518 floor_setup
->data
.t1
.partition_class
[j
] = get_bits(gb
, 4);
519 if (floor_setup
->data
.t1
.partition_class
[j
] > maximum_class
)
520 maximum_class
= floor_setup
->data
.t1
.partition_class
[j
];
522 ff_dlog(NULL
, " %d. floor %d partition class %d \n",
523 i
, j
, floor_setup
->data
.t1
.partition_class
[j
]);
527 ff_dlog(NULL
, " maximum class %d \n", maximum_class
);
529 for (j
= 0; j
<= maximum_class
; ++j
) {
530 floor_setup
->data
.t1
.class_dimensions
[j
] = get_bits(gb
, 3) + 1;
531 floor_setup
->data
.t1
.class_subclasses
[j
] = get_bits(gb
, 2);
533 ff_dlog(NULL
, " %d floor %d class dim: %d subclasses %d \n", i
, j
,
534 floor_setup
->data
.t1
.class_dimensions
[j
],
535 floor_setup
->data
.t1
.class_subclasses
[j
]);
537 if (floor_setup
->data
.t1
.class_subclasses
[j
]) {
538 GET_VALIDATED_INDEX(floor_setup
->data
.t1
.class_masterbook
[j
], 8, vc
->codebook_count
)
540 ff_dlog(NULL
, " masterbook: %d \n", floor_setup
->data
.t1
.class_masterbook
[j
]);
543 for (k
= 0; k
< (1 << floor_setup
->data
.t1
.class_subclasses
[j
]); ++k
) {
544 int16_t bits
= get_bits(gb
, 8) - 1;
546 VALIDATE_INDEX(bits
, vc
->codebook_count
)
547 floor_setup
->data
.t1
.subclass_books
[j
][k
] = bits
;
549 ff_dlog(NULL
, " book %d. : %d \n", k
, floor_setup
->data
.t1
.subclass_books
[j
][k
]);
553 floor_setup
->data
.t1
.multiplier
= get_bits(gb
, 2) + 1;
554 floor_setup
->data
.t1
.x_list_dim
= 2;
556 for (j
= 0; j
< floor_setup
->data
.t1
.partitions
; ++j
)
557 floor_setup
->data
.t1
.x_list_dim
+=floor_setup
->data
.t1
.class_dimensions
[floor_setup
->data
.t1
.partition_class
[j
]];
559 floor_setup
->data
.t1
.list
= av_mallocz(floor_setup
->data
.t1
.x_list_dim
*
560 sizeof(*floor_setup
->data
.t1
.list
));
561 if (!floor_setup
->data
.t1
.list
)
562 return AVERROR(ENOMEM
);
564 rangebits
= get_bits(gb
, 4);
565 rangemax
= (1 << rangebits
);
566 if (rangemax
> vc
->blocksize
[1] / 2) {
567 av_log(vc
->avctx
, AV_LOG_ERROR
,
568 "Floor value is too large for blocksize: %u (%"PRIu32
")\n",
569 rangemax
, vc
->blocksize
[1] / 2);
570 return AVERROR_INVALIDDATA
;
572 floor_setup
->data
.t1
.list
[0].x
= 0;
573 floor_setup
->data
.t1
.list
[1].x
= rangemax
;
575 for (j
= 0; j
< floor_setup
->data
.t1
.partitions
; ++j
) {
576 for (k
= 0; k
< floor_setup
->data
.t1
.class_dimensions
[floor_setup
->data
.t1
.partition_class
[j
]]; ++k
, ++floor1_values
) {
577 floor_setup
->data
.t1
.list
[floor1_values
].x
= get_bits(gb
, rangebits
);
579 ff_dlog(NULL
, " %u. floor1 Y coord. %d\n", floor1_values
,
580 floor_setup
->data
.t1
.list
[floor1_values
].x
);
584 // Precalculate order of x coordinates - needed for decode
585 if (ff_vorbis_ready_floor1_list(vc
->avctx
,
586 floor_setup
->data
.t1
.list
,
587 floor_setup
->data
.t1
.x_list_dim
)) {
588 return AVERROR_INVALIDDATA
;
590 } else if (floor_setup
->floor_type
== 0) {
591 unsigned max_codebook_dim
= 0;
593 floor_setup
->decode
= vorbis_floor0_decode
;
595 floor_setup
->data
.t0
.order
= get_bits(gb
, 8);
596 if (!floor_setup
->data
.t0
.order
) {
597 av_log(vc
->avctx
, AV_LOG_ERROR
, "Floor 0 order is 0.\n");
598 return AVERROR_INVALIDDATA
;
600 floor_setup
->data
.t0
.rate
= get_bits(gb
, 16);
601 if (!floor_setup
->data
.t0
.rate
) {
602 av_log(vc
->avctx
, AV_LOG_ERROR
, "Floor 0 rate is 0.\n");
603 return AVERROR_INVALIDDATA
;
605 floor_setup
->data
.t0
.bark_map_size
= get_bits(gb
, 16);
606 if (!floor_setup
->data
.t0
.bark_map_size
) {
607 av_log(vc
->avctx
, AV_LOG_ERROR
,
608 "Floor 0 bark map size is 0.\n");
609 return AVERROR_INVALIDDATA
;
611 floor_setup
->data
.t0
.amplitude_bits
= get_bits(gb
, 6);
612 floor_setup
->data
.t0
.amplitude_offset
= get_bits(gb
, 8);
613 floor_setup
->data
.t0
.num_books
= get_bits(gb
, 4) + 1;
615 /* allocate mem for booklist */
616 floor_setup
->data
.t0
.book_list
=
617 av_malloc(floor_setup
->data
.t0
.num_books
);
618 if (!floor_setup
->data
.t0
.book_list
)
619 return AVERROR(ENOMEM
);
620 /* read book indexes */
624 for (idx
= 0; idx
< floor_setup
->data
.t0
.num_books
; ++idx
) {
625 GET_VALIDATED_INDEX(book_idx
, 8, vc
->codebook_count
)
626 floor_setup
->data
.t0
.book_list
[idx
] = book_idx
;
627 if (vc
->codebooks
[book_idx
].dimensions
> max_codebook_dim
)
628 max_codebook_dim
= vc
->codebooks
[book_idx
].dimensions
;
632 if ((ret
= create_map(vc
, i
)) < 0)
635 /* codebook dim is for padding if codebook dim doesn't *
636 * divide order+1 then we need to read more data */
637 floor_setup
->data
.t0
.lsp
=
638 av_malloc((floor_setup
->data
.t0
.order
+ 1 + max_codebook_dim
)
639 * sizeof(*floor_setup
->data
.t0
.lsp
));
640 if (!floor_setup
->data
.t0
.lsp
)
641 return AVERROR(ENOMEM
);
643 /* debug output parsed headers */
644 ff_dlog(NULL
, "floor0 order: %u\n", floor_setup
->data
.t0
.order
);
645 ff_dlog(NULL
, "floor0 rate: %u\n", floor_setup
->data
.t0
.rate
);
646 ff_dlog(NULL
, "floor0 bark map size: %u\n",
647 floor_setup
->data
.t0
.bark_map_size
);
648 ff_dlog(NULL
, "floor0 amplitude bits: %u\n",
649 floor_setup
->data
.t0
.amplitude_bits
);
650 ff_dlog(NULL
, "floor0 amplitude offset: %u\n",
651 floor_setup
->data
.t0
.amplitude_offset
);
652 ff_dlog(NULL
, "floor0 number of books: %u\n",
653 floor_setup
->data
.t0
.num_books
);
654 ff_dlog(NULL
, "floor0 book list pointer: %p\n",
655 floor_setup
->data
.t0
.book_list
);
658 for (idx
= 0; idx
< floor_setup
->data
.t0
.num_books
; ++idx
) {
659 ff_dlog(NULL
, " Book %d: %u\n", idx
+ 1,
660 floor_setup
->data
.t0
.book_list
[idx
]);
664 av_log(vc
->avctx
, AV_LOG_ERROR
, "Invalid floor type!\n");
665 return AVERROR_INVALIDDATA
;
671 // Process residues part
673 static int vorbis_parse_setup_hdr_residues(vorbis_context
*vc
)
675 GetBitContext
*gb
= &vc
->gb
;
678 vc
->residue_count
= get_bits(gb
, 6)+1;
679 vc
->residues
= av_mallocz(vc
->residue_count
* sizeof(*vc
->residues
));
681 return AVERROR(ENOMEM
);
683 ff_dlog(NULL
, " There are %d residues. \n", vc
->residue_count
);
685 for (i
= 0; i
< vc
->residue_count
; ++i
) {
686 vorbis_residue
*res_setup
= &vc
->residues
[i
];
688 unsigned high_bits
, low_bits
;
690 res_setup
->type
= get_bits(gb
, 16);
692 ff_dlog(NULL
, " %u. residue type %d\n", i
, res_setup
->type
);
694 res_setup
->begin
= get_bits(gb
, 24);
695 res_setup
->end
= get_bits(gb
, 24);
696 res_setup
->partition_size
= get_bits(gb
, 24) + 1;
697 /* Validations to prevent a buffer overflow later. */
698 if (res_setup
->begin
>res_setup
->end
||
699 res_setup
->end
> (res_setup
->type
== 2 ? vc
->avctx
->channels
: 1) * vc
->blocksize
[1] / 2 ||
700 (res_setup
->end
-res_setup
->begin
) / res_setup
->partition_size
> V_MAX_PARTITIONS
) {
701 av_log(vc
->avctx
, AV_LOG_ERROR
,
702 "partition out of bounds: type, begin, end, size, blocksize: %"PRIu16
", %"PRIu32
", %"PRIu32
", %u, %"PRIu32
"\n",
703 res_setup
->type
, res_setup
->begin
, res_setup
->end
,
704 res_setup
->partition_size
, vc
->blocksize
[1] / 2);
705 return AVERROR_INVALIDDATA
;
708 res_setup
->classifications
= get_bits(gb
, 6) + 1;
709 GET_VALIDATED_INDEX(res_setup
->classbook
, 8, vc
->codebook_count
)
711 res_setup
->ptns_to_read
=
712 (res_setup
->end
- res_setup
->begin
) / res_setup
->partition_size
;
713 res_setup
->classifs
= av_malloc(res_setup
->ptns_to_read
*
715 sizeof(*res_setup
->classifs
));
716 if (!res_setup
->classifs
)
717 return AVERROR(ENOMEM
);
719 ff_dlog(NULL
, " begin %"PRIu32
" end %"PRIu32
" part.size %u classif.s %"PRIu8
" classbook %"PRIu8
"\n",
720 res_setup
->begin
, res_setup
->end
, res_setup
->partition_size
,
721 res_setup
->classifications
, res_setup
->classbook
);
723 for (j
= 0; j
< res_setup
->classifications
; ++j
) {
725 low_bits
= get_bits(gb
, 3);
727 high_bits
= get_bits(gb
, 5);
728 cascade
[j
] = (high_bits
<< 3) + low_bits
;
730 ff_dlog(NULL
, " %u class cascade depth: %d\n", j
, ilog(cascade
[j
]));
733 res_setup
->maxpass
= 0;
734 for (j
= 0; j
< res_setup
->classifications
; ++j
) {
735 for (k
= 0; k
< 8; ++k
) {
736 if (cascade
[j
]&(1 << k
)) {
737 GET_VALIDATED_INDEX(res_setup
->books
[j
][k
], 8, vc
->codebook_count
)
739 ff_dlog(NULL
, " %u class cascade depth %u book: %d\n",
740 j
, k
, res_setup
->books
[j
][k
]);
742 if (k
>res_setup
->maxpass
)
743 res_setup
->maxpass
= k
;
745 res_setup
->books
[j
][k
] = -1;
753 // Process mappings part
755 static int vorbis_parse_setup_hdr_mappings(vorbis_context
*vc
)
757 GetBitContext
*gb
= &vc
->gb
;
760 vc
->mapping_count
= get_bits(gb
, 6)+1;
761 vc
->mappings
= av_mallocz(vc
->mapping_count
* sizeof(*vc
->mappings
));
763 return AVERROR(ENOMEM
);
765 ff_dlog(NULL
, " There are %d mappings. \n", vc
->mapping_count
);
767 for (i
= 0; i
< vc
->mapping_count
; ++i
) {
768 vorbis_mapping
*mapping_setup
= &vc
->mappings
[i
];
770 if (get_bits(gb
, 16)) {
771 av_log(vc
->avctx
, AV_LOG_ERROR
, "Other mappings than type 0 are not compliant with the Vorbis I specification. \n");
772 return AVERROR_INVALIDDATA
;
775 mapping_setup
->submaps
= get_bits(gb
, 4) + 1;
777 mapping_setup
->submaps
= 1;
781 mapping_setup
->coupling_steps
= get_bits(gb
, 8) + 1;
782 mapping_setup
->magnitude
= av_mallocz(mapping_setup
->coupling_steps
*
783 sizeof(*mapping_setup
->magnitude
));
784 mapping_setup
->angle
= av_mallocz(mapping_setup
->coupling_steps
*
785 sizeof(*mapping_setup
->angle
));
786 if (!mapping_setup
->angle
|| !mapping_setup
->magnitude
)
787 return AVERROR(ENOMEM
);
789 for (j
= 0; j
< mapping_setup
->coupling_steps
; ++j
) {
790 GET_VALIDATED_INDEX(mapping_setup
->magnitude
[j
], ilog(vc
->audio_channels
- 1), vc
->audio_channels
)
791 GET_VALIDATED_INDEX(mapping_setup
->angle
[j
], ilog(vc
->audio_channels
- 1), vc
->audio_channels
)
794 mapping_setup
->coupling_steps
= 0;
797 ff_dlog(NULL
, " %u mapping coupling steps: %d\n",
798 i
, mapping_setup
->coupling_steps
);
800 if (get_bits(gb
, 2)) {
801 av_log(vc
->avctx
, AV_LOG_ERROR
, "%u. mapping setup data invalid.\n", i
);
802 return AVERROR_INVALIDDATA
; // following spec.
805 if (mapping_setup
->submaps
>1) {
806 mapping_setup
->mux
= av_mallocz(vc
->audio_channels
*
807 sizeof(*mapping_setup
->mux
));
808 if (!mapping_setup
->mux
)
809 return AVERROR(ENOMEM
);
811 for (j
= 0; j
< vc
->audio_channels
; ++j
)
812 mapping_setup
->mux
[j
] = get_bits(gb
, 4);
815 for (j
= 0; j
< mapping_setup
->submaps
; ++j
) {
816 skip_bits(gb
, 8); // FIXME check?
817 GET_VALIDATED_INDEX(mapping_setup
->submap_floor
[j
], 8, vc
->floor_count
)
818 GET_VALIDATED_INDEX(mapping_setup
->submap_residue
[j
], 8, vc
->residue_count
)
820 ff_dlog(NULL
, " %u mapping %u submap : floor %d, residue %d\n", i
, j
,
821 mapping_setup
->submap_floor
[j
],
822 mapping_setup
->submap_residue
[j
]);
828 // Process modes part
830 static int create_map(vorbis_context
*vc
, unsigned floor_number
)
832 vorbis_floor
*floors
= vc
->floors
;
838 for (blockflag
= 0; blockflag
< 2; ++blockflag
) {
839 n
= vc
->blocksize
[blockflag
] / 2;
840 floors
[floor_number
].data
.t0
.map
[blockflag
] =
841 av_malloc((n
+ 1) * sizeof(int32_t)); // n + sentinel
842 if (!floors
[floor_number
].data
.t0
.map
[blockflag
])
843 return AVERROR(ENOMEM
);
845 map
= floors
[floor_number
].data
.t0
.map
[blockflag
];
846 vf
= &floors
[floor_number
].data
.t0
;
848 for (idx
= 0; idx
< n
; ++idx
) {
849 map
[idx
] = floor(BARK((vf
->rate
* idx
) / (2.0f
* n
)) *
850 (vf
->bark_map_size
/ BARK(vf
->rate
/ 2.0f
)));
851 if (vf
->bark_map_size
-1 < map
[idx
])
852 map
[idx
] = vf
->bark_map_size
- 1;
855 vf
->map_size
[blockflag
] = n
;
858 for (idx
= 0; idx
<= n
; ++idx
) {
859 ff_dlog(NULL
, "floor0 map: map at pos %d is %"PRId32
"\n", idx
, map
[idx
]);
865 static int vorbis_parse_setup_hdr_modes(vorbis_context
*vc
)
867 GetBitContext
*gb
= &vc
->gb
;
870 vc
->mode_count
= get_bits(gb
, 6) + 1;
871 vc
->modes
= av_mallocz(vc
->mode_count
* sizeof(*vc
->modes
));
873 return AVERROR(ENOMEM
);
875 ff_dlog(NULL
, " There are %d modes.\n", vc
->mode_count
);
877 for (i
= 0; i
< vc
->mode_count
; ++i
) {
878 vorbis_mode
*mode_setup
= &vc
->modes
[i
];
880 mode_setup
->blockflag
= get_bits1(gb
);
881 mode_setup
->windowtype
= get_bits(gb
, 16); //FIXME check
882 mode_setup
->transformtype
= get_bits(gb
, 16); //FIXME check
883 GET_VALIDATED_INDEX(mode_setup
->mapping
, 8, vc
->mapping_count
);
885 ff_dlog(NULL
, " %u mode: blockflag %d, windowtype %d, transformtype %d, mapping %d\n",
886 i
, mode_setup
->blockflag
, mode_setup
->windowtype
,
887 mode_setup
->transformtype
, mode_setup
->mapping
);
892 // Process the whole setup header using the functions above
894 static int vorbis_parse_setup_hdr(vorbis_context
*vc
)
896 GetBitContext
*gb
= &vc
->gb
;
899 if ((get_bits(gb
, 8) != 'v') || (get_bits(gb
, 8) != 'o') ||
900 (get_bits(gb
, 8) != 'r') || (get_bits(gb
, 8) != 'b') ||
901 (get_bits(gb
, 8) != 'i') || (get_bits(gb
, 8) != 's')) {
902 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (no vorbis signature). \n");
903 return AVERROR_INVALIDDATA
;
906 if ((ret
= vorbis_parse_setup_hdr_codebooks(vc
))) {
907 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (codebooks). \n");
910 if ((ret
= vorbis_parse_setup_hdr_tdtransforms(vc
))) {
911 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (time domain transforms). \n");
914 if ((ret
= vorbis_parse_setup_hdr_floors(vc
))) {
915 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (floors). \n");
918 if ((ret
= vorbis_parse_setup_hdr_residues(vc
))) {
919 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (residues). \n");
922 if ((ret
= vorbis_parse_setup_hdr_mappings(vc
))) {
923 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (mappings). \n");
926 if ((ret
= vorbis_parse_setup_hdr_modes(vc
))) {
927 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (modes). \n");
930 if (!get_bits1(gb
)) {
931 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (framing flag). \n");
932 return AVERROR_INVALIDDATA
; // framing flag bit unset error
938 // Process the identification header
940 static int vorbis_parse_id_hdr(vorbis_context
*vc
)
942 GetBitContext
*gb
= &vc
->gb
;
945 if ((get_bits(gb
, 8) != 'v') || (get_bits(gb
, 8) != 'o') ||
946 (get_bits(gb
, 8) != 'r') || (get_bits(gb
, 8) != 'b') ||
947 (get_bits(gb
, 8) != 'i') || (get_bits(gb
, 8) != 's')) {
948 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis id header packet corrupt (no vorbis signature). \n");
949 return AVERROR_INVALIDDATA
;
952 vc
->version
= get_bits_long(gb
, 32); //FIXME check 0
953 vc
->audio_channels
= get_bits(gb
, 8);
954 if (vc
->audio_channels
<= 0) {
955 av_log(vc
->avctx
, AV_LOG_ERROR
, "Invalid number of channels\n");
956 return AVERROR_INVALIDDATA
;
958 vc
->audio_samplerate
= get_bits_long(gb
, 32);
959 if (vc
->audio_samplerate
<= 0) {
960 av_log(vc
->avctx
, AV_LOG_ERROR
, "Invalid samplerate\n");
961 return AVERROR_INVALIDDATA
;
963 vc
->bitrate_maximum
= get_bits_long(gb
, 32);
964 vc
->bitrate_nominal
= get_bits_long(gb
, 32);
965 vc
->bitrate_minimum
= get_bits_long(gb
, 32);
966 bl0
= get_bits(gb
, 4);
967 bl1
= get_bits(gb
, 4);
968 vc
->blocksize
[0] = (1 << bl0
);
969 vc
->blocksize
[1] = (1 << bl1
);
970 if (bl0
> 13 || bl0
< 6 || bl1
> 13 || bl1
< 6 || bl1
< bl0
) {
971 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis id header packet corrupt (illegal blocksize). \n");
972 return AVERROR_INVALIDDATA
;
974 vc
->win
[0] = ff_vorbis_vwin
[bl0
- 6];
975 vc
->win
[1] = ff_vorbis_vwin
[bl1
- 6];
977 if ((get_bits1(gb
)) == 0) {
978 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis id header packet corrupt (framing flag not set). \n");
979 return AVERROR_INVALIDDATA
;
982 vc
->channel_residues
= av_malloc((vc
->blocksize
[1] / 2) * vc
->audio_channels
* sizeof(*vc
->channel_residues
));
983 vc
->saved
= av_mallocz((vc
->blocksize
[1] / 4) * vc
->audio_channels
* sizeof(*vc
->saved
));
984 if (!vc
->channel_residues
|| !vc
->saved
)
985 return AVERROR(ENOMEM
);
987 vc
->previous_window
= 0;
989 ff_mdct_init(&vc
->mdct
[0], bl0
, 1, -1.0);
990 ff_mdct_init(&vc
->mdct
[1], bl1
, 1, -1.0);
992 ff_dlog(NULL
, " vorbis version %"PRIu32
" \n audio_channels %"PRIu8
" \n audio_samplerate %"PRIu32
" \n bitrate_max %"PRIu32
" \n bitrate_nom %"PRIu32
" \n bitrate_min %"PRIu32
" \n blk_0 %"PRIu32
" blk_1 %"PRIu32
" \n ",
993 vc
->version
, vc
->audio_channels
, vc
->audio_samplerate
, vc
->bitrate_maximum
, vc
->bitrate_nominal
, vc
->bitrate_minimum
, vc
->blocksize
[0], vc
->blocksize
[1]);
996 BLK = vc->blocksize[0];
997 for (i = 0; i < BLK / 2; ++i) {
998 vc->win[0][i] = sin(0.5*3.14159265358*(sin(((float)i + 0.5) / (float)BLK*3.14159265358))*(sin(((float)i + 0.5) / (float)BLK*3.14159265358)));
1005 // Process the extradata using the functions above (identification header, setup header)
1007 static av_cold
int vorbis_decode_init(AVCodecContext
*avctx
)
1009 vorbis_context
*vc
= avctx
->priv_data
;
1010 uint8_t *headers
= avctx
->extradata
;
1011 int headers_len
= avctx
->extradata_size
;
1012 uint8_t *header_start
[3];
1014 GetBitContext
*gb
= &vc
->gb
;
1018 ff_vorbisdsp_init(&vc
->dsp
);
1019 avpriv_float_dsp_init(&vc
->fdsp
, avctx
->flags
& AV_CODEC_FLAG_BITEXACT
);
1021 avctx
->sample_fmt
= AV_SAMPLE_FMT_FLTP
;
1024 av_log(avctx
, AV_LOG_ERROR
, "Extradata missing.\n");
1025 return AVERROR_INVALIDDATA
;
1028 if ((ret
= avpriv_split_xiph_headers(headers
, headers_len
, 30, header_start
, header_len
)) < 0) {
1029 av_log(avctx
, AV_LOG_ERROR
, "Extradata corrupt.\n");
1033 init_get_bits(gb
, header_start
[0], header_len
[0]*8);
1034 hdr_type
= get_bits(gb
, 8);
1035 if (hdr_type
!= 1) {
1036 av_log(avctx
, AV_LOG_ERROR
, "First header is not the id header.\n");
1037 return AVERROR_INVALIDDATA
;
1039 if ((ret
= vorbis_parse_id_hdr(vc
))) {
1040 av_log(avctx
, AV_LOG_ERROR
, "Id header corrupt.\n");
1045 init_get_bits(gb
, header_start
[2], header_len
[2]*8);
1046 hdr_type
= get_bits(gb
, 8);
1047 if (hdr_type
!= 5) {
1048 av_log(avctx
, AV_LOG_ERROR
, "Third header is not the setup header.\n");
1050 return AVERROR_INVALIDDATA
;
1052 if ((ret
= vorbis_parse_setup_hdr(vc
))) {
1053 av_log(avctx
, AV_LOG_ERROR
, "Setup header corrupt.\n");
1058 if (vc
->audio_channels
> 8)
1059 avctx
->channel_layout
= 0;
1061 avctx
->channel_layout
= ff_vorbis_channel_layouts
[vc
->audio_channels
- 1];
1063 avctx
->channels
= vc
->audio_channels
;
1064 avctx
->sample_rate
= vc
->audio_samplerate
;
1069 // Decode audiopackets -------------------------------------------------
1071 // Read and decode floor
1073 static int vorbis_floor0_decode(vorbis_context
*vc
,
1074 vorbis_floor_data
*vfu
, float *vec
)
1076 vorbis_floor0
*vf
= &vfu
->t0
;
1077 float *lsp
= vf
->lsp
;
1078 unsigned amplitude
, book_idx
;
1079 unsigned blockflag
= vc
->modes
[vc
->mode_number
].blockflag
;
1081 if (!vf
->amplitude_bits
)
1084 amplitude
= get_bits(&vc
->gb
, vf
->amplitude_bits
);
1085 if (amplitude
> 0) {
1087 unsigned idx
, lsp_len
= 0;
1088 vorbis_codebook codebook
;
1090 book_idx
= get_bits(&vc
->gb
, ilog(vf
->num_books
));
1091 if (book_idx
>= vf
->num_books
) {
1092 av_log(vc
->avctx
, AV_LOG_ERROR
, "floor0 dec: booknumber too high!\n");
1095 ff_dlog(NULL
, "floor0 dec: booknumber: %u\n", book_idx
);
1096 codebook
= vc
->codebooks
[vf
->book_list
[book_idx
]];
1097 /* Invalid codebook! */
1098 if (!codebook
.codevectors
)
1099 return AVERROR_INVALIDDATA
;
1101 while (lsp_len
<vf
->order
) {
1104 ff_dlog(NULL
, "floor0 dec: book dimension: %d\n", codebook
.dimensions
);
1105 ff_dlog(NULL
, "floor0 dec: maximum depth: %d\n", codebook
.maxdepth
);
1106 /* read temp vector */
1107 vec_off
= get_vlc2(&vc
->gb
, codebook
.vlc
.table
,
1108 codebook
.nb_bits
, codebook
.maxdepth
)
1109 * codebook
.dimensions
;
1110 ff_dlog(NULL
, "floor0 dec: vector offset: %d\n", vec_off
);
1111 /* copy each vector component and add last to it */
1112 for (idx
= 0; idx
< codebook
.dimensions
; ++idx
)
1113 lsp
[lsp_len
+idx
] = codebook
.codevectors
[vec_off
+idx
] + last
;
1114 last
= lsp
[lsp_len
+idx
-1]; /* set last to last vector component */
1116 lsp_len
+= codebook
.dimensions
;
1118 /* DEBUG: output lsp coeffs */
1121 for (idx
= 0; idx
< lsp_len
; ++idx
)
1122 ff_dlog(NULL
, "floor0 dec: coeff at %d is %f\n", idx
, lsp
[idx
]);
1125 /* synthesize floor output vector */
1128 int order
= vf
->order
;
1129 float wstep
= M_PI
/ vf
->bark_map_size
;
1131 for (i
= 0; i
< order
; i
++)
1132 lsp
[i
] = 2.0f
* cos(lsp
[i
]);
1134 ff_dlog(NULL
, "floor0 synth: map_size = %"PRIu32
"; m = %d; wstep = %f\n",
1135 vf
->map_size
[blockflag
], order
, wstep
);
1138 while (i
< vf
->map_size
[blockflag
]) {
1139 int j
, iter_cond
= vf
->map
[blockflag
][i
];
1142 float two_cos_w
= 2.0f
* cos(wstep
* iter_cond
); // needed all times
1144 /* similar part for the q and p products */
1145 for (j
= 0; j
+ 1 < order
; j
+= 2) {
1146 q
*= lsp
[j
] - two_cos_w
;
1147 p
*= lsp
[j
+ 1] - two_cos_w
;
1149 if (j
== order
) { // even order
1150 p
*= p
* (2.0f
- two_cos_w
);
1151 q
*= q
* (2.0f
+ two_cos_w
);
1152 } else { // odd order
1153 q
*= two_cos_w
-lsp
[j
]; // one more time for q
1155 /* final step and square */
1156 p
*= p
* (4.f
- two_cos_w
* two_cos_w
);
1160 /* calculate linear floor value */
1161 q
= exp((((amplitude
*vf
->amplitude_offset
) /
1162 (((1 << vf
->amplitude_bits
) - 1) * sqrt(p
+ q
)))
1163 - vf
->amplitude_offset
) * .11512925f
);
1168 } while (vf
->map
[blockflag
][i
] == iter_cond
);
1172 /* this channel is unused */
1176 ff_dlog(NULL
, " Floor0 decoded\n");
1181 static int vorbis_floor1_decode(vorbis_context
*vc
,
1182 vorbis_floor_data
*vfu
, float *vec
)
1184 vorbis_floor1
*vf
= &vfu
->t1
;
1185 GetBitContext
*gb
= &vc
->gb
;
1186 uint16_t range_v
[4] = { 256, 128, 86, 64 };
1187 unsigned range
= range_v
[vf
->multiplier
- 1];
1188 uint16_t floor1_Y
[258];
1189 uint16_t floor1_Y_final
[258];
1190 int floor1_flag
[258];
1191 unsigned class, cdim
, cbits
, csub
, cval
, offset
, i
, j
;
1192 int book
, adx
, ady
, dy
, off
, predicted
, err
;
1195 if (!get_bits1(gb
)) // silence
1198 // Read values (or differences) for the floor's points
1200 floor1_Y
[0] = get_bits(gb
, ilog(range
- 1));
1201 floor1_Y
[1] = get_bits(gb
, ilog(range
- 1));
1203 ff_dlog(NULL
, "floor 0 Y %d floor 1 Y %d \n", floor1_Y
[0], floor1_Y
[1]);
1206 for (i
= 0; i
< vf
->partitions
; ++i
) {
1207 class = vf
->partition_class
[i
];
1208 cdim
= vf
->class_dimensions
[class];
1209 cbits
= vf
->class_subclasses
[class];
1210 csub
= (1 << cbits
) - 1;
1213 ff_dlog(NULL
, "Cbits %u\n", cbits
);
1215 if (cbits
) // this reads all subclasses for this partition's class
1216 cval
= get_vlc2(gb
, vc
->codebooks
[vf
->class_masterbook
[class]].vlc
.table
,
1217 vc
->codebooks
[vf
->class_masterbook
[class]].nb_bits
, 3);
1219 for (j
= 0; j
< cdim
; ++j
) {
1220 book
= vf
->subclass_books
[class][cval
& csub
];
1222 ff_dlog(NULL
, "book %d Cbits %u cval %u bits:%d\n",
1223 book
, cbits
, cval
, get_bits_count(gb
));
1225 cval
= cval
>> cbits
;
1227 floor1_Y
[offset
+j
] = get_vlc2(gb
, vc
->codebooks
[book
].vlc
.table
,
1228 vc
->codebooks
[book
].nb_bits
, 3);
1230 floor1_Y
[offset
+j
] = 0;
1233 ff_dlog(NULL
, " floor(%d) = %d \n",
1234 vf
->list
[offset
+j
].x
, floor1_Y
[offset
+j
]);
1239 // Amplitude calculation from the differences
1243 floor1_Y_final
[0] = floor1_Y
[0];
1244 floor1_Y_final
[1] = floor1_Y
[1];
1246 for (i
= 2; i
< vf
->x_list_dim
; ++i
) {
1247 unsigned val
, highroom
, lowroom
, room
, high_neigh_offs
, low_neigh_offs
;
1249 low_neigh_offs
= vf
->list
[i
].low
;
1250 high_neigh_offs
= vf
->list
[i
].high
;
1251 dy
= floor1_Y_final
[high_neigh_offs
] - floor1_Y_final
[low_neigh_offs
]; // render_point begin
1252 adx
= vf
->list
[high_neigh_offs
].x
- vf
->list
[low_neigh_offs
].x
;
1254 err
= ady
* (vf
->list
[i
].x
- vf
->list
[low_neigh_offs
].x
);
1257 predicted
= floor1_Y_final
[low_neigh_offs
] - off
;
1259 predicted
= floor1_Y_final
[low_neigh_offs
] + off
;
1260 } // render_point end
1263 highroom
= range
-predicted
;
1264 lowroom
= predicted
;
1265 if (highroom
< lowroom
) {
1266 room
= highroom
* 2;
1268 room
= lowroom
* 2; // SPEC misspelling
1271 floor1_flag
[low_neigh_offs
] = 1;
1272 floor1_flag
[high_neigh_offs
] = 1;
1275 if (highroom
> lowroom
) {
1276 floor1_Y_final
[i
] = av_clip_uint16(val
- lowroom
+ predicted
);
1278 floor1_Y_final
[i
] = av_clip_uint16(predicted
- val
+ highroom
- 1);
1282 floor1_Y_final
[i
] = av_clip_uint16(predicted
- (val
+ 1) / 2);
1284 floor1_Y_final
[i
] = av_clip_uint16(predicted
+ val
/ 2);
1289 floor1_Y_final
[i
] = av_clip_uint16(predicted
);
1292 ff_dlog(NULL
, " Decoded floor(%d) = %u / val %u\n",
1293 vf
->list
[i
].x
, floor1_Y_final
[i
], val
);
1296 // Curve synth - connect the calculated dots and convert from dB scale FIXME optimize ?
1298 ff_vorbis_floor1_render_list(vf
->list
, vf
->x_list_dim
, floor1_Y_final
, floor1_flag
, vf
->multiplier
, vec
, vf
->list
[1].x
);
1300 ff_dlog(NULL
, " Floor decoded\n");
1305 static av_always_inline
int setup_classifs(vorbis_context
*vc
,
1307 uint8_t *do_not_decode
,
1309 int partition_count
)
1311 vorbis_codebook
*codebook
= vc
->codebooks
+ vr
->classbook
;
1313 unsigned c_p_c
= codebook
->dimensions
;
1314 unsigned inverse_class
= ff_inverse
[vr
->classifications
];
1316 for (p
= 0, j
= 0; j
< ch_used
; ++j
) {
1317 if (!do_not_decode
[j
]) {
1318 temp
= get_vlc2(&vc
->gb
, codebook
->vlc
.table
,
1319 codebook
->nb_bits
, 3);
1321 ff_dlog(NULL
, "Classword: %u\n", temp
);
1324 av_log(vc
->avctx
, AV_LOG_ERROR
,
1325 "Invalid vlc code decoding %d channel.", j
);
1326 return AVERROR_INVALIDDATA
;
1329 for (i
= partition_count
+ c_p_c
- 1; i
>= partition_count
; i
--) {
1330 temp2
= (((uint64_t)temp
) * inverse_class
) >> 32;
1332 if (i
< vr
->ptns_to_read
)
1333 vr
->classifs
[p
+ i
] = temp
- temp2
* vr
->classifications
;
1337 p
+= vr
->ptns_to_read
;
1341 // Read and decode residue
1343 static av_always_inline
int vorbis_residue_decode_internal(vorbis_context
*vc
,
1346 uint8_t *do_not_decode
,
1352 GetBitContext
*gb
= &vc
->gb
;
1353 unsigned c_p_c
= vc
->codebooks
[vr
->classbook
].dimensions
;
1354 uint8_t *classifs
= vr
->classifs
;
1355 unsigned pass
, ch_used
, i
, j
, k
, l
;
1356 unsigned max_output
= (ch
- 1) * vlen
;
1357 int ptns_to_read
= vr
->ptns_to_read
;
1360 for (j
= 1; j
< ch
; ++j
)
1361 do_not_decode
[0] &= do_not_decode
[j
]; // FIXME - clobbering input
1362 if (do_not_decode
[0])
1365 max_output
+= vr
->end
/ ch
;
1368 max_output
+= vr
->end
;
1371 if (max_output
> ch_left
* vlen
) {
1372 av_log(vc
->avctx
, AV_LOG_ERROR
, "Insufficient output buffer\n");
1373 return AVERROR_INVALIDDATA
;
1376 ff_dlog(NULL
, " residue type 0/1/2 decode begin, ch: %d cpc %d \n", ch
, c_p_c
);
1378 for (pass
= 0; pass
<= vr
->maxpass
; ++pass
) { // FIXME OPTIMIZE?
1379 int voffset
, partition_count
, j_times_ptns_to_read
;
1381 voffset
= vr
->begin
;
1382 for (partition_count
= 0; partition_count
< ptns_to_read
;) { // SPEC error
1384 int ret
= setup_classifs(vc
, vr
, do_not_decode
, ch_used
, partition_count
);
1388 for (i
= 0; (i
< c_p_c
) && (partition_count
< ptns_to_read
); ++i
) {
1389 for (j_times_ptns_to_read
= 0, j
= 0; j
< ch_used
; ++j
) {
1392 if (!do_not_decode
[j
]) {
1393 unsigned vqclass
= classifs
[j_times_ptns_to_read
+ partition_count
];
1394 int vqbook
= vr
->books
[vqclass
][pass
];
1396 if (vqbook
>= 0 && vc
->codebooks
[vqbook
].codevectors
) {
1398 unsigned dim
= vc
->codebooks
[vqbook
].dimensions
;
1399 unsigned step
= FASTDIV(vr
->partition_size
<< 1, dim
<< 1);
1400 vorbis_codebook codebook
= vc
->codebooks
[vqbook
];
1404 voffs
= voffset
+j
*vlen
;
1405 for (k
= 0; k
< step
; ++k
) {
1406 coffs
= get_vlc2(gb
, codebook
.vlc
.table
, codebook
.nb_bits
, 3) * dim
;
1407 for (l
= 0; l
< dim
; ++l
)
1408 vec
[voffs
+ k
+ l
* step
] += codebook
.codevectors
[coffs
+ l
];
1410 } else if (vr_type
== 1) {
1411 voffs
= voffset
+ j
* vlen
;
1412 for (k
= 0; k
< step
; ++k
) {
1413 coffs
= get_vlc2(gb
, codebook
.vlc
.table
, codebook
.nb_bits
, 3) * dim
;
1414 for (l
= 0; l
< dim
; ++l
, ++voffs
) {
1415 vec
[voffs
]+=codebook
.codevectors
[coffs
+l
];
1417 ff_dlog(NULL
, " pass %d offs: %d curr: %f change: %f cv offs.: %d \n",
1418 pass
, voffs
, vec
[voffs
], codebook
.codevectors
[coffs
+l
], coffs
);
1421 } else if (vr_type
== 2 && ch
== 2 && (voffset
& 1) == 0 && (dim
& 1) == 0) { // most frequent case optimized
1422 voffs
= voffset
>> 1;
1425 for (k
= 0; k
< step
; ++k
) {
1426 coffs
= get_vlc2(gb
, codebook
.vlc
.table
, codebook
.nb_bits
, 3) * 2;
1427 vec
[voffs
+ k
] += codebook
.codevectors
[coffs
];
1428 vec
[voffs
+ k
+ vlen
] += codebook
.codevectors
[coffs
+ 1];
1430 } else if (dim
== 4) {
1431 for (k
= 0; k
< step
; ++k
, voffs
+= 2) {
1432 coffs
= get_vlc2(gb
, codebook
.vlc
.table
, codebook
.nb_bits
, 3) * 4;
1433 vec
[voffs
] += codebook
.codevectors
[coffs
];
1434 vec
[voffs
+ 1 ] += codebook
.codevectors
[coffs
+ 2];
1435 vec
[voffs
+ vlen
] += codebook
.codevectors
[coffs
+ 1];
1436 vec
[voffs
+ vlen
+ 1] += codebook
.codevectors
[coffs
+ 3];
1439 for (k
= 0; k
< step
; ++k
) {
1440 coffs
= get_vlc2(gb
, codebook
.vlc
.table
, codebook
.nb_bits
, 3) * dim
;
1441 for (l
= 0; l
< dim
; l
+= 2, voffs
++) {
1442 vec
[voffs
] += codebook
.codevectors
[coffs
+ l
];
1443 vec
[voffs
+ vlen
] += codebook
.codevectors
[coffs
+ l
+ 1];
1445 ff_dlog(NULL
, " pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
1446 pass
, voffset
/ ch
+ (voffs
% ch
) * vlen
,
1447 vec
[voffset
/ ch
+ (voffs
% ch
) * vlen
],
1448 codebook
.codevectors
[coffs
+ l
], coffs
, l
);
1452 } else if (vr_type
== 2) {
1453 unsigned voffs_div
= FASTDIV(voffset
<< 1, ch
<<1);
1454 unsigned voffs_mod
= voffset
- voffs_div
* ch
;
1456 for (k
= 0; k
< step
; ++k
) {
1457 coffs
= get_vlc2(gb
, codebook
.vlc
.table
, codebook
.nb_bits
, 3) * dim
;
1458 for (l
= 0; l
< dim
; ++l
) {
1459 vec
[voffs_div
+ voffs_mod
* vlen
] +=
1460 codebook
.codevectors
[coffs
+ l
];
1462 ff_dlog(NULL
, " pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
1463 pass
, voffs_div
+ voffs_mod
* vlen
,
1464 vec
[voffs_div
+ voffs_mod
* vlen
],
1465 codebook
.codevectors
[coffs
+ l
], coffs
, l
);
1467 if (++voffs_mod
== ch
) {
1476 j_times_ptns_to_read
+= ptns_to_read
;
1479 voffset
+= vr
->partition_size
;
1486 static inline int vorbis_residue_decode(vorbis_context
*vc
, vorbis_residue
*vr
,
1488 uint8_t *do_not_decode
,
1489 float *vec
, unsigned vlen
,
1493 return vorbis_residue_decode_internal(vc
, vr
, ch
, do_not_decode
, vec
, vlen
, ch_left
, 2);
1494 else if (vr
->type
== 1)
1495 return vorbis_residue_decode_internal(vc
, vr
, ch
, do_not_decode
, vec
, vlen
, ch_left
, 1);
1496 else if (vr
->type
== 0)
1497 return vorbis_residue_decode_internal(vc
, vr
, ch
, do_not_decode
, vec
, vlen
, ch_left
, 0);
1499 av_log(vc
->avctx
, AV_LOG_ERROR
, " Invalid residue type while residue decode?! \n");
1500 return AVERROR_INVALIDDATA
;
1504 void ff_vorbis_inverse_coupling(float *mag
, float *ang
, intptr_t blocksize
)
1507 for (i
= 0; i
< blocksize
; i
++) {
1510 ang
[i
] = mag
[i
] - ang
[i
];
1512 float temp
= ang
[i
];
1520 float temp
= ang
[i
];
1528 // Decode the audio packet using the functions above
1530 static int vorbis_parse_audio_packet(vorbis_context
*vc
, float **floor_ptr
)
1532 GetBitContext
*gb
= &vc
->gb
;
1534 unsigned previous_window
= vc
->previous_window
;
1535 unsigned mode_number
, blockflag
, blocksize
;
1537 uint8_t no_residue
[255];
1538 uint8_t do_not_decode
[255];
1539 vorbis_mapping
*mapping
;
1540 float *ch_res_ptr
= vc
->channel_residues
;
1541 uint8_t res_chan
[255];
1542 unsigned res_num
= 0;
1544 unsigned ch_left
= vc
->audio_channels
;
1547 if (get_bits1(gb
)) {
1548 av_log(vc
->avctx
, AV_LOG_ERROR
, "Not a Vorbis I audio packet.\n");
1549 return AVERROR_INVALIDDATA
; // packet type not audio
1552 if (vc
->mode_count
== 1) {
1555 GET_VALIDATED_INDEX(mode_number
, ilog(vc
->mode_count
-1), vc
->mode_count
)
1557 vc
->mode_number
= mode_number
;
1558 mapping
= &vc
->mappings
[vc
->modes
[mode_number
].mapping
];
1560 ff_dlog(NULL
, " Mode number: %u , mapping: %d , blocktype %d\n", mode_number
,
1561 vc
->modes
[mode_number
].mapping
, vc
->modes
[mode_number
].blockflag
);
1563 blockflag
= vc
->modes
[mode_number
].blockflag
;
1564 blocksize
= vc
->blocksize
[blockflag
];
1565 vlen
= blocksize
/ 2;
1567 previous_window
= get_bits(gb
, 1);
1568 skip_bits1(gb
); // next_window
1571 memset(ch_res_ptr
, 0, sizeof(float) * vc
->audio_channels
* vlen
); //FIXME can this be removed ?
1572 for (i
= 0; i
< vc
->audio_channels
; ++i
)
1573 memset(floor_ptr
[i
], 0, vlen
* sizeof(floor_ptr
[0][0])); //FIXME can this be removed ?
1577 for (i
= 0; i
< vc
->audio_channels
; ++i
) {
1578 vorbis_floor
*floor
;
1580 if (mapping
->submaps
> 1) {
1581 floor
= &vc
->floors
[mapping
->submap_floor
[mapping
->mux
[i
]]];
1583 floor
= &vc
->floors
[mapping
->submap_floor
[0]];
1586 ret
= floor
->decode(vc
, &floor
->data
, floor_ptr
[i
]);
1589 av_log(vc
->avctx
, AV_LOG_ERROR
, "Invalid codebook in vorbis_floor_decode.\n");
1590 return AVERROR_INVALIDDATA
;
1592 no_residue
[i
] = ret
;
1595 // Nonzero vector propagate
1597 for (i
= mapping
->coupling_steps
- 1; i
>= 0; --i
) {
1598 if (!(no_residue
[mapping
->magnitude
[i
]] & no_residue
[mapping
->angle
[i
]])) {
1599 no_residue
[mapping
->magnitude
[i
]] = 0;
1600 no_residue
[mapping
->angle
[i
]] = 0;
1606 for (i
= 0; i
< mapping
->submaps
; ++i
) {
1607 vorbis_residue
*residue
;
1611 for (j
= 0; j
< vc
->audio_channels
; ++j
) {
1612 if ((mapping
->submaps
== 1) || (i
== mapping
->mux
[j
])) {
1613 res_chan
[j
] = res_num
;
1614 if (no_residue
[j
]) {
1615 do_not_decode
[ch
] = 1;
1617 do_not_decode
[ch
] = 0;
1623 residue
= &vc
->residues
[mapping
->submap_residue
[i
]];
1625 av_log(vc
->avctx
, AV_LOG_ERROR
, "Too many channels in vorbis_floor_decode.\n");
1626 return AVERROR_INVALIDDATA
;
1629 ret
= vorbis_residue_decode(vc
, residue
, ch
, do_not_decode
, ch_res_ptr
, vlen
, ch_left
);
1634 ch_res_ptr
+= ch
* vlen
;
1639 return AVERROR_INVALIDDATA
;
1643 for (i
= mapping
->coupling_steps
- 1; i
>= 0; --i
) { //warning: i has to be signed
1646 mag
= vc
->channel_residues
+res_chan
[mapping
->magnitude
[i
]] * blocksize
/ 2;
1647 ang
= vc
->channel_residues
+res_chan
[mapping
->angle
[i
]] * blocksize
/ 2;
1648 vc
->dsp
.vorbis_inverse_coupling(mag
, ang
, blocksize
/ 2);
1653 mdct
= &vc
->mdct
[blockflag
];
1655 for (j
= vc
->audio_channels
-1;j
>= 0; j
--) {
1656 ch_res_ptr
= vc
->channel_residues
+ res_chan
[j
] * blocksize
/ 2;
1657 vc
->fdsp
.vector_fmul(floor_ptr
[j
], floor_ptr
[j
], ch_res_ptr
, blocksize
/ 2);
1658 mdct
->imdct_half(mdct
, ch_res_ptr
, floor_ptr
[j
]);
1661 // Overlap/add, save data for next overlapping
1663 retlen
= (blocksize
+ vc
->blocksize
[previous_window
]) / 4;
1664 for (j
= 0; j
< vc
->audio_channels
; j
++) {
1665 unsigned bs0
= vc
->blocksize
[0];
1666 unsigned bs1
= vc
->blocksize
[1];
1667 float *residue
= vc
->channel_residues
+ res_chan
[j
] * blocksize
/ 2;
1668 float *saved
= vc
->saved
+ j
* bs1
/ 4;
1669 float *ret
= floor_ptr
[j
];
1670 float *buf
= residue
;
1671 const float *win
= vc
->win
[blockflag
& previous_window
];
1673 if (blockflag
== previous_window
) {
1674 vc
->fdsp
.vector_fmul_window(ret
, saved
, buf
, win
, blocksize
/ 4);
1675 } else if (blockflag
> previous_window
) {
1676 vc
->fdsp
.vector_fmul_window(ret
, saved
, buf
, win
, bs0
/ 4);
1677 memcpy(ret
+bs0
/2, buf
+bs0
/4, ((bs1
-bs0
)/4) * sizeof(float));
1679 memcpy(ret
, saved
, ((bs1
- bs0
) / 4) * sizeof(float));
1680 vc
->fdsp
.vector_fmul_window(ret
+ (bs1
- bs0
) / 4, saved
+ (bs1
- bs0
) / 4, buf
, win
, bs0
/ 4);
1682 memcpy(saved
, buf
+ blocksize
/ 4, blocksize
/ 4 * sizeof(float));
1685 vc
->previous_window
= blockflag
;
1689 // Return the decoded audio packet through the standard api
1691 static int vorbis_decode_frame(AVCodecContext
*avctx
, void *data
,
1692 int *got_frame_ptr
, AVPacket
*avpkt
)
1694 const uint8_t *buf
= avpkt
->data
;
1695 int buf_size
= avpkt
->size
;
1696 vorbis_context
*vc
= avctx
->priv_data
;
1697 AVFrame
*frame
= data
;
1698 GetBitContext
*gb
= &vc
->gb
;
1699 float *channel_ptrs
[255];
1702 ff_dlog(NULL
, "packet length %d \n", buf_size
);
1704 /* get output buffer */
1705 frame
->nb_samples
= vc
->blocksize
[1] / 2;
1706 if ((ret
= ff_get_buffer(avctx
, frame
, 0)) < 0) {
1707 av_log(avctx
, AV_LOG_ERROR
, "get_buffer() failed\n");
1711 if (vc
->audio_channels
> 8) {
1712 for (i
= 0; i
< vc
->audio_channels
; i
++)
1713 channel_ptrs
[i
] = (float *)frame
->extended_data
[i
];
1715 for (i
= 0; i
< vc
->audio_channels
; i
++) {
1716 int ch
= ff_vorbis_channel_layout_offsets
[vc
->audio_channels
- 1][i
];
1717 channel_ptrs
[ch
] = (float *)frame
->extended_data
[i
];
1721 init_get_bits(gb
, buf
, buf_size
*8);
1723 if ((len
= vorbis_parse_audio_packet(vc
, channel_ptrs
)) <= 0)
1726 if (!vc
->first_frame
) {
1727 vc
->first_frame
= 1;
1729 av_frame_unref(frame
);
1733 ff_dlog(NULL
, "parsed %d bytes %d bits, returned %d samples (*ch*bits) \n",
1734 get_bits_count(gb
) / 8, get_bits_count(gb
) % 8, len
);
1736 frame
->nb_samples
= len
;
1744 static av_cold
int vorbis_decode_close(AVCodecContext
*avctx
)
1746 vorbis_context
*vc
= avctx
->priv_data
;
1753 static av_cold
void vorbis_decode_flush(AVCodecContext
*avctx
)
1755 vorbis_context
*vc
= avctx
->priv_data
;
1758 memset(vc
->saved
, 0, (vc
->blocksize
[1] / 4) * vc
->audio_channels
*
1759 sizeof(*vc
->saved
));
1761 vc
->previous_window
= 0;
1764 AVCodec ff_vorbis_decoder
= {
1766 .long_name
= NULL_IF_CONFIG_SMALL("Vorbis"),
1767 .type
= AVMEDIA_TYPE_AUDIO
,
1768 .id
= AV_CODEC_ID_VORBIS
,
1769 .priv_data_size
= sizeof(vorbis_context
),
1770 .init
= vorbis_decode_init
,
1771 .close
= vorbis_decode_close
,
1772 .decode
= vorbis_decode_frame
,
1773 .flush
= vorbis_decode_flush
,
1774 .capabilities
= AV_CODEC_CAP_DR1
,
1775 .channel_layouts
= ff_vorbis_channel_layouts
,
1776 .sample_fmts
= (const enum AVSampleFormat
[]) { AV_SAMPLE_FMT_FLTP
,
1777 AV_SAMPLE_FMT_NONE
},