28 #define BITSTREAM_READER_LE
42 #define V_MAX_VLCS (1 << 16)
43 #define V_MAX_PARTITIONS (1 << 20)
86 int16_t subclass_books[16][8];
101 int16_t books[64][8];
161 (13.1f * atan(0.00074f * (x)) + 2.24f * atan(1.85e-8f * (x) * (x)) + 1e-4f * (x))
163 static const char idx_err_str[] =
"Index value %d out of range (0 - %d) for %s at %s:%i\n";
164 #define VALIDATE_INDEX(idx, limit) \
166 av_log(vc->avccontext, AV_LOG_ERROR,\
168 (int)(idx), (int)(limit - 1), #idx, __FILE__, __LINE__);\
169 return AVERROR_INVALIDDATA;\
171 #define GET_VALIDATED_INDEX(idx, bits, limit) \
173 idx = get_bits(gb, bits);\
174 VALIDATE_INDEX(idx, limit)\
179 double mant = val & 0x1fffff;
180 long exp = (val & 0x7fe00000
L) >> 21;
181 if (val & 0x80000000)
183 return ldexp(mant, exp - 20 - 768);
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;
590 "Floor 0 order is 0.\n");
596 "Floor 0 rate is 0.\n");
602 "Floor 0 bark map size is 0.\n");
679 unsigned high_bits, low_bits;
689 if (res_setup->
begin>res_setup->
end ||
693 "partition out of bounds: type, begin, end, size, blocksize: %"PRIu16
", %"PRIu32
", %"PRIu32
", %u, %"PRIu32
"\n",
710 av_dlog(
NULL,
" begin %d end %d part.size %d classif.s %d classbook %d \n",
719 cascade[j] = (high_bits << 3) + low_bits;
726 for (k = 0; k < 8; ++k) {
727 if (cascade[j]&(1 << k)) {
730 av_dlog(
NULL,
" %u class cascade depth %u book: %d\n",
731 j, k, res_setup->
books[j][k]);
736 res_setup->
books[j][k] = -1;
774 sizeof(*mapping_setup->
angle));
791 if (mapping_setup->
submaps>1) {
793 sizeof(*mapping_setup->
mux));
798 for (j = 0; j < mapping_setup->
submaps; ++j) {
803 av_dlog(
NULL,
" %u mapping %u submap : floor %d, residue %d\n", i, j,
821 for (blockflag = 0; blockflag < 2; ++blockflag) {
823 floors[floor_number].
data.
t0.
map[blockflag] =
826 map = floors[floor_number].
data.
t0.
map[blockflag];
827 vf = &floors[floor_number].
data.
t0;
829 for (idx = 0; idx < n; ++idx) {
830 map[idx] = floor(
BARK((vf->rate * idx) / (2.0f * n)) *
831 (vf->bark_map_size /
BARK(vf->rate / 2.0f)));
832 if (vf->bark_map_size-1 < map[idx])
833 map[idx] = vf->bark_map_size - 1;
836 vf->map_size[blockflag] = n;
839 for (idx = 0; idx <= n; ++idx) {
840 av_dlog(
NULL,
"floor0 map: map at pos %d is %d\n", idx, map[idx]);
862 av_dlog(
NULL,
" %u mode: blockflag %d, windowtype %d, transformtype %d, mapping %d\n",
947 if (bl0 > 13 || bl0 < 6 || bl1 > 13 || bl1 < 6 || bl1 < bl0) {
966 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 ",
1010 if (hdr_type != 1) {
1022 if (hdr_type != 5) {
1052 vorbis_floor_data *vfu,
float *vec)
1055 float *lsp = vf->lsp;
1056 unsigned amplitude, book_idx;
1059 if (!vf->amplitude_bits)
1062 amplitude =
get_bits(&vc->
gb, vf->amplitude_bits);
1063 if (amplitude > 0) {
1065 unsigned idx, lsp_len = 0;
1069 if (book_idx >= vf->num_books) {
1071 "floor0 dec: booknumber too high!\n");
1074 av_dlog(
NULL,
"floor0 dec: booknumber: %u\n", book_idx);
1075 codebook = vc->
codebooks[vf->book_list[book_idx]];
1080 while (lsp_len<vf->order) {
1089 av_dlog(
NULL,
"floor0 dec: vector offset: %d\n", vec_off);
1091 for (idx = 0; idx < codebook.
dimensions; ++idx)
1092 lsp[lsp_len+idx] = codebook.
codevectors[vec_off+idx] + last;
1093 last = lsp[lsp_len+idx-1];
1100 for (idx = 0; idx < lsp_len; ++idx)
1101 av_dlog(
NULL,
"floor0 dec: coeff at %d is %f\n", idx, lsp[idx]);
1107 int order = vf->order;
1108 float wstep = M_PI / vf->bark_map_size;
1110 for (i = 0; i < order; i++)
1111 lsp[i] = 2.0f * cos(lsp[i]);
1113 av_dlog(
NULL,
"floor0 synth: map_size = %"PRIu32
"; m = %d; wstep = %f\n",
1114 vf->map_size[blockflag], order, wstep);
1117 while (i < vf->map_size[blockflag]) {
1118 int j, iter_cond = vf->map[blockflag][i];
1121 float two_cos_w = 2.0f * cos(wstep * iter_cond);
1124 for (j = 0; j + 1 < order; j += 2) {
1125 q *= lsp[j] - two_cos_w;
1126 p *= lsp[j + 1] - two_cos_w;
1129 p *= p * (2.0f - two_cos_w);
1130 q *= q * (2.0f + two_cos_w);
1132 q *= two_cos_w-lsp[j];
1135 p *= p * (4.f - two_cos_w * two_cos_w);
1140 q = exp((((amplitude*vf->amplitude_offset) /
1141 (((1 << vf->amplitude_bits) - 1) * sqrt(p + q)))
1142 - vf->amplitude_offset) * .11512925f);
1147 }
while (vf->map[blockflag][i] == iter_cond);
1161 vorbis_floor_data *vfu,
float *vec)
1165 uint16_t range_v[4] = { 256, 128, 86, 64 };
1166 unsigned range = range_v[vf->multiplier - 1];
1167 uint16_t floor1_Y[258];
1168 uint16_t floor1_Y_final[258];
1169 int floor1_flag[258];
1170 unsigned class, cdim, cbits, csub, cval, offset, i, j;
1171 int book, adx, ady, dy,
off, predicted, err;
1182 av_dlog(
NULL,
"floor 0 Y %d floor 1 Y %d \n", floor1_Y[0], floor1_Y[1]);
1185 for (i = 0; i < vf->partitions; ++i) {
1186 class = vf->partition_class[i];
1187 cdim = vf->class_dimensions[
class];
1188 cbits = vf->class_subclasses[
class];
1189 csub = (1 << cbits) - 1;
1198 for (j = 0; j < cdim; ++j) {
1199 book = vf->subclass_books[
class][cval & csub];
1201 av_dlog(
NULL,
"book %d Cbits %u cval %u bits:%d\n",
1204 cval = cval >> cbits;
1209 floor1_Y[offset+j] = 0;
1213 vf->list[offset+j].x, floor1_Y[offset+j]);
1222 floor1_Y_final[0] = floor1_Y[0];
1223 floor1_Y_final[1] = floor1_Y[1];
1225 for (i = 2; i < vf->x_list_dim; ++i) {
1226 unsigned val, highroom, lowroom, room, high_neigh_offs, low_neigh_offs;
1228 low_neigh_offs = vf->list[i].low;
1229 high_neigh_offs = vf->list[i].high;
1230 dy = floor1_Y_final[high_neigh_offs] - floor1_Y_final[low_neigh_offs];
1231 adx = vf->list[high_neigh_offs].x - vf->list[low_neigh_offs].x;
1233 err = ady * (vf->list[i].x - vf->list[low_neigh_offs].x);
1236 predicted = floor1_Y_final[low_neigh_offs] -
off;
1238 predicted = floor1_Y_final[low_neigh_offs] +
off;
1242 highroom = range-predicted;
1243 lowroom = predicted;
1244 if (highroom < lowroom) {
1245 room = highroom * 2;
1250 floor1_flag[low_neigh_offs] = 1;
1251 floor1_flag[high_neigh_offs] = 1;
1254 if (highroom > lowroom) {
1255 floor1_Y_final[i] = av_clip_uint16(val - lowroom + predicted);
1257 floor1_Y_final[i] = av_clip_uint16(predicted - val + highroom - 1);
1261 floor1_Y_final[i] = av_clip_uint16(predicted - (val + 1) / 2);
1263 floor1_Y_final[i] = av_clip_uint16(predicted + val / 2);
1268 floor1_Y_final[i] = av_clip_uint16(predicted);
1271 av_dlog(
NULL,
" Decoded floor(%d) = %u / val %u\n",
1272 vf->list[i].x, floor1_Y_final[i], val);
1299 unsigned pass, ch_used, i, j, k, l;
1300 unsigned max_output = (ch - 1) * vlen;
1303 for (j = 1; j < ch; ++j)
1304 do_not_decode[0] &= do_not_decode[j];
1305 if (do_not_decode[0])
1308 max_output += vr->
end / ch;
1311 max_output += vr->
end;
1314 if (max_output > ch_left * vlen) {
1319 av_dlog(
NULL,
" residue type 0/1/2 decode begin, ch: %d cpc %d \n", ch, c_p_c);
1322 uint16_t voffset, partition_count, j_times_ptns_to_read;
1324 voffset = vr->
begin;
1325 for (partition_count = 0; partition_count < ptns_to_read;) {
1328 for (j_times_ptns_to_read = 0, j = 0; j < ch_used; ++j) {
1329 if (!do_not_decode[j]) {
1336 for (i = 0; i < c_p_c; ++i) {
1339 temp2 = (((uint64_t)temp) * inverse_class) >> 32;
1340 if (partition_count + c_p_c - 1 - i < ptns_to_read)
1341 classifs[j_times_ptns_to_read + partition_count + c_p_c - 1 - i] = temp - temp2 * vr->
classifications;
1345 j_times_ptns_to_read += ptns_to_read;
1348 for (i = 0; (i < c_p_c) && (partition_count < ptns_to_read); ++i) {
1349 for (j_times_ptns_to_read = 0, j = 0; j < ch_used; ++j) {
1352 if (!do_not_decode[j]) {
1353 unsigned vqclass = classifs[j_times_ptns_to_read + partition_count];
1364 voffs = voffset+j*vlen;
1365 for (k = 0; k <
step; ++k) {
1367 for (l = 0; l <
dim; ++l)
1368 vec[voffs + k + l * step] += codebook.
codevectors[coffs + l];
1370 }
else if (vr_type == 1) {
1371 voffs = voffset + j * vlen;
1372 for (k = 0; k <
step; ++k) {
1374 for (l = 0; l <
dim; ++l, ++voffs) {
1377 av_dlog(
NULL,
" pass %d offs: %d curr: %f change: %f cv offs.: %d \n",
1378 pass, voffs, vec[voffs], codebook.
codevectors[coffs+l], coffs);
1381 }
else if (vr_type == 2 && ch == 2 && (voffset & 1) == 0 && (dim & 1) == 0) {
1382 voffs = voffset >> 1;
1385 for (k = 0; k <
step; ++k) {
1388 vec[voffs + k + vlen] += codebook.
codevectors[coffs + 1];
1390 }
else if (dim == 4) {
1391 for (k = 0; k <
step; ++k, voffs += 2) {
1394 vec[voffs + 1 ] += codebook.
codevectors[coffs + 2];
1395 vec[voffs + vlen ] += codebook.
codevectors[coffs + 1];
1396 vec[voffs + vlen + 1] += codebook.
codevectors[coffs + 3];
1399 for (k = 0; k <
step; ++k) {
1401 for (l = 0; l <
dim; l += 2, voffs++) {
1403 vec[voffs + vlen] += codebook.
codevectors[coffs + l + 1];
1405 av_dlog(
NULL,
" pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
1406 pass, voffset / ch + (voffs % ch) * vlen,
1407 vec[voffset / ch + (voffs % ch) * vlen],
1412 }
else if (vr_type == 2) {
1413 unsigned voffs_div =
FASTDIV(voffset << 1, ch <<1);
1414 unsigned voffs_mod = voffset - voffs_div * ch;
1416 for (k = 0; k <
step; ++k) {
1418 for (l = 0; l <
dim; ++l) {
1419 vec[voffs_div + voffs_mod * vlen] +=
1422 av_dlog(
NULL,
" pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
1423 pass, voffs_div + voffs_mod * vlen,
1424 vec[voffs_div + voffs_mod * vlen],
1427 if (++voffs_mod == ch) {
1436 j_times_ptns_to_read += ptns_to_read;
1449 float *vec,
unsigned vlen,
1454 else if (vr->
type == 1)
1456 else if (vr->
type == 0)
1467 for (i = 0; i < blocksize; i++) {
1470 ang[i] = mag[i] - ang[i];
1472 float temp = ang[i];
1480 float temp = ang[i];
1495 unsigned mode_number, blockflag, blocksize;
1502 unsigned res_num = 0;
1520 av_dlog(
NULL,
" Mode number: %u , mapping: %d , blocktype %d\n", mode_number,
1525 vlen = blocksize / 2;
1531 memset(ch_res_ptr, 0,
sizeof(
float) * vc->
audio_channels * vlen);
1533 memset(floor_ptr[i], 0, vlen *
sizeof(floor_ptr[0][0]));
1546 ret = floor->
decode(vc, &floor->
data, floor_ptr[i]);
1552 no_residue[i] = ret;
1558 if (!(no_residue[mapping->
magnitude[i]] & no_residue[mapping->
angle[i]])) {
1560 no_residue[mapping->
angle[i]] = 0;
1566 for (i = 0; i < mapping->
submaps; ++i) {
1572 if ((mapping->
submaps == 1) || (i == mapping->
mux[j])) {
1573 res_chan[j] = res_num;
1574 if (no_residue[j]) {
1575 do_not_decode[ch] = 1;
1577 do_not_decode[ch] = 0;
1594 ch_res_ptr += ch * vlen;
1613 mdct = &vc->
mdct[blockflag];
1617 vc->
fdsp.
vector_fmul(floor_ptr[j], floor_ptr[j], ch_res_ptr, blocksize / 2);
1618 mdct->
imdct_half(mdct, ch_res_ptr, floor_ptr[j]);
1623 retlen = (blocksize + vc->
blocksize[previous_window]) / 4;
1628 float *saved = vc->
saved + j * bs1 / 4;
1629 float *ret = floor_ptr[j];
1630 float *buf = residue;
1631 const float *win = vc->
win[blockflag & previous_window];
1633 if (blockflag == previous_window) {
1635 }
else if (blockflag > previous_window) {
1637 memcpy(ret+bs0/2, buf+bs0/4, ((bs1-bs0)/4) *
sizeof(
float));
1639 memcpy(ret, saved, ((bs1 - bs0) / 4) *
sizeof(
float));
1642 memcpy(saved, buf + blocksize / 4, blocksize / 4 *
sizeof(
float));
1652 int *got_frame_ptr,
AVPacket *avpkt)
1655 int buf_size = avpkt->
size;
1658 float *channel_ptrs[255];
1691 av_dlog(
NULL,
"parsed %d bytes %d bits, returned %d samples (*ch*bits) \n",
1718 sizeof(*vc->
saved));