28 #define BITSTREAM_READER_LE
40 #define V_MAX_VLCS (1 << 16)
41 #define V_MAX_PARTITIONS (1 << 20)
80 uint8_t partition_class[32];
81 uint8_t class_dimensions[16];
82 uint8_t class_subclasses[16];
83 uint8_t class_masterbook[16];
84 int16_t subclass_books[16][8];
111 uint8_t submap_floor[16];
112 uint8_t submap_residue[16];
160 (13.1f * atan(0.00074f * (x)) + 2.24f * atan(1.85e-8f * (x) * (x)) + 1e-4f * (x))
162 static const char idx_err_str[] =
"Index value %d out of range (0 - %d) for %s at %s:%i\n";
163 #define VALIDATE_INDEX(idx, limit) \
165 av_log(vc->avccontext, AV_LOG_ERROR,\
167 (int)(idx), (int)(limit - 1), #idx, __FILE__, __LINE__);\
168 return AVERROR_INVALIDDATA;\
170 #define GET_VALIDATED_INDEX(idx, bits, limit) \
172 idx = get_bits(gb, bits);\
173 VALIDATE_INDEX(idx, limit)\
178 double mant = val & 0x1fffff;
179 long exp = (val & 0x7fe00000L) >> 21;
180 if (val & 0x80000000)
182 return ldexp(mant, exp - 20 - 768);
237 uint8_t *tmp_vlc_bits;
238 uint32_t *tmp_vlc_codes;
240 uint16_t *codebook_multiplicands;
254 unsigned ordered,
t, entries, used_entries = 0;
260 " %u. Codebook setup data corrupt.\n", cb);
268 " %u. Codebook's dimension is invalid (%d).\n",
276 " %u. Codebook has too many entries (%u).\n",
284 av_dlog(
NULL,
" codebook_dimensions %d, codebook_entries %u\n",
297 for (ce = 0; ce < entries; ++ce) {
300 tmp_vlc_bits[ce] =
get_bits(gb, 5) + 1;
303 tmp_vlc_bits[ce] = 0;
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 av_dlog(
NULL,
" ordered, current length: %u\n", current_length);
318 used_entries = entries;
319 for (; current_entry < used_entries && current_length <= 32; ++current_length) {
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) {
354 unsigned codebook_value_bits =
get_bits(gb, 4) + 1;
355 unsigned codebook_sequence_p =
get_bits1(gb);
357 av_dlog(
NULL,
" We expect %d numbers for building the codevectors. \n",
358 codebook_lookup_values);
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 av_dlog(
NULL,
" multiplicands*delta+minmum : %e \n",
366 (
float)codebook_multiplicands[i] * codebook_delta_value + codebook_minimum_value);
367 av_dlog(
NULL,
" multiplicand %u\n", codebook_multiplicands[i]);
375 for (j = 0, i = 0; i < entries; ++i) {
378 if (tmp_vlc_bits[i]) {
380 unsigned lookup_offset = i;
384 for (k = 0; k <
dim; ++k) {
385 unsigned multiplicand_offset = lookup_offset % codebook_lookup_values;
386 codebook_setup->
codevectors[j * dim + k] = codebook_multiplicands[multiplicand_offset] * codebook_delta_value + codebook_minimum_value + last;
387 if (codebook_sequence_p)
389 lookup_offset/=codebook_lookup_values;
391 tmp_vlc_bits[j] = tmp_vlc_bits[i];
394 for (k = 0; k <
dim; ++k)
402 if (j != used_entries) {
407 entries = used_entries;
421 for (t = 0; t < entries; ++
t)
422 if (tmp_vlc_bits[t] >= codebook_setup->
maxdepth)
423 codebook_setup->
maxdepth = tmp_vlc_bits[
t];
433 entries, tmp_vlc_bits,
sizeof(*tmp_vlc_bits),
434 sizeof(*tmp_vlc_bits), tmp_vlc_codes,
435 sizeof(*tmp_vlc_codes),
sizeof(*tmp_vlc_codes),
444 av_free(codebook_multiplicands);
451 av_free(codebook_multiplicands);
460 unsigned i, vorbis_time_count =
get_bits(gb, 6) + 1;
462 for (i = 0; i < vorbis_time_count; ++i) {
463 unsigned vorbis_tdtransform =
get_bits(gb, 16);
465 av_dlog(
NULL,
" Vorbis time domain transform %u: %u\n",
466 vorbis_time_count, vorbis_tdtransform);
468 if (vorbis_tdtransform) {
479 vorbis_floor_data *vfu,
float *vec);
482 vorbis_floor_data *vfu,
float *vec);
500 int maximum_class = -1;
501 unsigned rangebits, rangemax, floor1_values = 2;
515 av_dlog(
NULL,
" %d. floor %d partition class %d \n",
520 av_dlog(
NULL,
" maximum class %d \n", maximum_class);
522 for (j = 0; j <= maximum_class; ++j) {
526 av_dlog(
NULL,
" %d floor %d class dim: %d subclasses %d \n", i, j,
557 rangemax = (1 << rangebits);
560 "Floor value is too large for blocksize: %u (%"PRIu32
")\n",
571 av_dlog(
NULL,
" %u. floor1 Y coord. %d\n", floor1_values,
583 unsigned max_codebook_dim = 0;
592 "Floor 0 bark map size is 0.\n");
600 "Floor 0 amplitude bits is 0.\n");
676 unsigned high_bits, low_bits;
686 if (res_setup->
begin>res_setup->
end ||
690 "partition out of bounds: type, begin, end, size, blocksize: %"PRIu16
", %"PRIu32
", %"PRIu32
", %u, %"PRIu32
"\n",
707 av_dlog(
NULL,
" begin %d end %d part.size %d classif.s %d classbook %d \n",
716 cascade[j] = (high_bits << 3) + low_bits;
723 for (k = 0; k < 8; ++k) {
724 if (cascade[j]&(1 << k)) {
727 av_dlog(
NULL,
" %u class cascade depth %u book: %d\n",
728 j, k, res_setup->
books[j][k]);
733 res_setup->
books[j][k] = -1;
771 sizeof(*mapping_setup->
angle));
788 if (mapping_setup->
submaps>1) {
790 sizeof(*mapping_setup->
mux));
795 for (j = 0; j < mapping_setup->
submaps; ++j) {
800 av_dlog(
NULL,
" %u mapping %u submap : floor %d, residue %d\n", i, j,
818 for (blockflag = 0; blockflag < 2; ++blockflag) {
820 floors[floor_number].
data.
t0.
map[blockflag] =
823 map = floors[floor_number].
data.
t0.
map[blockflag];
824 vf = &floors[floor_number].
data.
t0;
826 for (idx = 0; idx < n; ++idx) {
827 map[idx] = floor(
BARK((vf->rate * idx) / (2.0f * n)) *
828 (vf->bark_map_size /
BARK(vf->rate / 2.0f)));
829 if (vf->bark_map_size-1 < map[idx])
830 map[idx] = vf->bark_map_size - 1;
833 vf->map_size[blockflag] = n;
836 for (idx = 0; idx <= n; ++idx) {
837 av_dlog(
NULL,
"floor0 map: map at pos %d is %d\n", idx, map[idx]);
859 av_dlog(
NULL,
" %u mode: blockflag %d, windowtype %d, transformtype %d, mapping %d\n",
944 if (bl0 > 13 || bl0 < 6 || bl1 > 13 || bl1 < 6 || bl1 < bl0) {
964 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 ",
982 uint8_t *headers = avccontext->
extradata;
984 uint8_t *header_start[3];
1013 if (hdr_type != 1) {
1025 if (hdr_type != 5) {
1056 vorbis_floor_data *vfu,
float *vec)
1059 float *lsp = vf->lsp;
1060 unsigned amplitude, book_idx;
1063 amplitude =
get_bits(&vc->
gb, vf->amplitude_bits);
1064 if (amplitude > 0) {
1066 unsigned idx, lsp_len = 0;
1070 if (book_idx >= vf->num_books) {
1072 "floor0 dec: booknumber too high!\n");
1075 av_dlog(
NULL,
"floor0 dec: booknumber: %u\n", book_idx);
1076 codebook = vc->
codebooks[vf->book_list[book_idx]];
1081 while (lsp_len<vf->order) {
1090 av_dlog(
NULL,
"floor0 dec: vector offset: %d\n", vec_off);
1092 for (idx = 0; idx < codebook.
dimensions; ++idx)
1093 lsp[lsp_len+idx] = codebook.
codevectors[vec_off+idx] + last;
1094 last = lsp[lsp_len+idx-1];
1101 for (idx = 0; idx < lsp_len; ++idx)
1102 av_dlog(
NULL,
"floor0 dec: coeff at %d is %f\n", idx, lsp[idx]);
1108 int order = vf->order;
1109 float wstep =
M_PI / vf->bark_map_size;
1111 for (i = 0; i < order; i++)
1112 lsp[i] = 2.0
f * cos(lsp[i]);
1114 av_dlog(
NULL,
"floor0 synth: map_size = %"PRIu32
"; m = %d; wstep = %f\n",
1115 vf->map_size[blockflag], order, wstep);
1118 while (i < vf->map_size[blockflag]) {
1119 int j, iter_cond = vf->map[blockflag][i];
1122 float two_cos_w = 2.0f * cos(wstep * iter_cond);
1125 for (j = 0; j + 1 < order; j += 2) {
1126 q *= lsp[j] - two_cos_w;
1127 p *= lsp[j + 1] - two_cos_w;
1130 p *= p * (2.0f - two_cos_w);
1131 q *= q * (2.0f + two_cos_w);
1133 q *= two_cos_w-lsp[j];
1136 p *= p * (4.f - two_cos_w * two_cos_w);
1141 q = exp((((amplitude*vf->amplitude_offset) /
1142 (((1 << vf->amplitude_bits) - 1) * sqrt(p + q)))
1143 - vf->amplitude_offset) * .11512925f);
1148 }
while (vf->map[blockflag][i] == iter_cond);
1162 vorbis_floor_data *vfu,
float *vec)
1166 uint16_t range_v[4] = { 256, 128, 86, 64 };
1167 unsigned range = range_v[vf->multiplier - 1];
1168 uint16_t floor1_Y[258];
1169 uint16_t floor1_Y_final[258];
1170 int floor1_flag[258];
1171 unsigned class, cdim, cbits, csub, cval, offset, i, j;
1172 int book, adx, ady, dy,
off, predicted, err;
1183 av_dlog(
NULL,
"floor 0 Y %d floor 1 Y %d \n", floor1_Y[0], floor1_Y[1]);
1186 for (i = 0; i < vf->partitions; ++i) {
1187 class = vf->partition_class[i];
1188 cdim = vf->class_dimensions[
class];
1189 cbits = vf->class_subclasses[
class];
1190 csub = (1 << cbits) - 1;
1199 for (j = 0; j < cdim; ++j) {
1200 book = vf->subclass_books[
class][cval & csub];
1202 av_dlog(
NULL,
"book %d Cbits %u cval %u bits:%d\n",
1205 cval = cval >> cbits;
1210 floor1_Y[offset+j] = 0;
1214 vf->list[offset+j].x, floor1_Y[offset+j]);
1223 floor1_Y_final[0] = floor1_Y[0];
1224 floor1_Y_final[1] = floor1_Y[1];
1226 for (i = 2; i < vf->x_list_dim; ++i) {
1227 unsigned val, highroom, lowroom, room, high_neigh_offs, low_neigh_offs;
1229 low_neigh_offs = vf->list[i].low;
1230 high_neigh_offs = vf->list[i].high;
1231 dy = floor1_Y_final[high_neigh_offs] - floor1_Y_final[low_neigh_offs];
1232 adx = vf->list[high_neigh_offs].x - vf->list[low_neigh_offs].x;
1234 err = ady * (vf->list[i].x - vf->list[low_neigh_offs].x);
1237 predicted = floor1_Y_final[low_neigh_offs] -
off;
1239 predicted = floor1_Y_final[low_neigh_offs] +
off;
1243 highroom = range-predicted;
1244 lowroom = predicted;
1245 if (highroom < lowroom) {
1246 room = highroom * 2;
1251 floor1_flag[low_neigh_offs] = 1;
1252 floor1_flag[high_neigh_offs] = 1;
1255 if (highroom > lowroom) {
1256 floor1_Y_final[i] = av_clip_uint16(val - lowroom + predicted);
1258 floor1_Y_final[i] = av_clip_uint16(predicted - val + highroom - 1);
1262 floor1_Y_final[i] = av_clip_uint16(predicted - (val + 1) / 2);
1264 floor1_Y_final[i] = av_clip_uint16(predicted + val / 2);
1269 floor1_Y_final[i] = av_clip_uint16(predicted);
1272 av_dlog(
NULL,
" Decoded floor(%d) = %u / val %u\n",
1273 vf->list[i].x, floor1_Y_final[i], val);
1290 uint8_t *do_not_decode,
1300 unsigned pass, ch_used, i, j, k, l;
1301 unsigned max_output = (ch - 1) * vlen;
1304 for (j = 1; j < ch; ++j)
1305 do_not_decode[0] &= do_not_decode[j];
1306 if (do_not_decode[0])
1309 max_output += vr->
end / ch;
1312 max_output += vr->
end;
1315 if (max_output > ch_left * vlen) {
1320 av_dlog(
NULL,
" residue type 0/1/2 decode begin, ch: %d cpc %d \n", ch, c_p_c);
1323 uint16_t voffset, partition_count, j_times_ptns_to_read;
1325 voffset = vr->
begin;
1326 for (partition_count = 0; partition_count < ptns_to_read;) {
1329 for (j_times_ptns_to_read = 0, j = 0; j < ch_used; ++j) {
1330 if (!do_not_decode[j]) {
1337 for (i = 0; i < c_p_c; ++i) {
1340 temp2 = (((uint64_t)temp) * inverse_class) >> 32;
1341 if (partition_count + c_p_c - 1 - i < ptns_to_read)
1342 classifs[j_times_ptns_to_read + partition_count + c_p_c - 1 - i] = temp - temp2 * vr->
classifications;
1346 j_times_ptns_to_read += ptns_to_read;
1349 for (i = 0; (i < c_p_c) && (partition_count < ptns_to_read); ++i) {
1350 for (j_times_ptns_to_read = 0, j = 0; j < ch_used; ++j) {
1353 if (!do_not_decode[j]) {
1354 unsigned vqclass = classifs[j_times_ptns_to_read + partition_count];
1366 voffs = voffset+j*vlen;
1367 for (k = 0; k <
step; ++k) {
1369 for (l = 0; l <
dim; ++l)
1370 vec[voffs + k + l * step] += codebook.
codevectors[coffs + l];
1372 }
else if (vr_type == 1) {
1373 voffs = voffset + j * vlen;
1374 for (k = 0; k <
step; ++k) {
1376 for (l = 0; l <
dim; ++l, ++voffs) {
1379 av_dlog(
NULL,
" pass %d offs: %d curr: %f change: %f cv offs.: %d \n",
1380 pass, voffs, vec[voffs], codebook.
codevectors[coffs+l], coffs);
1383 }
else if (vr_type == 2 && ch == 2 && (voffset & 1) == 0 && (dim & 1) == 0) {
1384 voffs = voffset >> 1;
1387 for (k = 0; k <
step; ++k) {
1390 vec[voffs + k + vlen] += codebook.
codevectors[coffs + 1];
1392 }
else if (dim == 4) {
1393 for (k = 0; k <
step; ++k, voffs += 2) {
1396 vec[voffs + 1 ] += codebook.
codevectors[coffs + 2];
1397 vec[voffs + vlen ] += codebook.
codevectors[coffs + 1];
1398 vec[voffs + vlen + 1] += codebook.
codevectors[coffs + 3];
1401 for (k = 0; k <
step; ++k) {
1403 for (l = 0; l <
dim; l += 2, voffs++) {
1405 vec[voffs + vlen] += codebook.
codevectors[coffs + l + 1];
1407 av_dlog(
NULL,
" pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
1408 pass, voffset / ch + (voffs % ch) * vlen,
1409 vec[voffset / ch + (voffs % ch) * vlen],
1414 }
else if (vr_type == 2) {
1417 for (k = 0; k <
step; ++k) {
1419 for (l = 0; l <
dim; ++l, ++voffs) {
1420 vec[voffs / ch + (voffs % ch) * vlen] += codebook.
codevectors[coffs + l];
1422 av_dlog(
NULL,
" pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
1423 pass, voffset / ch + (voffs % ch) * vlen,
1424 vec[voffset / ch + (voffs % ch) * vlen],
1431 j_times_ptns_to_read += ptns_to_read;
1443 uint8_t *do_not_decode,
1444 float *vec,
unsigned vlen,
1449 else if (vr->
type == 1)
1451 else if (vr->
type == 0)
1462 for (i = 0; i < blocksize; i++) {
1465 ang[i] = mag[i] - ang[i];
1467 float temp = ang[i];
1475 float temp = ang[i];
1490 unsigned mode_number, blockflag, blocksize;
1492 uint8_t no_residue[255];
1493 uint8_t do_not_decode[255];
1497 uint8_t res_chan[255];
1498 unsigned res_num = 0;
1516 av_dlog(
NULL,
" Mode number: %u , mapping: %d , blocktype %d\n", mode_number,
1521 vlen = blocksize / 2;
1525 memset(ch_res_ptr, 0,
sizeof(
float) * vc->
audio_channels * vlen);
1526 memset(ch_floor_ptr, 0,
sizeof(
float) * vc->
audio_channels * vlen);
1539 ret = floor->
decode(vc, &floor->
data, ch_floor_ptr);
1545 no_residue[i] = ret;
1546 ch_floor_ptr += vlen;
1552 if (!(no_residue[mapping->
magnitude[i]] & no_residue[mapping->
angle[i]])) {
1554 no_residue[mapping->
angle[i]] = 0;
1560 for (i = 0; i < mapping->
submaps; ++i) {
1566 if ((mapping->
submaps == 1) || (i == mapping->
mux[j])) {
1567 res_chan[j] = res_num;
1568 if (no_residue[j]) {
1569 do_not_decode[ch] = 1;
1571 do_not_decode[ch] = 0;
1588 ch_res_ptr += ch * vlen;
1604 mdct = &vc->
mdct[blockflag];
1609 vc->
dsp.
vector_fmul(ch_floor_ptr, ch_floor_ptr, ch_res_ptr, blocksize / 2);
1610 mdct->
imdct_half(mdct, ch_res_ptr, ch_floor_ptr);
1615 retlen = (blocksize + vc->
blocksize[previous_window]) / 4;
1620 float *saved = vc->
saved + j * bs1 / 4;
1622 float *buf = residue;
1623 const float *win = vc->
win[blockflag & previous_window];
1625 if (blockflag == previous_window) {
1627 }
else if (blockflag > previous_window) {
1629 memcpy(ret+bs0/2, buf+bs0/4, ((bs1-bs0)/4) *
sizeof(
float));
1631 memcpy(ret, saved, ((bs1 - bs0) / 4) *
sizeof(
float));
1634 memcpy(saved, buf + blocksize / 4, blocksize / 4 *
sizeof(
float));
1644 int *got_frame_ptr,
AVPacket *avpkt)
1646 const uint8_t *buf = avpkt->
data;
1647 int buf_size = avpkt->
size;
1650 const float *channel_ptrs[255];
1666 av_dlog(
NULL,
"parsed %d bytes %d bits, returned %d samples (*ch*bits) \n",