00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00027 #include "avcodec.h"
00028 #include "bitstream.h"
00029 #include "bytestream.h"
00030
00031 #define MAX_CHANNELS 64
00032
00033
00034
00035 #define SIGN_BIT (0x80)
00036 #define QUANT_MASK (0xf)
00037 #define NSEGS (8)
00038 #define SEG_SHIFT (4)
00039 #define SEG_MASK (0x70)
00040
00041 #define BIAS (0x84)
00042
00043
00044
00045
00046
00047 static int alaw2linear(unsigned char a_val)
00048 {
00049 int t;
00050 int seg;
00051
00052 a_val ^= 0x55;
00053
00054 t = a_val & QUANT_MASK;
00055 seg = ((unsigned)a_val & SEG_MASK) >> SEG_SHIFT;
00056 if(seg) t= (t + t + 1 + 32) << (seg + 2);
00057 else t= (t + t + 1 ) << 3;
00058
00059 return ((a_val & SIGN_BIT) ? t : -t);
00060 }
00061
00062 static int ulaw2linear(unsigned char u_val)
00063 {
00064 int t;
00065
00066
00067 u_val = ~u_val;
00068
00069
00070
00071
00072
00073 t = ((u_val & QUANT_MASK) << 3) + BIAS;
00074 t <<= ((unsigned)u_val & SEG_MASK) >> SEG_SHIFT;
00075
00076 return ((u_val & SIGN_BIT) ? (BIAS - t) : (t - BIAS));
00077 }
00078
00079
00080 static uint8_t linear_to_alaw[16384];
00081 static uint8_t linear_to_ulaw[16384];
00082
00083 static void build_xlaw_table(uint8_t *linear_to_xlaw,
00084 int (*xlaw2linear)(unsigned char),
00085 int mask)
00086 {
00087 int i, j, v, v1, v2;
00088
00089 j = 0;
00090 for(i=0;i<128;i++) {
00091 if (i != 127) {
00092 v1 = xlaw2linear(i ^ mask);
00093 v2 = xlaw2linear((i + 1) ^ mask);
00094 v = (v1 + v2 + 4) >> 3;
00095 } else {
00096 v = 8192;
00097 }
00098 for(;j<v;j++) {
00099 linear_to_xlaw[8192 + j] = (i ^ mask);
00100 if (j > 0)
00101 linear_to_xlaw[8192 - j] = (i ^ (mask ^ 0x80));
00102 }
00103 }
00104 linear_to_xlaw[0] = linear_to_xlaw[1];
00105 }
00106
00107 static int pcm_encode_init(AVCodecContext *avctx)
00108 {
00109 avctx->frame_size = 1;
00110 switch(avctx->codec->id) {
00111 case CODEC_ID_PCM_ALAW:
00112 build_xlaw_table(linear_to_alaw, alaw2linear, 0xd5);
00113 break;
00114 case CODEC_ID_PCM_MULAW:
00115 build_xlaw_table(linear_to_ulaw, ulaw2linear, 0xff);
00116 break;
00117 default:
00118 break;
00119 }
00120
00121 switch(avctx->codec->id) {
00122 case CODEC_ID_PCM_S32LE:
00123 case CODEC_ID_PCM_S32BE:
00124 case CODEC_ID_PCM_U32LE:
00125 case CODEC_ID_PCM_U32BE:
00126 avctx->block_align = 4 * avctx->channels;
00127 break;
00128 case CODEC_ID_PCM_S24LE:
00129 case CODEC_ID_PCM_S24BE:
00130 case CODEC_ID_PCM_U24LE:
00131 case CODEC_ID_PCM_U24BE:
00132 case CODEC_ID_PCM_S24DAUD:
00133 avctx->block_align = 3 * avctx->channels;
00134 break;
00135 case CODEC_ID_PCM_S16LE:
00136 case CODEC_ID_PCM_S16BE:
00137 case CODEC_ID_PCM_U16LE:
00138 case CODEC_ID_PCM_U16BE:
00139 avctx->block_align = 2 * avctx->channels;
00140 break;
00141 case CODEC_ID_PCM_S8:
00142 case CODEC_ID_PCM_U8:
00143 case CODEC_ID_PCM_MULAW:
00144 case CODEC_ID_PCM_ALAW:
00145 avctx->block_align = avctx->channels;
00146 break;
00147 default:
00148 break;
00149 }
00150
00151 avctx->coded_frame= avcodec_alloc_frame();
00152 avctx->coded_frame->key_frame= 1;
00153
00154 return 0;
00155 }
00156
00157 static int pcm_encode_close(AVCodecContext *avctx)
00158 {
00159 av_freep(&avctx->coded_frame);
00160
00161 return 0;
00162 }
00163
00173 static inline void encode_from16(int bps, int le, int us,
00174 short **samples, uint8_t **dst, int n) {
00175 int usum = us ? 0x8000 : 0;
00176 if (bps > 2)
00177 memset(*dst, 0, n * bps);
00178 if (le) *dst += bps - 2;
00179 for(;n>0;n--) {
00180 register int v = *(*samples)++;
00181 v += usum;
00182 if (le) AV_WL16(*dst, v);
00183 else AV_WB16(*dst, v);
00184 *dst += bps;
00185 }
00186 if (le) *dst -= bps - 2;
00187 }
00188
00189 static int pcm_encode_frame(AVCodecContext *avctx,
00190 unsigned char *frame, int buf_size, void *data)
00191 {
00192 int n, sample_size, v;
00193 short *samples;
00194 unsigned char *dst;
00195
00196 switch(avctx->codec->id) {
00197 case CODEC_ID_PCM_S32LE:
00198 case CODEC_ID_PCM_S32BE:
00199 case CODEC_ID_PCM_U32LE:
00200 case CODEC_ID_PCM_U32BE:
00201 sample_size = 4;
00202 break;
00203 case CODEC_ID_PCM_S24LE:
00204 case CODEC_ID_PCM_S24BE:
00205 case CODEC_ID_PCM_U24LE:
00206 case CODEC_ID_PCM_U24BE:
00207 case CODEC_ID_PCM_S24DAUD:
00208 sample_size = 3;
00209 break;
00210 case CODEC_ID_PCM_S16LE:
00211 case CODEC_ID_PCM_S16BE:
00212 case CODEC_ID_PCM_U16LE:
00213 case CODEC_ID_PCM_U16BE:
00214 sample_size = 2;
00215 break;
00216 default:
00217 sample_size = 1;
00218 break;
00219 }
00220 n = buf_size / sample_size;
00221 samples = data;
00222 dst = frame;
00223
00224 switch(avctx->codec->id) {
00225 case CODEC_ID_PCM_S32LE:
00226 encode_from16(4, 1, 0, &samples, &dst, n);
00227 break;
00228 case CODEC_ID_PCM_S32BE:
00229 encode_from16(4, 0, 0, &samples, &dst, n);
00230 break;
00231 case CODEC_ID_PCM_U32LE:
00232 encode_from16(4, 1, 1, &samples, &dst, n);
00233 break;
00234 case CODEC_ID_PCM_U32BE:
00235 encode_from16(4, 0, 1, &samples, &dst, n);
00236 break;
00237 case CODEC_ID_PCM_S24LE:
00238 encode_from16(3, 1, 0, &samples, &dst, n);
00239 break;
00240 case CODEC_ID_PCM_S24BE:
00241 encode_from16(3, 0, 0, &samples, &dst, n);
00242 break;
00243 case CODEC_ID_PCM_U24LE:
00244 encode_from16(3, 1, 1, &samples, &dst, n);
00245 break;
00246 case CODEC_ID_PCM_U24BE:
00247 encode_from16(3, 0, 1, &samples, &dst, n);
00248 break;
00249 case CODEC_ID_PCM_S24DAUD:
00250 for(;n>0;n--) {
00251 uint32_t tmp = ff_reverse[*samples >> 8] +
00252 (ff_reverse[*samples & 0xff] << 8);
00253 tmp <<= 4;
00254 bytestream_put_be24(&dst, tmp);
00255 samples++;
00256 }
00257 break;
00258 case CODEC_ID_PCM_S16LE:
00259 for(;n>0;n--) {
00260 v = *samples++;
00261 bytestream_put_le16(&dst, v);
00262 }
00263 break;
00264 case CODEC_ID_PCM_S16BE:
00265 for(;n>0;n--) {
00266 v = *samples++;
00267 bytestream_put_be16(&dst, v);
00268 }
00269 break;
00270 case CODEC_ID_PCM_U16LE:
00271 for(;n>0;n--) {
00272 v = *samples++;
00273 v += 0x8000;
00274 bytestream_put_le16(&dst, v);
00275 }
00276 break;
00277 case CODEC_ID_PCM_U16BE:
00278 for(;n>0;n--) {
00279 v = *samples++;
00280 v += 0x8000;
00281 bytestream_put_be16(&dst, v);
00282 }
00283 break;
00284 case CODEC_ID_PCM_S8:
00285 for(;n>0;n--) {
00286 v = *samples++;
00287 *dst++ = v >> 8;
00288 }
00289 break;
00290 case CODEC_ID_PCM_U8:
00291 for(;n>0;n--) {
00292 v = *samples++;
00293 *dst++ = (v >> 8) + 128;
00294 }
00295 break;
00296 case CODEC_ID_PCM_ZORK:
00297 for(;n>0;n--) {
00298 v= *samples++ >> 8;
00299 if(v<0) v = -v;
00300 else v+= 128;
00301 *dst++ = v;
00302 }
00303 break;
00304 case CODEC_ID_PCM_ALAW:
00305 for(;n>0;n--) {
00306 v = *samples++;
00307 *dst++ = linear_to_alaw[(v + 32768) >> 2];
00308 }
00309 break;
00310 case CODEC_ID_PCM_MULAW:
00311 for(;n>0;n--) {
00312 v = *samples++;
00313 *dst++ = linear_to_ulaw[(v + 32768) >> 2];
00314 }
00315 break;
00316 default:
00317 return -1;
00318 }
00319
00320
00321 return dst - frame;
00322 }
00323
00324 typedef struct PCMDecode {
00325 short table[256];
00326 } PCMDecode;
00327
00328 static int pcm_decode_init(AVCodecContext * avctx)
00329 {
00330 PCMDecode *s = avctx->priv_data;
00331 int i;
00332
00333 switch(avctx->codec->id) {
00334 case CODEC_ID_PCM_ALAW:
00335 for(i=0;i<256;i++)
00336 s->table[i] = alaw2linear(i);
00337 break;
00338 case CODEC_ID_PCM_MULAW:
00339 for(i=0;i<256;i++)
00340 s->table[i] = ulaw2linear(i);
00341 break;
00342 default:
00343 break;
00344 }
00345 return 0;
00346 }
00347
00357 static inline void decode_to16(int bps, int le, int us,
00358 const uint8_t **src, short **samples, int src_len)
00359 {
00360 int usum = us ? -0x8000 : 0;
00361 register int n = src_len / bps;
00362 if (le) *src += bps - 2;
00363 for(;n>0;n--) {
00364 register int v;
00365 if (le) v = AV_RL16(*src);
00366 else v = AV_RB16(*src);
00367 v += usum;
00368 *(*samples)++ = v;
00369 *src += bps;
00370 }
00371 if (le) *src -= bps - 2;
00372 }
00373
00374 static int pcm_decode_frame(AVCodecContext *avctx,
00375 void *data, int *data_size,
00376 const uint8_t *buf, int buf_size)
00377 {
00378 PCMDecode *s = avctx->priv_data;
00379 int c, n;
00380 short *samples;
00381 const uint8_t *src, *src2[MAX_CHANNELS];
00382
00383 samples = data;
00384 src = buf;
00385
00386 n= av_get_bits_per_sample(avctx->codec_id)/8;
00387 if(n && buf_size % n){
00388 av_log(avctx, AV_LOG_ERROR, "invalid PCM packet\n");
00389 return -1;
00390 }
00391 if(avctx->channels <= 0 || avctx->channels > MAX_CHANNELS){
00392 av_log(avctx, AV_LOG_ERROR, "PCM channels out of bounds\n");
00393 return -1;
00394 }
00395
00396 buf_size= FFMIN(buf_size, *data_size/2);
00397 *data_size=0;
00398
00399 n = buf_size/avctx->channels;
00400 for(c=0;c<avctx->channels;c++)
00401 src2[c] = &src[c*n];
00402
00403 switch(avctx->codec->id) {
00404 case CODEC_ID_PCM_S32LE:
00405 decode_to16(4, 1, 0, &src, &samples, buf_size);
00406 break;
00407 case CODEC_ID_PCM_S32BE:
00408 decode_to16(4, 0, 0, &src, &samples, buf_size);
00409 break;
00410 case CODEC_ID_PCM_U32LE:
00411 decode_to16(4, 1, 1, &src, &samples, buf_size);
00412 break;
00413 case CODEC_ID_PCM_U32BE:
00414 decode_to16(4, 0, 1, &src, &samples, buf_size);
00415 break;
00416 case CODEC_ID_PCM_S24LE:
00417 decode_to16(3, 1, 0, &src, &samples, buf_size);
00418 break;
00419 case CODEC_ID_PCM_S24BE:
00420 decode_to16(3, 0, 0, &src, &samples, buf_size);
00421 break;
00422 case CODEC_ID_PCM_U24LE:
00423 decode_to16(3, 1, 1, &src, &samples, buf_size);
00424 break;
00425 case CODEC_ID_PCM_U24BE:
00426 decode_to16(3, 0, 1, &src, &samples, buf_size);
00427 break;
00428 case CODEC_ID_PCM_S24DAUD:
00429 n = buf_size / 3;
00430 for(;n>0;n--) {
00431 uint32_t v = bytestream_get_be24(&src);
00432 v >>= 4;
00433 *samples++ = ff_reverse[(v >> 8) & 0xff] +
00434 (ff_reverse[v & 0xff] << 8);
00435 }
00436 break;
00437 case CODEC_ID_PCM_S16LE:
00438 n = buf_size >> 1;
00439 for(;n>0;n--) {
00440 *samples++ = bytestream_get_le16(&src);
00441 }
00442 break;
00443 case CODEC_ID_PCM_S16LE_PLANAR:
00444 for(n>>=1;n>0;n--)
00445 for(c=0;c<avctx->channels;c++)
00446 *samples++ = bytestream_get_le16(&src2[c]);
00447 src = src2[avctx->channels-1];
00448 break;
00449 case CODEC_ID_PCM_S16BE:
00450 n = buf_size >> 1;
00451 for(;n>0;n--) {
00452 *samples++ = bytestream_get_be16(&src);
00453 }
00454 break;
00455 case CODEC_ID_PCM_U16LE:
00456 n = buf_size >> 1;
00457 for(;n>0;n--) {
00458 *samples++ = bytestream_get_le16(&src) - 0x8000;
00459 }
00460 break;
00461 case CODEC_ID_PCM_U16BE:
00462 n = buf_size >> 1;
00463 for(;n>0;n--) {
00464 *samples++ = bytestream_get_be16(&src) - 0x8000;
00465 }
00466 break;
00467 case CODEC_ID_PCM_S8:
00468 n = buf_size;
00469 for(;n>0;n--) {
00470 *samples++ = *src++ << 8;
00471 }
00472 break;
00473 case CODEC_ID_PCM_U8:
00474 n = buf_size;
00475 for(;n>0;n--) {
00476 *samples++ = ((int)*src++ - 128) << 8;
00477 }
00478 break;
00479 case CODEC_ID_PCM_ZORK:
00480 n = buf_size;
00481 for(;n>0;n--) {
00482 int x= *src++;
00483 if(x&128) x-= 128;
00484 else x = -x;
00485 *samples++ = x << 8;
00486 }
00487 break;
00488 case CODEC_ID_PCM_ALAW:
00489 case CODEC_ID_PCM_MULAW:
00490 n = buf_size;
00491 for(;n>0;n--) {
00492 *samples++ = s->table[*src++];
00493 }
00494 break;
00495 default:
00496 return -1;
00497 }
00498 *data_size = (uint8_t *)samples - (uint8_t *)data;
00499 return src - buf;
00500 }
00501
00502 #ifdef CONFIG_ENCODERS
00503 #define PCM_ENCODER(id,name) \
00504 AVCodec name ## _encoder = { \
00505 #name, \
00506 CODEC_TYPE_AUDIO, \
00507 id, \
00508 0, \
00509 pcm_encode_init, \
00510 pcm_encode_frame, \
00511 pcm_encode_close, \
00512 NULL, \
00513 };
00514 #else
00515 #define PCM_ENCODER(id,name)
00516 #endif
00517
00518 #ifdef CONFIG_DECODERS
00519 #define PCM_DECODER(id,name) \
00520 AVCodec name ## _decoder = { \
00521 #name, \
00522 CODEC_TYPE_AUDIO, \
00523 id, \
00524 sizeof(PCMDecode), \
00525 pcm_decode_init, \
00526 NULL, \
00527 NULL, \
00528 pcm_decode_frame, \
00529 };
00530 #else
00531 #define PCM_DECODER(id,name)
00532 #endif
00533
00534 #define PCM_CODEC(id, name) \
00535 PCM_ENCODER(id,name) PCM_DECODER(id,name)
00536
00537 PCM_CODEC (CODEC_ID_PCM_S32LE, pcm_s32le);
00538 PCM_CODEC (CODEC_ID_PCM_S32BE, pcm_s32be);
00539 PCM_CODEC (CODEC_ID_PCM_U32LE, pcm_u32le);
00540 PCM_CODEC (CODEC_ID_PCM_U32BE, pcm_u32be);
00541 PCM_CODEC (CODEC_ID_PCM_S24LE, pcm_s24le);
00542 PCM_CODEC (CODEC_ID_PCM_S24BE, pcm_s24be);
00543 PCM_CODEC (CODEC_ID_PCM_U24LE, pcm_u24le);
00544 PCM_CODEC (CODEC_ID_PCM_U24BE, pcm_u24be);
00545 PCM_CODEC (CODEC_ID_PCM_S24DAUD, pcm_s24daud);
00546 PCM_CODEC (CODEC_ID_PCM_S16LE, pcm_s16le);
00547 PCM_DECODER(CODEC_ID_PCM_S16LE_PLANAR, pcm_s16le_planar);
00548 PCM_CODEC (CODEC_ID_PCM_S16BE, pcm_s16be);
00549 PCM_CODEC (CODEC_ID_PCM_U16LE, pcm_u16le);
00550 PCM_CODEC (CODEC_ID_PCM_U16BE, pcm_u16be);
00551 PCM_CODEC (CODEC_ID_PCM_S8, pcm_s8);
00552 PCM_CODEC (CODEC_ID_PCM_U8, pcm_u8);
00553 PCM_CODEC (CODEC_ID_PCM_ALAW, pcm_alaw);
00554 PCM_CODEC (CODEC_ID_PCM_MULAW, pcm_mulaw);
00555 PCM_CODEC (CODEC_ID_PCM_ZORK, pcm_zork);