oggvorbis.c
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:10k
源码类别:

Windows CE

开发平台:

C/C++

  1. /**
  2.  * @file oggvorbis.c
  3.  * Ogg Vorbis codec support via libvorbisenc.
  4.  * @author Mark Hills <mark@pogo.org.uk>
  5.  */
  6. #include <vorbis/vorbisenc.h>
  7. #include "avcodec.h"
  8. #undef NDEBUG
  9. #include <assert.h>
  10. #define OGGVORBIS_FRAME_SIZE 64
  11. #define BUFFER_SIZE (1024*64)
  12. typedef struct OggVorbisContext {
  13.     vorbis_info vi ;
  14.     vorbis_dsp_state vd ;
  15.     vorbis_block vb ;
  16.     uint8_t buffer[BUFFER_SIZE];
  17.     int buffer_index;
  18.     /* decoder */
  19.     vorbis_comment vc ;
  20.     ogg_packet op;
  21. } OggVorbisContext ;
  22. static int oggvorbis_init_encoder(vorbis_info *vi, AVCodecContext *avccontext) {
  23.     if(avccontext->flags & CODEC_FLAG_QSCALE) {
  24.         return vorbis_encode_init_vbr(vi, avccontext->channels,
  25.                 avccontext->sample_rate,
  26.                 avccontext->global_quality / (float)FF_QP2LAMBDA);
  27.     }
  28. #ifdef OGGVORBIS_VBR_BY_ESTIMATE
  29.     /* variable bitrate by estimate */
  30.     return (vorbis_encode_setup_managed(vi, avccontext->channels,
  31.               avccontext->sample_rate, -1, avccontext->bit_rate, -1) ||
  32.     vorbis_encode_ctl(vi, OV_ECTL_RATEMANAGE_AVG, NULL) ||
  33.     vorbis_encode_setup_init(vi)) ;
  34. #else
  35.     /* constant bitrate */
  36.     return vorbis_encode_init(vi, avccontext->channels,
  37.           avccontext->sample_rate, -1, avccontext->bit_rate, -1) ;
  38. #endif
  39. }
  40. static int oggvorbis_encode_init(AVCodecContext *avccontext) {
  41.     OggVorbisContext *context = avccontext->priv_data ;
  42.     ogg_packet header, header_comm, header_code;
  43.     uint8_t *p;
  44.     unsigned int offset, len;
  45.     vorbis_info_init(&context->vi) ;
  46.     if(oggvorbis_init_encoder(&context->vi, avccontext) < 0) {
  47. av_log(avccontext, AV_LOG_ERROR, "oggvorbis_encode_init: init_encoder failed") ;
  48. return -1 ;
  49.     }
  50.     vorbis_analysis_init(&context->vd, &context->vi) ;
  51.     vorbis_block_init(&context->vd, &context->vb) ;
  52.     vorbis_comment_init(&context->vc);
  53.     vorbis_comment_add_tag(&context->vc, "encoder", LIBAVCODEC_IDENT) ;
  54.     vorbis_analysis_headerout(&context->vd, &context->vc, &header,
  55.                                 &header_comm, &header_code);
  56.     
  57.     len = header.bytes + header_comm.bytes +  header_code.bytes;
  58.     avccontext->extradata_size= 64 + len + len/255;
  59.     p = avccontext->extradata= av_mallocz(avccontext->extradata_size);
  60.     p[0] = 2;
  61.     offset = 1;
  62.     offset += av_xiphlacing(&p[offset], header.bytes);
  63.     offset += av_xiphlacing(&p[offset], header_comm.bytes);
  64.     memcpy(&p[offset], header.packet, header.bytes);
  65.     offset += header.bytes;
  66.     memcpy(&p[offset], header_comm.packet, header_comm.bytes);
  67.     offset += header_comm.bytes;
  68.     memcpy(&p[offset], header_code.packet, header_code.bytes);
  69.     offset += header_code.bytes;
  70.     avccontext->extradata_size = offset;
  71.     avccontext->extradata= av_realloc(avccontext->extradata, avccontext->extradata_size);
  72.                                 
  73. /*    vorbis_block_clear(&context->vb);
  74.     vorbis_dsp_clear(&context->vd);
  75.     vorbis_info_clear(&context->vi);*/
  76.     vorbis_comment_clear(&context->vc);
  77.        
  78.     avccontext->frame_size = OGGVORBIS_FRAME_SIZE ;
  79.  
  80.     avccontext->coded_frame= avcodec_alloc_frame();
  81.     avccontext->coded_frame->key_frame= 1;
  82.     
  83.     return 0 ;
  84. }
  85. static int oggvorbis_encode_frame(AVCodecContext *avccontext,
  86.   unsigned char *packets,
  87.    int buf_size, void *data)
  88. {
  89.     OggVorbisContext *context = avccontext->priv_data ;
  90.     float **buffer ;
  91.     ogg_packet op ;
  92.     signed short *audio = data ;
  93.     int l, samples = data ? OGGVORBIS_FRAME_SIZE : 0;
  94.     buffer = vorbis_analysis_buffer(&context->vd, samples) ;
  95.     if(context->vi.channels == 1) {
  96. for(l = 0 ; l < samples ; l++)
  97.     buffer[0][l]=audio[l]/32768.f;
  98.     } else {
  99. for(l = 0 ; l < samples ; l++){
  100.     buffer[0][l]=audio[l*2]/32768.f;
  101.     buffer[1][l]=audio[l*2+1]/32768.f;
  102. }
  103.     }
  104.     
  105.     vorbis_analysis_wrote(&context->vd, samples) ; 
  106.     while(vorbis_analysis_blockout(&context->vd, &context->vb) == 1) {
  107. vorbis_analysis(&context->vb, NULL);
  108. vorbis_bitrate_addblock(&context->vb) ;
  109. while(vorbis_bitrate_flushpacket(&context->vd, &op)) {
  110.             if(op.bytes==1) //id love to say this is a hack, bad sadly its not, appearently the end of stream decission is in libogg
  111.                 continue;
  112.             memcpy(context->buffer + context->buffer_index, &op, sizeof(ogg_packet));
  113.             context->buffer_index += sizeof(ogg_packet);
  114.             memcpy(context->buffer + context->buffer_index, op.packet, op.bytes);
  115.             context->buffer_index += op.bytes;
  116. //            av_log(avccontext, AV_LOG_DEBUG, "e%d / %dn", context->buffer_index, op.bytes);
  117. }
  118.     }
  119.     l=0;
  120.     if(context->buffer_index){
  121.         ogg_packet *op2= (ogg_packet*)context->buffer;
  122.         op2->packet = context->buffer + sizeof(ogg_packet);
  123.         l=  op2->bytes;
  124.         avccontext->coded_frame->pts= av_rescale_q(op2->granulepos, (AVRational){1, avccontext->sample_rate}, avccontext->time_base);
  125.         //FIXME we should reorder the user supplied pts and not assume that they are spaced by 1/sample_rate
  126.         memcpy(packets, op2->packet, l);
  127.         context->buffer_index -= l + sizeof(ogg_packet);
  128.         memcpy(context->buffer, context->buffer + l + sizeof(ogg_packet), context->buffer_index);
  129. //        av_log(avccontext, AV_LOG_DEBUG, "E%dn", l);
  130.     }
  131.     return l;
  132. }
  133. static int oggvorbis_encode_close(AVCodecContext *avccontext) {
  134.     OggVorbisContext *context = avccontext->priv_data ;
  135. /*  ogg_packet op ; */
  136.     
  137.     vorbis_analysis_wrote(&context->vd, 0) ; /* notify vorbisenc this is EOF */
  138.     vorbis_block_clear(&context->vb);
  139.     vorbis_dsp_clear(&context->vd);
  140.     vorbis_info_clear(&context->vi);
  141.     av_freep(&avccontext->coded_frame);
  142.     av_freep(&avccontext->extradata);
  143.   
  144.     return 0 ;
  145. }
  146. AVCodec oggvorbis_encoder = {
  147.     "vorbis",
  148.     CODEC_TYPE_AUDIO,
  149.     CODEC_ID_VORBIS,
  150.     sizeof(OggVorbisContext),
  151.     oggvorbis_encode_init,
  152.     oggvorbis_encode_frame,
  153.     oggvorbis_encode_close,
  154.     .capabilities= CODEC_CAP_DELAY,
  155. } ;
  156. static int oggvorbis_decode_init(AVCodecContext *avccontext) {
  157.     OggVorbisContext *context = avccontext->priv_data ;
  158.     uint8_t *p= avccontext->extradata;
  159.     int i, hsizes[3];
  160.     unsigned char *headers[3], *extradata = avccontext->extradata;
  161.     vorbis_info_init(&context->vi) ;
  162.     vorbis_comment_init(&context->vc) ;
  163.     if(! avccontext->extradata_size || ! p) {
  164.         av_log(avccontext, AV_LOG_ERROR, "vorbis extradata absentn");
  165.         return -1;
  166.     }
  167.     if(p[0] == 0 && p[1] == 30) {
  168.         for(i = 0; i < 3; i++){
  169.             hsizes[i] = *p++ << 8;
  170.             hsizes[i] += *p++;
  171.             headers[i] = p;
  172.             p += hsizes[i];
  173.         }
  174.     } else if(*p == 2) {
  175.         unsigned int offset = 1;
  176.         p++;
  177.         for(i=0; i<2; i++) {
  178.             hsizes[i] = 0;
  179.             while((*p == 0xFF) && (offset < avccontext->extradata_size)) {
  180.                 hsizes[i] += 0xFF;
  181.                 offset++;
  182.                 p++;
  183.             }
  184.             if(offset >= avccontext->extradata_size - 1) {
  185.                 av_log(avccontext, AV_LOG_ERROR,
  186.                        "vorbis header sizes damagedn");
  187.                 return -1;
  188.             }
  189.             hsizes[i] += *p;
  190.             offset++;
  191.             p++;
  192.         }
  193.         hsizes[2] = avccontext->extradata_size - hsizes[0]-hsizes[1]-offset;
  194. #if 0
  195.         av_log(avccontext, AV_LOG_DEBUG,
  196.                "vorbis header sizes: %d, %d, %d, / extradata_len is %d n",
  197.                hsizes[0], hsizes[1], hsizes[2], avccontext->extradata_size);
  198. #endif
  199.         headers[0] = extradata + offset;
  200.         headers[1] = extradata + offset + hsizes[0];
  201.         headers[2] = extradata + offset + hsizes[0] + hsizes[1];
  202.     } else {
  203.         av_log(avccontext, AV_LOG_ERROR,
  204.                "vorbis initial header len is wrong: %dn", *p);
  205.         return -1;
  206.     }
  207.     for(i=0; i<3; i++){
  208.         context->op.b_o_s= i==0;
  209.         context->op.bytes = hsizes[i];
  210.         context->op.packet = headers[i];
  211.         if(vorbis_synthesis_headerin(&context->vi, &context->vc, &context->op)<0){
  212.             av_log(avccontext, AV_LOG_ERROR, "%d. vorbis header damagedn", i+1);
  213.             return -1;
  214.         }
  215.     }
  216.     avccontext->channels = context->vi.channels;
  217.     avccontext->sample_rate = context->vi.rate;
  218.     avccontext->time_base= (AVRational){1, avccontext->sample_rate};
  219.     vorbis_synthesis_init(&context->vd, &context->vi);
  220.     vorbis_block_init(&context->vd, &context->vb); 
  221.     return 0 ;
  222. }
  223. static inline int conv(int samples, float **pcm, char *buf, int channels) {
  224.     int i, j, val ;
  225.     ogg_int16_t *ptr, *data = (ogg_int16_t*)buf ;
  226.     float *mono ;
  227.  
  228.     for(i = 0 ; i < channels ; i++){
  229. ptr = &data[i];
  230. mono = pcm[i] ;
  231. for(j = 0 ; j < samples ; j++) {
  232.     
  233.     val = mono[j] * 32767.f;
  234.     
  235.     if(val > 32767) val = 32767 ;
  236.     if(val < -32768) val = -32768 ;
  237.         
  238.     *ptr = val ;
  239.     ptr += channels;
  240. }
  241.     }
  242.     
  243.     return 0 ;
  244. }
  245.    
  246. static int oggvorbis_decode_frame(AVCodecContext *avccontext,
  247.                         void *data, int *data_size,
  248.                         uint8_t *buf, int buf_size)
  249. {
  250.     OggVorbisContext *context = avccontext->priv_data ;
  251.     float **pcm ;
  252.     ogg_packet *op= &context->op;    
  253.     int samples, total_samples, total_bytes,i;
  254.  
  255.     if(!buf_size){
  256.     //FIXME flush
  257.         return 0;
  258.     }
  259.     
  260.     op->packet = buf;
  261.     op->bytes  = buf_size;
  262. //    av_log(avccontext, AV_LOG_DEBUG, "%d %d %d %lld %lld %d %dn", op->bytes, op->b_o_s, op->e_o_s, op->granulepos, op->packetno, buf_size, context->vi.rate);
  263.     
  264. /*    for(i=0; i<op->bytes; i++)
  265.       av_log(avccontext, AV_LOG_DEBUG, "%02X ", op->packet[i]);
  266.     av_log(avccontext, AV_LOG_DEBUG, "n");*/
  267.     if(vorbis_synthesis(&context->vb, op) == 0)
  268. vorbis_synthesis_blockin(&context->vd, &context->vb) ;
  269.     
  270.     total_samples = 0 ;
  271.     total_bytes = 0 ;
  272.     while((samples = vorbis_synthesis_pcmout(&context->vd, &pcm)) > 0) {
  273. conv(samples, pcm, (char*)data + total_bytes, context->vi.channels) ;
  274. total_bytes += samples * 2 * context->vi.channels ;
  275. total_samples += samples ;
  276.         vorbis_synthesis_read(&context->vd, samples) ;
  277.     }
  278.     *data_size = total_bytes ;   
  279.     return buf_size ;
  280. }
  281. static int oggvorbis_decode_close(AVCodecContext *avccontext) {
  282.     OggVorbisContext *context = avccontext->priv_data ;
  283.    
  284.     vorbis_info_clear(&context->vi) ;
  285.     vorbis_comment_clear(&context->vc) ;
  286.     return 0 ;
  287. }
  288. AVCodec oggvorbis_decoder = {
  289.     "vorbis",
  290.     CODEC_TYPE_AUDIO,
  291.     CODEC_ID_VORBIS,
  292.     sizeof(OggVorbisContext),
  293.     oggvorbis_decode_init,
  294.     NULL,
  295.     oggvorbis_decode_close,
  296.     oggvorbis_decode_frame,
  297.     .capabilities= CODEC_CAP_DELAY,
  298. } ;