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 #define BITSTREAM_READER_LE
29 #include "libavutil/float_dsp.h"
36 #include "vorbisdsp.h"
41 #define V_MAX_VLCS (1 << 16)
42 #define V_MAX_PARTITIONS (1 << 20)
44 typedef struct vorbis_codebook
{
53 typedef union vorbis_floor_u vorbis_floor_data
;
54 typedef struct vorbis_floor0_s vorbis_floor0
;
55 typedef struct vorbis_floor1_s vorbis_floor1
;
56 struct vorbis_context_s
;
58 int (* vorbis_floor_decode_func
)
59 (struct vorbis_context_s
*, vorbis_floor_data
*, float *);
60 typedef struct vorbis_floor
{
62 vorbis_floor_decode_func decode
;
63 union vorbis_floor_u
{
64 struct vorbis_floor0_s
{
67 uint16_t bark_map_size
;
70 uint8_t amplitude_bits
;
71 uint8_t amplitude_offset
;
76 struct vorbis_floor1_s
{
78 uint8_t partition_class
[32];
79 uint8_t class_dimensions
[16];
80 uint8_t class_subclasses
[16];
81 uint8_t class_masterbook
[16];
82 int16_t subclass_books
[16][8];
85 vorbis_floor1_entry
*list
;
90 typedef struct vorbis_residue
{
94 unsigned partition_size
;
95 uint8_t classifications
;
99 uint16_t ptns_to_read
;
103 typedef struct vorbis_mapping
{
105 uint16_t coupling_steps
;
109 uint8_t submap_floor
[16];
110 uint8_t submap_residue
[16];
113 typedef struct vorbis_mode
{
116 uint16_t transformtype
;
120 typedef struct vorbis_context_s
{
121 AVCodecContext
*avctx
;
123 VorbisDSPContext dsp
;
124 AVFloatDSPContext fdsp
;
129 uint8_t audio_channels
;
130 uint32_t audio_samplerate
;
131 uint32_t bitrate_maximum
;
132 uint32_t bitrate_nominal
;
133 uint32_t bitrate_minimum
;
134 uint32_t blocksize
[2];
136 uint16_t codebook_count
;
137 vorbis_codebook
*codebooks
;
139 vorbis_floor
*floors
;
140 uint8_t residue_count
;
141 vorbis_residue
*residues
;
142 uint8_t mapping_count
;
143 vorbis_mapping
*mappings
;
146 uint8_t mode_number
; // mode number for the current packet
147 uint8_t previous_window
;
148 float *channel_residues
;
152 /* Helper functions */
155 (13.1f * atan(0.00074f * (x)) + 2.24f * atan(1.85e-8f * (x) * (x)) + 1e-4f * (x))
157 static const char idx_err_str
[] = "Index value %d out of range (0 - %d) for %s at %s:%i\n";
158 #define VALIDATE_INDEX(idx, limit) \
160 av_log(vc->avctx, AV_LOG_ERROR,\
162 (int)(idx), (int)(limit - 1), #idx, __FILE__, __LINE__);\
163 return AVERROR_INVALIDDATA;\
165 #define GET_VALIDATED_INDEX(idx, bits, limit) \
167 idx = get_bits(gb, bits);\
168 VALIDATE_INDEX(idx, limit)\
171 static float vorbisfloat2float(unsigned val
)
173 double mant
= val
& 0x1fffff;
174 long exp
= (val
& 0x7fe00000L
) >> 21;
175 if (val
& 0x80000000)
177 return ldexp(mant
, exp
- 20 - 768);
181 // Free all allocated memory -----------------------------------------
183 static void vorbis_free(vorbis_context
*vc
)
187 av_freep(&vc
->channel_residues
);
188 av_freep(&vc
->saved
);
190 for (i
= 0; i
< vc
->residue_count
; i
++)
191 av_free(vc
->residues
[i
].classifs
);
192 av_freep(&vc
->residues
);
193 av_freep(&vc
->modes
);
195 ff_mdct_end(&vc
->mdct
[0]);
196 ff_mdct_end(&vc
->mdct
[1]);
198 for (i
= 0; i
< vc
->codebook_count
; ++i
) {
199 av_free(vc
->codebooks
[i
].codevectors
);
200 ff_free_vlc(&vc
->codebooks
[i
].vlc
);
202 av_freep(&vc
->codebooks
);
204 for (i
= 0; i
< vc
->floor_count
; ++i
) {
205 if (vc
->floors
[i
].floor_type
== 0) {
206 av_free(vc
->floors
[i
].data
.t0
.map
[0]);
207 av_free(vc
->floors
[i
].data
.t0
.map
[1]);
208 av_free(vc
->floors
[i
].data
.t0
.book_list
);
209 av_free(vc
->floors
[i
].data
.t0
.lsp
);
211 av_free(vc
->floors
[i
].data
.t1
.list
);
214 av_freep(&vc
->floors
);
216 for (i
= 0; i
< vc
->mapping_count
; ++i
) {
217 av_free(vc
->mappings
[i
].magnitude
);
218 av_free(vc
->mappings
[i
].angle
);
219 av_free(vc
->mappings
[i
].mux
);
221 av_freep(&vc
->mappings
);
224 // Parse setup header -------------------------------------------------
226 // Process codebooks part
228 static int vorbis_parse_setup_hdr_codebooks(vorbis_context
*vc
)
231 uint8_t *tmp_vlc_bits
= NULL
;
232 uint32_t *tmp_vlc_codes
= NULL
;
233 GetBitContext
*gb
= &vc
->gb
;
234 uint16_t *codebook_multiplicands
= NULL
;
237 vc
->codebook_count
= get_bits(gb
, 8) + 1;
239 av_dlog(NULL
, " Codebooks: %d \n", vc
->codebook_count
);
241 vc
->codebooks
= av_mallocz(vc
->codebook_count
* sizeof(*vc
->codebooks
));
242 tmp_vlc_bits
= av_mallocz(V_MAX_VLCS
* sizeof(*tmp_vlc_bits
));
243 tmp_vlc_codes
= av_mallocz(V_MAX_VLCS
* sizeof(*tmp_vlc_codes
));
244 codebook_multiplicands
= av_malloc(V_MAX_VLCS
* sizeof(*codebook_multiplicands
));
245 if (!vc
->codebooks
||
246 !tmp_vlc_bits
|| !tmp_vlc_codes
|| !codebook_multiplicands
) {
247 ret
= AVERROR(ENOMEM
);
251 for (cb
= 0; cb
< vc
->codebook_count
; ++cb
) {
252 vorbis_codebook
*codebook_setup
= &vc
->codebooks
[cb
];
253 unsigned ordered
, t
, entries
, used_entries
= 0;
255 av_dlog(NULL
, " %u. Codebook\n", cb
);
257 if (get_bits(gb
, 24) != 0x564342) {
258 av_log(vc
->avctx
, AV_LOG_ERROR
,
259 " %u. Codebook setup data corrupt.\n", cb
);
260 ret
= AVERROR_INVALIDDATA
;
264 codebook_setup
->dimensions
=get_bits(gb
, 16);
265 if (codebook_setup
->dimensions
> 16 || codebook_setup
->dimensions
== 0) {
266 av_log(vc
->avctx
, AV_LOG_ERROR
,
267 " %u. Codebook's dimension is invalid (%d).\n",
268 cb
, codebook_setup
->dimensions
);
269 ret
= AVERROR_INVALIDDATA
;
272 entries
= get_bits(gb
, 24);
273 if (entries
> V_MAX_VLCS
) {
274 av_log(vc
->avctx
, AV_LOG_ERROR
,
275 " %u. Codebook has too many entries (%u).\n",
277 ret
= AVERROR_INVALIDDATA
;
281 ordered
= get_bits1(gb
);
283 av_dlog(NULL
, " codebook_dimensions %d, codebook_entries %u\n",
284 codebook_setup
->dimensions
, entries
);
288 unsigned sparse
= get_bits1(gb
);
290 av_dlog(NULL
, " not ordered \n");
293 av_dlog(NULL
, " sparse \n");
296 for (ce
= 0; ce
< entries
; ++ce
) {
297 flag
= get_bits1(gb
);
299 tmp_vlc_bits
[ce
] = get_bits(gb
, 5) + 1;
302 tmp_vlc_bits
[ce
] = 0;
305 av_dlog(NULL
, " not sparse \n");
307 used_entries
= entries
;
308 for (ce
= 0; ce
< entries
; ++ce
)
309 tmp_vlc_bits
[ce
] = get_bits(gb
, 5) + 1;
312 unsigned current_entry
= 0;
313 unsigned current_length
= get_bits(gb
, 5) + 1;
315 av_dlog(NULL
, " ordered, current length: %u\n", current_length
); //FIXME
317 used_entries
= entries
;
318 for (; current_entry
< used_entries
&& current_length
<= 32; ++current_length
) {
321 av_dlog(NULL
, " number bits: %u ", ilog(entries
- current_entry
));
323 number
= get_bits(gb
, ilog(entries
- current_entry
));
325 av_dlog(NULL
, " number: %u\n", number
);
327 for (i
= current_entry
; i
< number
+current_entry
; ++i
)
328 if (i
< used_entries
)
329 tmp_vlc_bits
[i
] = current_length
;
331 current_entry
+=number
;
333 if (current_entry
>used_entries
) {
334 av_log(vc
->avctx
, AV_LOG_ERROR
, " More codelengths than codes in codebook. \n");
335 ret
= AVERROR_INVALIDDATA
;
340 codebook_setup
->lookup_type
= get_bits(gb
, 4);
342 av_dlog(NULL
, " lookup type: %d : %s \n", codebook_setup
->lookup_type
,
343 codebook_setup
->lookup_type ?
"vq" : "no lookup");
345 // If the codebook is used for (inverse) VQ, calculate codevectors.
347 if (codebook_setup
->lookup_type
== 1) {
349 unsigned codebook_lookup_values
= ff_vorbis_nth_root(entries
, codebook_setup
->dimensions
);
351 float codebook_minimum_value
= vorbisfloat2float(get_bits_long(gb
, 32));
352 float codebook_delta_value
= vorbisfloat2float(get_bits_long(gb
, 32));
353 unsigned codebook_value_bits
= get_bits(gb
, 4) + 1;
354 unsigned codebook_sequence_p
= get_bits1(gb
);
356 av_dlog(NULL
, " We expect %d numbers for building the codevectors. \n",
357 codebook_lookup_values
);
358 av_dlog(NULL
, " delta %f minmum %f \n",
359 codebook_delta_value
, codebook_minimum_value
);
361 for (i
= 0; i
< codebook_lookup_values
; ++i
) {
362 codebook_multiplicands
[i
] = get_bits(gb
, codebook_value_bits
);
364 av_dlog(NULL
, " multiplicands*delta+minmum : %e \n",
365 (float)codebook_multiplicands
[i
] * codebook_delta_value
+ codebook_minimum_value
);
366 av_dlog(NULL
, " multiplicand %u\n", codebook_multiplicands
[i
]);
369 // Weed out unused vlcs and build codevector vector
371 codebook_setup
->codevectors
=
372 av_mallocz(used_entries
* codebook_setup
->dimensions
*
373 sizeof(*codebook_setup
->codevectors
));
374 if (!codebook_setup
->codevectors
)
375 return AVERROR(ENOMEM
);
377 codebook_setup
->codevectors
= NULL
;
379 for (j
= 0, i
= 0; i
< entries
; ++i
) {
380 unsigned dim
= codebook_setup
->dimensions
;
382 if (tmp_vlc_bits
[i
]) {
384 unsigned lookup_offset
= i
;
386 av_dlog(vc
->avctx
, "Lookup offset %u ,", i
);
388 for (k
= 0; k
< dim
; ++k
) {
389 unsigned multiplicand_offset
= lookup_offset
% codebook_lookup_values
;
390 codebook_setup
->codevectors
[j
* dim
+ k
] = codebook_multiplicands
[multiplicand_offset
] * codebook_delta_value
+ codebook_minimum_value
+ last
;
391 if (codebook_sequence_p
)
392 last
= codebook_setup
->codevectors
[j
* dim
+ k
];
393 lookup_offset
/=codebook_lookup_values
;
395 tmp_vlc_bits
[j
] = tmp_vlc_bits
[i
];
397 av_dlog(vc
->avctx
, "real lookup offset %u, vector: ", j
);
398 for (k
= 0; k
< dim
; ++k
)
399 av_dlog(vc
->avctx
, " %f ",
400 codebook_setup
->codevectors
[j
* dim
+ k
]);
401 av_dlog(vc
->avctx
, "\n");
406 if (j
!= used_entries
) {
407 av_log(vc
->avctx
, AV_LOG_ERROR
, "Bug in codevector vector building code. \n");
408 ret
= AVERROR_INVALIDDATA
;
411 entries
= used_entries
;
412 } else if (codebook_setup
->lookup_type
>= 2) {
413 av_log(vc
->avctx
, AV_LOG_ERROR
, "Codebook lookup type not supported. \n");
414 ret
= AVERROR_INVALIDDATA
;
418 // Initialize VLC table
419 if (ff_vorbis_len2vlc(tmp_vlc_bits
, tmp_vlc_codes
, entries
)) {
420 av_log(vc
->avctx
, AV_LOG_ERROR
, " Invalid code lengths while generating vlcs. \n");
421 ret
= AVERROR_INVALIDDATA
;
424 codebook_setup
->maxdepth
= 0;
425 for (t
= 0; t
< entries
; ++t
)
426 if (tmp_vlc_bits
[t
] >= codebook_setup
->maxdepth
)
427 codebook_setup
->maxdepth
= tmp_vlc_bits
[t
];
429 if (codebook_setup
->maxdepth
> 3 * V_NB_BITS
)
430 codebook_setup
->nb_bits
= V_NB_BITS2
;
432 codebook_setup
->nb_bits
= V_NB_BITS
;
434 codebook_setup
->maxdepth
= (codebook_setup
->maxdepth
+codebook_setup
->nb_bits
- 1) / codebook_setup
->nb_bits
;
436 if ((ret
= init_vlc(&codebook_setup
->vlc
, codebook_setup
->nb_bits
,
437 entries
, tmp_vlc_bits
, sizeof(*tmp_vlc_bits
),
438 sizeof(*tmp_vlc_bits
), tmp_vlc_codes
,
439 sizeof(*tmp_vlc_codes
), sizeof(*tmp_vlc_codes
),
441 av_log(vc
->avctx
, AV_LOG_ERROR
, " Error generating vlc tables. \n");
446 av_free(tmp_vlc_bits
);
447 av_free(tmp_vlc_codes
);
448 av_free(codebook_multiplicands
);
453 av_free(tmp_vlc_bits
);
454 av_free(tmp_vlc_codes
);
455 av_free(codebook_multiplicands
);
459 // Process time domain transforms part (unused in Vorbis I)
461 static int vorbis_parse_setup_hdr_tdtransforms(vorbis_context
*vc
)
463 GetBitContext
*gb
= &vc
->gb
;
464 unsigned i
, vorbis_time_count
= get_bits(gb
, 6) + 1;
466 for (i
= 0; i
< vorbis_time_count
; ++i
) {
467 unsigned vorbis_tdtransform
= get_bits(gb
, 16);
469 av_dlog(NULL
, " Vorbis time domain transform %u: %u\n",
470 vorbis_time_count
, vorbis_tdtransform
);
472 if (vorbis_tdtransform
) {
473 av_log(vc
->avctx
, AV_LOG_ERROR
, "Vorbis time domain transform data nonzero. \n");
474 return AVERROR_INVALIDDATA
;
480 // Process floors part
482 static int vorbis_floor0_decode(vorbis_context
*vc
,
483 vorbis_floor_data
*vfu
, float *vec
);
484 static int create_map(vorbis_context
*vc
, unsigned floor_number
);
485 static int vorbis_floor1_decode(vorbis_context
*vc
,
486 vorbis_floor_data
*vfu
, float *vec
);
487 static int vorbis_parse_setup_hdr_floors(vorbis_context
*vc
)
489 GetBitContext
*gb
= &vc
->gb
;
492 vc
->floor_count
= get_bits(gb
, 6) + 1;
494 vc
->floors
= av_mallocz(vc
->floor_count
* sizeof(*vc
->floors
));
496 return AVERROR(ENOMEM
);
498 for (i
= 0; i
< vc
->floor_count
; ++i
) {
499 vorbis_floor
*floor_setup
= &vc
->floors
[i
];
501 floor_setup
->floor_type
= get_bits(gb
, 16);
503 av_dlog(NULL
, " %d. floor type %d \n", i
, floor_setup
->floor_type
);
505 if (floor_setup
->floor_type
== 1) {
506 int maximum_class
= -1;
507 unsigned rangebits
, rangemax
, floor1_values
= 2;
509 floor_setup
->decode
= vorbis_floor1_decode
;
511 floor_setup
->data
.t1
.partitions
= get_bits(gb
, 5);
513 av_dlog(NULL
, " %d.floor: %d partitions \n",
514 i
, floor_setup
->data
.t1
.partitions
);
516 for (j
= 0; j
< floor_setup
->data
.t1
.partitions
; ++j
) {
517 floor_setup
->data
.t1
.partition_class
[j
] = get_bits(gb
, 4);
518 if (floor_setup
->data
.t1
.partition_class
[j
] > maximum_class
)
519 maximum_class
= floor_setup
->data
.t1
.partition_class
[j
];
521 av_dlog(NULL
, " %d. floor %d partition class %d \n",
522 i
, j
, floor_setup
->data
.t1
.partition_class
[j
]);
526 av_dlog(NULL
, " maximum class %d \n", maximum_class
);
528 for (j
= 0; j
<= maximum_class
; ++j
) {
529 floor_setup
->data
.t1
.class_dimensions
[j
] = get_bits(gb
, 3) + 1;
530 floor_setup
->data
.t1
.class_subclasses
[j
] = get_bits(gb
, 2);
532 av_dlog(NULL
, " %d floor %d class dim: %d subclasses %d \n", i
, j
,
533 floor_setup
->data
.t1
.class_dimensions
[j
],
534 floor_setup
->data
.t1
.class_subclasses
[j
]);
536 if (floor_setup
->data
.t1
.class_subclasses
[j
]) {
537 GET_VALIDATED_INDEX(floor_setup
->data
.t1
.class_masterbook
[j
], 8, vc
->codebook_count
)
539 av_dlog(NULL
, " masterbook: %d \n", floor_setup
->data
.t1
.class_masterbook
[j
]);
542 for (k
= 0; k
< (1 << floor_setup
->data
.t1
.class_subclasses
[j
]); ++k
) {
543 int16_t bits
= get_bits(gb
, 8) - 1;
545 VALIDATE_INDEX(bits
, vc
->codebook_count
)
546 floor_setup
->data
.t1
.subclass_books
[j
][k
] = bits
;
548 av_dlog(NULL
, " book %d. : %d \n", k
, floor_setup
->data
.t1
.subclass_books
[j
][k
]);
552 floor_setup
->data
.t1
.multiplier
= get_bits(gb
, 2) + 1;
553 floor_setup
->data
.t1
.x_list_dim
= 2;
555 for (j
= 0; j
< floor_setup
->data
.t1
.partitions
; ++j
)
556 floor_setup
->data
.t1
.x_list_dim
+=floor_setup
->data
.t1
.class_dimensions
[floor_setup
->data
.t1
.partition_class
[j
]];
558 floor_setup
->data
.t1
.list
= av_mallocz(floor_setup
->data
.t1
.x_list_dim
*
559 sizeof(*floor_setup
->data
.t1
.list
));
560 if (!floor_setup
->data
.t1
.list
)
561 return AVERROR(ENOMEM
);
563 rangebits
= get_bits(gb
, 4);
564 rangemax
= (1 << rangebits
);
565 if (rangemax
> vc
->blocksize
[1] / 2) {
566 av_log(vc
->avctx
, AV_LOG_ERROR
,
567 "Floor value is too large for blocksize: %u (%"PRIu32
")\n",
568 rangemax
, vc
->blocksize
[1] / 2);
569 return AVERROR_INVALIDDATA
;
571 floor_setup
->data
.t1
.list
[0].x
= 0;
572 floor_setup
->data
.t1
.list
[1].x
= rangemax
;
574 for (j
= 0; j
< floor_setup
->data
.t1
.partitions
; ++j
) {
575 for (k
= 0; k
< floor_setup
->data
.t1
.class_dimensions
[floor_setup
->data
.t1
.partition_class
[j
]]; ++k
, ++floor1_values
) {
576 floor_setup
->data
.t1
.list
[floor1_values
].x
= get_bits(gb
, rangebits
);
578 av_dlog(NULL
, " %u. floor1 Y coord. %d\n", floor1_values
,
579 floor_setup
->data
.t1
.list
[floor1_values
].x
);
583 // Precalculate order of x coordinates - needed for decode
584 if (ff_vorbis_ready_floor1_list(vc
->avctx
,
585 floor_setup
->data
.t1
.list
,
586 floor_setup
->data
.t1
.x_list_dim
)) {
587 return AVERROR_INVALIDDATA
;
589 } else if (floor_setup
->floor_type
== 0) {
590 unsigned max_codebook_dim
= 0;
592 floor_setup
->decode
= vorbis_floor0_decode
;
594 floor_setup
->data
.t0
.order
= get_bits(gb
, 8);
595 if (!floor_setup
->data
.t0
.order
) {
596 av_log(vc
->avctx
, AV_LOG_ERROR
, "Floor 0 order is 0.\n");
597 return AVERROR_INVALIDDATA
;
599 floor_setup
->data
.t0
.rate
= get_bits(gb
, 16);
600 if (!floor_setup
->data
.t0
.rate
) {
601 av_log(vc
->avctx
, AV_LOG_ERROR
, "Floor 0 rate is 0.\n");
602 return AVERROR_INVALIDDATA
;
604 floor_setup
->data
.t0
.bark_map_size
= get_bits(gb
, 16);
605 if (!floor_setup
->data
.t0
.bark_map_size
) {
606 av_log(vc
->avctx
, AV_LOG_ERROR
,
607 "Floor 0 bark map size is 0.\n");
608 return AVERROR_INVALIDDATA
;
610 floor_setup
->data
.t0
.amplitude_bits
= get_bits(gb
, 6);
611 floor_setup
->data
.t0
.amplitude_offset
= get_bits(gb
, 8);
612 floor_setup
->data
.t0
.num_books
= get_bits(gb
, 4) + 1;
614 /* allocate mem for booklist */
615 floor_setup
->data
.t0
.book_list
=
616 av_malloc(floor_setup
->data
.t0
.num_books
);
617 if (!floor_setup
->data
.t0
.book_list
)
618 return AVERROR(ENOMEM
);
619 /* read book indexes */
623 for (idx
= 0; idx
< floor_setup
->data
.t0
.num_books
; ++idx
) {
624 GET_VALIDATED_INDEX(book_idx
, 8, vc
->codebook_count
)
625 floor_setup
->data
.t0
.book_list
[idx
] = book_idx
;
626 if (vc
->codebooks
[book_idx
].dimensions
> max_codebook_dim
)
627 max_codebook_dim
= vc
->codebooks
[book_idx
].dimensions
;
631 if ((ret
= create_map(vc
, i
)) < 0)
634 /* codebook dim is for padding if codebook dim doesn't *
635 * divide order+1 then we need to read more data */
636 floor_setup
->data
.t0
.lsp
=
637 av_malloc((floor_setup
->data
.t0
.order
+ 1 + max_codebook_dim
)
638 * sizeof(*floor_setup
->data
.t0
.lsp
));
639 if (!floor_setup
->data
.t0
.lsp
)
640 return AVERROR(ENOMEM
);
642 /* debug output parsed headers */
643 av_dlog(NULL
, "floor0 order: %u\n", floor_setup
->data
.t0
.order
);
644 av_dlog(NULL
, "floor0 rate: %u\n", floor_setup
->data
.t0
.rate
);
645 av_dlog(NULL
, "floor0 bark map size: %u\n",
646 floor_setup
->data
.t0
.bark_map_size
);
647 av_dlog(NULL
, "floor0 amplitude bits: %u\n",
648 floor_setup
->data
.t0
.amplitude_bits
);
649 av_dlog(NULL
, "floor0 amplitude offset: %u\n",
650 floor_setup
->data
.t0
.amplitude_offset
);
651 av_dlog(NULL
, "floor0 number of books: %u\n",
652 floor_setup
->data
.t0
.num_books
);
653 av_dlog(NULL
, "floor0 book list pointer: %p\n",
654 floor_setup
->data
.t0
.book_list
);
657 for (idx
= 0; idx
< floor_setup
->data
.t0
.num_books
; ++idx
) {
658 av_dlog(NULL
, " Book %d: %u\n", idx
+ 1,
659 floor_setup
->data
.t0
.book_list
[idx
]);
663 av_log(vc
->avctx
, AV_LOG_ERROR
, "Invalid floor type!\n");
664 return AVERROR_INVALIDDATA
;
670 // Process residues part
672 static int vorbis_parse_setup_hdr_residues(vorbis_context
*vc
)
674 GetBitContext
*gb
= &vc
->gb
;
677 vc
->residue_count
= get_bits(gb
, 6)+1;
678 vc
->residues
= av_mallocz(vc
->residue_count
* sizeof(*vc
->residues
));
680 return AVERROR(ENOMEM
);
682 av_dlog(NULL
, " There are %d residues. \n", vc
->residue_count
);
684 for (i
= 0; i
< vc
->residue_count
; ++i
) {
685 vorbis_residue
*res_setup
= &vc
->residues
[i
];
687 unsigned high_bits
, low_bits
;
689 res_setup
->type
= get_bits(gb
, 16);
691 av_dlog(NULL
, " %u. residue type %d\n", i
, res_setup
->type
);
693 res_setup
->begin
= get_bits(gb
, 24);
694 res_setup
->end
= get_bits(gb
, 24);
695 res_setup
->partition_size
= get_bits(gb
, 24) + 1;
696 /* Validations to prevent a buffer overflow later. */
697 if (res_setup
->begin
>res_setup
->end
||
698 res_setup
->end
> (res_setup
->type
== 2 ? vc
->avctx
->channels
: 1) * vc
->blocksize
[1] / 2 ||
699 (res_setup
->end
-res_setup
->begin
) / res_setup
->partition_size
> V_MAX_PARTITIONS
) {
700 av_log(vc
->avctx
, AV_LOG_ERROR
,
701 "partition out of bounds: type, begin, end, size, blocksize: %"PRIu16
", %"PRIu32
", %"PRIu32
", %u, %"PRIu32
"\n",
702 res_setup
->type
, res_setup
->begin
, res_setup
->end
,
703 res_setup
->partition_size
, vc
->blocksize
[1] / 2);
704 return AVERROR_INVALIDDATA
;
707 res_setup
->classifications
= get_bits(gb
, 6) + 1;
708 GET_VALIDATED_INDEX(res_setup
->classbook
, 8, vc
->codebook_count
)
710 res_setup
->ptns_to_read
=
711 (res_setup
->end
- res_setup
->begin
) / res_setup
->partition_size
;
712 res_setup
->classifs
= av_malloc(res_setup
->ptns_to_read
*
714 sizeof(*res_setup
->classifs
));
715 if (!res_setup
->classifs
)
716 return AVERROR(ENOMEM
);
718 av_dlog(NULL
, " begin %d end %d part.size %d classif.s %d classbook %d \n",
719 res_setup
->begin
, res_setup
->end
, res_setup
->partition_size
,
720 res_setup
->classifications
, res_setup
->classbook
);
722 for (j
= 0; j
< res_setup
->classifications
; ++j
) {
724 low_bits
= get_bits(gb
, 3);
726 high_bits
= get_bits(gb
, 5);
727 cascade
[j
] = (high_bits
<< 3) + low_bits
;
729 av_dlog(NULL
, " %u class cascade depth: %d\n", j
, ilog(cascade
[j
]));
732 res_setup
->maxpass
= 0;
733 for (j
= 0; j
< res_setup
->classifications
; ++j
) {
734 for (k
= 0; k
< 8; ++k
) {
735 if (cascade
[j
]&(1 << k
)) {
736 GET_VALIDATED_INDEX(res_setup
->books
[j
][k
], 8, vc
->codebook_count
)
738 av_dlog(NULL
, " %u class cascade depth %u book: %d\n",
739 j
, k
, res_setup
->books
[j
][k
]);
741 if (k
>res_setup
->maxpass
)
742 res_setup
->maxpass
= k
;
744 res_setup
->books
[j
][k
] = -1;
752 // Process mappings part
754 static int vorbis_parse_setup_hdr_mappings(vorbis_context
*vc
)
756 GetBitContext
*gb
= &vc
->gb
;
759 vc
->mapping_count
= get_bits(gb
, 6)+1;
760 vc
->mappings
= av_mallocz(vc
->mapping_count
* sizeof(*vc
->mappings
));
762 return AVERROR(ENOMEM
);
764 av_dlog(NULL
, " There are %d mappings. \n", vc
->mapping_count
);
766 for (i
= 0; i
< vc
->mapping_count
; ++i
) {
767 vorbis_mapping
*mapping_setup
= &vc
->mappings
[i
];
769 if (get_bits(gb
, 16)) {
770 av_log(vc
->avctx
, AV_LOG_ERROR
, "Other mappings than type 0 are not compliant with the Vorbis I specification. \n");
771 return AVERROR_INVALIDDATA
;
774 mapping_setup
->submaps
= get_bits(gb
, 4) + 1;
776 mapping_setup
->submaps
= 1;
780 mapping_setup
->coupling_steps
= get_bits(gb
, 8) + 1;
781 mapping_setup
->magnitude
= av_mallocz(mapping_setup
->coupling_steps
*
782 sizeof(*mapping_setup
->magnitude
));
783 mapping_setup
->angle
= av_mallocz(mapping_setup
->coupling_steps
*
784 sizeof(*mapping_setup
->angle
));
785 if (!mapping_setup
->angle
|| !mapping_setup
->magnitude
)
786 return AVERROR(ENOMEM
);
788 for (j
= 0; j
< mapping_setup
->coupling_steps
; ++j
) {
789 GET_VALIDATED_INDEX(mapping_setup
->magnitude
[j
], ilog(vc
->audio_channels
- 1), vc
->audio_channels
)
790 GET_VALIDATED_INDEX(mapping_setup
->angle
[j
], ilog(vc
->audio_channels
- 1), vc
->audio_channels
)
793 mapping_setup
->coupling_steps
= 0;
796 av_dlog(NULL
, " %u mapping coupling steps: %d\n",
797 i
, mapping_setup
->coupling_steps
);
799 if (get_bits(gb
, 2)) {
800 av_log(vc
->avctx
, AV_LOG_ERROR
, "%u. mapping setup data invalid.\n", i
);
801 return AVERROR_INVALIDDATA
; // following spec.
804 if (mapping_setup
->submaps
>1) {
805 mapping_setup
->mux
= av_mallocz(vc
->audio_channels
*
806 sizeof(*mapping_setup
->mux
));
807 if (!mapping_setup
->mux
)
808 return AVERROR(ENOMEM
);
810 for (j
= 0; j
< vc
->audio_channels
; ++j
)
811 mapping_setup
->mux
[j
] = get_bits(gb
, 4);
814 for (j
= 0; j
< mapping_setup
->submaps
; ++j
) {
815 skip_bits(gb
, 8); // FIXME check?
816 GET_VALIDATED_INDEX(mapping_setup
->submap_floor
[j
], 8, vc
->floor_count
)
817 GET_VALIDATED_INDEX(mapping_setup
->submap_residue
[j
], 8, vc
->residue_count
)
819 av_dlog(NULL
, " %u mapping %u submap : floor %d, residue %d\n", i
, j
,
820 mapping_setup
->submap_floor
[j
],
821 mapping_setup
->submap_residue
[j
]);
827 // Process modes part
829 static int create_map(vorbis_context
*vc
, unsigned floor_number
)
831 vorbis_floor
*floors
= vc
->floors
;
837 for (blockflag
= 0; blockflag
< 2; ++blockflag
) {
838 n
= vc
->blocksize
[blockflag
] / 2;
839 floors
[floor_number
].data
.t0
.map
[blockflag
] =
840 av_malloc((n
+ 1) * sizeof(int32_t)); // n + sentinel
841 if (!floors
[floor_number
].data
.t0
.map
[blockflag
])
842 return AVERROR(ENOMEM
);
844 map
= floors
[floor_number
].data
.t0
.map
[blockflag
];
845 vf
= &floors
[floor_number
].data
.t0
;
847 for (idx
= 0; idx
< n
; ++idx
) {
848 map
[idx
] = floor(BARK((vf
->rate
* idx
) / (2.0f
* n
)) *
849 (vf
->bark_map_size
/ BARK(vf
->rate
/ 2.0f
)));
850 if (vf
->bark_map_size
-1 < map
[idx
])
851 map
[idx
] = vf
->bark_map_size
- 1;
854 vf
->map_size
[blockflag
] = n
;
857 for (idx
= 0; idx
<= n
; ++idx
) {
858 av_dlog(NULL
, "floor0 map: map at pos %d is %d\n", idx
, map
[idx
]);
864 static int vorbis_parse_setup_hdr_modes(vorbis_context
*vc
)
866 GetBitContext
*gb
= &vc
->gb
;
869 vc
->mode_count
= get_bits(gb
, 6) + 1;
870 vc
->modes
= av_mallocz(vc
->mode_count
* sizeof(*vc
->modes
));
872 return AVERROR(ENOMEM
);
874 av_dlog(NULL
, " There are %d modes.\n", vc
->mode_count
);
876 for (i
= 0; i
< vc
->mode_count
; ++i
) {
877 vorbis_mode
*mode_setup
= &vc
->modes
[i
];
879 mode_setup
->blockflag
= get_bits1(gb
);
880 mode_setup
->windowtype
= get_bits(gb
, 16); //FIXME check
881 mode_setup
->transformtype
= get_bits(gb
, 16); //FIXME check
882 GET_VALIDATED_INDEX(mode_setup
->mapping
, 8, vc
->mapping_count
);
884 av_dlog(NULL
, " %u mode: blockflag %d, windowtype %d, transformtype %d, mapping %d\n",
885 i
, mode_setup
->blockflag
, mode_setup
->windowtype
,
886 mode_setup
->transformtype
, mode_setup
->mapping
);
891 // Process the whole setup header using the functions above
893 static int vorbis_parse_setup_hdr(vorbis_context
*vc
)
895 GetBitContext
*gb
= &vc
->gb
;
898 if ((get_bits(gb
, 8) != 'v') || (get_bits(gb
, 8) != 'o') ||
899 (get_bits(gb
, 8) != 'r') || (get_bits(gb
, 8) != 'b') ||
900 (get_bits(gb
, 8) != 'i') || (get_bits(gb
, 8) != 's')) {
901 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (no vorbis signature). \n");
902 return AVERROR_INVALIDDATA
;
905 if ((ret
= vorbis_parse_setup_hdr_codebooks(vc
))) {
906 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (codebooks). \n");
909 if ((ret
= vorbis_parse_setup_hdr_tdtransforms(vc
))) {
910 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (time domain transforms). \n");
913 if ((ret
= vorbis_parse_setup_hdr_floors(vc
))) {
914 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (floors). \n");
917 if ((ret
= vorbis_parse_setup_hdr_residues(vc
))) {
918 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (residues). \n");
921 if ((ret
= vorbis_parse_setup_hdr_mappings(vc
))) {
922 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (mappings). \n");
925 if ((ret
= vorbis_parse_setup_hdr_modes(vc
))) {
926 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (modes). \n");
929 if (!get_bits1(gb
)) {
930 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis setup header packet corrupt (framing flag). \n");
931 return AVERROR_INVALIDDATA
; // framing flag bit unset error
937 // Process the identification header
939 static int vorbis_parse_id_hdr(vorbis_context
*vc
)
941 GetBitContext
*gb
= &vc
->gb
;
944 if ((get_bits(gb
, 8) != 'v') || (get_bits(gb
, 8) != 'o') ||
945 (get_bits(gb
, 8) != 'r') || (get_bits(gb
, 8) != 'b') ||
946 (get_bits(gb
, 8) != 'i') || (get_bits(gb
, 8) != 's')) {
947 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis id header packet corrupt (no vorbis signature). \n");
948 return AVERROR_INVALIDDATA
;
951 vc
->version
= get_bits_long(gb
, 32); //FIXME check 0
952 vc
->audio_channels
= get_bits(gb
, 8);
953 if (vc
->audio_channels
<= 0) {
954 av_log(vc
->avctx
, AV_LOG_ERROR
, "Invalid number of channels\n");
955 return AVERROR_INVALIDDATA
;
957 vc
->audio_samplerate
= get_bits_long(gb
, 32);
958 if (vc
->audio_samplerate
<= 0) {
959 av_log(vc
->avctx
, AV_LOG_ERROR
, "Invalid samplerate\n");
960 return AVERROR_INVALIDDATA
;
962 vc
->bitrate_maximum
= get_bits_long(gb
, 32);
963 vc
->bitrate_nominal
= get_bits_long(gb
, 32);
964 vc
->bitrate_minimum
= get_bits_long(gb
, 32);
965 bl0
= get_bits(gb
, 4);
966 bl1
= get_bits(gb
, 4);
967 vc
->blocksize
[0] = (1 << bl0
);
968 vc
->blocksize
[1] = (1 << bl1
);
969 if (bl0
> 13 || bl0
< 6 || bl1
> 13 || bl1
< 6 || bl1
< bl0
) {
970 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis id header packet corrupt (illegal blocksize). \n");
971 return AVERROR_INVALIDDATA
;
973 vc
->win
[0] = ff_vorbis_vwin
[bl0
- 6];
974 vc
->win
[1] = ff_vorbis_vwin
[bl1
- 6];
976 if ((get_bits1(gb
)) == 0) {
977 av_log(vc
->avctx
, AV_LOG_ERROR
, " Vorbis id header packet corrupt (framing flag not set). \n");
978 return AVERROR_INVALIDDATA
;
981 vc
->channel_residues
= av_malloc((vc
->blocksize
[1] / 2) * vc
->audio_channels
* sizeof(*vc
->channel_residues
));
982 vc
->saved
= av_mallocz((vc
->blocksize
[1] / 4) * vc
->audio_channels
* sizeof(*vc
->saved
));
983 if (!vc
->channel_residues
|| !vc
->saved
)
984 return AVERROR(ENOMEM
);
986 vc
->previous_window
= 0;
988 ff_mdct_init(&vc
->mdct
[0], bl0
, 1, -1.0);
989 ff_mdct_init(&vc
->mdct
[1], bl1
, 1, -1.0);
991 av_dlog(NULL
, " vorbis version %d \n audio_channels %d \n audio_samplerate %d \n bitrate_max %d \n bitrate_nom %d \n bitrate_min %d \n blk_0 %d blk_1 %d \n ",
992 vc
->version
, vc
->audio_channels
, vc
->audio_samplerate
, vc
->bitrate_maximum
, vc
->bitrate_nominal
, vc
->bitrate_minimum
, vc
->blocksize
[0], vc
->blocksize
[1]);
995 BLK = vc->blocksize[0];
996 for (i = 0; i < BLK / 2; ++i) {
997 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)));
1004 // Process the extradata using the functions above (identification header, setup header)
1006 static av_cold
int vorbis_decode_init(AVCodecContext
*avctx
)
1008 vorbis_context
*vc
= avctx
->priv_data
;
1009 uint8_t *headers
= avctx
->extradata
;
1010 int headers_len
= avctx
->extradata_size
;
1011 uint8_t *header_start
[3];
1013 GetBitContext
*gb
= &vc
->gb
;
1017 ff_vorbisdsp_init(&vc
->dsp
);
1018 avpriv_float_dsp_init(&vc
->fdsp
, avctx
->flags
& CODEC_FLAG_BITEXACT
);
1020 avctx
->sample_fmt
= AV_SAMPLE_FMT_FLTP
;
1023 av_log(avctx
, AV_LOG_ERROR
, "Extradata missing.\n");
1024 return AVERROR_INVALIDDATA
;
1027 if ((ret
= avpriv_split_xiph_headers(headers
, headers_len
, 30, header_start
, header_len
)) < 0) {
1028 av_log(avctx
, AV_LOG_ERROR
, "Extradata corrupt.\n");
1032 init_get_bits(gb
, header_start
[0], header_len
[0]*8);
1033 hdr_type
= get_bits(gb
, 8);
1034 if (hdr_type
!= 1) {
1035 av_log(avctx
, AV_LOG_ERROR
, "First header is not the id header.\n");
1036 return AVERROR_INVALIDDATA
;
1038 if ((ret
= vorbis_parse_id_hdr(vc
))) {
1039 av_log(avctx
, AV_LOG_ERROR
, "Id header corrupt.\n");
1044 init_get_bits(gb
, header_start
[2], header_len
[2]*8);
1045 hdr_type
= get_bits(gb
, 8);
1046 if (hdr_type
!= 5) {
1047 av_log(avctx
, AV_LOG_ERROR
, "Third header is not the setup header.\n");
1049 return AVERROR_INVALIDDATA
;
1051 if ((ret
= vorbis_parse_setup_hdr(vc
))) {
1052 av_log(avctx
, AV_LOG_ERROR
, "Setup header corrupt.\n");
1057 if (vc
->audio_channels
> 8)
1058 avctx
->channel_layout
= 0;
1060 avctx
->channel_layout
= ff_vorbis_channel_layouts
[vc
->audio_channels
- 1];
1062 avctx
->channels
= vc
->audio_channels
;
1063 avctx
->sample_rate
= vc
->audio_samplerate
;
1068 // Decode audiopackets -------------------------------------------------
1070 // Read and decode floor
1072 static int vorbis_floor0_decode(vorbis_context
*vc
,
1073 vorbis_floor_data
*vfu
, float *vec
)
1075 vorbis_floor0
*vf
= &vfu
->t0
;
1076 float *lsp
= vf
->lsp
;
1077 unsigned amplitude
, book_idx
;
1078 unsigned blockflag
= vc
->modes
[vc
->mode_number
].blockflag
;
1080 if (!vf
->amplitude_bits
)
1083 amplitude
= get_bits(&vc
->gb
, vf
->amplitude_bits
);
1084 if (amplitude
> 0) {
1086 unsigned idx
, lsp_len
= 0;
1087 vorbis_codebook codebook
;
1089 book_idx
= get_bits(&vc
->gb
, ilog(vf
->num_books
));
1090 if (book_idx
>= vf
->num_books
) {
1091 av_log(vc
->avctx
, AV_LOG_ERROR
, "floor0 dec: booknumber too high!\n");
1094 av_dlog(NULL
, "floor0 dec: booknumber: %u\n", book_idx
);
1095 codebook
= vc
->codebooks
[vf
->book_list
[book_idx
]];
1096 /* Invalid codebook! */
1097 if (!codebook
.codevectors
)
1098 return AVERROR_INVALIDDATA
;
1100 while (lsp_len
<vf
->order
) {
1103 av_dlog(NULL
, "floor0 dec: book dimension: %d\n", codebook
.dimensions
);
1104 av_dlog(NULL
, "floor0 dec: maximum depth: %d\n", codebook
.maxdepth
);
1105 /* read temp vector */
1106 vec_off
= get_vlc2(&vc
->gb
, codebook
.vlc
.table
,
1107 codebook
.nb_bits
, codebook
.maxdepth
)
1108 * codebook
.dimensions
;
1109 av_dlog(NULL
, "floor0 dec: vector offset: %d\n", vec_off
);
1110 /* copy each vector component and add last to it */
1111 for (idx
= 0; idx
< codebook
.dimensions
; ++idx
)
1112 lsp
[lsp_len
+idx
] = codebook
.codevectors
[vec_off
+idx
] + last
;
1113 last
= lsp
[lsp_len
+idx
-1]; /* set last to last vector component */
1115 lsp_len
+= codebook
.dimensions
;
1117 /* DEBUG: output lsp coeffs */
1120 for (idx
= 0; idx
< lsp_len
; ++idx
)
1121 av_dlog(NULL
, "floor0 dec: coeff at %d is %f\n", idx
, lsp
[idx
]);
1124 /* synthesize floor output vector */
1127 int order
= vf
->order
;
1128 float wstep
= M_PI
/ vf
->bark_map_size
;
1130 for (i
= 0; i
< order
; i
++)
1131 lsp
[i
] = 2.0f
* cos(lsp
[i
]);
1133 av_dlog(NULL
, "floor0 synth: map_size = %"PRIu32
"; m = %d; wstep = %f\n",
1134 vf
->map_size
[blockflag
], order
, wstep
);
1137 while (i
< vf
->map_size
[blockflag
]) {
1138 int j
, iter_cond
= vf
->map
[blockflag
][i
];
1141 float two_cos_w
= 2.0f
* cos(wstep
* iter_cond
); // needed all times
1143 /* similar part for the q and p products */
1144 for (j
= 0; j
+ 1 < order
; j
+= 2) {
1145 q
*= lsp
[j
] - two_cos_w
;
1146 p
*= lsp
[j
+ 1] - two_cos_w
;
1148 if (j
== order
) { // even order
1149 p
*= p
* (2.0f
- two_cos_w
);
1150 q
*= q
* (2.0f
+ two_cos_w
);
1151 } else { // odd order
1152 q
*= two_cos_w
-lsp
[j
]; // one more time for q
1154 /* final step and square */
1155 p
*= p
* (4.f
- two_cos_w
* two_cos_w
);
1159 /* calculate linear floor value */
1160 q
= exp((((amplitude
*vf
->amplitude_offset
) /
1161 (((1 << vf
->amplitude_bits
) - 1) * sqrt(p
+ q
)))
1162 - vf
->amplitude_offset
) * .11512925f
);
1167 } while (vf
->map
[blockflag
][i
] == iter_cond
);
1171 /* this channel is unused */
1175 av_dlog(NULL
, " Floor0 decoded\n");
1180 static int vorbis_floor1_decode(vorbis_context
*vc
,
1181 vorbis_floor_data
*vfu
, float *vec
)
1183 vorbis_floor1
*vf
= &vfu
->t1
;
1184 GetBitContext
*gb
= &vc
->gb
;
1185 uint16_t range_v
[4] = { 256, 128, 86, 64 };
1186 unsigned range
= range_v
[vf
->multiplier
- 1];
1187 uint16_t floor1_Y
[258];
1188 uint16_t floor1_Y_final
[258];
1189 int floor1_flag
[258];
1190 unsigned class, cdim
, cbits
, csub
, cval
, offset
, i
, j
;
1191 int book
, adx
, ady
, dy
, off
, predicted
, err
;
1194 if (!get_bits1(gb
)) // silence
1197 // Read values (or differences) for the floor's points
1199 floor1_Y
[0] = get_bits(gb
, ilog(range
- 1));
1200 floor1_Y
[1] = get_bits(gb
, ilog(range
- 1));
1202 av_dlog(NULL
, "floor 0 Y %d floor 1 Y %d \n", floor1_Y
[0], floor1_Y
[1]);
1205 for (i
= 0; i
< vf
->partitions
; ++i
) {
1206 class = vf
->partition_class
[i
];
1207 cdim
= vf
->class_dimensions
[class];
1208 cbits
= vf
->class_subclasses
[class];
1209 csub
= (1 << cbits
) - 1;
1212 av_dlog(NULL
, "Cbits %u\n", cbits
);
1214 if (cbits
) // this reads all subclasses for this partition's class
1215 cval
= get_vlc2(gb
, vc
->codebooks
[vf
->class_masterbook
[class]].vlc
.table
,
1216 vc
->codebooks
[vf
->class_masterbook
[class]].nb_bits
, 3);
1218 for (j
= 0; j
< cdim
; ++j
) {
1219 book
= vf
->subclass_books
[class][cval
& csub
];
1221 av_dlog(NULL
, "book %d Cbits %u cval %u bits:%d\n",
1222 book
, cbits
, cval
, get_bits_count(gb
));
1224 cval
= cval
>> cbits
;
1226 floor1_Y
[offset
+j
] = get_vlc2(gb
, vc
->codebooks
[book
].vlc
.table
,
1227 vc
->codebooks
[book
].nb_bits
, 3);
1229 floor1_Y
[offset
+j
] = 0;
1232 av_dlog(NULL
, " floor(%d) = %d \n",
1233 vf
->list
[offset
+j
].x
, floor1_Y
[offset
+j
]);
1238 // Amplitude calculation from the differences
1242 floor1_Y_final
[0] = floor1_Y
[0];
1243 floor1_Y_final
[1] = floor1_Y
[1];
1245 for (i
= 2; i
< vf
->x_list_dim
; ++i
) {
1246 unsigned val
, highroom
, lowroom
, room
, high_neigh_offs
, low_neigh_offs
;
1248 low_neigh_offs
= vf
->list
[i
].low
;
1249 high_neigh_offs
= vf
->list
[i
].high
;
1250 dy
= floor1_Y_final
[high_neigh_offs
] - floor1_Y_final
[low_neigh_offs
]; // render_point begin
1251 adx
= vf
->list
[high_neigh_offs
].x
- vf
->list
[low_neigh_offs
].x
;
1253 err
= ady
* (vf
->list
[i
].x
- vf
->list
[low_neigh_offs
].x
);
1256 predicted
= floor1_Y_final
[low_neigh_offs
] - off
;
1258 predicted
= floor1_Y_final
[low_neigh_offs
] + off
;
1259 } // render_point end
1262 highroom
= range
-predicted
;
1263 lowroom
= predicted
;
1264 if (highroom
< lowroom
) {
1265 room
= highroom
* 2;
1267 room
= lowroom
* 2; // SPEC misspelling
1270 floor1_flag
[low_neigh_offs
] = 1;
1271 floor1_flag
[high_neigh_offs
] = 1;
1274 if (highroom
> lowroom
) {
1275 floor1_Y_final
[i
] = av_clip_uint16(val
- lowroom
+ predicted
);
1277 floor1_Y_final
[i
] = av_clip_uint16(predicted
- val
+ highroom
- 1);
1281 floor1_Y_final
[i
] = av_clip_uint16(predicted
- (val
+ 1) / 2);
1283 floor1_Y_final
[i
] = av_clip_uint16(predicted
+ val
/ 2);
1288 floor1_Y_final
[i
] = av_clip_uint16(predicted
);
1291 av_dlog(NULL
, " Decoded floor(%d) = %u / val %u\n",
1292 vf
->list
[i
].x
, floor1_Y_final
[i
], val
);
1295 // Curve synth - connect the calculated dots and convert from dB scale FIXME optimize ?
1297 ff_vorbis_floor1_render_list(vf
->list
, vf
->x_list_dim
, floor1_Y_final
, floor1_flag
, vf
->multiplier
, vec
, vf
->list
[1].x
);
1299 av_dlog(NULL
, " Floor decoded\n");
1304 static av_always_inline
int setup_classifs(vorbis_context
*vc
,
1306 uint8_t *do_not_decode
,
1308 int partition_count
)
1311 unsigned c_p_c
= vc
->codebooks
[vr
->classbook
].dimensions
;
1312 unsigned inverse_class
= ff_inverse
[vr
->classifications
];
1313 unsigned temp
, temp2
;
1314 for (p
= 0, j
= 0; j
< ch_used
; ++j
) {
1315 if (!do_not_decode
[j
]) {
1316 temp
= get_vlc2(&vc
->gb
, vc
->codebooks
[vr
->classbook
].vlc
.table
,
1317 vc
->codebooks
[vr
->classbook
].nb_bits
, 3);
1319 av_dlog(NULL
, "Classword: %u\n", temp
);
1321 if (temp
<= 65536) {
1322 for (i
= partition_count
+ c_p_c
- 1; i
>= partition_count
; i
--) {
1323 temp2
= (((uint64_t)temp
) * inverse_class
) >> 32;
1325 if (i
< vr
->ptns_to_read
)
1326 vr
->classifs
[p
+ i
] = temp
- temp2
* vr
->classifications
;
1330 for (i
= partition_count
+ c_p_c
- 1; i
>= partition_count
; i
--) {
1331 temp2
= temp
/ vr
->classifications
;
1333 if (i
< vr
->ptns_to_read
)
1334 vr
->classifs
[p
+ i
] = temp
- temp2
* vr
->classifications
;
1339 p
+= vr
->ptns_to_read
;
1343 // Read and decode residue
1345 static av_always_inline
int vorbis_residue_decode_internal(vorbis_context
*vc
,
1348 uint8_t *do_not_decode
,
1354 GetBitContext
*gb
= &vc
->gb
;
1355 unsigned c_p_c
= vc
->codebooks
[vr
->classbook
].dimensions
;
1356 uint8_t *classifs
= vr
->classifs
;
1357 unsigned pass
, ch_used
, i
, j
, k
, l
;
1358 unsigned max_output
= (ch
- 1) * vlen
;
1359 int ptns_to_read
= vr
->ptns_to_read
;
1362 for (j
= 1; j
< ch
; ++j
)
1363 do_not_decode
[0] &= do_not_decode
[j
]; // FIXME - clobbering input
1364 if (do_not_decode
[0])
1367 max_output
+= vr
->end
/ ch
;
1370 max_output
+= vr
->end
;
1373 if (max_output
> ch_left
* vlen
) {
1374 av_log(vc
->avctx
, AV_LOG_ERROR
, "Insufficient output buffer\n");
1375 return AVERROR_INVALIDDATA
;
1378 av_dlog(NULL
, " residue type 0/1/2 decode begin, ch: %d cpc %d \n", ch
, c_p_c
);
1380 for (pass
= 0; pass
<= vr
->maxpass
; ++pass
) { // FIXME OPTIMIZE?
1381 int voffset
, partition_count
, j_times_ptns_to_read
;
1383 voffset
= vr
->begin
;
1384 for (partition_count
= 0; partition_count
< ptns_to_read
;) { // SPEC error
1386 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 av_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 av_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 av_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 av_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 av_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 av_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
= 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
},