MP3Loader.cpp 37 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867
  1. /*
  2. * Copyright (c) 2021, Arne Elster <arne@elster.li>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include "MP3Loader.h"
  7. #include "MP3HuffmanTables.h"
  8. #include "MP3Tables.h"
  9. #include "MP3Types.h"
  10. #include <AK/FixedArray.h>
  11. #include <LibCore/File.h>
  12. namespace Audio {
  13. DSP::MDCT<12> MP3LoaderPlugin::s_mdct_12;
  14. DSP::MDCT<36> MP3LoaderPlugin::s_mdct_36;
  15. MP3LoaderPlugin::MP3LoaderPlugin(NonnullOwnPtr<SeekableStream> stream)
  16. : LoaderPlugin(move(stream))
  17. {
  18. }
  19. Result<NonnullOwnPtr<MP3LoaderPlugin>, LoaderError> MP3LoaderPlugin::create(StringView path)
  20. {
  21. auto stream = LOADER_TRY(Core::BufferedFile::create(LOADER_TRY(Core::File::open(path, Core::File::OpenMode::Read))));
  22. auto loader = make<MP3LoaderPlugin>(move(stream));
  23. LOADER_TRY(loader->initialize());
  24. return loader;
  25. }
  26. Result<NonnullOwnPtr<MP3LoaderPlugin>, LoaderError> MP3LoaderPlugin::create(Bytes buffer)
  27. {
  28. auto stream = LOADER_TRY(try_make<FixedMemoryStream>(buffer));
  29. auto loader = make<MP3LoaderPlugin>(move(stream));
  30. LOADER_TRY(loader->initialize());
  31. return loader;
  32. }
  33. MaybeLoaderError MP3LoaderPlugin::initialize()
  34. {
  35. m_bitstream = LOADER_TRY(try_make<BigEndianInputBitStream>(MaybeOwned<Stream>(*m_stream)));
  36. TRY(synchronize());
  37. auto header = TRY(read_header());
  38. if (header.id != 1 || header.layer != 3)
  39. return LoaderError { LoaderError::Category::Format, "Only MPEG-1 layer 3 supported." };
  40. m_sample_rate = header.samplerate;
  41. m_num_channels = header.channel_count();
  42. m_loaded_samples = 0;
  43. TRY(build_seek_table());
  44. LOADER_TRY(m_stream->seek(0, SeekMode::SetPosition));
  45. return {};
  46. }
  47. MaybeLoaderError MP3LoaderPlugin::reset()
  48. {
  49. TRY(seek(0));
  50. m_current_frame = {};
  51. m_synthesis_buffer = {};
  52. m_loaded_samples = 0;
  53. LOADER_TRY(m_bit_reservoir.discard(m_bit_reservoir.used_buffer_size()));
  54. m_bitstream->align_to_byte_boundary();
  55. return {};
  56. }
  57. MaybeLoaderError MP3LoaderPlugin::seek(int const position)
  58. {
  59. auto seek_entry = m_seek_table.seek_point_before(position);
  60. if (seek_entry.has_value()) {
  61. LOADER_TRY(m_stream->seek(seek_entry->byte_offset, SeekMode::SetPosition));
  62. m_loaded_samples = seek_entry->sample_index;
  63. }
  64. m_current_frame = {};
  65. m_synthesis_buffer = {};
  66. LOADER_TRY(m_bit_reservoir.discard(m_bit_reservoir.used_buffer_size()));
  67. m_bitstream->align_to_byte_boundary();
  68. return {};
  69. }
  70. ErrorOr<Vector<FixedArray<Sample>>, LoaderError> MP3LoaderPlugin::load_chunks(size_t samples_to_read_from_input)
  71. {
  72. int samples_to_read = samples_to_read_from_input;
  73. Vector<FixedArray<Sample>> frames;
  74. while (samples_to_read > 0) {
  75. FixedArray<Sample> samples = LOADER_TRY(FixedArray<Sample>::create(MP3::frame_size));
  76. if (!m_current_frame.has_value()) {
  77. auto maybe_frame = read_next_frame();
  78. if (maybe_frame.is_error()) {
  79. if (m_stream->is_eof()) {
  80. return Vector<FixedArray<Sample>> {};
  81. }
  82. return maybe_frame.release_error();
  83. }
  84. m_current_frame = maybe_frame.release_value();
  85. if (!m_current_frame.has_value())
  86. break;
  87. }
  88. bool const is_stereo = m_current_frame->header.channel_count() == 2;
  89. size_t current_frame_read = 0;
  90. for (; current_frame_read < MP3::granule_size; current_frame_read++) {
  91. auto const left_sample = m_current_frame->channels[0].granules[0].pcm[current_frame_read / 32][current_frame_read % 32];
  92. auto const right_sample = is_stereo ? m_current_frame->channels[1].granules[0].pcm[current_frame_read / 32][current_frame_read % 32] : left_sample;
  93. samples[current_frame_read] = Sample { left_sample, right_sample };
  94. samples_to_read--;
  95. }
  96. for (; current_frame_read < MP3::frame_size; current_frame_read++) {
  97. auto const left_sample = m_current_frame->channels[0].granules[1].pcm[(current_frame_read - MP3::granule_size) / 32][(current_frame_read - MP3::granule_size) % 32];
  98. auto const right_sample = is_stereo ? m_current_frame->channels[1].granules[1].pcm[(current_frame_read - MP3::granule_size) / 32][(current_frame_read - MP3::granule_size) % 32] : left_sample;
  99. samples[current_frame_read] = Sample { left_sample, right_sample };
  100. samples_to_read--;
  101. }
  102. m_loaded_samples += samples.size();
  103. TRY(frames.try_append(move(samples)));
  104. m_current_frame = {};
  105. }
  106. return frames;
  107. }
  108. MaybeLoaderError MP3LoaderPlugin::build_seek_table()
  109. {
  110. int sample_count = 0;
  111. size_t frame_count = 0;
  112. m_seek_table = {};
  113. m_bitstream->align_to_byte_boundary();
  114. while (!synchronize().is_error()) {
  115. auto const frame_pos = -2 + LOADER_TRY(m_stream->seek(0, SeekMode::FromCurrentPosition));
  116. auto error_or_header = read_header();
  117. if (error_or_header.is_error() || error_or_header.value().id != 1 || error_or_header.value().layer != 3) {
  118. continue;
  119. }
  120. frame_count++;
  121. sample_count += MP3::frame_size;
  122. if (frame_count % 10 == 0)
  123. LOADER_TRY(m_seek_table.insert_seek_point({ static_cast<u64>(sample_count), frame_pos }));
  124. LOADER_TRY(m_stream->seek(error_or_header.value().frame_size - 6, SeekMode::FromCurrentPosition));
  125. // TODO: This is just here to clear the bitstream buffer.
  126. // Bitstream should have a method to sync its state to the underlying stream.
  127. m_bitstream->align_to_byte_boundary();
  128. }
  129. m_total_samples = sample_count;
  130. return {};
  131. }
  132. ErrorOr<MP3::Header, LoaderError> MP3LoaderPlugin::read_header()
  133. {
  134. MP3::Header header;
  135. header.id = LOADER_TRY(m_bitstream->read_bit());
  136. header.layer = MP3::Tables::LayerNumberLookup[LOADER_TRY(m_bitstream->read_bits(2))];
  137. if (header.layer <= 0)
  138. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Frame header contains invalid layer number." };
  139. header.protection_bit = LOADER_TRY(m_bitstream->read_bit());
  140. header.bitrate = MP3::Tables::BitratesPerLayerLookup[header.layer - 1][LOADER_TRY(m_bitstream->read_bits(4))];
  141. if (header.bitrate <= 0)
  142. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Frame header contains invalid bitrate." };
  143. header.samplerate = MP3::Tables::SampleratesLookup[LOADER_TRY(m_bitstream->read_bits(2))];
  144. if (header.samplerate <= 0)
  145. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Frame header contains invalid samplerate." };
  146. header.padding_bit = LOADER_TRY(m_bitstream->read_bit());
  147. header.private_bit = LOADER_TRY(m_bitstream->read_bit());
  148. header.mode = static_cast<MP3::Mode>(LOADER_TRY(m_bitstream->read_bits(2)));
  149. header.mode_extension = static_cast<MP3::ModeExtension>(LOADER_TRY(m_bitstream->read_bits(2)));
  150. header.copyright_bit = LOADER_TRY(m_bitstream->read_bit());
  151. header.original_bit = LOADER_TRY(m_bitstream->read_bit());
  152. header.emphasis = static_cast<MP3::Emphasis>(LOADER_TRY(m_bitstream->read_bits(2)));
  153. if (!header.protection_bit)
  154. header.crc16 = LOADER_TRY(m_bitstream->read_bits<u16>(16));
  155. header.frame_size = 144 * header.bitrate * 1000 / header.samplerate + header.padding_bit;
  156. header.slot_count = header.frame_size - ((header.channel_count() == 2 ? 32 : 17) + (header.protection_bit ? 0 : 2) + 4);
  157. return header;
  158. }
  159. MaybeLoaderError MP3LoaderPlugin::synchronize()
  160. {
  161. size_t one_counter = 0;
  162. while (one_counter < 12 && !m_bitstream->is_eof()) {
  163. bool const bit = LOADER_TRY(m_bitstream->read_bit());
  164. one_counter = bit ? one_counter + 1 : 0;
  165. if (!bit) {
  166. m_bitstream->align_to_byte_boundary();
  167. }
  168. }
  169. if (one_counter != 12)
  170. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Failed to synchronize." };
  171. return {};
  172. }
  173. ErrorOr<MP3::MP3Frame, LoaderError> MP3LoaderPlugin::read_next_frame()
  174. {
  175. // Note: This will spin until we find a correct frame, or we reach eof.
  176. // In the second case, the error will bubble up from read_frame_data().
  177. while (true) {
  178. TRY(synchronize());
  179. MP3::Header header = TRY(read_header());
  180. if (header.id != 1 || header.layer != 3) {
  181. continue;
  182. }
  183. return read_frame_data(header);
  184. }
  185. }
  186. ErrorOr<MP3::MP3Frame, LoaderError> MP3LoaderPlugin::read_frame_data(MP3::Header const& header)
  187. {
  188. MP3::MP3Frame frame { header };
  189. TRY(read_side_information(frame));
  190. auto maybe_buffer = ByteBuffer::create_uninitialized(header.slot_count);
  191. if (maybe_buffer.is_error())
  192. return LoaderError { LoaderError::Category::IO, m_loaded_samples, "Out of memory" };
  193. auto& buffer = maybe_buffer.value();
  194. size_t old_reservoir_size = m_bit_reservoir.used_buffer_size();
  195. LOADER_TRY(m_bitstream->read_until_filled(buffer));
  196. LOADER_TRY(m_bit_reservoir.write_until_depleted(buffer));
  197. // If we don't have enough data in the reservoir to process this frame, skip it (but keep the data).
  198. if (old_reservoir_size < static_cast<size_t>(frame.main_data_begin))
  199. return frame;
  200. TRY(m_bit_reservoir.discard(old_reservoir_size - frame.main_data_begin));
  201. BigEndianInputBitStream reservoir_stream { MaybeOwned<Stream>(m_bit_reservoir) };
  202. for (size_t granule_index = 0; granule_index < 2; granule_index++) {
  203. for (size_t channel_index = 0; channel_index < header.channel_count(); channel_index++) {
  204. size_t scale_factor_size = TRY(read_scale_factors(frame, reservoir_stream, granule_index, channel_index));
  205. TRY(read_huffman_data(frame, reservoir_stream, granule_index, channel_index, scale_factor_size));
  206. if (frame.channels[channel_index].granules[granule_index].block_type == MP3::BlockType::Short) {
  207. reorder_samples(frame.channels[channel_index].granules[granule_index], frame.header.samplerate);
  208. // Only reduce alias for lowest 2 bands as they're long.
  209. // Afaik this is not mentioned in the ISO spec, but it is addressed in the
  210. // changelog for the ISO compliance tests.
  211. if (frame.channels[channel_index].granules[granule_index].mixed_block_flag)
  212. reduce_alias(frame.channels[channel_index].granules[granule_index], 36);
  213. } else {
  214. reduce_alias(frame.channels[channel_index].granules[granule_index]);
  215. }
  216. }
  217. if (header.mode == MP3::Mode::JointStereo) {
  218. process_stereo(frame, granule_index);
  219. }
  220. }
  221. for (size_t granule_index = 0; granule_index < 2; granule_index++) {
  222. for (size_t channel_index = 0; channel_index < header.channel_count(); channel_index++) {
  223. auto& granule = frame.channels[channel_index].granules[granule_index];
  224. for (size_t i = 0; i < MP3::granule_size; i += 18) {
  225. MP3::BlockType block_type = granule.block_type;
  226. if (i < 36 && granule.mixed_block_flag) {
  227. // ISO/IEC 11172-3: if mixed_block_flag is set, the lowest two subbands are transformed with normal window.
  228. block_type = MP3::BlockType::Normal;
  229. }
  230. Array<float, 36> output;
  231. transform_samples_to_time(granule.samples, i, output, block_type);
  232. int const subband_index = i / 18;
  233. for (size_t sample_index = 0; sample_index < 18; sample_index++) {
  234. // overlap add
  235. granule.filter_bank_input[subband_index][sample_index] = output[sample_index] + m_last_values[channel_index][subband_index][sample_index];
  236. m_last_values[channel_index][subband_index][sample_index] = output[sample_index + 18];
  237. // frequency inversion
  238. if (subband_index % 2 == 1 && sample_index % 2 == 1)
  239. granule.filter_bank_input[subband_index][sample_index] *= -1;
  240. }
  241. }
  242. }
  243. }
  244. Array<float, 32> in_samples;
  245. for (size_t channel_index = 0; channel_index < frame.header.channel_count(); channel_index++) {
  246. for (size_t granule_index = 0; granule_index < 2; granule_index++) {
  247. auto& granule = frame.channels[channel_index].granules[granule_index];
  248. for (size_t sample_index = 0; sample_index < 18; sample_index++) {
  249. for (size_t band_index = 0; band_index < 32; band_index++) {
  250. in_samples[band_index] = granule.filter_bank_input[band_index][sample_index];
  251. }
  252. synthesis(m_synthesis_buffer[channel_index], in_samples, granule.pcm[sample_index]);
  253. }
  254. }
  255. }
  256. return frame;
  257. }
  258. MaybeLoaderError MP3LoaderPlugin::read_side_information(MP3::MP3Frame& frame)
  259. {
  260. frame.main_data_begin = LOADER_TRY(m_bitstream->read_bits(9));
  261. if (frame.header.channel_count() == 1) {
  262. frame.private_bits = LOADER_TRY(m_bitstream->read_bits(5));
  263. } else {
  264. frame.private_bits = LOADER_TRY(m_bitstream->read_bits(3));
  265. }
  266. for (size_t channel_index = 0; channel_index < frame.header.channel_count(); channel_index++) {
  267. for (size_t scale_factor_selection_info_band = 0; scale_factor_selection_info_band < 4; scale_factor_selection_info_band++) {
  268. frame.channels[channel_index].scale_factor_selection_info[scale_factor_selection_info_band] = LOADER_TRY(m_bitstream->read_bit());
  269. }
  270. }
  271. for (size_t granule_index = 0; granule_index < 2; granule_index++) {
  272. for (size_t channel_index = 0; channel_index < frame.header.channel_count(); channel_index++) {
  273. auto& granule = frame.channels[channel_index].granules[granule_index];
  274. granule.part_2_3_length = LOADER_TRY(m_bitstream->read_bits(12));
  275. granule.big_values = LOADER_TRY(m_bitstream->read_bits(9));
  276. granule.global_gain = LOADER_TRY(m_bitstream->read_bits(8));
  277. granule.scalefac_compress = LOADER_TRY(m_bitstream->read_bits(4));
  278. granule.window_switching_flag = LOADER_TRY(m_bitstream->read_bit());
  279. if (granule.window_switching_flag) {
  280. granule.block_type = static_cast<MP3::BlockType>(LOADER_TRY(m_bitstream->read_bits(2)));
  281. granule.mixed_block_flag = LOADER_TRY(m_bitstream->read_bit());
  282. for (size_t region = 0; region < 2; region++)
  283. granule.table_select[region] = LOADER_TRY(m_bitstream->read_bits(5));
  284. for (size_t window = 0; window < 3; window++)
  285. granule.sub_block_gain[window] = LOADER_TRY(m_bitstream->read_bits(3));
  286. granule.region0_count = (granule.block_type == MP3::BlockType::Short && !granule.mixed_block_flag) ? 8 : 7;
  287. granule.region1_count = 36;
  288. } else {
  289. for (size_t region = 0; region < 3; region++)
  290. granule.table_select[region] = LOADER_TRY(m_bitstream->read_bits(5));
  291. granule.region0_count = LOADER_TRY(m_bitstream->read_bits(4));
  292. granule.region1_count = LOADER_TRY(m_bitstream->read_bits(3));
  293. }
  294. granule.preflag = LOADER_TRY(m_bitstream->read_bit());
  295. granule.scalefac_scale = LOADER_TRY(m_bitstream->read_bit());
  296. granule.count1table_select = LOADER_TRY(m_bitstream->read_bit());
  297. }
  298. }
  299. return {};
  300. }
  301. // From ISO/IEC 11172-3 (2.4.3.4.7.1)
  302. Array<float, MP3::granule_size> MP3LoaderPlugin::calculate_frame_exponents(MP3::MP3Frame const& frame, size_t granule_index, size_t channel_index)
  303. {
  304. Array<float, MP3::granule_size> exponents;
  305. auto fill_band = [&exponents](float exponent, size_t start, size_t end) {
  306. for (size_t j = start; j <= end; j++) {
  307. exponents[j] = exponent;
  308. }
  309. };
  310. auto const& channel = frame.channels[channel_index];
  311. auto const& granule = frame.channels[channel_index].granules[granule_index];
  312. auto const scale_factor_bands = get_scalefactor_bands(granule, frame.header.samplerate);
  313. float const scale_factor_multiplier = granule.scalefac_scale ? 1 : 0.5;
  314. int const gain = granule.global_gain - 210;
  315. if (granule.block_type != MP3::BlockType::Short) {
  316. for (size_t band_index = 0; band_index < 22; band_index++) {
  317. float const exponent = gain / 4.0f - (scale_factor_multiplier * (channel.scale_factors[band_index] + granule.preflag * MP3::Tables::Pretab[band_index]));
  318. fill_band(AK::pow<float>(2.0, exponent), scale_factor_bands[band_index].start, scale_factor_bands[band_index].end);
  319. }
  320. } else {
  321. size_t band_index = 0;
  322. size_t sample_count = 0;
  323. if (granule.mixed_block_flag) {
  324. while (sample_count < 36) {
  325. float const exponent = gain / 4.0f - (scale_factor_multiplier * (channel.scale_factors[band_index] + granule.preflag * MP3::Tables::Pretab[band_index]));
  326. fill_band(AK::pow<float>(2.0, exponent), scale_factor_bands[band_index].start, scale_factor_bands[band_index].end);
  327. sample_count += scale_factor_bands[band_index].width;
  328. band_index++;
  329. }
  330. }
  331. float const gain0 = (gain - 8 * granule.sub_block_gain[0]) / 4.0;
  332. float const gain1 = (gain - 8 * granule.sub_block_gain[1]) / 4.0;
  333. float const gain2 = (gain - 8 * granule.sub_block_gain[2]) / 4.0;
  334. while (sample_count < MP3::granule_size && band_index < scale_factor_bands.size()) {
  335. float const exponent0 = gain0 - (scale_factor_multiplier * channel.scale_factors[band_index + 0]);
  336. float const exponent1 = gain1 - (scale_factor_multiplier * channel.scale_factors[band_index + 1]);
  337. float const exponent2 = gain2 - (scale_factor_multiplier * channel.scale_factors[band_index + 2]);
  338. fill_band(AK::pow<float>(2.0, exponent0), scale_factor_bands[band_index + 0].start, scale_factor_bands[band_index + 0].end);
  339. sample_count += scale_factor_bands[band_index + 0].width;
  340. fill_band(AK::pow<float>(2.0, exponent1), scale_factor_bands[band_index + 1].start, scale_factor_bands[band_index + 1].end);
  341. sample_count += scale_factor_bands[band_index + 1].width;
  342. fill_band(AK::pow<float>(2.0, exponent2), scale_factor_bands[band_index + 2].start, scale_factor_bands[band_index + 2].end);
  343. sample_count += scale_factor_bands[band_index + 2].width;
  344. band_index += 3;
  345. }
  346. while (sample_count < MP3::granule_size)
  347. exponents[sample_count++] = 0;
  348. }
  349. return exponents;
  350. }
  351. ErrorOr<size_t, LoaderError> MP3LoaderPlugin::read_scale_factors(MP3::MP3Frame& frame, BigEndianInputBitStream& reservoir, size_t granule_index, size_t channel_index)
  352. {
  353. auto& channel = frame.channels[channel_index];
  354. auto const& granule = channel.granules[granule_index];
  355. size_t band_index = 0;
  356. size_t bits_read = 0;
  357. if (granule.window_switching_flag && granule.block_type == MP3::BlockType::Short) {
  358. if (granule.mixed_block_flag) {
  359. for (size_t i = 0; i < 8; i++) {
  360. auto const bits = MP3::Tables::ScalefacCompressSlen1[granule.scalefac_compress];
  361. channel.scale_factors[band_index++] = TRY(reservoir.read_bits(bits));
  362. bits_read += bits;
  363. }
  364. for (size_t i = 3; i < 12; i++) {
  365. auto const bits = i <= 5 ? MP3::Tables::ScalefacCompressSlen1[granule.scalefac_compress] : MP3::Tables::ScalefacCompressSlen2[granule.scalefac_compress];
  366. channel.scale_factors[band_index++] = TRY(reservoir.read_bits(bits));
  367. channel.scale_factors[band_index++] = TRY(reservoir.read_bits(bits));
  368. channel.scale_factors[band_index++] = TRY(reservoir.read_bits(bits));
  369. bits_read += 3 * bits;
  370. }
  371. } else {
  372. for (size_t i = 0; i < 12; i++) {
  373. auto const bits = i <= 5 ? MP3::Tables::ScalefacCompressSlen1[granule.scalefac_compress] : MP3::Tables::ScalefacCompressSlen2[granule.scalefac_compress];
  374. channel.scale_factors[band_index++] = TRY(reservoir.read_bits(bits));
  375. channel.scale_factors[band_index++] = TRY(reservoir.read_bits(bits));
  376. channel.scale_factors[band_index++] = TRY(reservoir.read_bits(bits));
  377. bits_read += 3 * bits;
  378. }
  379. }
  380. channel.scale_factors[band_index++] = 0;
  381. channel.scale_factors[band_index++] = 0;
  382. channel.scale_factors[band_index++] = 0;
  383. } else {
  384. if ((channel.scale_factor_selection_info[0] == 0) || (granule_index == 0)) {
  385. for (band_index = 0; band_index < 6; band_index++) {
  386. auto const bits = MP3::Tables::ScalefacCompressSlen1[granule.scalefac_compress];
  387. channel.scale_factors[band_index] = TRY(reservoir.read_bits(bits));
  388. bits_read += bits;
  389. }
  390. }
  391. if ((channel.scale_factor_selection_info[1] == 0) || (granule_index == 0)) {
  392. for (band_index = 6; band_index < 11; band_index++) {
  393. auto const bits = MP3::Tables::ScalefacCompressSlen1[granule.scalefac_compress];
  394. channel.scale_factors[band_index] = TRY(reservoir.read_bits(bits));
  395. bits_read += bits;
  396. }
  397. }
  398. if ((channel.scale_factor_selection_info[2] == 0) || (granule_index == 0)) {
  399. for (band_index = 11; band_index < 16; band_index++) {
  400. auto const bits = MP3::Tables::ScalefacCompressSlen2[granule.scalefac_compress];
  401. channel.scale_factors[band_index] = TRY(reservoir.read_bits(bits));
  402. bits_read += bits;
  403. }
  404. }
  405. if ((channel.scale_factor_selection_info[3] == 0) || (granule_index == 0)) {
  406. for (band_index = 16; band_index < 21; band_index++) {
  407. auto const bits = MP3::Tables::ScalefacCompressSlen2[granule.scalefac_compress];
  408. channel.scale_factors[band_index] = TRY(reservoir.read_bits(bits));
  409. bits_read += bits;
  410. }
  411. }
  412. channel.scale_factors[21] = 0;
  413. }
  414. return bits_read;
  415. }
  416. MaybeLoaderError MP3LoaderPlugin::read_huffman_data(MP3::MP3Frame& frame, BigEndianInputBitStream& reservoir, size_t granule_index, size_t channel_index, size_t granule_bits_read)
  417. {
  418. auto const exponents = calculate_frame_exponents(frame, granule_index, channel_index);
  419. auto& granule = frame.channels[channel_index].granules[granule_index];
  420. auto const scale_factor_bands = get_scalefactor_bands(granule, frame.header.samplerate);
  421. size_t const scale_factor_band_index1 = granule.region0_count + 1;
  422. size_t const scale_factor_band_index2 = min(scale_factor_bands.size() - 1, scale_factor_band_index1 + granule.region1_count + 1);
  423. bool const is_short_granule = granule.window_switching_flag && granule.block_type == MP3::BlockType::Short;
  424. size_t const region1_start = is_short_granule ? 36 : scale_factor_bands[scale_factor_band_index1].start;
  425. size_t const region2_start = is_short_granule ? MP3::granule_size : scale_factor_bands[scale_factor_band_index2].start;
  426. auto requantize = [](int const sample, float const exponent) -> float {
  427. int const sign = sample < 0 ? -1 : 1;
  428. int const magnitude = AK::abs(sample);
  429. return sign * AK::pow<float>(static_cast<float>(magnitude), 4 / 3.0) * exponent;
  430. };
  431. size_t count = 0;
  432. for (; count < granule.big_values * 2; count += 2) {
  433. MP3::Tables::Huffman::HuffmanTreeXY const* tree = nullptr;
  434. if (count < region1_start) {
  435. tree = &MP3::Tables::Huffman::HuffmanTreesXY[granule.table_select[0]];
  436. } else if (count < region2_start) {
  437. tree = &MP3::Tables::Huffman::HuffmanTreesXY[granule.table_select[1]];
  438. } else {
  439. tree = &MP3::Tables::Huffman::HuffmanTreesXY[granule.table_select[2]];
  440. }
  441. if (!tree || tree->nodes.is_empty()) {
  442. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Frame references invalid huffman table." };
  443. }
  444. // Assumption: There's enough bits to read. 32 is just a placeholder for "unlimited".
  445. // There are no 32 bit long huffman codes in the tables.
  446. auto const entry = MP3::Tables::Huffman::huffman_decode(reservoir, tree->nodes, 32);
  447. granule_bits_read += entry.bits_read;
  448. if (!entry.code.has_value())
  449. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Frame contains invalid huffman data." };
  450. int x = entry.code->symbol.x;
  451. int y = entry.code->symbol.y;
  452. if (x == 15 && tree->linbits > 0) {
  453. x += LOADER_TRY(reservoir.read_bits(tree->linbits));
  454. granule_bits_read += tree->linbits;
  455. }
  456. if (x != 0) {
  457. if (LOADER_TRY(reservoir.read_bit()))
  458. x = -x;
  459. granule_bits_read++;
  460. }
  461. if (y == 15 && tree->linbits > 0) {
  462. y += LOADER_TRY(reservoir.read_bits(tree->linbits));
  463. granule_bits_read += tree->linbits;
  464. }
  465. if (y != 0) {
  466. if (LOADER_TRY(reservoir.read_bit()))
  467. y = -y;
  468. granule_bits_read++;
  469. }
  470. granule.samples[count + 0] = requantize(x, exponents[count + 0]);
  471. granule.samples[count + 1] = requantize(y, exponents[count + 1]);
  472. }
  473. ReadonlySpan<MP3::Tables::Huffman::HuffmanNode<MP3::Tables::Huffman::HuffmanVWXY>> count1table = granule.count1table_select ? MP3::Tables::Huffman::TreeB : MP3::Tables::Huffman::TreeA;
  474. // count1 is not known. We have to read huffman encoded values
  475. // until we've exhausted the granule's bits. We know the size of
  476. // the granule from part2_3_length, which is the number of bits
  477. // used for scaleactors and huffman data (in the granule).
  478. while (granule_bits_read < granule.part_2_3_length && count <= MP3::granule_size - 4) {
  479. auto const entry = MP3::Tables::Huffman::huffman_decode(reservoir, count1table, granule.part_2_3_length - granule_bits_read);
  480. granule_bits_read += entry.bits_read;
  481. if (!entry.code.has_value())
  482. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Frame contains invalid huffman data." };
  483. int v = entry.code->symbol.v;
  484. if (v != 0) {
  485. if (granule_bits_read >= granule.part_2_3_length)
  486. break;
  487. if (LOADER_TRY(reservoir.read_bit()))
  488. v = -v;
  489. granule_bits_read++;
  490. }
  491. int w = entry.code->symbol.w;
  492. if (w != 0) {
  493. if (granule_bits_read >= granule.part_2_3_length)
  494. break;
  495. if (LOADER_TRY(reservoir.read_bit()))
  496. w = -w;
  497. granule_bits_read++;
  498. }
  499. int x = entry.code->symbol.x;
  500. if (x != 0) {
  501. if (granule_bits_read >= granule.part_2_3_length)
  502. break;
  503. if (LOADER_TRY(reservoir.read_bit()))
  504. x = -x;
  505. granule_bits_read++;
  506. }
  507. int y = entry.code->symbol.y;
  508. if (y != 0) {
  509. if (granule_bits_read >= granule.part_2_3_length)
  510. break;
  511. if (LOADER_TRY(reservoir.read_bit()))
  512. y = -y;
  513. granule_bits_read++;
  514. }
  515. granule.samples[count + 0] = requantize(v, exponents[count + 0]);
  516. granule.samples[count + 1] = requantize(w, exponents[count + 1]);
  517. granule.samples[count + 2] = requantize(x, exponents[count + 2]);
  518. granule.samples[count + 3] = requantize(y, exponents[count + 3]);
  519. count += 4;
  520. }
  521. if (granule_bits_read > granule.part_2_3_length) {
  522. return LoaderError { LoaderError::Category::Format, m_loaded_samples, "Read too many bits from bit reservoir." };
  523. }
  524. for (size_t i = granule_bits_read; i < granule.part_2_3_length; i++) {
  525. LOADER_TRY(reservoir.read_bit());
  526. }
  527. return {};
  528. }
  529. void MP3LoaderPlugin::reorder_samples(MP3::Granule& granule, u32 sample_rate)
  530. {
  531. float tmp[MP3::granule_size] = {};
  532. size_t band_index = 0;
  533. size_t subband_index = 0;
  534. auto scale_factor_bands = get_scalefactor_bands(granule, sample_rate);
  535. if (granule.mixed_block_flag) {
  536. while (subband_index < 36) {
  537. for (size_t frequency_line_index = 0; frequency_line_index < scale_factor_bands[band_index].width; frequency_line_index++) {
  538. tmp[subband_index] = granule.samples[subband_index];
  539. subband_index++;
  540. }
  541. band_index++;
  542. }
  543. }
  544. while (subband_index < MP3::granule_size && band_index <= 36) {
  545. for (size_t frequency_line_index = 0; frequency_line_index < scale_factor_bands[band_index].width; frequency_line_index++) {
  546. tmp[subband_index++] = granule.samples[scale_factor_bands[band_index + 0].start + frequency_line_index];
  547. tmp[subband_index++] = granule.samples[scale_factor_bands[band_index + 1].start + frequency_line_index];
  548. tmp[subband_index++] = granule.samples[scale_factor_bands[band_index + 2].start + frequency_line_index];
  549. }
  550. band_index += 3;
  551. }
  552. for (size_t i = 0; i < MP3::granule_size; i++)
  553. granule.samples[i] = tmp[i];
  554. }
  555. void MP3LoaderPlugin::reduce_alias(MP3::Granule& granule, size_t max_subband_index)
  556. {
  557. for (size_t subband = 0; subband < max_subband_index - 18; subband += 18) {
  558. for (size_t i = 0; i < 8; i++) {
  559. size_t const idx1 = subband + 17 - i;
  560. size_t const idx2 = subband + 18 + i;
  561. auto const d1 = granule.samples[idx1];
  562. auto const d2 = granule.samples[idx2];
  563. granule.samples[idx1] = d1 * MP3::Tables::AliasReductionCs[i] - d2 * MP3::Tables::AliasReductionCa[i];
  564. granule.samples[idx2] = d2 * MP3::Tables::AliasReductionCs[i] + d1 * MP3::Tables::AliasReductionCa[i];
  565. }
  566. }
  567. }
  568. void MP3LoaderPlugin::process_stereo(MP3::MP3Frame& frame, size_t granule_index)
  569. {
  570. size_t band_index_ms_start = 0;
  571. size_t band_index_ms_end = 0;
  572. size_t band_index_intensity_start = 0;
  573. size_t band_index_intensity_end = 0;
  574. auto& granule_left = frame.channels[0].granules[granule_index];
  575. auto& granule_right = frame.channels[1].granules[granule_index];
  576. auto get_last_nonempty_band = [](Span<float> samples, ReadonlySpan<MP3::Tables::ScaleFactorBand> bands) -> size_t {
  577. size_t last_nonempty_band = 0;
  578. for (size_t i = 0; i < bands.size(); i++) {
  579. bool is_empty = true;
  580. for (size_t l = bands[i].start; l < bands[i].end; l++) {
  581. if (samples[l] != 0) {
  582. is_empty = false;
  583. break;
  584. }
  585. }
  586. if (!is_empty)
  587. last_nonempty_band = i;
  588. }
  589. return last_nonempty_band;
  590. };
  591. auto process_ms_stereo = [&](MP3::Tables::ScaleFactorBand const& band) {
  592. float const SQRT_2 = AK::sqrt(2.0);
  593. for (size_t i = band.start; i <= band.end; i++) {
  594. float const m = granule_left.samples[i];
  595. float const s = granule_right.samples[i];
  596. granule_left.samples[i] = (m + s) / SQRT_2;
  597. granule_right.samples[i] = (m - s) / SQRT_2;
  598. }
  599. };
  600. auto process_intensity_stereo = [&](MP3::Tables::ScaleFactorBand const& band, float intensity_stereo_ratio) {
  601. for (size_t i = band.start; i <= band.end; i++) {
  602. float const sample_left = granule_left.samples[i];
  603. float const coeff_l = intensity_stereo_ratio / (1 + intensity_stereo_ratio);
  604. float const coeff_r = 1 / (1 + intensity_stereo_ratio);
  605. granule_left.samples[i] = sample_left * coeff_l;
  606. granule_right.samples[i] = sample_left * coeff_r;
  607. }
  608. };
  609. auto scale_factor_bands = get_scalefactor_bands(granule_right, frame.header.samplerate);
  610. if (has_flag(frame.header.mode_extension, MP3::ModeExtension::MsStereo)) {
  611. band_index_ms_start = 0;
  612. band_index_ms_end = scale_factor_bands.size();
  613. }
  614. if (has_flag(frame.header.mode_extension, MP3::ModeExtension::IntensityStereo)) {
  615. band_index_intensity_start = get_last_nonempty_band(granule_right.samples, scale_factor_bands);
  616. band_index_intensity_end = scale_factor_bands.size();
  617. band_index_ms_end = band_index_intensity_start;
  618. }
  619. for (size_t band_index = band_index_ms_start; band_index < band_index_ms_end; band_index++) {
  620. process_ms_stereo(scale_factor_bands[band_index]);
  621. }
  622. for (size_t band_index = band_index_intensity_start; band_index < band_index_intensity_end; band_index++) {
  623. auto const intensity_stereo_position = frame.channels[1].scale_factors[band_index];
  624. if (intensity_stereo_position == 7) {
  625. if (has_flag(frame.header.mode_extension, MP3::ModeExtension::MsStereo))
  626. process_ms_stereo(scale_factor_bands[band_index]);
  627. continue;
  628. }
  629. float const intensity_stereo_ratio = AK::tan(intensity_stereo_position * AK::Pi<float> / 12);
  630. process_intensity_stereo(scale_factor_bands[band_index], intensity_stereo_ratio);
  631. }
  632. }
  633. void MP3LoaderPlugin::transform_samples_to_time(Array<float, MP3::granule_size> const& input, size_t input_offset, Array<float, 36>& output, MP3::BlockType block_type)
  634. {
  635. if (block_type == MP3::BlockType::Short) {
  636. size_t const N = 12;
  637. Array<float, N * 3> temp_out;
  638. Array<float, N / 2> temp_in;
  639. for (size_t k = 0; k < N / 2; k++)
  640. temp_in[k] = input[input_offset + 3 * k + 0];
  641. s_mdct_12.transform(temp_in, Span<float>(temp_out).slice(0, N));
  642. for (size_t i = 0; i < N; i++)
  643. temp_out[i + 0] *= MP3::Tables::WindowBlockTypeShort[i];
  644. for (size_t k = 0; k < N / 2; k++)
  645. temp_in[k] = input[input_offset + 3 * k + 1];
  646. s_mdct_12.transform(temp_in, Span<float>(temp_out).slice(12, N));
  647. for (size_t i = 0; i < N; i++)
  648. temp_out[i + 12] *= MP3::Tables::WindowBlockTypeShort[i];
  649. for (size_t k = 0; k < N / 2; k++)
  650. temp_in[k] = input[input_offset + 3 * k + 2];
  651. s_mdct_12.transform(temp_in, Span<float>(temp_out).slice(24, N));
  652. for (size_t i = 0; i < N; i++)
  653. temp_out[i + 24] *= MP3::Tables::WindowBlockTypeShort[i];
  654. Span<float> idmct1 = Span<float>(temp_out).slice(0, 12);
  655. Span<float> idmct2 = Span<float>(temp_out).slice(12, 12);
  656. Span<float> idmct3 = Span<float>(temp_out).slice(24, 12);
  657. for (size_t i = 0; i < 6; i++)
  658. output[i] = 0;
  659. for (size_t i = 6; i < 12; i++)
  660. output[i] = idmct1[i - 6];
  661. for (size_t i = 12; i < 18; i++)
  662. output[i] = idmct1[i - 6] + idmct2[i - 12];
  663. for (size_t i = 18; i < 24; i++)
  664. output[i] = idmct2[i - 12] + idmct3[i - 18];
  665. for (size_t i = 24; i < 30; i++)
  666. output[i] = idmct3[i - 18];
  667. for (size_t i = 30; i < 36; i++)
  668. output[i] = 0;
  669. } else {
  670. s_mdct_36.transform(ReadonlySpan<float>(input).slice(input_offset, 18), output);
  671. for (size_t i = 0; i < 36; i++) {
  672. switch (block_type) {
  673. case MP3::BlockType::Normal:
  674. output[i] *= MP3::Tables::WindowBlockTypeNormal[i];
  675. break;
  676. case MP3::BlockType::Start:
  677. output[i] *= MP3::Tables::WindowBlockTypeStart[i];
  678. break;
  679. case MP3::BlockType::End:
  680. output[i] *= MP3::Tables::WindowBlockTypeEnd[i];
  681. break;
  682. case MP3::BlockType::Short:
  683. VERIFY_NOT_REACHED();
  684. break;
  685. }
  686. }
  687. }
  688. }
  689. // ISO/IEC 11172-3 (Figure A.2)
  690. void MP3LoaderPlugin::synthesis(Array<float, 1024>& V, Array<float, 32>& samples, Array<float, 32>& result)
  691. {
  692. for (size_t i = 1023; i >= 64; i--) {
  693. V[i] = V[i - 64];
  694. }
  695. for (size_t i = 0; i < 64; i++) {
  696. V[i] = 0;
  697. for (size_t k = 0; k < 32; k++) {
  698. float const N = MP3::Tables::SynthesisSubbandFilterCoefficients[i][k];
  699. V[i] += N * samples[k];
  700. }
  701. }
  702. Array<float, 512> U;
  703. for (size_t i = 0; i < 8; i++) {
  704. for (size_t j = 0; j < 32; j++) {
  705. U[i * 64 + j] = V[i * 128 + j];
  706. U[i * 64 + 32 + j] = V[i * 128 + 96 + j];
  707. }
  708. }
  709. Array<float, 512> W;
  710. for (size_t i = 0; i < 512; i++) {
  711. W[i] = U[i] * MP3::Tables::WindowSynthesis[i];
  712. }
  713. for (size_t j = 0; j < 32; j++) {
  714. result[j] = 0;
  715. for (size_t k = 0; k < 16; k++) {
  716. result[j] += W[j + 32 * k];
  717. }
  718. }
  719. }
  720. ReadonlySpan<MP3::Tables::ScaleFactorBand> MP3LoaderPlugin::get_scalefactor_bands(MP3::Granule const& granule, int samplerate)
  721. {
  722. switch (granule.block_type) {
  723. case MP3::BlockType::Short:
  724. switch (samplerate) {
  725. case 32000:
  726. return granule.mixed_block_flag ? MP3::Tables::ScaleFactorBandMixed32000 : MP3::Tables::ScaleFactorBandShort32000;
  727. case 44100:
  728. return granule.mixed_block_flag ? MP3::Tables::ScaleFactorBandMixed44100 : MP3::Tables::ScaleFactorBandShort44100;
  729. case 48000:
  730. return granule.mixed_block_flag ? MP3::Tables::ScaleFactorBandMixed48000 : MP3::Tables::ScaleFactorBandShort48000;
  731. }
  732. break;
  733. case MP3::BlockType::Normal:
  734. [[fallthrough]];
  735. case MP3::BlockType::Start:
  736. [[fallthrough]];
  737. case MP3::BlockType::End:
  738. switch (samplerate) {
  739. case 32000:
  740. return MP3::Tables::ScaleFactorBandLong32000;
  741. case 44100:
  742. return MP3::Tables::ScaleFactorBandLong44100;
  743. case 48000:
  744. return MP3::Tables::ScaleFactorBandLong48000;
  745. }
  746. }
  747. VERIFY_NOT_REACHED();
  748. }
  749. }