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.

556 lines
15KB

  1. /*
  2. * PCM codecs
  3. * Copyright (c) 2001 Fabrice Bellard.
  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. /**
  22. * @file pcm.c
  23. * PCM codecs
  24. */
  25. #include "avcodec.h"
  26. #include "bitstream.h" // for ff_reverse
  27. #include "bytestream.h"
  28. #define MAX_CHANNELS 64
  29. /* from g711.c by SUN microsystems (unrestricted use) */
  30. #define SIGN_BIT (0x80) /* Sign bit for a A-law byte. */
  31. #define QUANT_MASK (0xf) /* Quantization field mask. */
  32. #define NSEGS (8) /* Number of A-law segments. */
  33. #define SEG_SHIFT (4) /* Left shift for segment number. */
  34. #define SEG_MASK (0x70) /* Segment field mask. */
  35. #define BIAS (0x84) /* Bias for linear code. */
  36. /*
  37. * alaw2linear() - Convert an A-law value to 16-bit linear PCM
  38. *
  39. */
  40. static int alaw2linear(unsigned char a_val)
  41. {
  42. int t;
  43. int seg;
  44. a_val ^= 0x55;
  45. t = a_val & QUANT_MASK;
  46. seg = ((unsigned)a_val & SEG_MASK) >> SEG_SHIFT;
  47. if(seg) t= (t + t + 1 + 32) << (seg + 2);
  48. else t= (t + t + 1 ) << 3;
  49. return ((a_val & SIGN_BIT) ? t : -t);
  50. }
  51. static int ulaw2linear(unsigned char u_val)
  52. {
  53. int t;
  54. /* Complement to obtain normal u-law value. */
  55. u_val = ~u_val;
  56. /*
  57. * Extract and bias the quantization bits. Then
  58. * shift up by the segment number and subtract out the bias.
  59. */
  60. t = ((u_val & QUANT_MASK) << 3) + BIAS;
  61. t <<= ((unsigned)u_val & SEG_MASK) >> SEG_SHIFT;
  62. return ((u_val & SIGN_BIT) ? (BIAS - t) : (t - BIAS));
  63. }
  64. /* 16384 entries per table */
  65. static uint8_t linear_to_alaw[16384];
  66. static uint8_t linear_to_ulaw[16384];
  67. static void build_xlaw_table(uint8_t *linear_to_xlaw,
  68. int (*xlaw2linear)(unsigned char),
  69. int mask)
  70. {
  71. int i, j, v, v1, v2;
  72. j = 0;
  73. for(i=0;i<128;i++) {
  74. if (i != 127) {
  75. v1 = xlaw2linear(i ^ mask);
  76. v2 = xlaw2linear((i + 1) ^ mask);
  77. v = (v1 + v2 + 4) >> 3;
  78. } else {
  79. v = 8192;
  80. }
  81. for(;j<v;j++) {
  82. linear_to_xlaw[8192 + j] = (i ^ mask);
  83. if (j > 0)
  84. linear_to_xlaw[8192 - j] = (i ^ (mask ^ 0x80));
  85. }
  86. }
  87. linear_to_xlaw[0] = linear_to_xlaw[1];
  88. }
  89. static int pcm_encode_init(AVCodecContext *avctx)
  90. {
  91. avctx->frame_size = 1;
  92. switch(avctx->codec->id) {
  93. case CODEC_ID_PCM_ALAW:
  94. build_xlaw_table(linear_to_alaw, alaw2linear, 0xd5);
  95. break;
  96. case CODEC_ID_PCM_MULAW:
  97. build_xlaw_table(linear_to_ulaw, ulaw2linear, 0xff);
  98. break;
  99. default:
  100. break;
  101. }
  102. switch(avctx->codec->id) {
  103. case CODEC_ID_PCM_S32LE:
  104. case CODEC_ID_PCM_S32BE:
  105. case CODEC_ID_PCM_U32LE:
  106. case CODEC_ID_PCM_U32BE:
  107. avctx->block_align = 4 * avctx->channels;
  108. break;
  109. case CODEC_ID_PCM_S24LE:
  110. case CODEC_ID_PCM_S24BE:
  111. case CODEC_ID_PCM_U24LE:
  112. case CODEC_ID_PCM_U24BE:
  113. case CODEC_ID_PCM_S24DAUD:
  114. avctx->block_align = 3 * avctx->channels;
  115. break;
  116. case CODEC_ID_PCM_S16LE:
  117. case CODEC_ID_PCM_S16BE:
  118. case CODEC_ID_PCM_U16LE:
  119. case CODEC_ID_PCM_U16BE:
  120. avctx->block_align = 2 * avctx->channels;
  121. break;
  122. case CODEC_ID_PCM_S8:
  123. case CODEC_ID_PCM_U8:
  124. case CODEC_ID_PCM_MULAW:
  125. case CODEC_ID_PCM_ALAW:
  126. avctx->block_align = avctx->channels;
  127. break;
  128. default:
  129. break;
  130. }
  131. avctx->coded_frame= avcodec_alloc_frame();
  132. avctx->coded_frame->key_frame= 1;
  133. return 0;
  134. }
  135. static int pcm_encode_close(AVCodecContext *avctx)
  136. {
  137. av_freep(&avctx->coded_frame);
  138. return 0;
  139. }
  140. /**
  141. * \brief convert samples from 16 bit
  142. * \param bps byte per sample for the destination format, must be >= 2
  143. * \param le 0 for big-, 1 for little-endian
  144. * \param us 0 for signed, 1 for unsigned output
  145. * \param samples input samples
  146. * \param dst output samples
  147. * \param n number of samples in samples buffer.
  148. */
  149. static inline void encode_from16(int bps, int le, int us,
  150. short **samples, uint8_t **dst, int n) {
  151. int usum = us ? 0x8000 : 0;
  152. if (bps > 2)
  153. memset(*dst, 0, n * bps);
  154. if (le) *dst += bps - 2;
  155. for(;n>0;n--) {
  156. register int v = *(*samples)++;
  157. v += usum;
  158. if (le) AV_WL16(*dst, v);
  159. else AV_WB16(*dst, v);
  160. *dst += bps;
  161. }
  162. if (le) *dst -= bps - 2;
  163. }
  164. static int pcm_encode_frame(AVCodecContext *avctx,
  165. unsigned char *frame, int buf_size, void *data)
  166. {
  167. int n, sample_size, v;
  168. short *samples;
  169. unsigned char *dst;
  170. switch(avctx->codec->id) {
  171. case CODEC_ID_PCM_S32LE:
  172. case CODEC_ID_PCM_S32BE:
  173. case CODEC_ID_PCM_U32LE:
  174. case CODEC_ID_PCM_U32BE:
  175. sample_size = 4;
  176. break;
  177. case CODEC_ID_PCM_S24LE:
  178. case CODEC_ID_PCM_S24BE:
  179. case CODEC_ID_PCM_U24LE:
  180. case CODEC_ID_PCM_U24BE:
  181. case CODEC_ID_PCM_S24DAUD:
  182. sample_size = 3;
  183. break;
  184. case CODEC_ID_PCM_S16LE:
  185. case CODEC_ID_PCM_S16BE:
  186. case CODEC_ID_PCM_U16LE:
  187. case CODEC_ID_PCM_U16BE:
  188. sample_size = 2;
  189. break;
  190. default:
  191. sample_size = 1;
  192. break;
  193. }
  194. n = buf_size / sample_size;
  195. samples = data;
  196. dst = frame;
  197. switch(avctx->codec->id) {
  198. case CODEC_ID_PCM_S32LE:
  199. encode_from16(4, 1, 0, &samples, &dst, n);
  200. break;
  201. case CODEC_ID_PCM_S32BE:
  202. encode_from16(4, 0, 0, &samples, &dst, n);
  203. break;
  204. case CODEC_ID_PCM_U32LE:
  205. encode_from16(4, 1, 1, &samples, &dst, n);
  206. break;
  207. case CODEC_ID_PCM_U32BE:
  208. encode_from16(4, 0, 1, &samples, &dst, n);
  209. break;
  210. case CODEC_ID_PCM_S24LE:
  211. encode_from16(3, 1, 0, &samples, &dst, n);
  212. break;
  213. case CODEC_ID_PCM_S24BE:
  214. encode_from16(3, 0, 0, &samples, &dst, n);
  215. break;
  216. case CODEC_ID_PCM_U24LE:
  217. encode_from16(3, 1, 1, &samples, &dst, n);
  218. break;
  219. case CODEC_ID_PCM_U24BE:
  220. encode_from16(3, 0, 1, &samples, &dst, n);
  221. break;
  222. case CODEC_ID_PCM_S24DAUD:
  223. for(;n>0;n--) {
  224. uint32_t tmp = ff_reverse[*samples >> 8] +
  225. (ff_reverse[*samples & 0xff] << 8);
  226. tmp <<= 4; // sync flags would go here
  227. bytestream_put_be24(&dst, tmp);
  228. samples++;
  229. }
  230. break;
  231. case CODEC_ID_PCM_S16LE:
  232. for(;n>0;n--) {
  233. v = *samples++;
  234. bytestream_put_le16(&dst, v);
  235. }
  236. break;
  237. case CODEC_ID_PCM_S16BE:
  238. for(;n>0;n--) {
  239. v = *samples++;
  240. bytestream_put_be16(&dst, v);
  241. }
  242. break;
  243. case CODEC_ID_PCM_U16LE:
  244. for(;n>0;n--) {
  245. v = *samples++;
  246. v += 0x8000;
  247. bytestream_put_le16(&dst, v);
  248. }
  249. break;
  250. case CODEC_ID_PCM_U16BE:
  251. for(;n>0;n--) {
  252. v = *samples++;
  253. v += 0x8000;
  254. bytestream_put_be16(&dst, v);
  255. }
  256. break;
  257. case CODEC_ID_PCM_S8:
  258. for(;n>0;n--) {
  259. v = *samples++;
  260. *dst++ = v >> 8;
  261. }
  262. break;
  263. case CODEC_ID_PCM_U8:
  264. for(;n>0;n--) {
  265. v = *samples++;
  266. *dst++ = (v >> 8) + 128;
  267. }
  268. break;
  269. case CODEC_ID_PCM_ZORK:
  270. for(;n>0;n--) {
  271. v= *samples++ >> 8;
  272. if(v<0) v = -v;
  273. else v+= 128;
  274. *dst++ = v;
  275. }
  276. break;
  277. case CODEC_ID_PCM_ALAW:
  278. for(;n>0;n--) {
  279. v = *samples++;
  280. *dst++ = linear_to_alaw[(v + 32768) >> 2];
  281. }
  282. break;
  283. case CODEC_ID_PCM_MULAW:
  284. for(;n>0;n--) {
  285. v = *samples++;
  286. *dst++ = linear_to_ulaw[(v + 32768) >> 2];
  287. }
  288. break;
  289. default:
  290. return -1;
  291. }
  292. //avctx->frame_size = (dst - frame) / (sample_size * avctx->channels);
  293. return dst - frame;
  294. }
  295. typedef struct PCMDecode {
  296. short table[256];
  297. } PCMDecode;
  298. static int pcm_decode_init(AVCodecContext * avctx)
  299. {
  300. PCMDecode *s = avctx->priv_data;
  301. int i;
  302. switch(avctx->codec->id) {
  303. case CODEC_ID_PCM_ALAW:
  304. for(i=0;i<256;i++)
  305. s->table[i] = alaw2linear(i);
  306. break;
  307. case CODEC_ID_PCM_MULAW:
  308. for(i=0;i<256;i++)
  309. s->table[i] = ulaw2linear(i);
  310. break;
  311. default:
  312. break;
  313. }
  314. return 0;
  315. }
  316. /**
  317. * \brief convert samples to 16 bit
  318. * \param bps byte per sample for the source format, must be >= 2
  319. * \param le 0 for big-, 1 for little-endian
  320. * \param us 0 for signed, 1 for unsigned input
  321. * \param src input samples
  322. * \param samples output samples
  323. * \param src_len number of bytes in src
  324. */
  325. static inline void decode_to16(int bps, int le, int us,
  326. const uint8_t **src, short **samples, int src_len)
  327. {
  328. int usum = us ? -0x8000 : 0;
  329. register int n = src_len / bps;
  330. if (le) *src += bps - 2;
  331. for(;n>0;n--) {
  332. register int v;
  333. if (le) v = AV_RL16(*src);
  334. else v = AV_RB16(*src);
  335. v += usum;
  336. *(*samples)++ = v;
  337. *src += bps;
  338. }
  339. if (le) *src -= bps - 2;
  340. }
  341. static int pcm_decode_frame(AVCodecContext *avctx,
  342. void *data, int *data_size,
  343. const uint8_t *buf, int buf_size)
  344. {
  345. PCMDecode *s = avctx->priv_data;
  346. int c, n;
  347. short *samples;
  348. const uint8_t *src, *src2[MAX_CHANNELS];
  349. samples = data;
  350. src = buf;
  351. n= av_get_bits_per_sample(avctx->codec_id)/8;
  352. if(n && buf_size % n){
  353. av_log(avctx, AV_LOG_ERROR, "invalid PCM packet\n");
  354. return -1;
  355. }
  356. if(avctx->channels <= 0 || avctx->channels > MAX_CHANNELS){
  357. av_log(avctx, AV_LOG_ERROR, "PCM channels out of bounds\n");
  358. return -1;
  359. }
  360. buf_size= FFMIN(buf_size, *data_size/2);
  361. *data_size=0;
  362. n = buf_size/avctx->channels;
  363. for(c=0;c<avctx->channels;c++)
  364. src2[c] = &src[c*n];
  365. switch(avctx->codec->id) {
  366. case CODEC_ID_PCM_S32LE:
  367. decode_to16(4, 1, 0, &src, &samples, buf_size);
  368. break;
  369. case CODEC_ID_PCM_S32BE:
  370. decode_to16(4, 0, 0, &src, &samples, buf_size);
  371. break;
  372. case CODEC_ID_PCM_U32LE:
  373. decode_to16(4, 1, 1, &src, &samples, buf_size);
  374. break;
  375. case CODEC_ID_PCM_U32BE:
  376. decode_to16(4, 0, 1, &src, &samples, buf_size);
  377. break;
  378. case CODEC_ID_PCM_S24LE:
  379. decode_to16(3, 1, 0, &src, &samples, buf_size);
  380. break;
  381. case CODEC_ID_PCM_S24BE:
  382. decode_to16(3, 0, 0, &src, &samples, buf_size);
  383. break;
  384. case CODEC_ID_PCM_U24LE:
  385. decode_to16(3, 1, 1, &src, &samples, buf_size);
  386. break;
  387. case CODEC_ID_PCM_U24BE:
  388. decode_to16(3, 0, 1, &src, &samples, buf_size);
  389. break;
  390. case CODEC_ID_PCM_S24DAUD:
  391. n = buf_size / 3;
  392. for(;n>0;n--) {
  393. uint32_t v = bytestream_get_be24(&src);
  394. v >>= 4; // sync flags are here
  395. *samples++ = ff_reverse[(v >> 8) & 0xff] +
  396. (ff_reverse[v & 0xff] << 8);
  397. }
  398. break;
  399. case CODEC_ID_PCM_S16LE:
  400. n = buf_size >> 1;
  401. for(;n>0;n--) {
  402. *samples++ = bytestream_get_le16(&src);
  403. }
  404. break;
  405. case CODEC_ID_PCM_S16LE_PLANAR:
  406. for(n>>=1;n>0;n--)
  407. for(c=0;c<avctx->channels;c++)
  408. *samples++ = bytestream_get_le16(&src2[c]);
  409. src = src2[avctx->channels-1];
  410. break;
  411. case CODEC_ID_PCM_S16BE:
  412. n = buf_size >> 1;
  413. for(;n>0;n--) {
  414. *samples++ = bytestream_get_be16(&src);
  415. }
  416. break;
  417. case CODEC_ID_PCM_U16LE:
  418. n = buf_size >> 1;
  419. for(;n>0;n--) {
  420. *samples++ = bytestream_get_le16(&src) - 0x8000;
  421. }
  422. break;
  423. case CODEC_ID_PCM_U16BE:
  424. n = buf_size >> 1;
  425. for(;n>0;n--) {
  426. *samples++ = bytestream_get_be16(&src) - 0x8000;
  427. }
  428. break;
  429. case CODEC_ID_PCM_S8:
  430. n = buf_size;
  431. for(;n>0;n--) {
  432. *samples++ = *src++ << 8;
  433. }
  434. break;
  435. case CODEC_ID_PCM_U8:
  436. n = buf_size;
  437. for(;n>0;n--) {
  438. *samples++ = ((int)*src++ - 128) << 8;
  439. }
  440. break;
  441. case CODEC_ID_PCM_ZORK:
  442. n = buf_size;
  443. for(;n>0;n--) {
  444. int x= *src++;
  445. if(x&128) x-= 128;
  446. else x = -x;
  447. *samples++ = x << 8;
  448. }
  449. break;
  450. case CODEC_ID_PCM_ALAW:
  451. case CODEC_ID_PCM_MULAW:
  452. n = buf_size;
  453. for(;n>0;n--) {
  454. *samples++ = s->table[*src++];
  455. }
  456. break;
  457. default:
  458. return -1;
  459. }
  460. *data_size = (uint8_t *)samples - (uint8_t *)data;
  461. return src - buf;
  462. }
  463. #ifdef CONFIG_ENCODERS
  464. #define PCM_ENCODER(id,name) \
  465. AVCodec name ## _encoder = { \
  466. #name, \
  467. CODEC_TYPE_AUDIO, \
  468. id, \
  469. 0, \
  470. pcm_encode_init, \
  471. pcm_encode_frame, \
  472. pcm_encode_close, \
  473. NULL, \
  474. };
  475. #else
  476. #define PCM_ENCODER(id,name)
  477. #endif
  478. #ifdef CONFIG_DECODERS
  479. #define PCM_DECODER(id,name) \
  480. AVCodec name ## _decoder = { \
  481. #name, \
  482. CODEC_TYPE_AUDIO, \
  483. id, \
  484. sizeof(PCMDecode), \
  485. pcm_decode_init, \
  486. NULL, \
  487. NULL, \
  488. pcm_decode_frame, \
  489. };
  490. #else
  491. #define PCM_DECODER(id,name)
  492. #endif
  493. #define PCM_CODEC(id, name) \
  494. PCM_ENCODER(id,name) PCM_DECODER(id,name)
  495. PCM_CODEC (CODEC_ID_PCM_S32LE, pcm_s32le);
  496. PCM_CODEC (CODEC_ID_PCM_S32BE, pcm_s32be);
  497. PCM_CODEC (CODEC_ID_PCM_U32LE, pcm_u32le);
  498. PCM_CODEC (CODEC_ID_PCM_U32BE, pcm_u32be);
  499. PCM_CODEC (CODEC_ID_PCM_S24LE, pcm_s24le);
  500. PCM_CODEC (CODEC_ID_PCM_S24BE, pcm_s24be);
  501. PCM_CODEC (CODEC_ID_PCM_U24LE, pcm_u24le);
  502. PCM_CODEC (CODEC_ID_PCM_U24BE, pcm_u24be);
  503. PCM_CODEC (CODEC_ID_PCM_S24DAUD, pcm_s24daud);
  504. PCM_CODEC (CODEC_ID_PCM_S16LE, pcm_s16le);
  505. PCM_DECODER(CODEC_ID_PCM_S16LE_PLANAR, pcm_s16le_planar);
  506. PCM_CODEC (CODEC_ID_PCM_S16BE, pcm_s16be);
  507. PCM_CODEC (CODEC_ID_PCM_U16LE, pcm_u16le);
  508. PCM_CODEC (CODEC_ID_PCM_U16BE, pcm_u16be);
  509. PCM_CODEC (CODEC_ID_PCM_S8, pcm_s8);
  510. PCM_CODEC (CODEC_ID_PCM_U8, pcm_u8);
  511. PCM_CODEC (CODEC_ID_PCM_ALAW, pcm_alaw);
  512. PCM_CODEC (CODEC_ID_PCM_MULAW, pcm_mulaw);
  513. PCM_CODEC (CODEC_ID_PCM_ZORK, pcm_zork);