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.

545 lines
15KB

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