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.

1500 lines
43KB

  1. /**
  2. * FLAC audio encoder
  3. * Copyright (c) 2006 Justin Ruggles <jruggle@earthlink.net>
  4. *
  5. * This file is part of FFmpeg.
  6. *
  7. * FFmpeg is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU Lesser General Public
  9. * License as published by the Free Software Foundation; either
  10. * version 2.1 of the License, or (at your option) any later version.
  11. *
  12. * FFmpeg is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15. * Lesser General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU Lesser General Public
  18. * License along with FFmpeg; if not, write to the Free Software
  19. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  20. */
  21. #include "avcodec.h"
  22. #include "bitstream.h"
  23. #include "crc.h"
  24. #include "dsputil.h"
  25. #include "golomb.h"
  26. #include "lls.h"
  27. #define FLAC_MAX_CH 8
  28. #define FLAC_MIN_BLOCKSIZE 16
  29. #define FLAC_MAX_BLOCKSIZE 65535
  30. #define FLAC_SUBFRAME_CONSTANT 0
  31. #define FLAC_SUBFRAME_VERBATIM 1
  32. #define FLAC_SUBFRAME_FIXED 8
  33. #define FLAC_SUBFRAME_LPC 32
  34. #define FLAC_CHMODE_NOT_STEREO 0
  35. #define FLAC_CHMODE_LEFT_RIGHT 1
  36. #define FLAC_CHMODE_LEFT_SIDE 8
  37. #define FLAC_CHMODE_RIGHT_SIDE 9
  38. #define FLAC_CHMODE_MID_SIDE 10
  39. #define ORDER_METHOD_EST 0
  40. #define ORDER_METHOD_2LEVEL 1
  41. #define ORDER_METHOD_4LEVEL 2
  42. #define ORDER_METHOD_8LEVEL 3
  43. #define ORDER_METHOD_SEARCH 4
  44. #define ORDER_METHOD_LOG 5
  45. #define FLAC_STREAMINFO_SIZE 34
  46. #define MIN_LPC_ORDER 1
  47. #define MAX_LPC_ORDER 32
  48. #define MAX_FIXED_ORDER 4
  49. #define MAX_PARTITION_ORDER 8
  50. #define MAX_PARTITIONS (1 << MAX_PARTITION_ORDER)
  51. #define MAX_LPC_PRECISION 15
  52. #define MAX_LPC_SHIFT 15
  53. #define MAX_RICE_PARAM 14
  54. typedef struct CompressionOptions {
  55. int compression_level;
  56. int block_time_ms;
  57. int use_lpc;
  58. int lpc_coeff_precision;
  59. int min_prediction_order;
  60. int max_prediction_order;
  61. int prediction_order_method;
  62. int min_partition_order;
  63. int max_partition_order;
  64. } CompressionOptions;
  65. typedef struct RiceContext {
  66. int porder;
  67. int params[MAX_PARTITIONS];
  68. } RiceContext;
  69. typedef struct FlacSubframe {
  70. int type;
  71. int type_code;
  72. int obits;
  73. int order;
  74. int32_t coefs[MAX_LPC_ORDER];
  75. int shift;
  76. RiceContext rc;
  77. int32_t samples[FLAC_MAX_BLOCKSIZE];
  78. int32_t residual[FLAC_MAX_BLOCKSIZE+1];
  79. } FlacSubframe;
  80. typedef struct FlacFrame {
  81. FlacSubframe subframes[FLAC_MAX_CH];
  82. int blocksize;
  83. int bs_code[2];
  84. uint8_t crc8;
  85. int ch_mode;
  86. } FlacFrame;
  87. typedef struct FlacEncodeContext {
  88. PutBitContext pb;
  89. int channels;
  90. int ch_code;
  91. int samplerate;
  92. int sr_code[2];
  93. int blocksize;
  94. int max_framesize;
  95. uint32_t frame_count;
  96. FlacFrame frame;
  97. CompressionOptions options;
  98. AVCodecContext *avctx;
  99. DSPContext dsp;
  100. } FlacEncodeContext;
  101. static const int flac_samplerates[16] = {
  102. 0, 0, 0, 0,
  103. 8000, 16000, 22050, 24000, 32000, 44100, 48000, 96000,
  104. 0, 0, 0, 0
  105. };
  106. static const int flac_blocksizes[16] = {
  107. 0,
  108. 192,
  109. 576, 1152, 2304, 4608,
  110. 0, 0,
  111. 256, 512, 1024, 2048, 4096, 8192, 16384, 32768
  112. };
  113. /**
  114. * Writes streaminfo metadata block to byte array
  115. */
  116. static void write_streaminfo(FlacEncodeContext *s, uint8_t *header)
  117. {
  118. PutBitContext pb;
  119. memset(header, 0, FLAC_STREAMINFO_SIZE);
  120. init_put_bits(&pb, header, FLAC_STREAMINFO_SIZE);
  121. /* streaminfo metadata block */
  122. put_bits(&pb, 16, s->blocksize);
  123. put_bits(&pb, 16, s->blocksize);
  124. put_bits(&pb, 24, 0);
  125. put_bits(&pb, 24, s->max_framesize);
  126. put_bits(&pb, 20, s->samplerate);
  127. put_bits(&pb, 3, s->channels-1);
  128. put_bits(&pb, 5, 15); /* bits per sample - 1 */
  129. flush_put_bits(&pb);
  130. /* total samples = 0 */
  131. /* MD5 signature = 0 */
  132. }
  133. /**
  134. * Sets blocksize based on samplerate
  135. * Chooses the closest predefined blocksize >= BLOCK_TIME_MS milliseconds
  136. */
  137. static int select_blocksize(int samplerate, int block_time_ms)
  138. {
  139. int i;
  140. int target;
  141. int blocksize;
  142. assert(samplerate > 0);
  143. blocksize = flac_blocksizes[1];
  144. target = (samplerate * block_time_ms) / 1000;
  145. for(i=0; i<16; i++) {
  146. if(target >= flac_blocksizes[i] && flac_blocksizes[i] > blocksize) {
  147. blocksize = flac_blocksizes[i];
  148. }
  149. }
  150. return blocksize;
  151. }
  152. static av_cold int flac_encode_init(AVCodecContext *avctx)
  153. {
  154. int freq = avctx->sample_rate;
  155. int channels = avctx->channels;
  156. FlacEncodeContext *s = avctx->priv_data;
  157. int i, level;
  158. uint8_t *streaminfo;
  159. s->avctx = avctx;
  160. dsputil_init(&s->dsp, avctx);
  161. if(avctx->sample_fmt != SAMPLE_FMT_S16) {
  162. return -1;
  163. }
  164. if(channels < 1 || channels > FLAC_MAX_CH) {
  165. return -1;
  166. }
  167. s->channels = channels;
  168. s->ch_code = s->channels-1;
  169. /* find samplerate in table */
  170. if(freq < 1)
  171. return -1;
  172. for(i=4; i<12; i++) {
  173. if(freq == flac_samplerates[i]) {
  174. s->samplerate = flac_samplerates[i];
  175. s->sr_code[0] = i;
  176. s->sr_code[1] = 0;
  177. break;
  178. }
  179. }
  180. /* if not in table, samplerate is non-standard */
  181. if(i == 12) {
  182. if(freq % 1000 == 0 && freq < 255000) {
  183. s->sr_code[0] = 12;
  184. s->sr_code[1] = freq / 1000;
  185. } else if(freq % 10 == 0 && freq < 655350) {
  186. s->sr_code[0] = 14;
  187. s->sr_code[1] = freq / 10;
  188. } else if(freq < 65535) {
  189. s->sr_code[0] = 13;
  190. s->sr_code[1] = freq;
  191. } else {
  192. return -1;
  193. }
  194. s->samplerate = freq;
  195. }
  196. /* set compression option defaults based on avctx->compression_level */
  197. if(avctx->compression_level < 0) {
  198. s->options.compression_level = 5;
  199. } else {
  200. s->options.compression_level = avctx->compression_level;
  201. }
  202. av_log(avctx, AV_LOG_DEBUG, " compression: %d\n", s->options.compression_level);
  203. level= s->options.compression_level;
  204. if(level > 12) {
  205. av_log(avctx, AV_LOG_ERROR, "invalid compression level: %d\n",
  206. s->options.compression_level);
  207. return -1;
  208. }
  209. s->options.block_time_ms = ((int[]){ 27, 27, 27,105,105,105,105,105,105,105,105,105,105})[level];
  210. s->options.use_lpc = ((int[]){ 0, 0, 0, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1})[level];
  211. s->options.min_prediction_order= ((int[]){ 2, 0, 0, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1})[level];
  212. s->options.max_prediction_order= ((int[]){ 3, 4, 4, 6, 8, 8, 8, 8, 12, 12, 12, 32, 32})[level];
  213. s->options.prediction_order_method = ((int[]){ ORDER_METHOD_EST, ORDER_METHOD_EST, ORDER_METHOD_EST,
  214. ORDER_METHOD_EST, ORDER_METHOD_EST, ORDER_METHOD_EST,
  215. ORDER_METHOD_4LEVEL, ORDER_METHOD_LOG, ORDER_METHOD_4LEVEL,
  216. ORDER_METHOD_LOG, ORDER_METHOD_SEARCH, ORDER_METHOD_LOG,
  217. ORDER_METHOD_SEARCH})[level];
  218. s->options.min_partition_order = ((int[]){ 2, 2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0})[level];
  219. s->options.max_partition_order = ((int[]){ 2, 2, 3, 3, 3, 8, 8, 8, 8, 8, 8, 8, 8})[level];
  220. /* set compression option overrides from AVCodecContext */
  221. if(avctx->use_lpc >= 0) {
  222. s->options.use_lpc = av_clip(avctx->use_lpc, 0, 11);
  223. }
  224. if(s->options.use_lpc == 1)
  225. av_log(avctx, AV_LOG_DEBUG, " use lpc: Levinson-Durbin recursion with Welch window\n");
  226. else if(s->options.use_lpc > 1)
  227. av_log(avctx, AV_LOG_DEBUG, " use lpc: Cholesky factorization\n");
  228. if(avctx->min_prediction_order >= 0) {
  229. if(s->options.use_lpc) {
  230. if(avctx->min_prediction_order < MIN_LPC_ORDER ||
  231. avctx->min_prediction_order > MAX_LPC_ORDER) {
  232. av_log(avctx, AV_LOG_ERROR, "invalid min prediction order: %d\n",
  233. avctx->min_prediction_order);
  234. return -1;
  235. }
  236. } else {
  237. if(avctx->min_prediction_order > MAX_FIXED_ORDER) {
  238. av_log(avctx, AV_LOG_ERROR, "invalid min prediction order: %d\n",
  239. avctx->min_prediction_order);
  240. return -1;
  241. }
  242. }
  243. s->options.min_prediction_order = avctx->min_prediction_order;
  244. }
  245. if(avctx->max_prediction_order >= 0) {
  246. if(s->options.use_lpc) {
  247. if(avctx->max_prediction_order < MIN_LPC_ORDER ||
  248. avctx->max_prediction_order > MAX_LPC_ORDER) {
  249. av_log(avctx, AV_LOG_ERROR, "invalid max prediction order: %d\n",
  250. avctx->max_prediction_order);
  251. return -1;
  252. }
  253. } else {
  254. if(avctx->max_prediction_order > MAX_FIXED_ORDER) {
  255. av_log(avctx, AV_LOG_ERROR, "invalid max prediction order: %d\n",
  256. avctx->max_prediction_order);
  257. return -1;
  258. }
  259. }
  260. s->options.max_prediction_order = avctx->max_prediction_order;
  261. }
  262. if(s->options.max_prediction_order < s->options.min_prediction_order) {
  263. av_log(avctx, AV_LOG_ERROR, "invalid prediction orders: min=%d max=%d\n",
  264. s->options.min_prediction_order, s->options.max_prediction_order);
  265. return -1;
  266. }
  267. av_log(avctx, AV_LOG_DEBUG, " prediction order: %d, %d\n",
  268. s->options.min_prediction_order, s->options.max_prediction_order);
  269. if(avctx->prediction_order_method >= 0) {
  270. if(avctx->prediction_order_method > ORDER_METHOD_LOG) {
  271. av_log(avctx, AV_LOG_ERROR, "invalid prediction order method: %d\n",
  272. avctx->prediction_order_method);
  273. return -1;
  274. }
  275. s->options.prediction_order_method = avctx->prediction_order_method;
  276. }
  277. switch(s->options.prediction_order_method) {
  278. case ORDER_METHOD_EST: av_log(avctx, AV_LOG_DEBUG, " order method: %s\n",
  279. "estimate"); break;
  280. case ORDER_METHOD_2LEVEL: av_log(avctx, AV_LOG_DEBUG, " order method: %s\n",
  281. "2-level"); break;
  282. case ORDER_METHOD_4LEVEL: av_log(avctx, AV_LOG_DEBUG, " order method: %s\n",
  283. "4-level"); break;
  284. case ORDER_METHOD_8LEVEL: av_log(avctx, AV_LOG_DEBUG, " order method: %s\n",
  285. "8-level"); break;
  286. case ORDER_METHOD_SEARCH: av_log(avctx, AV_LOG_DEBUG, " order method: %s\n",
  287. "full search"); break;
  288. case ORDER_METHOD_LOG: av_log(avctx, AV_LOG_DEBUG, " order method: %s\n",
  289. "log search"); break;
  290. }
  291. if(avctx->min_partition_order >= 0) {
  292. if(avctx->min_partition_order > MAX_PARTITION_ORDER) {
  293. av_log(avctx, AV_LOG_ERROR, "invalid min partition order: %d\n",
  294. avctx->min_partition_order);
  295. return -1;
  296. }
  297. s->options.min_partition_order = avctx->min_partition_order;
  298. }
  299. if(avctx->max_partition_order >= 0) {
  300. if(avctx->max_partition_order > MAX_PARTITION_ORDER) {
  301. av_log(avctx, AV_LOG_ERROR, "invalid max partition order: %d\n",
  302. avctx->max_partition_order);
  303. return -1;
  304. }
  305. s->options.max_partition_order = avctx->max_partition_order;
  306. }
  307. if(s->options.max_partition_order < s->options.min_partition_order) {
  308. av_log(avctx, AV_LOG_ERROR, "invalid partition orders: min=%d max=%d\n",
  309. s->options.min_partition_order, s->options.max_partition_order);
  310. return -1;
  311. }
  312. av_log(avctx, AV_LOG_DEBUG, " partition order: %d, %d\n",
  313. s->options.min_partition_order, s->options.max_partition_order);
  314. if(avctx->frame_size > 0) {
  315. if(avctx->frame_size < FLAC_MIN_BLOCKSIZE ||
  316. avctx->frame_size > FLAC_MAX_BLOCKSIZE) {
  317. av_log(avctx, AV_LOG_ERROR, "invalid block size: %d\n",
  318. avctx->frame_size);
  319. return -1;
  320. }
  321. s->blocksize = avctx->frame_size;
  322. } else {
  323. s->blocksize = select_blocksize(s->samplerate, s->options.block_time_ms);
  324. avctx->frame_size = s->blocksize;
  325. }
  326. av_log(avctx, AV_LOG_DEBUG, " block size: %d\n", s->blocksize);
  327. /* set LPC precision */
  328. if(avctx->lpc_coeff_precision > 0) {
  329. if(avctx->lpc_coeff_precision > MAX_LPC_PRECISION) {
  330. av_log(avctx, AV_LOG_ERROR, "invalid lpc coeff precision: %d\n",
  331. avctx->lpc_coeff_precision);
  332. return -1;
  333. }
  334. s->options.lpc_coeff_precision = avctx->lpc_coeff_precision;
  335. } else {
  336. /* default LPC precision */
  337. s->options.lpc_coeff_precision = 15;
  338. }
  339. av_log(avctx, AV_LOG_DEBUG, " lpc precision: %d\n",
  340. s->options.lpc_coeff_precision);
  341. /* set maximum encoded frame size in verbatim mode */
  342. if(s->channels == 2) {
  343. s->max_framesize = 14 + ((s->blocksize * 33 + 7) >> 3);
  344. } else {
  345. s->max_framesize = 14 + (s->blocksize * s->channels * 2);
  346. }
  347. streaminfo = av_malloc(FLAC_STREAMINFO_SIZE);
  348. write_streaminfo(s, streaminfo);
  349. avctx->extradata = streaminfo;
  350. avctx->extradata_size = FLAC_STREAMINFO_SIZE;
  351. s->frame_count = 0;
  352. avctx->coded_frame = avcodec_alloc_frame();
  353. avctx->coded_frame->key_frame = 1;
  354. return 0;
  355. }
  356. static void init_frame(FlacEncodeContext *s)
  357. {
  358. int i, ch;
  359. FlacFrame *frame;
  360. frame = &s->frame;
  361. for(i=0; i<16; i++) {
  362. if(s->blocksize == flac_blocksizes[i]) {
  363. frame->blocksize = flac_blocksizes[i];
  364. frame->bs_code[0] = i;
  365. frame->bs_code[1] = 0;
  366. break;
  367. }
  368. }
  369. if(i == 16) {
  370. frame->blocksize = s->blocksize;
  371. if(frame->blocksize <= 256) {
  372. frame->bs_code[0] = 6;
  373. frame->bs_code[1] = frame->blocksize-1;
  374. } else {
  375. frame->bs_code[0] = 7;
  376. frame->bs_code[1] = frame->blocksize-1;
  377. }
  378. }
  379. for(ch=0; ch<s->channels; ch++) {
  380. frame->subframes[ch].obits = 16;
  381. }
  382. }
  383. /**
  384. * Copy channel-interleaved input samples into separate subframes
  385. */
  386. static void copy_samples(FlacEncodeContext *s, int16_t *samples)
  387. {
  388. int i, j, ch;
  389. FlacFrame *frame;
  390. frame = &s->frame;
  391. for(i=0,j=0; i<frame->blocksize; i++) {
  392. for(ch=0; ch<s->channels; ch++,j++) {
  393. frame->subframes[ch].samples[i] = samples[j];
  394. }
  395. }
  396. }
  397. #define rice_encode_count(sum, n, k) (((n)*((k)+1))+((sum-(n>>1))>>(k)))
  398. /**
  399. * Solve for d/dk(rice_encode_count) = n-((sum-(n>>1))>>(k+1)) = 0
  400. */
  401. static int find_optimal_param(uint32_t sum, int n)
  402. {
  403. int k;
  404. uint32_t sum2;
  405. if(sum <= n>>1)
  406. return 0;
  407. sum2 = sum-(n>>1);
  408. k = av_log2(n<256 ? FASTDIV(sum2,n) : sum2/n);
  409. return FFMIN(k, MAX_RICE_PARAM);
  410. }
  411. static uint32_t calc_optimal_rice_params(RiceContext *rc, int porder,
  412. uint32_t *sums, int n, int pred_order)
  413. {
  414. int i;
  415. int k, cnt, part;
  416. uint32_t all_bits;
  417. part = (1 << porder);
  418. all_bits = 4 * part;
  419. cnt = (n >> porder) - pred_order;
  420. for(i=0; i<part; i++) {
  421. k = find_optimal_param(sums[i], cnt);
  422. rc->params[i] = k;
  423. all_bits += rice_encode_count(sums[i], cnt, k);
  424. cnt = n >> porder;
  425. }
  426. rc->porder = porder;
  427. return all_bits;
  428. }
  429. static void calc_sums(int pmin, int pmax, uint32_t *data, int n, int pred_order,
  430. uint32_t sums[][MAX_PARTITIONS])
  431. {
  432. int i, j;
  433. int parts;
  434. uint32_t *res, *res_end;
  435. /* sums for highest level */
  436. parts = (1 << pmax);
  437. res = &data[pred_order];
  438. res_end = &data[n >> pmax];
  439. for(i=0; i<parts; i++) {
  440. uint32_t sum = 0;
  441. while(res < res_end){
  442. sum += *(res++);
  443. }
  444. sums[pmax][i] = sum;
  445. res_end+= n >> pmax;
  446. }
  447. /* sums for lower levels */
  448. for(i=pmax-1; i>=pmin; i--) {
  449. parts = (1 << i);
  450. for(j=0; j<parts; j++) {
  451. sums[i][j] = sums[i+1][2*j] + sums[i+1][2*j+1];
  452. }
  453. }
  454. }
  455. static uint32_t calc_rice_params(RiceContext *rc, int pmin, int pmax,
  456. int32_t *data, int n, int pred_order)
  457. {
  458. int i;
  459. uint32_t bits[MAX_PARTITION_ORDER+1];
  460. int opt_porder;
  461. RiceContext tmp_rc;
  462. uint32_t *udata;
  463. uint32_t sums[MAX_PARTITION_ORDER+1][MAX_PARTITIONS];
  464. assert(pmin >= 0 && pmin <= MAX_PARTITION_ORDER);
  465. assert(pmax >= 0 && pmax <= MAX_PARTITION_ORDER);
  466. assert(pmin <= pmax);
  467. udata = av_malloc(n * sizeof(uint32_t));
  468. for(i=0; i<n; i++) {
  469. udata[i] = (2*data[i]) ^ (data[i]>>31);
  470. }
  471. calc_sums(pmin, pmax, udata, n, pred_order, sums);
  472. opt_porder = pmin;
  473. bits[pmin] = UINT32_MAX;
  474. for(i=pmin; i<=pmax; i++) {
  475. bits[i] = calc_optimal_rice_params(&tmp_rc, i, sums[i], n, pred_order);
  476. if(bits[i] <= bits[opt_porder]) {
  477. opt_porder = i;
  478. *rc= tmp_rc;
  479. }
  480. }
  481. av_freep(&udata);
  482. return bits[opt_porder];
  483. }
  484. static int get_max_p_order(int max_porder, int n, int order)
  485. {
  486. int porder = FFMIN(max_porder, av_log2(n^(n-1)));
  487. if(order > 0)
  488. porder = FFMIN(porder, av_log2(n/order));
  489. return porder;
  490. }
  491. static uint32_t calc_rice_params_fixed(RiceContext *rc, int pmin, int pmax,
  492. int32_t *data, int n, int pred_order,
  493. int bps)
  494. {
  495. uint32_t bits;
  496. pmin = get_max_p_order(pmin, n, pred_order);
  497. pmax = get_max_p_order(pmax, n, pred_order);
  498. bits = pred_order*bps + 6;
  499. bits += calc_rice_params(rc, pmin, pmax, data, n, pred_order);
  500. return bits;
  501. }
  502. static uint32_t calc_rice_params_lpc(RiceContext *rc, int pmin, int pmax,
  503. int32_t *data, int n, int pred_order,
  504. int bps, int precision)
  505. {
  506. uint32_t bits;
  507. pmin = get_max_p_order(pmin, n, pred_order);
  508. pmax = get_max_p_order(pmax, n, pred_order);
  509. bits = pred_order*bps + 4 + 5 + pred_order*precision + 6;
  510. bits += calc_rice_params(rc, pmin, pmax, data, n, pred_order);
  511. return bits;
  512. }
  513. /**
  514. * Apply Welch window function to audio block
  515. */
  516. static void apply_welch_window(const int32_t *data, int len, double *w_data)
  517. {
  518. int i, n2;
  519. double w;
  520. double c;
  521. assert(!(len&1)); //the optimization in r11881 does not support odd len
  522. //if someone wants odd len extend the change in r11881
  523. n2 = (len >> 1);
  524. c = 2.0 / (len - 1.0);
  525. w_data+=n2;
  526. data+=n2;
  527. for(i=0; i<n2; i++) {
  528. w = c - n2 + i;
  529. w = 1.0 - (w * w);
  530. w_data[-i-1] = data[-i-1] * w;
  531. w_data[+i ] = data[+i ] * w;
  532. }
  533. }
  534. /**
  535. * Calculates autocorrelation data from audio samples
  536. * A Welch window function is applied before calculation.
  537. */
  538. void ff_flac_compute_autocorr(const int32_t *data, int len, int lag,
  539. double *autoc)
  540. {
  541. int i, j;
  542. double tmp[len + lag + 1];
  543. double *data1= tmp + lag;
  544. apply_welch_window(data, len, data1);
  545. for(j=0; j<lag; j++)
  546. data1[j-lag]= 0.0;
  547. data1[len] = 0.0;
  548. for(j=0; j<lag; j+=2){
  549. double sum0 = 1.0, sum1 = 1.0;
  550. for(i=0; i<len; i++){
  551. sum0 += data1[i] * data1[i-j];
  552. sum1 += data1[i] * data1[i-j-1];
  553. }
  554. autoc[j ] = sum0;
  555. autoc[j+1] = sum1;
  556. }
  557. if(j==lag){
  558. double sum = 1.0;
  559. for(i=0; i<len; i+=2){
  560. sum += data1[i ] * data1[i-j ]
  561. + data1[i+1] * data1[i-j+1];
  562. }
  563. autoc[j] = sum;
  564. }
  565. }
  566. /**
  567. * Levinson-Durbin recursion.
  568. * Produces LPC coefficients from autocorrelation data.
  569. */
  570. static void compute_lpc_coefs(const double *autoc, int max_order,
  571. double lpc[][MAX_LPC_ORDER], double *ref)
  572. {
  573. int i, j, i2;
  574. double r, err, tmp;
  575. double lpc_tmp[MAX_LPC_ORDER];
  576. for(i=0; i<max_order; i++) lpc_tmp[i] = 0;
  577. err = autoc[0];
  578. for(i=0; i<max_order; i++) {
  579. r = -autoc[i+1];
  580. for(j=0; j<i; j++) {
  581. r -= lpc_tmp[j] * autoc[i-j];
  582. }
  583. r /= err;
  584. ref[i] = fabs(r);
  585. err *= 1.0 - (r * r);
  586. i2 = (i >> 1);
  587. lpc_tmp[i] = r;
  588. for(j=0; j<i2; j++) {
  589. tmp = lpc_tmp[j];
  590. lpc_tmp[j] += r * lpc_tmp[i-1-j];
  591. lpc_tmp[i-1-j] += r * tmp;
  592. }
  593. if(i & 1) {
  594. lpc_tmp[j] += lpc_tmp[j] * r;
  595. }
  596. for(j=0; j<=i; j++) {
  597. lpc[i][j] = -lpc_tmp[j];
  598. }
  599. }
  600. }
  601. /**
  602. * Quantize LPC coefficients
  603. */
  604. static void quantize_lpc_coefs(double *lpc_in, int order, int precision,
  605. int32_t *lpc_out, int *shift)
  606. {
  607. int i;
  608. double cmax, error;
  609. int32_t qmax;
  610. int sh;
  611. /* define maximum levels */
  612. qmax = (1 << (precision - 1)) - 1;
  613. /* find maximum coefficient value */
  614. cmax = 0.0;
  615. for(i=0; i<order; i++) {
  616. cmax= FFMAX(cmax, fabs(lpc_in[i]));
  617. }
  618. /* if maximum value quantizes to zero, return all zeros */
  619. if(cmax * (1 << MAX_LPC_SHIFT) < 1.0) {
  620. *shift = 0;
  621. memset(lpc_out, 0, sizeof(int32_t) * order);
  622. return;
  623. }
  624. /* calculate level shift which scales max coeff to available bits */
  625. sh = MAX_LPC_SHIFT;
  626. while((cmax * (1 << sh) > qmax) && (sh > 0)) {
  627. sh--;
  628. }
  629. /* since negative shift values are unsupported in decoder, scale down
  630. coefficients instead */
  631. if(sh == 0 && cmax > qmax) {
  632. double scale = ((double)qmax) / cmax;
  633. for(i=0; i<order; i++) {
  634. lpc_in[i] *= scale;
  635. }
  636. }
  637. /* output quantized coefficients and level shift */
  638. error=0;
  639. for(i=0; i<order; i++) {
  640. error += lpc_in[i] * (1 << sh);
  641. lpc_out[i] = av_clip(lrintf(error), -qmax, qmax);
  642. error -= lpc_out[i];
  643. }
  644. *shift = sh;
  645. }
  646. static int estimate_best_order(double *ref, int max_order)
  647. {
  648. int i, est;
  649. est = 1;
  650. for(i=max_order-1; i>=0; i--) {
  651. if(ref[i] > 0.10) {
  652. est = i+1;
  653. break;
  654. }
  655. }
  656. return est;
  657. }
  658. /**
  659. * Calculate LPC coefficients for multiple orders
  660. */
  661. static int lpc_calc_coefs(FlacEncodeContext *s,
  662. const int32_t *samples, int blocksize, int max_order,
  663. int precision, int32_t coefs[][MAX_LPC_ORDER],
  664. int *shift, int use_lpc, int omethod)
  665. {
  666. double autoc[MAX_LPC_ORDER+1];
  667. double ref[MAX_LPC_ORDER];
  668. double lpc[MAX_LPC_ORDER][MAX_LPC_ORDER];
  669. int i, j, pass;
  670. int opt_order;
  671. assert(max_order >= MIN_LPC_ORDER && max_order <= MAX_LPC_ORDER);
  672. if(use_lpc == 1){
  673. s->dsp.flac_compute_autocorr(samples, blocksize, max_order, autoc);
  674. compute_lpc_coefs(autoc, max_order, lpc, ref);
  675. }else{
  676. LLSModel m[2];
  677. double var[MAX_LPC_ORDER+1], weight;
  678. for(pass=0; pass<use_lpc-1; pass++){
  679. av_init_lls(&m[pass&1], max_order);
  680. weight=0;
  681. for(i=max_order; i<blocksize; i++){
  682. for(j=0; j<=max_order; j++)
  683. var[j]= samples[i-j];
  684. if(pass){
  685. double eval, inv, rinv;
  686. eval= av_evaluate_lls(&m[(pass-1)&1], var+1, max_order-1);
  687. eval= (512>>pass) + fabs(eval - var[0]);
  688. inv = 1/eval;
  689. rinv = sqrt(inv);
  690. for(j=0; j<=max_order; j++)
  691. var[j] *= rinv;
  692. weight += inv;
  693. }else
  694. weight++;
  695. av_update_lls(&m[pass&1], var, 1.0);
  696. }
  697. av_solve_lls(&m[pass&1], 0.001, 0);
  698. }
  699. for(i=0; i<max_order; i++){
  700. for(j=0; j<max_order; j++)
  701. lpc[i][j]= m[(pass-1)&1].coeff[i][j];
  702. ref[i]= sqrt(m[(pass-1)&1].variance[i] / weight) * (blocksize - max_order) / 4000;
  703. }
  704. for(i=max_order-1; i>0; i--)
  705. ref[i] = ref[i-1] - ref[i];
  706. }
  707. opt_order = max_order;
  708. if(omethod == ORDER_METHOD_EST) {
  709. opt_order = estimate_best_order(ref, max_order);
  710. i = opt_order-1;
  711. quantize_lpc_coefs(lpc[i], i+1, precision, coefs[i], &shift[i]);
  712. } else {
  713. for(i=0; i<max_order; i++) {
  714. quantize_lpc_coefs(lpc[i], i+1, precision, coefs[i], &shift[i]);
  715. }
  716. }
  717. return opt_order;
  718. }
  719. static void encode_residual_verbatim(int32_t *res, int32_t *smp, int n)
  720. {
  721. assert(n > 0);
  722. memcpy(res, smp, n * sizeof(int32_t));
  723. }
  724. static void encode_residual_fixed(int32_t *res, const int32_t *smp, int n,
  725. int order)
  726. {
  727. int i;
  728. for(i=0; i<order; i++) {
  729. res[i] = smp[i];
  730. }
  731. if(order==0){
  732. for(i=order; i<n; i++)
  733. res[i]= smp[i];
  734. }else if(order==1){
  735. for(i=order; i<n; i++)
  736. res[i]= smp[i] - smp[i-1];
  737. }else if(order==2){
  738. int a = smp[order-1] - smp[order-2];
  739. for(i=order; i<n; i+=2) {
  740. int b = smp[i] - smp[i-1];
  741. res[i]= b - a;
  742. a = smp[i+1] - smp[i];
  743. res[i+1]= a - b;
  744. }
  745. }else if(order==3){
  746. int a = smp[order-1] - smp[order-2];
  747. int c = smp[order-1] - 2*smp[order-2] + smp[order-3];
  748. for(i=order; i<n; i+=2) {
  749. int b = smp[i] - smp[i-1];
  750. int d = b - a;
  751. res[i]= d - c;
  752. a = smp[i+1] - smp[i];
  753. c = a - b;
  754. res[i+1]= c - d;
  755. }
  756. }else{
  757. int a = smp[order-1] - smp[order-2];
  758. int c = smp[order-1] - 2*smp[order-2] + smp[order-3];
  759. int e = smp[order-1] - 3*smp[order-2] + 3*smp[order-3] - smp[order-4];
  760. for(i=order; i<n; i+=2) {
  761. int b = smp[i] - smp[i-1];
  762. int d = b - a;
  763. int f = d - c;
  764. res[i]= f - e;
  765. a = smp[i+1] - smp[i];
  766. c = a - b;
  767. e = c - d;
  768. res[i+1]= e - f;
  769. }
  770. }
  771. }
  772. #define LPC1(x) {\
  773. int c = coefs[(x)-1];\
  774. p0 += c*s;\
  775. s = smp[i-(x)+1];\
  776. p1 += c*s;\
  777. }
  778. static av_always_inline void encode_residual_lpc_unrolled(
  779. int32_t *res, const int32_t *smp, int n,
  780. int order, const int32_t *coefs, int shift, int big)
  781. {
  782. int i;
  783. for(i=order; i<n; i+=2) {
  784. int s = smp[i-order];
  785. int p0 = 0, p1 = 0;
  786. if(big) {
  787. switch(order) {
  788. case 32: LPC1(32)
  789. case 31: LPC1(31)
  790. case 30: LPC1(30)
  791. case 29: LPC1(29)
  792. case 28: LPC1(28)
  793. case 27: LPC1(27)
  794. case 26: LPC1(26)
  795. case 25: LPC1(25)
  796. case 24: LPC1(24)
  797. case 23: LPC1(23)
  798. case 22: LPC1(22)
  799. case 21: LPC1(21)
  800. case 20: LPC1(20)
  801. case 19: LPC1(19)
  802. case 18: LPC1(18)
  803. case 17: LPC1(17)
  804. case 16: LPC1(16)
  805. case 15: LPC1(15)
  806. case 14: LPC1(14)
  807. case 13: LPC1(13)
  808. case 12: LPC1(12)
  809. case 11: LPC1(11)
  810. case 10: LPC1(10)
  811. case 9: LPC1( 9)
  812. LPC1( 8)
  813. LPC1( 7)
  814. LPC1( 6)
  815. LPC1( 5)
  816. LPC1( 4)
  817. LPC1( 3)
  818. LPC1( 2)
  819. LPC1( 1)
  820. }
  821. } else {
  822. switch(order) {
  823. case 8: LPC1( 8)
  824. case 7: LPC1( 7)
  825. case 6: LPC1( 6)
  826. case 5: LPC1( 5)
  827. case 4: LPC1( 4)
  828. case 3: LPC1( 3)
  829. case 2: LPC1( 2)
  830. case 1: LPC1( 1)
  831. }
  832. }
  833. res[i ] = smp[i ] - (p0 >> shift);
  834. res[i+1] = smp[i+1] - (p1 >> shift);
  835. }
  836. }
  837. static void encode_residual_lpc(int32_t *res, const int32_t *smp, int n,
  838. int order, const int32_t *coefs, int shift)
  839. {
  840. int i;
  841. for(i=0; i<order; i++) {
  842. res[i] = smp[i];
  843. }
  844. #ifdef CONFIG_SMALL
  845. for(i=order; i<n; i+=2) {
  846. int j;
  847. int s = smp[i];
  848. int p0 = 0, p1 = 0;
  849. for(j=0; j<order; j++) {
  850. int c = coefs[j];
  851. p1 += c*s;
  852. s = smp[i-j-1];
  853. p0 += c*s;
  854. }
  855. res[i ] = smp[i ] - (p0 >> shift);
  856. res[i+1] = smp[i+1] - (p1 >> shift);
  857. }
  858. #else
  859. switch(order) {
  860. case 1: encode_residual_lpc_unrolled(res, smp, n, 1, coefs, shift, 0); break;
  861. case 2: encode_residual_lpc_unrolled(res, smp, n, 2, coefs, shift, 0); break;
  862. case 3: encode_residual_lpc_unrolled(res, smp, n, 3, coefs, shift, 0); break;
  863. case 4: encode_residual_lpc_unrolled(res, smp, n, 4, coefs, shift, 0); break;
  864. case 5: encode_residual_lpc_unrolled(res, smp, n, 5, coefs, shift, 0); break;
  865. case 6: encode_residual_lpc_unrolled(res, smp, n, 6, coefs, shift, 0); break;
  866. case 7: encode_residual_lpc_unrolled(res, smp, n, 7, coefs, shift, 0); break;
  867. case 8: encode_residual_lpc_unrolled(res, smp, n, 8, coefs, shift, 0); break;
  868. default: encode_residual_lpc_unrolled(res, smp, n, order, coefs, shift, 1); break;
  869. }
  870. #endif
  871. }
  872. static int encode_residual(FlacEncodeContext *ctx, int ch)
  873. {
  874. int i, n;
  875. int min_order, max_order, opt_order, precision, omethod;
  876. int min_porder, max_porder;
  877. FlacFrame *frame;
  878. FlacSubframe *sub;
  879. int32_t coefs[MAX_LPC_ORDER][MAX_LPC_ORDER];
  880. int shift[MAX_LPC_ORDER];
  881. int32_t *res, *smp;
  882. frame = &ctx->frame;
  883. sub = &frame->subframes[ch];
  884. res = sub->residual;
  885. smp = sub->samples;
  886. n = frame->blocksize;
  887. /* CONSTANT */
  888. for(i=1; i<n; i++) {
  889. if(smp[i] != smp[0]) break;
  890. }
  891. if(i == n) {
  892. sub->type = sub->type_code = FLAC_SUBFRAME_CONSTANT;
  893. res[0] = smp[0];
  894. return sub->obits;
  895. }
  896. /* VERBATIM */
  897. if(n < 5) {
  898. sub->type = sub->type_code = FLAC_SUBFRAME_VERBATIM;
  899. encode_residual_verbatim(res, smp, n);
  900. return sub->obits * n;
  901. }
  902. min_order = ctx->options.min_prediction_order;
  903. max_order = ctx->options.max_prediction_order;
  904. min_porder = ctx->options.min_partition_order;
  905. max_porder = ctx->options.max_partition_order;
  906. precision = ctx->options.lpc_coeff_precision;
  907. omethod = ctx->options.prediction_order_method;
  908. /* FIXED */
  909. if(!ctx->options.use_lpc || max_order == 0 || (n <= max_order)) {
  910. uint32_t bits[MAX_FIXED_ORDER+1];
  911. if(max_order > MAX_FIXED_ORDER) max_order = MAX_FIXED_ORDER;
  912. opt_order = 0;
  913. bits[0] = UINT32_MAX;
  914. for(i=min_order; i<=max_order; i++) {
  915. encode_residual_fixed(res, smp, n, i);
  916. bits[i] = calc_rice_params_fixed(&sub->rc, min_porder, max_porder, res,
  917. n, i, sub->obits);
  918. if(bits[i] < bits[opt_order]) {
  919. opt_order = i;
  920. }
  921. }
  922. sub->order = opt_order;
  923. sub->type = FLAC_SUBFRAME_FIXED;
  924. sub->type_code = sub->type | sub->order;
  925. if(sub->order != max_order) {
  926. encode_residual_fixed(res, smp, n, sub->order);
  927. return calc_rice_params_fixed(&sub->rc, min_porder, max_porder, res, n,
  928. sub->order, sub->obits);
  929. }
  930. return bits[sub->order];
  931. }
  932. /* LPC */
  933. opt_order = lpc_calc_coefs(ctx, smp, n, max_order, precision, coefs, shift, ctx->options.use_lpc, omethod);
  934. if(omethod == ORDER_METHOD_2LEVEL ||
  935. omethod == ORDER_METHOD_4LEVEL ||
  936. omethod == ORDER_METHOD_8LEVEL) {
  937. int levels = 1 << omethod;
  938. uint32_t bits[levels];
  939. int order;
  940. int opt_index = levels-1;
  941. opt_order = max_order-1;
  942. bits[opt_index] = UINT32_MAX;
  943. for(i=levels-1; i>=0; i--) {
  944. order = min_order + (((max_order-min_order+1) * (i+1)) / levels)-1;
  945. if(order < 0) order = 0;
  946. encode_residual_lpc(res, smp, n, order+1, coefs[order], shift[order]);
  947. bits[i] = calc_rice_params_lpc(&sub->rc, min_porder, max_porder,
  948. res, n, order+1, sub->obits, precision);
  949. if(bits[i] < bits[opt_index]) {
  950. opt_index = i;
  951. opt_order = order;
  952. }
  953. }
  954. opt_order++;
  955. } else if(omethod == ORDER_METHOD_SEARCH) {
  956. // brute-force optimal order search
  957. uint32_t bits[MAX_LPC_ORDER];
  958. opt_order = 0;
  959. bits[0] = UINT32_MAX;
  960. for(i=min_order-1; i<max_order; i++) {
  961. encode_residual_lpc(res, smp, n, i+1, coefs[i], shift[i]);
  962. bits[i] = calc_rice_params_lpc(&sub->rc, min_porder, max_porder,
  963. res, n, i+1, sub->obits, precision);
  964. if(bits[i] < bits[opt_order]) {
  965. opt_order = i;
  966. }
  967. }
  968. opt_order++;
  969. } else if(omethod == ORDER_METHOD_LOG) {
  970. uint32_t bits[MAX_LPC_ORDER];
  971. int step;
  972. opt_order= min_order - 1 + (max_order-min_order)/3;
  973. memset(bits, -1, sizeof(bits));
  974. for(step=16 ;step; step>>=1){
  975. int last= opt_order;
  976. for(i=last-step; i<=last+step; i+= step){
  977. if(i<min_order-1 || i>=max_order || bits[i] < UINT32_MAX)
  978. continue;
  979. encode_residual_lpc(res, smp, n, i+1, coefs[i], shift[i]);
  980. bits[i] = calc_rice_params_lpc(&sub->rc, min_porder, max_porder,
  981. res, n, i+1, sub->obits, precision);
  982. if(bits[i] < bits[opt_order])
  983. opt_order= i;
  984. }
  985. }
  986. opt_order++;
  987. }
  988. sub->order = opt_order;
  989. sub->type = FLAC_SUBFRAME_LPC;
  990. sub->type_code = sub->type | (sub->order-1);
  991. sub->shift = shift[sub->order-1];
  992. for(i=0; i<sub->order; i++) {
  993. sub->coefs[i] = coefs[sub->order-1][i];
  994. }
  995. encode_residual_lpc(res, smp, n, sub->order, sub->coefs, sub->shift);
  996. return calc_rice_params_lpc(&sub->rc, min_porder, max_porder, res, n, sub->order,
  997. sub->obits, precision);
  998. }
  999. static int encode_residual_v(FlacEncodeContext *ctx, int ch)
  1000. {
  1001. int i, n;
  1002. FlacFrame *frame;
  1003. FlacSubframe *sub;
  1004. int32_t *res, *smp;
  1005. frame = &ctx->frame;
  1006. sub = &frame->subframes[ch];
  1007. res = sub->residual;
  1008. smp = sub->samples;
  1009. n = frame->blocksize;
  1010. /* CONSTANT */
  1011. for(i=1; i<n; i++) {
  1012. if(smp[i] != smp[0]) break;
  1013. }
  1014. if(i == n) {
  1015. sub->type = sub->type_code = FLAC_SUBFRAME_CONSTANT;
  1016. res[0] = smp[0];
  1017. return sub->obits;
  1018. }
  1019. /* VERBATIM */
  1020. sub->type = sub->type_code = FLAC_SUBFRAME_VERBATIM;
  1021. encode_residual_verbatim(res, smp, n);
  1022. return sub->obits * n;
  1023. }
  1024. static int estimate_stereo_mode(int32_t *left_ch, int32_t *right_ch, int n)
  1025. {
  1026. int i, best;
  1027. int32_t lt, rt;
  1028. uint64_t sum[4];
  1029. uint64_t score[4];
  1030. int k;
  1031. /* calculate sum of 2nd order residual for each channel */
  1032. sum[0] = sum[1] = sum[2] = sum[3] = 0;
  1033. for(i=2; i<n; i++) {
  1034. lt = left_ch[i] - 2*left_ch[i-1] + left_ch[i-2];
  1035. rt = right_ch[i] - 2*right_ch[i-1] + right_ch[i-2];
  1036. sum[2] += FFABS((lt + rt) >> 1);
  1037. sum[3] += FFABS(lt - rt);
  1038. sum[0] += FFABS(lt);
  1039. sum[1] += FFABS(rt);
  1040. }
  1041. /* estimate bit counts */
  1042. for(i=0; i<4; i++) {
  1043. k = find_optimal_param(2*sum[i], n);
  1044. sum[i] = rice_encode_count(2*sum[i], n, k);
  1045. }
  1046. /* calculate score for each mode */
  1047. score[0] = sum[0] + sum[1];
  1048. score[1] = sum[0] + sum[3];
  1049. score[2] = sum[1] + sum[3];
  1050. score[3] = sum[2] + sum[3];
  1051. /* return mode with lowest score */
  1052. best = 0;
  1053. for(i=1; i<4; i++) {
  1054. if(score[i] < score[best]) {
  1055. best = i;
  1056. }
  1057. }
  1058. if(best == 0) {
  1059. return FLAC_CHMODE_LEFT_RIGHT;
  1060. } else if(best == 1) {
  1061. return FLAC_CHMODE_LEFT_SIDE;
  1062. } else if(best == 2) {
  1063. return FLAC_CHMODE_RIGHT_SIDE;
  1064. } else {
  1065. return FLAC_CHMODE_MID_SIDE;
  1066. }
  1067. }
  1068. /**
  1069. * Perform stereo channel decorrelation
  1070. */
  1071. static void channel_decorrelation(FlacEncodeContext *ctx)
  1072. {
  1073. FlacFrame *frame;
  1074. int32_t *left, *right;
  1075. int i, n;
  1076. frame = &ctx->frame;
  1077. n = frame->blocksize;
  1078. left = frame->subframes[0].samples;
  1079. right = frame->subframes[1].samples;
  1080. if(ctx->channels != 2) {
  1081. frame->ch_mode = FLAC_CHMODE_NOT_STEREO;
  1082. return;
  1083. }
  1084. frame->ch_mode = estimate_stereo_mode(left, right, n);
  1085. /* perform decorrelation and adjust bits-per-sample */
  1086. if(frame->ch_mode == FLAC_CHMODE_LEFT_RIGHT) {
  1087. return;
  1088. }
  1089. if(frame->ch_mode == FLAC_CHMODE_MID_SIDE) {
  1090. int32_t tmp;
  1091. for(i=0; i<n; i++) {
  1092. tmp = left[i];
  1093. left[i] = (tmp + right[i]) >> 1;
  1094. right[i] = tmp - right[i];
  1095. }
  1096. frame->subframes[1].obits++;
  1097. } else if(frame->ch_mode == FLAC_CHMODE_LEFT_SIDE) {
  1098. for(i=0; i<n; i++) {
  1099. right[i] = left[i] - right[i];
  1100. }
  1101. frame->subframes[1].obits++;
  1102. } else {
  1103. for(i=0; i<n; i++) {
  1104. left[i] -= right[i];
  1105. }
  1106. frame->subframes[0].obits++;
  1107. }
  1108. }
  1109. static void put_sbits(PutBitContext *pb, int bits, int32_t val)
  1110. {
  1111. assert(bits >= 0 && bits <= 31);
  1112. put_bits(pb, bits, val & ((1<<bits)-1));
  1113. }
  1114. static void write_utf8(PutBitContext *pb, uint32_t val)
  1115. {
  1116. uint8_t tmp;
  1117. PUT_UTF8(val, tmp, put_bits(pb, 8, tmp);)
  1118. }
  1119. static void output_frame_header(FlacEncodeContext *s)
  1120. {
  1121. FlacFrame *frame;
  1122. int crc;
  1123. frame = &s->frame;
  1124. put_bits(&s->pb, 16, 0xFFF8);
  1125. put_bits(&s->pb, 4, frame->bs_code[0]);
  1126. put_bits(&s->pb, 4, s->sr_code[0]);
  1127. if(frame->ch_mode == FLAC_CHMODE_NOT_STEREO) {
  1128. put_bits(&s->pb, 4, s->ch_code);
  1129. } else {
  1130. put_bits(&s->pb, 4, frame->ch_mode);
  1131. }
  1132. put_bits(&s->pb, 3, 4); /* bits-per-sample code */
  1133. put_bits(&s->pb, 1, 0);
  1134. write_utf8(&s->pb, s->frame_count);
  1135. if(frame->bs_code[0] == 6) {
  1136. put_bits(&s->pb, 8, frame->bs_code[1]);
  1137. } else if(frame->bs_code[0] == 7) {
  1138. put_bits(&s->pb, 16, frame->bs_code[1]);
  1139. }
  1140. if(s->sr_code[0] == 12) {
  1141. put_bits(&s->pb, 8, s->sr_code[1]);
  1142. } else if(s->sr_code[0] > 12) {
  1143. put_bits(&s->pb, 16, s->sr_code[1]);
  1144. }
  1145. flush_put_bits(&s->pb);
  1146. crc = av_crc(av_crc_get_table(AV_CRC_8_ATM), 0,
  1147. s->pb.buf, put_bits_count(&s->pb)>>3);
  1148. put_bits(&s->pb, 8, crc);
  1149. }
  1150. static void output_subframe_constant(FlacEncodeContext *s, int ch)
  1151. {
  1152. FlacSubframe *sub;
  1153. int32_t res;
  1154. sub = &s->frame.subframes[ch];
  1155. res = sub->residual[0];
  1156. put_sbits(&s->pb, sub->obits, res);
  1157. }
  1158. static void output_subframe_verbatim(FlacEncodeContext *s, int ch)
  1159. {
  1160. int i;
  1161. FlacFrame *frame;
  1162. FlacSubframe *sub;
  1163. int32_t res;
  1164. frame = &s->frame;
  1165. sub = &frame->subframes[ch];
  1166. for(i=0; i<frame->blocksize; i++) {
  1167. res = sub->residual[i];
  1168. put_sbits(&s->pb, sub->obits, res);
  1169. }
  1170. }
  1171. static void output_residual(FlacEncodeContext *ctx, int ch)
  1172. {
  1173. int i, j, p, n, parts;
  1174. int k, porder, psize, res_cnt;
  1175. FlacFrame *frame;
  1176. FlacSubframe *sub;
  1177. int32_t *res;
  1178. frame = &ctx->frame;
  1179. sub = &frame->subframes[ch];
  1180. res = sub->residual;
  1181. n = frame->blocksize;
  1182. /* rice-encoded block */
  1183. put_bits(&ctx->pb, 2, 0);
  1184. /* partition order */
  1185. porder = sub->rc.porder;
  1186. psize = n >> porder;
  1187. parts = (1 << porder);
  1188. put_bits(&ctx->pb, 4, porder);
  1189. res_cnt = psize - sub->order;
  1190. /* residual */
  1191. j = sub->order;
  1192. for(p=0; p<parts; p++) {
  1193. k = sub->rc.params[p];
  1194. put_bits(&ctx->pb, 4, k);
  1195. if(p == 1) res_cnt = psize;
  1196. for(i=0; i<res_cnt && j<n; i++, j++) {
  1197. set_sr_golomb_flac(&ctx->pb, res[j], k, INT32_MAX, 0);
  1198. }
  1199. }
  1200. }
  1201. static void output_subframe_fixed(FlacEncodeContext *ctx, int ch)
  1202. {
  1203. int i;
  1204. FlacFrame *frame;
  1205. FlacSubframe *sub;
  1206. frame = &ctx->frame;
  1207. sub = &frame->subframes[ch];
  1208. /* warm-up samples */
  1209. for(i=0; i<sub->order; i++) {
  1210. put_sbits(&ctx->pb, sub->obits, sub->residual[i]);
  1211. }
  1212. /* residual */
  1213. output_residual(ctx, ch);
  1214. }
  1215. static void output_subframe_lpc(FlacEncodeContext *ctx, int ch)
  1216. {
  1217. int i, cbits;
  1218. FlacFrame *frame;
  1219. FlacSubframe *sub;
  1220. frame = &ctx->frame;
  1221. sub = &frame->subframes[ch];
  1222. /* warm-up samples */
  1223. for(i=0; i<sub->order; i++) {
  1224. put_sbits(&ctx->pb, sub->obits, sub->residual[i]);
  1225. }
  1226. /* LPC coefficients */
  1227. cbits = ctx->options.lpc_coeff_precision;
  1228. put_bits(&ctx->pb, 4, cbits-1);
  1229. put_sbits(&ctx->pb, 5, sub->shift);
  1230. for(i=0; i<sub->order; i++) {
  1231. put_sbits(&ctx->pb, cbits, sub->coefs[i]);
  1232. }
  1233. /* residual */
  1234. output_residual(ctx, ch);
  1235. }
  1236. static void output_subframes(FlacEncodeContext *s)
  1237. {
  1238. FlacFrame *frame;
  1239. FlacSubframe *sub;
  1240. int ch;
  1241. frame = &s->frame;
  1242. for(ch=0; ch<s->channels; ch++) {
  1243. sub = &frame->subframes[ch];
  1244. /* subframe header */
  1245. put_bits(&s->pb, 1, 0);
  1246. put_bits(&s->pb, 6, sub->type_code);
  1247. put_bits(&s->pb, 1, 0); /* no wasted bits */
  1248. /* subframe */
  1249. if(sub->type == FLAC_SUBFRAME_CONSTANT) {
  1250. output_subframe_constant(s, ch);
  1251. } else if(sub->type == FLAC_SUBFRAME_VERBATIM) {
  1252. output_subframe_verbatim(s, ch);
  1253. } else if(sub->type == FLAC_SUBFRAME_FIXED) {
  1254. output_subframe_fixed(s, ch);
  1255. } else if(sub->type == FLAC_SUBFRAME_LPC) {
  1256. output_subframe_lpc(s, ch);
  1257. }
  1258. }
  1259. }
  1260. static void output_frame_footer(FlacEncodeContext *s)
  1261. {
  1262. int crc;
  1263. flush_put_bits(&s->pb);
  1264. crc = bswap_16(av_crc(av_crc_get_table(AV_CRC_16_ANSI), 0,
  1265. s->pb.buf, put_bits_count(&s->pb)>>3));
  1266. put_bits(&s->pb, 16, crc);
  1267. flush_put_bits(&s->pb);
  1268. }
  1269. static int flac_encode_frame(AVCodecContext *avctx, uint8_t *frame,
  1270. int buf_size, void *data)
  1271. {
  1272. int ch;
  1273. FlacEncodeContext *s;
  1274. int16_t *samples = data;
  1275. int out_bytes;
  1276. s = avctx->priv_data;
  1277. s->blocksize = avctx->frame_size;
  1278. init_frame(s);
  1279. copy_samples(s, samples);
  1280. channel_decorrelation(s);
  1281. for(ch=0; ch<s->channels; ch++) {
  1282. encode_residual(s, ch);
  1283. }
  1284. init_put_bits(&s->pb, frame, buf_size);
  1285. output_frame_header(s);
  1286. output_subframes(s);
  1287. output_frame_footer(s);
  1288. out_bytes = put_bits_count(&s->pb) >> 3;
  1289. if(out_bytes > s->max_framesize || out_bytes >= buf_size) {
  1290. /* frame too large. use verbatim mode */
  1291. for(ch=0; ch<s->channels; ch++) {
  1292. encode_residual_v(s, ch);
  1293. }
  1294. init_put_bits(&s->pb, frame, buf_size);
  1295. output_frame_header(s);
  1296. output_subframes(s);
  1297. output_frame_footer(s);
  1298. out_bytes = put_bits_count(&s->pb) >> 3;
  1299. if(out_bytes > s->max_framesize || out_bytes >= buf_size) {
  1300. /* still too large. must be an error. */
  1301. av_log(avctx, AV_LOG_ERROR, "error encoding frame\n");
  1302. return -1;
  1303. }
  1304. }
  1305. s->frame_count++;
  1306. return out_bytes;
  1307. }
  1308. static av_cold int flac_encode_close(AVCodecContext *avctx)
  1309. {
  1310. av_freep(&avctx->extradata);
  1311. avctx->extradata_size = 0;
  1312. av_freep(&avctx->coded_frame);
  1313. return 0;
  1314. }
  1315. AVCodec flac_encoder = {
  1316. "flac",
  1317. CODEC_TYPE_AUDIO,
  1318. CODEC_ID_FLAC,
  1319. sizeof(FlacEncodeContext),
  1320. flac_encode_init,
  1321. flac_encode_frame,
  1322. flac_encode_close,
  1323. NULL,
  1324. .capabilities = CODEC_CAP_SMALL_LAST_FRAME,
  1325. };