You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

1686 lines
62KB

  1. /**
  2. * @file
  3. * Vorbis I decoder
  4. * @author Denes Balatoni ( dbalatoni programozo hu )
  5. *
  6. * This file is part of Libav.
  7. *
  8. * Libav is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU Lesser General Public
  10. * License as published by the Free Software Foundation; either
  11. * version 2.1 of the License, or (at your option) any later version.
  12. *
  13. * Libav is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16. * Lesser General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU Lesser General Public
  19. * License along with Libav; if not, write to the Free Software
  20. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  21. */
  22. #include <math.h>
  23. #define ALT_BITSTREAM_READER_LE
  24. #include "avcodec.h"
  25. #include "get_bits.h"
  26. #include "dsputil.h"
  27. #include "fft.h"
  28. #include "fmtconvert.h"
  29. #include "vorbis.h"
  30. #include "xiph.h"
  31. #define V_NB_BITS 8
  32. #define V_NB_BITS2 11
  33. #define V_MAX_VLCS (1 << 16)
  34. #define V_MAX_PARTITIONS (1 << 20)
  35. #undef NDEBUG
  36. #include <assert.h>
  37. typedef struct {
  38. uint8_t dimensions;
  39. uint8_t lookup_type;
  40. uint8_t maxdepth;
  41. VLC vlc;
  42. float *codevectors;
  43. unsigned int nb_bits;
  44. } vorbis_codebook;
  45. typedef union vorbis_floor_u vorbis_floor_data;
  46. typedef struct vorbis_floor0_s vorbis_floor0;
  47. typedef struct vorbis_floor1_s vorbis_floor1;
  48. struct vorbis_context_s;
  49. typedef
  50. int (* vorbis_floor_decode_func)
  51. (struct vorbis_context_s *, vorbis_floor_data *, float *);
  52. typedef struct {
  53. uint8_t floor_type;
  54. vorbis_floor_decode_func decode;
  55. union vorbis_floor_u {
  56. struct vorbis_floor0_s {
  57. uint8_t order;
  58. uint16_t rate;
  59. uint16_t bark_map_size;
  60. int32_t *map[2];
  61. uint32_t map_size[2];
  62. uint8_t amplitude_bits;
  63. uint8_t amplitude_offset;
  64. uint8_t num_books;
  65. uint8_t *book_list;
  66. float *lsp;
  67. } t0;
  68. struct vorbis_floor1_s {
  69. uint8_t partitions;
  70. uint8_t partition_class[32];
  71. uint8_t class_dimensions[16];
  72. uint8_t class_subclasses[16];
  73. uint8_t class_masterbook[16];
  74. int16_t subclass_books[16][8];
  75. uint8_t multiplier;
  76. uint16_t x_list_dim;
  77. vorbis_floor1_entry *list;
  78. } t1;
  79. } data;
  80. } vorbis_floor;
  81. typedef struct {
  82. uint16_t type;
  83. uint32_t begin;
  84. uint32_t end;
  85. unsigned partition_size;
  86. uint8_t classifications;
  87. uint8_t classbook;
  88. int16_t books[64][8];
  89. uint8_t maxpass;
  90. uint16_t ptns_to_read;
  91. uint8_t *classifs;
  92. } vorbis_residue;
  93. typedef struct {
  94. uint8_t submaps;
  95. uint16_t coupling_steps;
  96. uint8_t *magnitude;
  97. uint8_t *angle;
  98. uint8_t *mux;
  99. uint8_t submap_floor[16];
  100. uint8_t submap_residue[16];
  101. } vorbis_mapping;
  102. typedef struct {
  103. uint8_t blockflag;
  104. uint16_t windowtype;
  105. uint16_t transformtype;
  106. uint8_t mapping;
  107. } vorbis_mode;
  108. typedef struct vorbis_context_s {
  109. AVCodecContext *avccontext;
  110. GetBitContext gb;
  111. DSPContext dsp;
  112. FmtConvertContext fmt_conv;
  113. FFTContext mdct[2];
  114. uint8_t first_frame;
  115. uint32_t version;
  116. uint8_t audio_channels;
  117. uint32_t audio_samplerate;
  118. uint32_t bitrate_maximum;
  119. uint32_t bitrate_nominal;
  120. uint32_t bitrate_minimum;
  121. uint32_t blocksize[2];
  122. const float *win[2];
  123. uint16_t codebook_count;
  124. vorbis_codebook *codebooks;
  125. uint8_t floor_count;
  126. vorbis_floor *floors;
  127. uint8_t residue_count;
  128. vorbis_residue *residues;
  129. uint8_t mapping_count;
  130. vorbis_mapping *mappings;
  131. uint8_t mode_count;
  132. vorbis_mode *modes;
  133. uint8_t mode_number; // mode number for the current packet
  134. uint8_t previous_window;
  135. float *channel_residues;
  136. float *channel_floors;
  137. float *saved;
  138. float scale_bias; // for float->int conversion
  139. } vorbis_context;
  140. /* Helper functions */
  141. #define BARK(x) \
  142. (13.1f * atan(0.00074f * (x)) + 2.24f * atan(1.85e-8f * (x) * (x)) + 1e-4f * (x))
  143. static const char idx_err_str[] = "Index value %d out of range (0 - %d) for %s at %s:%i\n";
  144. #define VALIDATE_INDEX(idx, limit) \
  145. if (idx >= limit) {\
  146. av_log(vc->avccontext, AV_LOG_ERROR,\
  147. idx_err_str,\
  148. (int)(idx), (int)(limit - 1), #idx, __FILE__, __LINE__);\
  149. return -1;\
  150. }
  151. #define GET_VALIDATED_INDEX(idx, bits, limit) \
  152. {\
  153. idx = get_bits(gb, bits);\
  154. VALIDATE_INDEX(idx, limit)\
  155. }
  156. static float vorbisfloat2float(unsigned val)
  157. {
  158. double mant = val & 0x1fffff;
  159. long exp = (val & 0x7fe00000L) >> 21;
  160. if (val & 0x80000000)
  161. mant = -mant;
  162. return ldexp(mant, exp - 20 - 768);
  163. }
  164. // Free all allocated memory -----------------------------------------
  165. static void vorbis_free(vorbis_context *vc)
  166. {
  167. int i;
  168. av_freep(&vc->channel_residues);
  169. av_freep(&vc->channel_floors);
  170. av_freep(&vc->saved);
  171. for (i = 0; i < vc->residue_count; i++)
  172. av_free(vc->residues[i].classifs);
  173. av_freep(&vc->residues);
  174. av_freep(&vc->modes);
  175. ff_mdct_end(&vc->mdct[0]);
  176. ff_mdct_end(&vc->mdct[1]);
  177. for (i = 0; i < vc->codebook_count; ++i) {
  178. av_free(vc->codebooks[i].codevectors);
  179. free_vlc(&vc->codebooks[i].vlc);
  180. }
  181. av_freep(&vc->codebooks);
  182. for (i = 0; i < vc->floor_count; ++i) {
  183. if (vc->floors[i].floor_type == 0) {
  184. av_free(vc->floors[i].data.t0.map[0]);
  185. av_free(vc->floors[i].data.t0.map[1]);
  186. av_free(vc->floors[i].data.t0.book_list);
  187. av_free(vc->floors[i].data.t0.lsp);
  188. } else {
  189. av_free(vc->floors[i].data.t1.list);
  190. }
  191. }
  192. av_freep(&vc->floors);
  193. for (i = 0; i < vc->mapping_count; ++i) {
  194. av_free(vc->mappings[i].magnitude);
  195. av_free(vc->mappings[i].angle);
  196. av_free(vc->mappings[i].mux);
  197. }
  198. av_freep(&vc->mappings);
  199. }
  200. // Parse setup header -------------------------------------------------
  201. // Process codebooks part
  202. static int vorbis_parse_setup_hdr_codebooks(vorbis_context *vc)
  203. {
  204. unsigned cb;
  205. uint8_t *tmp_vlc_bits;
  206. uint32_t *tmp_vlc_codes;
  207. GetBitContext *gb = &vc->gb;
  208. uint16_t *codebook_multiplicands;
  209. vc->codebook_count = get_bits(gb, 8) + 1;
  210. av_dlog(NULL, " Codebooks: %d \n", vc->codebook_count);
  211. vc->codebooks = av_mallocz(vc->codebook_count * sizeof(*vc->codebooks));
  212. tmp_vlc_bits = av_mallocz(V_MAX_VLCS * sizeof(*tmp_vlc_bits));
  213. tmp_vlc_codes = av_mallocz(V_MAX_VLCS * sizeof(*tmp_vlc_codes));
  214. codebook_multiplicands = av_malloc(V_MAX_VLCS * sizeof(*codebook_multiplicands));
  215. for (cb = 0; cb < vc->codebook_count; ++cb) {
  216. vorbis_codebook *codebook_setup = &vc->codebooks[cb];
  217. unsigned ordered, t, entries, used_entries = 0;
  218. av_dlog(NULL, " %u. Codebook\n", cb);
  219. if (get_bits(gb, 24) != 0x564342) {
  220. av_log(vc->avccontext, AV_LOG_ERROR,
  221. " %u. Codebook setup data corrupt.\n", cb);
  222. goto error;
  223. }
  224. codebook_setup->dimensions=get_bits(gb, 16);
  225. if (codebook_setup->dimensions > 16 || codebook_setup->dimensions == 0) {
  226. av_log(vc->avccontext, AV_LOG_ERROR,
  227. " %u. Codebook's dimension is invalid (%d).\n",
  228. cb, codebook_setup->dimensions);
  229. goto error;
  230. }
  231. entries = get_bits(gb, 24);
  232. if (entries > V_MAX_VLCS) {
  233. av_log(vc->avccontext, AV_LOG_ERROR,
  234. " %u. Codebook has too many entries (%u).\n",
  235. cb, entries);
  236. goto error;
  237. }
  238. ordered = get_bits1(gb);
  239. av_dlog(NULL, " codebook_dimensions %d, codebook_entries %u\n",
  240. codebook_setup->dimensions, entries);
  241. if (!ordered) {
  242. unsigned ce, flag;
  243. unsigned sparse = get_bits1(gb);
  244. av_dlog(NULL, " not ordered \n");
  245. if (sparse) {
  246. av_dlog(NULL, " sparse \n");
  247. used_entries = 0;
  248. for (ce = 0; ce < entries; ++ce) {
  249. flag = get_bits1(gb);
  250. if (flag) {
  251. tmp_vlc_bits[ce] = get_bits(gb, 5) + 1;
  252. ++used_entries;
  253. } else
  254. tmp_vlc_bits[ce] = 0;
  255. }
  256. } else {
  257. av_dlog(NULL, " not sparse \n");
  258. used_entries = entries;
  259. for (ce = 0; ce < entries; ++ce)
  260. tmp_vlc_bits[ce] = get_bits(gb, 5) + 1;
  261. }
  262. } else {
  263. unsigned current_entry = 0;
  264. unsigned current_length = get_bits(gb, 5) + 1;
  265. av_dlog(NULL, " ordered, current length: %u\n", current_length); //FIXME
  266. used_entries = entries;
  267. for (; current_entry < used_entries && current_length <= 32; ++current_length) {
  268. unsigned i, number;
  269. av_dlog(NULL, " number bits: %u ", ilog(entries - current_entry));
  270. number = get_bits(gb, ilog(entries - current_entry));
  271. av_dlog(NULL, " number: %u\n", number);
  272. for (i = current_entry; i < number+current_entry; ++i)
  273. if (i < used_entries)
  274. tmp_vlc_bits[i] = current_length;
  275. current_entry+=number;
  276. }
  277. if (current_entry>used_entries) {
  278. av_log(vc->avccontext, AV_LOG_ERROR, " More codelengths than codes in codebook. \n");
  279. goto error;
  280. }
  281. }
  282. codebook_setup->lookup_type = get_bits(gb, 4);
  283. av_dlog(NULL, " lookup type: %d : %s \n", codebook_setup->lookup_type,
  284. codebook_setup->lookup_type ? "vq" : "no lookup");
  285. // If the codebook is used for (inverse) VQ, calculate codevectors.
  286. if (codebook_setup->lookup_type == 1) {
  287. unsigned i, j, k;
  288. unsigned codebook_lookup_values = ff_vorbis_nth_root(entries, codebook_setup->dimensions);
  289. float codebook_minimum_value = vorbisfloat2float(get_bits_long(gb, 32));
  290. float codebook_delta_value = vorbisfloat2float(get_bits_long(gb, 32));
  291. unsigned codebook_value_bits = get_bits(gb, 4) + 1;
  292. unsigned codebook_sequence_p = get_bits1(gb);
  293. av_dlog(NULL, " We expect %d numbers for building the codevectors. \n",
  294. codebook_lookup_values);
  295. av_dlog(NULL, " delta %f minmum %f \n",
  296. codebook_delta_value, codebook_minimum_value);
  297. for (i = 0; i < codebook_lookup_values; ++i) {
  298. codebook_multiplicands[i] = get_bits(gb, codebook_value_bits);
  299. av_dlog(NULL, " multiplicands*delta+minmum : %e \n",
  300. (float)codebook_multiplicands[i] * codebook_delta_value + codebook_minimum_value);
  301. av_dlog(NULL, " multiplicand %u\n", codebook_multiplicands[i]);
  302. }
  303. // Weed out unused vlcs and build codevector vector
  304. codebook_setup->codevectors = used_entries ? av_mallocz(used_entries *
  305. codebook_setup->dimensions *
  306. sizeof(*codebook_setup->codevectors))
  307. : NULL;
  308. for (j = 0, i = 0; i < entries; ++i) {
  309. unsigned dim = codebook_setup->dimensions;
  310. if (tmp_vlc_bits[i]) {
  311. float last = 0.0;
  312. unsigned lookup_offset = i;
  313. av_dlog(vc->avccontext, "Lookup offset %u ,", i);
  314. for (k = 0; k < dim; ++k) {
  315. unsigned multiplicand_offset = lookup_offset % codebook_lookup_values;
  316. codebook_setup->codevectors[j * dim + k] = codebook_multiplicands[multiplicand_offset] * codebook_delta_value + codebook_minimum_value + last;
  317. if (codebook_sequence_p)
  318. last = codebook_setup->codevectors[j * dim + k];
  319. lookup_offset/=codebook_lookup_values;
  320. }
  321. tmp_vlc_bits[j] = tmp_vlc_bits[i];
  322. av_dlog(vc->avccontext, "real lookup offset %u, vector: ", j);
  323. for (k = 0; k < dim; ++k)
  324. av_dlog(vc->avccontext, " %f ",
  325. codebook_setup->codevectors[j * dim + k]);
  326. av_dlog(vc->avccontext, "\n");
  327. ++j;
  328. }
  329. }
  330. if (j != used_entries) {
  331. av_log(vc->avccontext, AV_LOG_ERROR, "Bug in codevector vector building code. \n");
  332. goto error;
  333. }
  334. entries = used_entries;
  335. } else if (codebook_setup->lookup_type >= 2) {
  336. av_log(vc->avccontext, AV_LOG_ERROR, "Codebook lookup type not supported. \n");
  337. goto error;
  338. }
  339. // Initialize VLC table
  340. if (ff_vorbis_len2vlc(tmp_vlc_bits, tmp_vlc_codes, entries)) {
  341. av_log(vc->avccontext, AV_LOG_ERROR, " Invalid code lengths while generating vlcs. \n");
  342. goto error;
  343. }
  344. codebook_setup->maxdepth = 0;
  345. for (t = 0; t < entries; ++t)
  346. if (tmp_vlc_bits[t] >= codebook_setup->maxdepth)
  347. codebook_setup->maxdepth = tmp_vlc_bits[t];
  348. if (codebook_setup->maxdepth > 3 * V_NB_BITS)
  349. codebook_setup->nb_bits = V_NB_BITS2;
  350. else
  351. codebook_setup->nb_bits = V_NB_BITS;
  352. codebook_setup->maxdepth = (codebook_setup->maxdepth+codebook_setup->nb_bits - 1) / codebook_setup->nb_bits;
  353. if (init_vlc(&codebook_setup->vlc, codebook_setup->nb_bits, entries, tmp_vlc_bits, sizeof(*tmp_vlc_bits), sizeof(*tmp_vlc_bits), tmp_vlc_codes, sizeof(*tmp_vlc_codes), sizeof(*tmp_vlc_codes), INIT_VLC_LE)) {
  354. av_log(vc->avccontext, AV_LOG_ERROR, " Error generating vlc tables. \n");
  355. goto error;
  356. }
  357. }
  358. av_free(tmp_vlc_bits);
  359. av_free(tmp_vlc_codes);
  360. av_free(codebook_multiplicands);
  361. return 0;
  362. // Error:
  363. error:
  364. av_free(tmp_vlc_bits);
  365. av_free(tmp_vlc_codes);
  366. av_free(codebook_multiplicands);
  367. return -1;
  368. }
  369. // Process time domain transforms part (unused in Vorbis I)
  370. static int vorbis_parse_setup_hdr_tdtransforms(vorbis_context *vc)
  371. {
  372. GetBitContext *gb = &vc->gb;
  373. unsigned i, vorbis_time_count = get_bits(gb, 6) + 1;
  374. for (i = 0; i < vorbis_time_count; ++i) {
  375. unsigned vorbis_tdtransform = get_bits(gb, 16);
  376. av_dlog(NULL, " Vorbis time domain transform %u: %u\n",
  377. vorbis_time_count, vorbis_tdtransform);
  378. if (vorbis_tdtransform) {
  379. av_log(vc->avccontext, AV_LOG_ERROR, "Vorbis time domain transform data nonzero. \n");
  380. return -1;
  381. }
  382. }
  383. return 0;
  384. }
  385. // Process floors part
  386. static int vorbis_floor0_decode(vorbis_context *vc,
  387. vorbis_floor_data *vfu, float *vec);
  388. static void create_map(vorbis_context *vc, unsigned floor_number);
  389. static int vorbis_floor1_decode(vorbis_context *vc,
  390. vorbis_floor_data *vfu, float *vec);
  391. static int vorbis_parse_setup_hdr_floors(vorbis_context *vc)
  392. {
  393. GetBitContext *gb = &vc->gb;
  394. int i,j,k;
  395. vc->floor_count = get_bits(gb, 6) + 1;
  396. vc->floors = av_mallocz(vc->floor_count * sizeof(*vc->floors));
  397. for (i = 0; i < vc->floor_count; ++i) {
  398. vorbis_floor *floor_setup = &vc->floors[i];
  399. floor_setup->floor_type = get_bits(gb, 16);
  400. av_dlog(NULL, " %d. floor type %d \n", i, floor_setup->floor_type);
  401. if (floor_setup->floor_type == 1) {
  402. int maximum_class = -1;
  403. unsigned rangebits, rangemax, floor1_values = 2;
  404. floor_setup->decode = vorbis_floor1_decode;
  405. floor_setup->data.t1.partitions = get_bits(gb, 5);
  406. av_dlog(NULL, " %d.floor: %d partitions \n",
  407. i, floor_setup->data.t1.partitions);
  408. for (j = 0; j < floor_setup->data.t1.partitions; ++j) {
  409. floor_setup->data.t1.partition_class[j] = get_bits(gb, 4);
  410. if (floor_setup->data.t1.partition_class[j] > maximum_class)
  411. maximum_class = floor_setup->data.t1.partition_class[j];
  412. av_dlog(NULL, " %d. floor %d partition class %d \n",
  413. i, j, floor_setup->data.t1.partition_class[j]);
  414. }
  415. av_dlog(NULL, " maximum class %d \n", maximum_class);
  416. for (j = 0; j <= maximum_class; ++j) {
  417. floor_setup->data.t1.class_dimensions[j] = get_bits(gb, 3) + 1;
  418. floor_setup->data.t1.class_subclasses[j] = get_bits(gb, 2);
  419. av_dlog(NULL, " %d floor %d class dim: %d subclasses %d \n", i, j,
  420. floor_setup->data.t1.class_dimensions[j],
  421. floor_setup->data.t1.class_subclasses[j]);
  422. if (floor_setup->data.t1.class_subclasses[j]) {
  423. GET_VALIDATED_INDEX(floor_setup->data.t1.class_masterbook[j], 8, vc->codebook_count)
  424. av_dlog(NULL, " masterbook: %d \n", floor_setup->data.t1.class_masterbook[j]);
  425. }
  426. for (k = 0; k < (1 << floor_setup->data.t1.class_subclasses[j]); ++k) {
  427. int16_t bits = get_bits(gb, 8) - 1;
  428. if (bits != -1)
  429. VALIDATE_INDEX(bits, vc->codebook_count)
  430. floor_setup->data.t1.subclass_books[j][k] = bits;
  431. av_dlog(NULL, " book %d. : %d \n", k, floor_setup->data.t1.subclass_books[j][k]);
  432. }
  433. }
  434. floor_setup->data.t1.multiplier = get_bits(gb, 2) + 1;
  435. floor_setup->data.t1.x_list_dim = 2;
  436. for (j = 0; j < floor_setup->data.t1.partitions; ++j)
  437. floor_setup->data.t1.x_list_dim+=floor_setup->data.t1.class_dimensions[floor_setup->data.t1.partition_class[j]];
  438. floor_setup->data.t1.list = av_mallocz(floor_setup->data.t1.x_list_dim *
  439. sizeof(*floor_setup->data.t1.list));
  440. rangebits = get_bits(gb, 4);
  441. rangemax = (1 << rangebits);
  442. if (rangemax > vc->blocksize[1] / 2) {
  443. av_log(vc->avccontext, AV_LOG_ERROR,
  444. "Floor value is too large for blocksize: %u (%"PRIu32")\n",
  445. rangemax, vc->blocksize[1] / 2);
  446. return -1;
  447. }
  448. floor_setup->data.t1.list[0].x = 0;
  449. floor_setup->data.t1.list[1].x = rangemax;
  450. for (j = 0; j < floor_setup->data.t1.partitions; ++j) {
  451. for (k = 0; k < floor_setup->data.t1.class_dimensions[floor_setup->data.t1.partition_class[j]]; ++k, ++floor1_values) {
  452. floor_setup->data.t1.list[floor1_values].x = get_bits(gb, rangebits);
  453. av_dlog(NULL, " %u. floor1 Y coord. %d\n", floor1_values,
  454. floor_setup->data.t1.list[floor1_values].x);
  455. }
  456. }
  457. // Precalculate order of x coordinates - needed for decode
  458. ff_vorbis_ready_floor1_list(floor_setup->data.t1.list, floor_setup->data.t1.x_list_dim);
  459. } else if (floor_setup->floor_type == 0) {
  460. unsigned max_codebook_dim = 0;
  461. floor_setup->decode = vorbis_floor0_decode;
  462. floor_setup->data.t0.order = get_bits(gb, 8);
  463. floor_setup->data.t0.rate = get_bits(gb, 16);
  464. floor_setup->data.t0.bark_map_size = get_bits(gb, 16);
  465. floor_setup->data.t0.amplitude_bits = get_bits(gb, 6);
  466. /* zero would result in a div by zero later *
  467. * 2^0 - 1 == 0 */
  468. if (floor_setup->data.t0.amplitude_bits == 0) {
  469. av_log(vc->avccontext, AV_LOG_ERROR,
  470. "Floor 0 amplitude bits is 0.\n");
  471. return -1;
  472. }
  473. floor_setup->data.t0.amplitude_offset = get_bits(gb, 8);
  474. floor_setup->data.t0.num_books = get_bits(gb, 4) + 1;
  475. /* allocate mem for booklist */
  476. floor_setup->data.t0.book_list =
  477. av_malloc(floor_setup->data.t0.num_books);
  478. if (!floor_setup->data.t0.book_list)
  479. return -1;
  480. /* read book indexes */
  481. {
  482. int idx;
  483. unsigned book_idx;
  484. for (idx = 0; idx < floor_setup->data.t0.num_books; ++idx) {
  485. GET_VALIDATED_INDEX(book_idx, 8, vc->codebook_count)
  486. floor_setup->data.t0.book_list[idx] = book_idx;
  487. if (vc->codebooks[book_idx].dimensions > max_codebook_dim)
  488. max_codebook_dim = vc->codebooks[book_idx].dimensions;
  489. }
  490. }
  491. create_map(vc, i);
  492. /* codebook dim is for padding if codebook dim doesn't *
  493. * divide order+1 then we need to read more data */
  494. floor_setup->data.t0.lsp =
  495. av_malloc((floor_setup->data.t0.order + 1 + max_codebook_dim)
  496. * sizeof(*floor_setup->data.t0.lsp));
  497. if (!floor_setup->data.t0.lsp)
  498. return -1;
  499. #ifdef V_DEBUG /* debug output parsed headers */
  500. /* debug output parsed headers */
  501. av_dlog(NULL, "floor0 order: %u\n", floor_setup->data.t0.order);
  502. av_dlog(NULL, "floor0 rate: %u\n", floor_setup->data.t0.rate);
  503. av_dlog(NULL, "floor0 bark map size: %u\n",
  504. floor_setup->data.t0.bark_map_size);
  505. av_dlog(NULL, "floor0 amplitude bits: %u\n",
  506. floor_setup->data.t0.amplitude_bits);
  507. av_dlog(NULL, "floor0 amplitude offset: %u\n",
  508. floor_setup->data.t0.amplitude_offset);
  509. av_dlog(NULL, "floor0 number of books: %u\n",
  510. floor_setup->data.t0.num_books);
  511. av_dlog(NULL, "floor0 book list pointer: %p\n",
  512. floor_setup->data.t0.book_list);
  513. {
  514. int idx;
  515. for (idx = 0; idx < floor_setup->data.t0.num_books; ++idx) {
  516. av_dlog(NULL, " Book %d: %u\n", idx + 1,
  517. floor_setup->data.t0.book_list[idx]);
  518. }
  519. }
  520. #endif
  521. } else {
  522. av_log(vc->avccontext, AV_LOG_ERROR, "Invalid floor type!\n");
  523. return -1;
  524. }
  525. }
  526. return 0;
  527. }
  528. // Process residues part
  529. static int vorbis_parse_setup_hdr_residues(vorbis_context *vc)
  530. {
  531. GetBitContext *gb = &vc->gb;
  532. unsigned i, j, k;
  533. vc->residue_count = get_bits(gb, 6)+1;
  534. vc->residues = av_mallocz(vc->residue_count * sizeof(*vc->residues));
  535. av_dlog(NULL, " There are %d residues. \n", vc->residue_count);
  536. for (i = 0; i < vc->residue_count; ++i) {
  537. vorbis_residue *res_setup = &vc->residues[i];
  538. uint8_t cascade[64];
  539. unsigned high_bits, low_bits;
  540. res_setup->type = get_bits(gb, 16);
  541. av_dlog(NULL, " %u. residue type %d\n", i, res_setup->type);
  542. res_setup->begin = get_bits(gb, 24);
  543. res_setup->end = get_bits(gb, 24);
  544. res_setup->partition_size = get_bits(gb, 24) + 1;
  545. /* Validations to prevent a buffer overflow later. */
  546. if (res_setup->begin>res_setup->end ||
  547. res_setup->end > vc->avccontext->channels * vc->blocksize[1] / 2 ||
  548. (res_setup->end-res_setup->begin) / res_setup->partition_size > V_MAX_PARTITIONS) {
  549. av_log(vc->avccontext, AV_LOG_ERROR,
  550. "partition out of bounds: type, begin, end, size, blocksize: %"PRIu16", %"PRIu32", %"PRIu32", %u, %"PRIu32"\n",
  551. res_setup->type, res_setup->begin, res_setup->end,
  552. res_setup->partition_size, vc->blocksize[1] / 2);
  553. return -1;
  554. }
  555. res_setup->classifications = get_bits(gb, 6) + 1;
  556. GET_VALIDATED_INDEX(res_setup->classbook, 8, vc->codebook_count)
  557. res_setup->ptns_to_read =
  558. (res_setup->end - res_setup->begin) / res_setup->partition_size;
  559. res_setup->classifs = av_malloc(res_setup->ptns_to_read *
  560. vc->audio_channels *
  561. sizeof(*res_setup->classifs));
  562. if (!res_setup->classifs)
  563. return AVERROR(ENOMEM);
  564. av_dlog(NULL, " begin %d end %d part.size %d classif.s %d classbook %d \n",
  565. res_setup->begin, res_setup->end, res_setup->partition_size,
  566. res_setup->classifications, res_setup->classbook);
  567. for (j = 0; j < res_setup->classifications; ++j) {
  568. high_bits = 0;
  569. low_bits = get_bits(gb, 3);
  570. if (get_bits1(gb))
  571. high_bits = get_bits(gb, 5);
  572. cascade[j] = (high_bits << 3) + low_bits;
  573. av_dlog(NULL, " %u class cascade depth: %d\n", j, ilog(cascade[j]));
  574. }
  575. res_setup->maxpass = 0;
  576. for (j = 0; j < res_setup->classifications; ++j) {
  577. for (k = 0; k < 8; ++k) {
  578. if (cascade[j]&(1 << k)) {
  579. GET_VALIDATED_INDEX(res_setup->books[j][k], 8, vc->codebook_count)
  580. av_dlog(NULL, " %u class cascade depth %u book: %d\n",
  581. j, k, res_setup->books[j][k]);
  582. if (k>res_setup->maxpass)
  583. res_setup->maxpass = k;
  584. } else {
  585. res_setup->books[j][k] = -1;
  586. }
  587. }
  588. }
  589. }
  590. return 0;
  591. }
  592. // Process mappings part
  593. static int vorbis_parse_setup_hdr_mappings(vorbis_context *vc)
  594. {
  595. GetBitContext *gb = &vc->gb;
  596. unsigned i, j;
  597. vc->mapping_count = get_bits(gb, 6)+1;
  598. vc->mappings = av_mallocz(vc->mapping_count * sizeof(*vc->mappings));
  599. av_dlog(NULL, " There are %d mappings. \n", vc->mapping_count);
  600. for (i = 0; i < vc->mapping_count; ++i) {
  601. vorbis_mapping *mapping_setup = &vc->mappings[i];
  602. if (get_bits(gb, 16)) {
  603. av_log(vc->avccontext, AV_LOG_ERROR, "Other mappings than type 0 are not compliant with the Vorbis I specification. \n");
  604. return -1;
  605. }
  606. if (get_bits1(gb)) {
  607. mapping_setup->submaps = get_bits(gb, 4) + 1;
  608. } else {
  609. mapping_setup->submaps = 1;
  610. }
  611. if (get_bits1(gb)) {
  612. mapping_setup->coupling_steps = get_bits(gb, 8) + 1;
  613. mapping_setup->magnitude = av_mallocz(mapping_setup->coupling_steps *
  614. sizeof(*mapping_setup->magnitude));
  615. mapping_setup->angle = av_mallocz(mapping_setup->coupling_steps *
  616. sizeof(*mapping_setup->angle));
  617. for (j = 0; j < mapping_setup->coupling_steps; ++j) {
  618. GET_VALIDATED_INDEX(mapping_setup->magnitude[j], ilog(vc->audio_channels - 1), vc->audio_channels)
  619. GET_VALIDATED_INDEX(mapping_setup->angle[j], ilog(vc->audio_channels - 1), vc->audio_channels)
  620. }
  621. } else {
  622. mapping_setup->coupling_steps = 0;
  623. }
  624. av_dlog(NULL, " %u mapping coupling steps: %d\n",
  625. i, mapping_setup->coupling_steps);
  626. if (get_bits(gb, 2)) {
  627. av_log(vc->avccontext, AV_LOG_ERROR, "%u. mapping setup data invalid.\n", i);
  628. return -1; // following spec.
  629. }
  630. if (mapping_setup->submaps>1) {
  631. mapping_setup->mux = av_mallocz(vc->audio_channels *
  632. sizeof(*mapping_setup->mux));
  633. for (j = 0; j < vc->audio_channels; ++j)
  634. mapping_setup->mux[j] = get_bits(gb, 4);
  635. }
  636. for (j = 0; j < mapping_setup->submaps; ++j) {
  637. skip_bits(gb, 8); // FIXME check?
  638. GET_VALIDATED_INDEX(mapping_setup->submap_floor[j], 8, vc->floor_count)
  639. GET_VALIDATED_INDEX(mapping_setup->submap_residue[j], 8, vc->residue_count)
  640. av_dlog(NULL, " %u mapping %u submap : floor %d, residue %d\n", i, j,
  641. mapping_setup->submap_floor[j],
  642. mapping_setup->submap_residue[j]);
  643. }
  644. }
  645. return 0;
  646. }
  647. // Process modes part
  648. static void create_map(vorbis_context *vc, unsigned floor_number)
  649. {
  650. vorbis_floor *floors = vc->floors;
  651. vorbis_floor0 *vf;
  652. int idx;
  653. int blockflag, n;
  654. int32_t *map;
  655. for (blockflag = 0; blockflag < 2; ++blockflag) {
  656. n = vc->blocksize[blockflag] / 2;
  657. floors[floor_number].data.t0.map[blockflag] =
  658. av_malloc((n + 1) * sizeof(int32_t)); // n + sentinel
  659. map = floors[floor_number].data.t0.map[blockflag];
  660. vf = &floors[floor_number].data.t0;
  661. for (idx = 0; idx < n; ++idx) {
  662. map[idx] = floor(BARK((vf->rate * idx) / (2.0f * n)) *
  663. ((vf->bark_map_size) /
  664. BARK(vf->rate / 2.0f)));
  665. if (vf->bark_map_size-1 < map[idx])
  666. map[idx] = vf->bark_map_size - 1;
  667. }
  668. map[n] = -1;
  669. vf->map_size[blockflag] = n;
  670. }
  671. #ifdef V_DEBUG
  672. for (idx = 0; idx <= n; ++idx) {
  673. av_dlog(NULL, "floor0 map: map at pos %d is %d\n", idx, map[idx]);
  674. }
  675. #endif
  676. }
  677. static int vorbis_parse_setup_hdr_modes(vorbis_context *vc)
  678. {
  679. GetBitContext *gb = &vc->gb;
  680. unsigned i;
  681. vc->mode_count = get_bits(gb, 6) + 1;
  682. vc->modes = av_mallocz(vc->mode_count * sizeof(*vc->modes));
  683. av_dlog(NULL, " There are %d modes.\n", vc->mode_count);
  684. for (i = 0; i < vc->mode_count; ++i) {
  685. vorbis_mode *mode_setup = &vc->modes[i];
  686. mode_setup->blockflag = get_bits1(gb);
  687. mode_setup->windowtype = get_bits(gb, 16); //FIXME check
  688. mode_setup->transformtype = get_bits(gb, 16); //FIXME check
  689. GET_VALIDATED_INDEX(mode_setup->mapping, 8, vc->mapping_count);
  690. av_dlog(NULL, " %u mode: blockflag %d, windowtype %d, transformtype %d, mapping %d\n",
  691. i, mode_setup->blockflag, mode_setup->windowtype,
  692. mode_setup->transformtype, mode_setup->mapping);
  693. }
  694. return 0;
  695. }
  696. // Process the whole setup header using the functions above
  697. static int vorbis_parse_setup_hdr(vorbis_context *vc)
  698. {
  699. GetBitContext *gb = &vc->gb;
  700. if ((get_bits(gb, 8) != 'v') || (get_bits(gb, 8) != 'o') ||
  701. (get_bits(gb, 8) != 'r') || (get_bits(gb, 8) != 'b') ||
  702. (get_bits(gb, 8) != 'i') || (get_bits(gb, 8) != 's')) {
  703. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (no vorbis signature). \n");
  704. return -1;
  705. }
  706. if (vorbis_parse_setup_hdr_codebooks(vc)) {
  707. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (codebooks). \n");
  708. return -2;
  709. }
  710. if (vorbis_parse_setup_hdr_tdtransforms(vc)) {
  711. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (time domain transforms). \n");
  712. return -3;
  713. }
  714. if (vorbis_parse_setup_hdr_floors(vc)) {
  715. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (floors). \n");
  716. return -4;
  717. }
  718. if (vorbis_parse_setup_hdr_residues(vc)) {
  719. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (residues). \n");
  720. return -5;
  721. }
  722. if (vorbis_parse_setup_hdr_mappings(vc)) {
  723. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (mappings). \n");
  724. return -6;
  725. }
  726. if (vorbis_parse_setup_hdr_modes(vc)) {
  727. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (modes). \n");
  728. return -7;
  729. }
  730. if (!get_bits1(gb)) {
  731. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis setup header packet corrupt (framing flag). \n");
  732. return -8; // framing flag bit unset error
  733. }
  734. return 0;
  735. }
  736. // Process the identification header
  737. static int vorbis_parse_id_hdr(vorbis_context *vc)
  738. {
  739. GetBitContext *gb = &vc->gb;
  740. unsigned bl0, bl1;
  741. if ((get_bits(gb, 8) != 'v') || (get_bits(gb, 8) != 'o') ||
  742. (get_bits(gb, 8) != 'r') || (get_bits(gb, 8) != 'b') ||
  743. (get_bits(gb, 8) != 'i') || (get_bits(gb, 8) != 's')) {
  744. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis id header packet corrupt (no vorbis signature). \n");
  745. return -1;
  746. }
  747. vc->version = get_bits_long(gb, 32); //FIXME check 0
  748. vc->audio_channels = get_bits(gb, 8);
  749. if (vc->audio_channels <= 0) {
  750. av_log(vc->avccontext, AV_LOG_ERROR, "Invalid number of channels\n");
  751. return -1;
  752. }
  753. vc->audio_samplerate = get_bits_long(gb, 32);
  754. if (vc->audio_samplerate <= 0) {
  755. av_log(vc->avccontext, AV_LOG_ERROR, "Invalid samplerate\n");
  756. return -1;
  757. }
  758. vc->bitrate_maximum = get_bits_long(gb, 32);
  759. vc->bitrate_nominal = get_bits_long(gb, 32);
  760. vc->bitrate_minimum = get_bits_long(gb, 32);
  761. bl0 = get_bits(gb, 4);
  762. bl1 = get_bits(gb, 4);
  763. vc->blocksize[0] = (1 << bl0);
  764. vc->blocksize[1] = (1 << bl1);
  765. if (bl0 > 13 || bl0 < 6 || bl1 > 13 || bl1 < 6 || bl1 < bl0) {
  766. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis id header packet corrupt (illegal blocksize). \n");
  767. return -3;
  768. }
  769. // output format int16
  770. if (vc->blocksize[1] / 2 * vc->audio_channels * 2 > AVCODEC_MAX_AUDIO_FRAME_SIZE) {
  771. av_log(vc->avccontext, AV_LOG_ERROR, "Vorbis channel count makes "
  772. "output packets too large.\n");
  773. return -4;
  774. }
  775. vc->win[0] = ff_vorbis_vwin[bl0 - 6];
  776. vc->win[1] = ff_vorbis_vwin[bl1 - 6];
  777. if ((get_bits1(gb)) == 0) {
  778. av_log(vc->avccontext, AV_LOG_ERROR, " Vorbis id header packet corrupt (framing flag not set). \n");
  779. return -2;
  780. }
  781. vc->channel_residues = av_malloc((vc->blocksize[1] / 2) * vc->audio_channels * sizeof(*vc->channel_residues));
  782. vc->channel_floors = av_malloc((vc->blocksize[1] / 2) * vc->audio_channels * sizeof(*vc->channel_floors));
  783. vc->saved = av_mallocz((vc->blocksize[1] / 4) * vc->audio_channels * sizeof(*vc->saved));
  784. vc->previous_window = 0;
  785. ff_mdct_init(&vc->mdct[0], bl0, 1, -vc->scale_bias);
  786. ff_mdct_init(&vc->mdct[1], bl1, 1, -vc->scale_bias);
  787. 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 ",
  788. vc->version, vc->audio_channels, vc->audio_samplerate, vc->bitrate_maximum, vc->bitrate_nominal, vc->bitrate_minimum, vc->blocksize[0], vc->blocksize[1]);
  789. /*
  790. BLK = vc->blocksize[0];
  791. for (i = 0; i < BLK / 2; ++i) {
  792. 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)));
  793. }
  794. */
  795. return 0;
  796. }
  797. // Process the extradata using the functions above (identification header, setup header)
  798. static av_cold int vorbis_decode_init(AVCodecContext *avccontext)
  799. {
  800. vorbis_context *vc = avccontext->priv_data ;
  801. uint8_t *headers = avccontext->extradata;
  802. int headers_len = avccontext->extradata_size;
  803. uint8_t *header_start[3];
  804. int header_len[3];
  805. GetBitContext *gb = &(vc->gb);
  806. int hdr_type;
  807. vc->avccontext = avccontext;
  808. dsputil_init(&vc->dsp, avccontext);
  809. ff_fmt_convert_init(&vc->fmt_conv, avccontext);
  810. if (avccontext->request_sample_fmt == AV_SAMPLE_FMT_FLT) {
  811. avccontext->sample_fmt = AV_SAMPLE_FMT_FLT;
  812. vc->scale_bias = 1.0f;
  813. } else {
  814. avccontext->sample_fmt = AV_SAMPLE_FMT_S16;
  815. vc->scale_bias = 32768.0f;
  816. }
  817. if (!headers_len) {
  818. av_log(avccontext, AV_LOG_ERROR, "Extradata missing.\n");
  819. return -1;
  820. }
  821. if (ff_split_xiph_headers(headers, headers_len, 30, header_start, header_len) < 0) {
  822. av_log(avccontext, AV_LOG_ERROR, "Extradata corrupt.\n");
  823. return -1;
  824. }
  825. init_get_bits(gb, header_start[0], header_len[0]*8);
  826. hdr_type = get_bits(gb, 8);
  827. if (hdr_type != 1) {
  828. av_log(avccontext, AV_LOG_ERROR, "First header is not the id header.\n");
  829. return -1;
  830. }
  831. if (vorbis_parse_id_hdr(vc)) {
  832. av_log(avccontext, AV_LOG_ERROR, "Id header corrupt.\n");
  833. vorbis_free(vc);
  834. return -1;
  835. }
  836. init_get_bits(gb, header_start[2], header_len[2]*8);
  837. hdr_type = get_bits(gb, 8);
  838. if (hdr_type != 5) {
  839. av_log(avccontext, AV_LOG_ERROR, "Third header is not the setup header.\n");
  840. vorbis_free(vc);
  841. return -1;
  842. }
  843. if (vorbis_parse_setup_hdr(vc)) {
  844. av_log(avccontext, AV_LOG_ERROR, "Setup header corrupt.\n");
  845. vorbis_free(vc);
  846. return -1;
  847. }
  848. if (vc->audio_channels > 8)
  849. avccontext->channel_layout = 0;
  850. else
  851. avccontext->channel_layout = ff_vorbis_channel_layouts[vc->audio_channels - 1];
  852. avccontext->channels = vc->audio_channels;
  853. avccontext->sample_rate = vc->audio_samplerate;
  854. avccontext->frame_size = FFMIN(vc->blocksize[0], vc->blocksize[1]) >> 2;
  855. return 0 ;
  856. }
  857. // Decode audiopackets -------------------------------------------------
  858. // Read and decode floor
  859. static int vorbis_floor0_decode(vorbis_context *vc,
  860. vorbis_floor_data *vfu, float *vec)
  861. {
  862. vorbis_floor0 *vf = &vfu->t0;
  863. float *lsp = vf->lsp;
  864. unsigned amplitude, book_idx;
  865. unsigned blockflag = vc->modes[vc->mode_number].blockflag;
  866. amplitude = get_bits(&vc->gb, vf->amplitude_bits);
  867. if (amplitude > 0) {
  868. float last = 0;
  869. unsigned idx, lsp_len = 0;
  870. vorbis_codebook codebook;
  871. book_idx = get_bits(&vc->gb, ilog(vf->num_books));
  872. if (book_idx >= vf->num_books) {
  873. av_log(vc->avccontext, AV_LOG_ERROR,
  874. "floor0 dec: booknumber too high!\n");
  875. book_idx = 0;
  876. }
  877. av_dlog(NULL, "floor0 dec: booknumber: %u\n", book_idx);
  878. codebook = vc->codebooks[vf->book_list[book_idx]];
  879. /* Invalid codebook! */
  880. if (!codebook.codevectors)
  881. return -1;
  882. while (lsp_len<vf->order) {
  883. int vec_off;
  884. av_dlog(NULL, "floor0 dec: book dimension: %d\n", codebook.dimensions);
  885. av_dlog(NULL, "floor0 dec: maximum depth: %d\n", codebook.maxdepth);
  886. /* read temp vector */
  887. vec_off = get_vlc2(&vc->gb, codebook.vlc.table,
  888. codebook.nb_bits, codebook.maxdepth)
  889. * codebook.dimensions;
  890. av_dlog(NULL, "floor0 dec: vector offset: %d\n", vec_off);
  891. /* copy each vector component and add last to it */
  892. for (idx = 0; idx < codebook.dimensions; ++idx)
  893. lsp[lsp_len+idx] = codebook.codevectors[vec_off+idx] + last;
  894. last = lsp[lsp_len+idx-1]; /* set last to last vector component */
  895. lsp_len += codebook.dimensions;
  896. }
  897. #ifdef V_DEBUG
  898. /* DEBUG: output lsp coeffs */
  899. {
  900. int idx;
  901. for (idx = 0; idx < lsp_len; ++idx)
  902. av_dlog(NULL, "floor0 dec: coeff at %d is %f\n", idx, lsp[idx]);
  903. }
  904. #endif
  905. /* synthesize floor output vector */
  906. {
  907. int i;
  908. int order = vf->order;
  909. float wstep = M_PI / vf->bark_map_size;
  910. for (i = 0; i < order; i++)
  911. lsp[i] = 2.0f * cos(lsp[i]);
  912. AV_DEBUG("floor0 synth: map_size = %d; m = %d; wstep = %f\n",
  913. vf->map_size, order, wstep);
  914. i = 0;
  915. while (i < vf->map_size[blockflag]) {
  916. int j, iter_cond = vf->map[blockflag][i];
  917. float p = 0.5f;
  918. float q = 0.5f;
  919. float two_cos_w = 2.0f * cos(wstep * iter_cond); // needed all times
  920. /* similar part for the q and p products */
  921. for (j = 0; j + 1 < order; j += 2) {
  922. q *= lsp[j] - two_cos_w;
  923. p *= lsp[j + 1] - two_cos_w;
  924. }
  925. if (j == order) { // even order
  926. p *= p * (2.0f - two_cos_w);
  927. q *= q * (2.0f + two_cos_w);
  928. } else { // odd order
  929. q *= two_cos_w-lsp[j]; // one more time for q
  930. /* final step and square */
  931. p *= p * (4.f - two_cos_w * two_cos_w);
  932. q *= q;
  933. }
  934. /* calculate linear floor value */
  935. q = exp((((amplitude*vf->amplitude_offset) /
  936. (((1 << vf->amplitude_bits) - 1) * sqrt(p + q)))
  937. - vf->amplitude_offset) * .11512925f);
  938. /* fill vector */
  939. do {
  940. vec[i] = q; ++i;
  941. } while (vf->map[blockflag][i] == iter_cond);
  942. }
  943. }
  944. } else {
  945. /* this channel is unused */
  946. return 1;
  947. }
  948. av_dlog(NULL, " Floor0 decoded\n");
  949. return 0;
  950. }
  951. static int vorbis_floor1_decode(vorbis_context *vc,
  952. vorbis_floor_data *vfu, float *vec)
  953. {
  954. vorbis_floor1 *vf = &vfu->t1;
  955. GetBitContext *gb = &vc->gb;
  956. uint16_t range_v[4] = { 256, 128, 86, 64 };
  957. unsigned range = range_v[vf->multiplier - 1];
  958. uint16_t floor1_Y[258];
  959. uint16_t floor1_Y_final[258];
  960. int floor1_flag[258];
  961. unsigned class, cdim, cbits, csub, cval, offset, i, j;
  962. int book, adx, ady, dy, off, predicted, err;
  963. if (!get_bits1(gb)) // silence
  964. return 1;
  965. // Read values (or differences) for the floor's points
  966. floor1_Y[0] = get_bits(gb, ilog(range - 1));
  967. floor1_Y[1] = get_bits(gb, ilog(range - 1));
  968. av_dlog(NULL, "floor 0 Y %d floor 1 Y %d \n", floor1_Y[0], floor1_Y[1]);
  969. offset = 2;
  970. for (i = 0; i < vf->partitions; ++i) {
  971. class = vf->partition_class[i];
  972. cdim = vf->class_dimensions[class];
  973. cbits = vf->class_subclasses[class];
  974. csub = (1 << cbits) - 1;
  975. cval = 0;
  976. av_dlog(NULL, "Cbits %u\n", cbits);
  977. if (cbits) // this reads all subclasses for this partition's class
  978. cval = get_vlc2(gb, vc->codebooks[vf->class_masterbook[class]].vlc.table,
  979. vc->codebooks[vf->class_masterbook[class]].nb_bits, 3);
  980. for (j = 0; j < cdim; ++j) {
  981. book = vf->subclass_books[class][cval & csub];
  982. av_dlog(NULL, "book %d Cbits %u cval %u bits:%d\n",
  983. book, cbits, cval, get_bits_count(gb));
  984. cval = cval >> cbits;
  985. if (book > -1) {
  986. floor1_Y[offset+j] = get_vlc2(gb, vc->codebooks[book].vlc.table,
  987. vc->codebooks[book].nb_bits, 3);
  988. } else {
  989. floor1_Y[offset+j] = 0;
  990. }
  991. av_dlog(NULL, " floor(%d) = %d \n",
  992. vf->list[offset+j].x, floor1_Y[offset+j]);
  993. }
  994. offset+=cdim;
  995. }
  996. // Amplitude calculation from the differences
  997. floor1_flag[0] = 1;
  998. floor1_flag[1] = 1;
  999. floor1_Y_final[0] = floor1_Y[0];
  1000. floor1_Y_final[1] = floor1_Y[1];
  1001. for (i = 2; i < vf->x_list_dim; ++i) {
  1002. unsigned val, highroom, lowroom, room, high_neigh_offs, low_neigh_offs;
  1003. low_neigh_offs = vf->list[i].low;
  1004. high_neigh_offs = vf->list[i].high;
  1005. dy = floor1_Y_final[high_neigh_offs] - floor1_Y_final[low_neigh_offs]; // render_point begin
  1006. adx = vf->list[high_neigh_offs].x - vf->list[low_neigh_offs].x;
  1007. ady = FFABS(dy);
  1008. err = ady * (vf->list[i].x - vf->list[low_neigh_offs].x);
  1009. off = err / adx;
  1010. if (dy < 0) {
  1011. predicted = floor1_Y_final[low_neigh_offs] - off;
  1012. } else {
  1013. predicted = floor1_Y_final[low_neigh_offs] + off;
  1014. } // render_point end
  1015. val = floor1_Y[i];
  1016. highroom = range-predicted;
  1017. lowroom = predicted;
  1018. if (highroom < lowroom) {
  1019. room = highroom * 2;
  1020. } else {
  1021. room = lowroom * 2; // SPEC mispelling
  1022. }
  1023. if (val) {
  1024. floor1_flag[low_neigh_offs] = 1;
  1025. floor1_flag[high_neigh_offs] = 1;
  1026. floor1_flag[i] = 1;
  1027. if (val >= room) {
  1028. if (highroom > lowroom) {
  1029. floor1_Y_final[i] = val - lowroom + predicted;
  1030. } else {
  1031. floor1_Y_final[i] = predicted - val + highroom - 1;
  1032. }
  1033. } else {
  1034. if (val & 1) {
  1035. floor1_Y_final[i] = predicted - (val + 1) / 2;
  1036. } else {
  1037. floor1_Y_final[i] = predicted + val / 2;
  1038. }
  1039. }
  1040. } else {
  1041. floor1_flag[i] = 0;
  1042. floor1_Y_final[i] = predicted;
  1043. }
  1044. av_dlog(NULL, " Decoded floor(%d) = %u / val %u\n",
  1045. vf->list[i].x, floor1_Y_final[i], val);
  1046. }
  1047. // Curve synth - connect the calculated dots and convert from dB scale FIXME optimize ?
  1048. ff_vorbis_floor1_render_list(vf->list, vf->x_list_dim, floor1_Y_final, floor1_flag, vf->multiplier, vec, vf->list[1].x);
  1049. av_dlog(NULL, " Floor decoded\n");
  1050. return 0;
  1051. }
  1052. // Read and decode residue
  1053. static av_always_inline int vorbis_residue_decode_internal(vorbis_context *vc,
  1054. vorbis_residue *vr,
  1055. unsigned ch,
  1056. uint8_t *do_not_decode,
  1057. float *vec,
  1058. unsigned vlen,
  1059. int vr_type)
  1060. {
  1061. GetBitContext *gb = &vc->gb;
  1062. unsigned c_p_c = vc->codebooks[vr->classbook].dimensions;
  1063. unsigned ptns_to_read = vr->ptns_to_read;
  1064. uint8_t *classifs = vr->classifs;
  1065. unsigned pass, ch_used, i, j, k, l;
  1066. if (vr_type == 2) {
  1067. for (j = 1; j < ch; ++j)
  1068. do_not_decode[0] &= do_not_decode[j]; // FIXME - clobbering input
  1069. if (do_not_decode[0])
  1070. return 0;
  1071. ch_used = 1;
  1072. } else {
  1073. ch_used = ch;
  1074. }
  1075. av_dlog(NULL, " residue type 0/1/2 decode begin, ch: %d cpc %d \n", ch, c_p_c);
  1076. for (pass = 0; pass <= vr->maxpass; ++pass) { // FIXME OPTIMIZE?
  1077. uint16_t voffset, partition_count, j_times_ptns_to_read;
  1078. voffset = vr->begin;
  1079. for (partition_count = 0; partition_count < ptns_to_read;) { // SPEC error
  1080. if (!pass) {
  1081. unsigned inverse_class = ff_inverse[vr->classifications];
  1082. for (j_times_ptns_to_read = 0, j = 0; j < ch_used; ++j) {
  1083. if (!do_not_decode[j]) {
  1084. unsigned temp = get_vlc2(gb, vc->codebooks[vr->classbook].vlc.table,
  1085. vc->codebooks[vr->classbook].nb_bits, 3);
  1086. av_dlog(NULL, "Classword: %u\n", temp);
  1087. assert(vr->classifications > 1 && temp <= 65536); //needed for inverse[]
  1088. for (i = 0; i < c_p_c; ++i) {
  1089. unsigned temp2;
  1090. temp2 = (((uint64_t)temp) * inverse_class) >> 32;
  1091. if (partition_count + c_p_c - 1 - i < ptns_to_read)
  1092. classifs[j_times_ptns_to_read + partition_count + c_p_c - 1 - i] = temp - temp2 * vr->classifications;
  1093. temp = temp2;
  1094. }
  1095. }
  1096. j_times_ptns_to_read += ptns_to_read;
  1097. }
  1098. }
  1099. for (i = 0; (i < c_p_c) && (partition_count < ptns_to_read); ++i) {
  1100. for (j_times_ptns_to_read = 0, j = 0; j < ch_used; ++j) {
  1101. unsigned voffs;
  1102. if (!do_not_decode[j]) {
  1103. unsigned vqclass = classifs[j_times_ptns_to_read + partition_count];
  1104. int vqbook = vr->books[vqclass][pass];
  1105. if (vqbook >= 0 && vc->codebooks[vqbook].codevectors) {
  1106. unsigned coffs;
  1107. unsigned dim = vc->codebooks[vqbook].dimensions;
  1108. unsigned step = dim == 1 ? vr->partition_size
  1109. : FASTDIV(vr->partition_size, dim);
  1110. vorbis_codebook codebook = vc->codebooks[vqbook];
  1111. if (vr_type == 0) {
  1112. voffs = voffset+j*vlen;
  1113. for (k = 0; k < step; ++k) {
  1114. coffs = get_vlc2(gb, codebook.vlc.table, codebook.nb_bits, 3) * dim;
  1115. for (l = 0; l < dim; ++l)
  1116. vec[voffs + k + l * step] += codebook.codevectors[coffs + l]; // FPMATH
  1117. }
  1118. } else if (vr_type == 1) {
  1119. voffs = voffset + j * vlen;
  1120. for (k = 0; k < step; ++k) {
  1121. coffs = get_vlc2(gb, codebook.vlc.table, codebook.nb_bits, 3) * dim;
  1122. for (l = 0; l < dim; ++l, ++voffs) {
  1123. vec[voffs]+=codebook.codevectors[coffs+l]; // FPMATH
  1124. av_dlog(NULL, " pass %d offs: %d curr: %f change: %f cv offs.: %d \n",
  1125. pass, voffs, vec[voffs], codebook.codevectors[coffs+l], coffs);
  1126. }
  1127. }
  1128. } else if (vr_type == 2 && ch == 2 && (voffset & 1) == 0 && (dim & 1) == 0) { // most frequent case optimized
  1129. voffs = voffset >> 1;
  1130. if (dim == 2) {
  1131. for (k = 0; k < step; ++k) {
  1132. coffs = get_vlc2(gb, codebook.vlc.table, codebook.nb_bits, 3) * 2;
  1133. vec[voffs + k ] += codebook.codevectors[coffs ]; // FPMATH
  1134. vec[voffs + k + vlen] += codebook.codevectors[coffs + 1]; // FPMATH
  1135. }
  1136. } else if (dim == 4) {
  1137. for (k = 0; k < step; ++k, voffs += 2) {
  1138. coffs = get_vlc2(gb, codebook.vlc.table, codebook.nb_bits, 3) * 4;
  1139. vec[voffs ] += codebook.codevectors[coffs ]; // FPMATH
  1140. vec[voffs + 1 ] += codebook.codevectors[coffs + 2]; // FPMATH
  1141. vec[voffs + vlen ] += codebook.codevectors[coffs + 1]; // FPMATH
  1142. vec[voffs + vlen + 1] += codebook.codevectors[coffs + 3]; // FPMATH
  1143. }
  1144. } else
  1145. for (k = 0; k < step; ++k) {
  1146. coffs = get_vlc2(gb, codebook.vlc.table, codebook.nb_bits, 3) * dim;
  1147. for (l = 0; l < dim; l += 2, voffs++) {
  1148. vec[voffs ] += codebook.codevectors[coffs + l ]; // FPMATH
  1149. vec[voffs + vlen] += codebook.codevectors[coffs + l + 1]; // FPMATH
  1150. av_dlog(NULL, " pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
  1151. pass, voffset / ch + (voffs % ch) * vlen,
  1152. vec[voffset / ch + (voffs % ch) * vlen],
  1153. codebook.codevectors[coffs + l], coffs, l);
  1154. }
  1155. }
  1156. } else if (vr_type == 2) {
  1157. voffs = voffset;
  1158. for (k = 0; k < step; ++k) {
  1159. coffs = get_vlc2(gb, codebook.vlc.table, codebook.nb_bits, 3) * dim;
  1160. for (l = 0; l < dim; ++l, ++voffs) {
  1161. vec[voffs / ch + (voffs % ch) * vlen] += codebook.codevectors[coffs + l]; // FPMATH FIXME use if and counter instead of / and %
  1162. av_dlog(NULL, " pass %d offs: %d curr: %f change: %f cv offs.: %d+%d \n",
  1163. pass, voffset / ch + (voffs % ch) * vlen,
  1164. vec[voffset / ch + (voffs % ch) * vlen],
  1165. codebook.codevectors[coffs + l], coffs, l);
  1166. }
  1167. }
  1168. }
  1169. }
  1170. }
  1171. j_times_ptns_to_read += ptns_to_read;
  1172. }
  1173. ++partition_count;
  1174. voffset += vr->partition_size;
  1175. }
  1176. }
  1177. }
  1178. return 0;
  1179. }
  1180. static inline int vorbis_residue_decode(vorbis_context *vc, vorbis_residue *vr,
  1181. unsigned ch,
  1182. uint8_t *do_not_decode,
  1183. float *vec, unsigned vlen)
  1184. {
  1185. if (vr->type == 2)
  1186. return vorbis_residue_decode_internal(vc, vr, ch, do_not_decode, vec, vlen, 2);
  1187. else if (vr->type == 1)
  1188. return vorbis_residue_decode_internal(vc, vr, ch, do_not_decode, vec, vlen, 1);
  1189. else if (vr->type == 0)
  1190. return vorbis_residue_decode_internal(vc, vr, ch, do_not_decode, vec, vlen, 0);
  1191. else {
  1192. av_log(vc->avccontext, AV_LOG_ERROR, " Invalid residue type while residue decode?! \n");
  1193. return -1;
  1194. }
  1195. }
  1196. void vorbis_inverse_coupling(float *mag, float *ang, int blocksize)
  1197. {
  1198. int i;
  1199. for (i = 0; i < blocksize; i++) {
  1200. if (mag[i] > 0.0) {
  1201. if (ang[i] > 0.0) {
  1202. ang[i] = mag[i] - ang[i];
  1203. } else {
  1204. float temp = ang[i];
  1205. ang[i] = mag[i];
  1206. mag[i] += temp;
  1207. }
  1208. } else {
  1209. if (ang[i] > 0.0) {
  1210. ang[i] += mag[i];
  1211. } else {
  1212. float temp = ang[i];
  1213. ang[i] = mag[i];
  1214. mag[i] -= temp;
  1215. }
  1216. }
  1217. }
  1218. }
  1219. // Decode the audio packet using the functions above
  1220. static int vorbis_parse_audio_packet(vorbis_context *vc)
  1221. {
  1222. GetBitContext *gb = &vc->gb;
  1223. FFTContext *mdct;
  1224. unsigned previous_window = vc->previous_window;
  1225. unsigned mode_number, blockflag, blocksize;
  1226. int i, j;
  1227. uint8_t no_residue[255];
  1228. uint8_t do_not_decode[255];
  1229. vorbis_mapping *mapping;
  1230. float *ch_res_ptr = vc->channel_residues;
  1231. float *ch_floor_ptr = vc->channel_floors;
  1232. uint8_t res_chan[255];
  1233. unsigned res_num = 0;
  1234. int retlen = 0;
  1235. if (get_bits1(gb)) {
  1236. av_log(vc->avccontext, AV_LOG_ERROR, "Not a Vorbis I audio packet.\n");
  1237. return -1; // packet type not audio
  1238. }
  1239. if (vc->mode_count == 1) {
  1240. mode_number = 0;
  1241. } else {
  1242. GET_VALIDATED_INDEX(mode_number, ilog(vc->mode_count-1), vc->mode_count)
  1243. }
  1244. vc->mode_number = mode_number;
  1245. mapping = &vc->mappings[vc->modes[mode_number].mapping];
  1246. av_dlog(NULL, " Mode number: %u , mapping: %d , blocktype %d\n", mode_number,
  1247. vc->modes[mode_number].mapping, vc->modes[mode_number].blockflag);
  1248. blockflag = vc->modes[mode_number].blockflag;
  1249. blocksize = vc->blocksize[blockflag];
  1250. if (blockflag)
  1251. skip_bits(gb, 2); // previous_window, next_window
  1252. memset(ch_res_ptr, 0, sizeof(float) * vc->audio_channels * blocksize / 2); //FIXME can this be removed ?
  1253. memset(ch_floor_ptr, 0, sizeof(float) * vc->audio_channels * blocksize / 2); //FIXME can this be removed ?
  1254. // Decode floor
  1255. for (i = 0; i < vc->audio_channels; ++i) {
  1256. vorbis_floor *floor;
  1257. int ret;
  1258. if (mapping->submaps > 1) {
  1259. floor = &vc->floors[mapping->submap_floor[mapping->mux[i]]];
  1260. } else {
  1261. floor = &vc->floors[mapping->submap_floor[0]];
  1262. }
  1263. ret = floor->decode(vc, &floor->data, ch_floor_ptr);
  1264. if (ret < 0) {
  1265. av_log(vc->avccontext, AV_LOG_ERROR, "Invalid codebook in vorbis_floor_decode.\n");
  1266. return -1;
  1267. }
  1268. no_residue[i] = ret;
  1269. ch_floor_ptr += blocksize / 2;
  1270. }
  1271. // Nonzero vector propagate
  1272. for (i = mapping->coupling_steps - 1; i >= 0; --i) {
  1273. if (!(no_residue[mapping->magnitude[i]] & no_residue[mapping->angle[i]])) {
  1274. no_residue[mapping->magnitude[i]] = 0;
  1275. no_residue[mapping->angle[i]] = 0;
  1276. }
  1277. }
  1278. // Decode residue
  1279. for (i = 0; i < mapping->submaps; ++i) {
  1280. vorbis_residue *residue;
  1281. unsigned ch = 0;
  1282. for (j = 0; j < vc->audio_channels; ++j) {
  1283. if ((mapping->submaps == 1) || (i == mapping->mux[j])) {
  1284. res_chan[j] = res_num;
  1285. if (no_residue[j]) {
  1286. do_not_decode[ch] = 1;
  1287. } else {
  1288. do_not_decode[ch] = 0;
  1289. }
  1290. ++ch;
  1291. ++res_num;
  1292. }
  1293. }
  1294. residue = &vc->residues[mapping->submap_residue[i]];
  1295. vorbis_residue_decode(vc, residue, ch, do_not_decode, ch_res_ptr, blocksize/2);
  1296. ch_res_ptr += ch * blocksize / 2;
  1297. }
  1298. // Inverse coupling
  1299. for (i = mapping->coupling_steps - 1; i >= 0; --i) { //warning: i has to be signed
  1300. float *mag, *ang;
  1301. mag = vc->channel_residues+res_chan[mapping->magnitude[i]] * blocksize / 2;
  1302. ang = vc->channel_residues+res_chan[mapping->angle[i]] * blocksize / 2;
  1303. vc->dsp.vorbis_inverse_coupling(mag, ang, blocksize / 2);
  1304. }
  1305. // Dotproduct, MDCT
  1306. mdct = &vc->mdct[blockflag];
  1307. for (j = vc->audio_channels-1;j >= 0; j--) {
  1308. ch_floor_ptr = vc->channel_floors + j * blocksize / 2;
  1309. ch_res_ptr = vc->channel_residues + res_chan[j] * blocksize / 2;
  1310. vc->dsp.vector_fmul(ch_floor_ptr, ch_floor_ptr, ch_res_ptr, blocksize / 2);
  1311. mdct->imdct_half(mdct, ch_res_ptr, ch_floor_ptr);
  1312. }
  1313. // Overlap/add, save data for next overlapping FPMATH
  1314. retlen = (blocksize + vc->blocksize[previous_window]) / 4;
  1315. for (j = 0; j < vc->audio_channels; j++) {
  1316. unsigned bs0 = vc->blocksize[0];
  1317. unsigned bs1 = vc->blocksize[1];
  1318. float *residue = vc->channel_residues + res_chan[j] * blocksize / 2;
  1319. float *saved = vc->saved + j * bs1 / 4;
  1320. float *ret = vc->channel_floors + j * retlen;
  1321. float *buf = residue;
  1322. const float *win = vc->win[blockflag & previous_window];
  1323. if (blockflag == previous_window) {
  1324. vc->dsp.vector_fmul_window(ret, saved, buf, win, blocksize / 4);
  1325. } else if (blockflag > previous_window) {
  1326. vc->dsp.vector_fmul_window(ret, saved, buf, win, bs0 / 4);
  1327. memcpy(ret+bs0/2, buf+bs0/4, ((bs1-bs0)/4) * sizeof(float));
  1328. } else {
  1329. memcpy(ret, saved, ((bs1 - bs0) / 4) * sizeof(float));
  1330. vc->dsp.vector_fmul_window(ret + (bs1 - bs0) / 4, saved + (bs1 - bs0) / 4, buf, win, bs0 / 4);
  1331. }
  1332. memcpy(saved, buf + blocksize / 4, blocksize / 4 * sizeof(float));
  1333. }
  1334. vc->previous_window = blockflag;
  1335. return retlen;
  1336. }
  1337. // Return the decoded audio packet through the standard api
  1338. static int vorbis_decode_frame(AVCodecContext *avccontext,
  1339. void *data, int *data_size,
  1340. AVPacket *avpkt)
  1341. {
  1342. const uint8_t *buf = avpkt->data;
  1343. int buf_size = avpkt->size;
  1344. vorbis_context *vc = avccontext->priv_data ;
  1345. GetBitContext *gb = &(vc->gb);
  1346. const float *channel_ptrs[255];
  1347. int i, len;
  1348. if (!buf_size)
  1349. return 0;
  1350. av_dlog(NULL, "packet length %d \n", buf_size);
  1351. init_get_bits(gb, buf, buf_size*8);
  1352. len = vorbis_parse_audio_packet(vc);
  1353. if (len <= 0) {
  1354. *data_size = 0;
  1355. return buf_size;
  1356. }
  1357. if (!vc->first_frame) {
  1358. vc->first_frame = 1;
  1359. *data_size = 0;
  1360. return buf_size ;
  1361. }
  1362. av_dlog(NULL, "parsed %d bytes %d bits, returned %d samples (*ch*bits) \n",
  1363. get_bits_count(gb) / 8, get_bits_count(gb) % 8, len);
  1364. if (vc->audio_channels > 8) {
  1365. for (i = 0; i < vc->audio_channels; i++)
  1366. channel_ptrs[i] = vc->channel_floors + i * len;
  1367. } else {
  1368. for (i = 0; i < vc->audio_channels; i++)
  1369. channel_ptrs[i] = vc->channel_floors +
  1370. len * ff_vorbis_channel_layout_offsets[vc->audio_channels - 1][i];
  1371. }
  1372. if (avccontext->sample_fmt == AV_SAMPLE_FMT_FLT)
  1373. vc->fmt_conv.float_interleave(data, channel_ptrs, len, vc->audio_channels);
  1374. else
  1375. vc->fmt_conv.float_to_int16_interleave(data, channel_ptrs, len,
  1376. vc->audio_channels);
  1377. *data_size = len * vc->audio_channels *
  1378. (av_get_bits_per_sample_fmt(avccontext->sample_fmt) / 8);
  1379. return buf_size ;
  1380. }
  1381. // Close decoder
  1382. static av_cold int vorbis_decode_close(AVCodecContext *avccontext)
  1383. {
  1384. vorbis_context *vc = avccontext->priv_data;
  1385. vorbis_free(vc);
  1386. return 0 ;
  1387. }
  1388. AVCodec ff_vorbis_decoder = {
  1389. "vorbis",
  1390. AVMEDIA_TYPE_AUDIO,
  1391. CODEC_ID_VORBIS,
  1392. sizeof(vorbis_context),
  1393. vorbis_decode_init,
  1394. NULL,
  1395. vorbis_decode_close,
  1396. vorbis_decode_frame,
  1397. .long_name = NULL_IF_CONFIG_SMALL("Vorbis"),
  1398. .channel_layouts = ff_vorbis_channel_layouts,
  1399. .sample_fmts = (const enum AVSampleFormat[]) {
  1400. AV_SAMPLE_FMT_FLT, AV_SAMPLE_FMT_S16, AV_SAMPLE_FMT_NONE
  1401. },
  1402. };