Cinelerra: hvirtual/quicktime/ffmpeg/libavcodec/roqvideo.c Source File

00001 /*
00002  * Copyright (C) 2003 the ffmpeg project
00003  *
00004  * This library is free software; you can redistribute it and/or
00005  * modify it under the terms of the GNU Lesser General Public
00006  * License as published by the Free Software Foundation; either
00007  * version 2 of the License, or (at your option) any later version.
00008  *
00009  * This library is distributed in the hope that it will be useful,
00010  * but WITHOUT ANY WARRANTY; without even the implied warranty of
00011  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
00012  * Lesser General Public License for more details.
00013  *
00014  * You should have received a copy of the GNU Lesser General Public
00015  * License along with this library; if not, write to the Free Software
00016  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
00017  *
00018  */
00019 
00027 #include <stdio.h>
00028 #include <stdlib.h>
00029 #include <string.h>
00030 #include <unistd.h>
00031 
00032 #include "common.h"
00033 #include "avcodec.h"
00034 #include "dsputil.h"
00035 
00036 typedef struct {
00037   unsigned char y0, y1, y2, y3, u, v;
00038 } roq_cell;
00039 
00040 typedef struct {
00041   int idx[4];
00042 } roq_qcell;
00043 
00044 static int uiclip[1024], *uiclp;  /* clipping table */
00045 #define avg2(a,b) uiclp[(((int)(a)+(int)(b)+1)>>1)]
00046 #define avg4(a,b,c,d) uiclp[(((int)(a)+(int)(b)+(int)(c)+(int)(d)+2)>>2)]
00047 
00048 typedef struct RoqContext {
00049 
00050     AVCodecContext *avctx;
00051     DSPContext dsp;
00052     AVFrame last_frame;
00053     AVFrame current_frame;
00054     int first_frame;
00055     int y_stride;
00056     int c_stride;
00057 
00058     roq_cell cells[256];
00059     roq_qcell qcells[256];
00060 
00061     unsigned char *buf;
00062     int size;
00063 
00064 } RoqContext;
00065 
00066 #define RoQ_INFO              0x1001
00067 #define RoQ_QUAD_CODEBOOK     0x1002
00068 #define RoQ_QUAD_VQ           0x1011
00069 #define RoQ_SOUND_MONO        0x1020
00070 #define RoQ_SOUND_STEREO      0x1021
00071 
00072 #define RoQ_ID_MOT              0x00
00073 #define RoQ_ID_FCC              0x01
00074 #define RoQ_ID_SLD              0x02
00075 #define RoQ_ID_CCC              0x03
00076 
00077 #define get_byte(in_buffer) *(in_buffer++)
00078 #define get_word(in_buffer) ((unsigned short)(in_buffer += 2, \
00079   (in_buffer[-1] << 8 | in_buffer[-2])))
00080 #define get_long(in_buffer) ((unsigned long)(in_buffer += 4, \
00081   (in_buffer[-1] << 24 | in_buffer[-2] << 16 | in_buffer[-3] << 8 | in_buffer[-4])))
00082 
00083 
00084 static void apply_vector_2x2(RoqContext *ri, int x, int y, roq_cell *cell)
00085 {
00086     unsigned char *yptr;
00087 
00088     yptr = ri->current_frame.data[0] + (y * ri->y_stride) + x;
00089     *yptr++ = cell->y0;
00090     *yptr++ = cell->y1;
00091     yptr += (ri->y_stride - 2);
00092     *yptr++ = cell->y2;
00093     *yptr++ = cell->y3;
00094     ri->current_frame.data[1][(y/2) * (ri->c_stride) + x/2] = cell->u;
00095     ri->current_frame.data[2][(y/2) * (ri->c_stride) + x/2] = cell->v;
00096 }
00097 
00098 static void apply_vector_4x4(RoqContext *ri, int x, int y, roq_cell *cell)
00099 {
00100     unsigned long row_inc, c_row_inc;
00101     register unsigned char y0, y1, u, v;
00102     unsigned char *yptr, *uptr, *vptr;
00103 
00104     yptr = ri->current_frame.data[0] + (y * ri->y_stride) + x;
00105     uptr = ri->current_frame.data[1] + (y/2) * (ri->c_stride) + x/2;
00106     vptr = ri->current_frame.data[2] + (y/2) * (ri->c_stride) + x/2;
00107 
00108     row_inc = ri->y_stride - 4;
00109     c_row_inc = (ri->c_stride) - 2;
00110     *yptr++ = y0 = cell->y0; *uptr++ = u = cell->u; *vptr++ = v = cell->v;
00111     *yptr++ = y0;
00112     *yptr++ = y1 = cell->y1; *uptr++ = u; *vptr++ = v;
00113     *yptr++ = y1;
00114 
00115     yptr += row_inc;
00116 
00117     *yptr++ = y0;
00118     *yptr++ = y0;
00119     *yptr++ = y1;
00120     *yptr++ = y1;
00121 
00122     yptr += row_inc; uptr += c_row_inc; vptr += c_row_inc;
00123 
00124     *yptr++ = y0 = cell->y2; *uptr++ = u; *vptr++ = v;
00125     *yptr++ = y0;
00126     *yptr++ = y1 = cell->y3; *uptr++ = u; *vptr++ = v;
00127     *yptr++ = y1;
00128 
00129     yptr += row_inc;
00130 
00131     *yptr++ = y0;
00132     *yptr++ = y0;
00133     *yptr++ = y1;
00134     *yptr++ = y1;
00135 }
00136 
00137 static void apply_motion_4x4(RoqContext *ri, int x, int y, unsigned char mv,
00138     signed char mean_x, signed char mean_y)
00139 {
00140     int i, hw, mx, my;
00141     unsigned char *pa, *pb;
00142 
00143     mx = x + 8 - (mv >> 4) - mean_x;
00144     my = y + 8 - (mv & 0xf) - mean_y;
00145 
00146     pa = ri->current_frame.data[0] + (y * ri->y_stride) + x;
00147     pb = ri->last_frame.data[0] + (my * ri->y_stride) + mx;
00148     for(i = 0; i < 4; i++) {
00149         pa[0] = pb[0];
00150         pa[1] = pb[1];
00151         pa[2] = pb[2];
00152         pa[3] = pb[3];
00153         pa += ri->y_stride;
00154         pb += ri->y_stride;
00155     }
00156 
00157 #if 0
00158     pa = ri->current_frame.data[1] + (y/2) * (ri->c_stride) + x/2;
00159     pb = ri->last_frame.data[1] + (my/2) * (ri->c_stride) + (mx + 1)/2;
00160     for(i = 0; i < 2; i++) {
00161         pa[0] = pb[0];
00162         pa[1] = pb[1];
00163         pa += ri->c_stride;
00164         pb += ri->c_stride;
00165     }
00166 
00167     pa = ri->current_frame.data[2] + (y/2) * (ri->c_stride) + x/2;
00168     pb = ri->last_frame.data[2] + (my/2) * (ri->c_stride) + (mx + 1)/2;
00169     for(i = 0; i < 2; i++) {
00170         pa[0] = pb[0];
00171         pa[1] = pb[1];
00172         pa += ri->c_stride;
00173         pb += ri->c_stride;
00174     }
00175 #else
00176     hw = ri->y_stride/2;
00177     pa = ri->current_frame.data[1] + (y * ri->y_stride)/4 + x/2;
00178     pb = ri->last_frame.data[1] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
00179 
00180     for(i = 0; i < 2; i++) {
00181         switch(((my & 0x01) << 1) | (mx & 0x01)) {
00182 
00183         case 0:
00184             pa[0] = pb[0];
00185             pa[1] = pb[1];
00186             pa[hw] = pb[hw];
00187             pa[hw+1] = pb[hw+1];
00188             break;
00189 
00190         case 1:
00191             pa[0] = avg2(pb[0], pb[1]);
00192             pa[1] = avg2(pb[1], pb[2]);
00193             pa[hw] = avg2(pb[hw], pb[hw+1]);
00194             pa[hw+1] = avg2(pb[hw+1], pb[hw+2]);
00195             break;
00196 
00197         case 2:
00198             pa[0] = avg2(pb[0], pb[hw]);
00199             pa[1] = avg2(pb[1], pb[hw+1]);
00200             pa[hw] = avg2(pb[hw], pb[hw*2]);
00201             pa[hw+1] = avg2(pb[hw+1], pb[(hw*2)+1]);
00202             break;
00203 
00204         case 3:
00205             pa[0] = avg4(pb[0], pb[1], pb[hw], pb[hw+1]);
00206             pa[1] = avg4(pb[1], pb[2], pb[hw+1], pb[hw+2]);
00207             pa[hw] = avg4(pb[hw], pb[hw+1], pb[hw*2], pb[(hw*2)+1]);
00208             pa[hw+1] = avg4(pb[hw+1], pb[hw+2], pb[(hw*2)+1], pb[(hw*2)+1]);
00209             break;
00210         }
00211 
00212         pa = ri->current_frame.data[2] + (y * ri->y_stride)/4 + x/2;
00213         pb = ri->last_frame.data[2] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
00214     }
00215 #endif
00216 }
00217 
00218 static void apply_motion_8x8(RoqContext *ri, int x, int y,
00219     unsigned char mv, signed char mean_x, signed char mean_y)
00220 {
00221     int mx, my, i, j, hw;
00222     unsigned char *pa, *pb;
00223 
00224     mx = x + 8 - (mv >> 4) - mean_x;
00225     my = y + 8 - (mv & 0xf) - mean_y;
00226 
00227     pa = ri->current_frame.data[0] + (y * ri->y_stride) + x;
00228     pb = ri->last_frame.data[0] + (my * ri->y_stride) + mx;
00229     for(i = 0; i < 8; i++) {
00230         pa[0] = pb[0];
00231         pa[1] = pb[1];
00232         pa[2] = pb[2];
00233         pa[3] = pb[3];
00234         pa[4] = pb[4];
00235         pa[5] = pb[5];
00236         pa[6] = pb[6];
00237         pa[7] = pb[7];
00238         pa += ri->y_stride;
00239         pb += ri->y_stride;
00240     }
00241 
00242 #if 0
00243     pa = ri->current_frame.data[1] + (y/2) * (ri->c_stride) + x/2;
00244     pb = ri->last_frame.data[1] + (my/2) * (ri->c_stride) + (mx + 1)/2;
00245     for(i = 0; i < 4; i++) {
00246         pa[0] = pb[0];
00247         pa[1] = pb[1];
00248         pa[2] = pb[2];
00249         pa[3] = pb[3];
00250         pa += ri->c_stride;
00251         pb += ri->c_stride;
00252     }
00253 
00254     pa = ri->current_frame.data[2] + (y/2) * (ri->c_stride) + x/2;
00255     pb = ri->last_frame.data[2] + (my/2) * (ri->c_stride) + (mx + 1)/2;
00256     for(i = 0; i < 4; i++) {
00257         pa[0] = pb[0];
00258         pa[1] = pb[1];
00259         pa[2] = pb[2];
00260         pa[3] = pb[3];
00261         pa += ri->c_stride;
00262         pb += ri->c_stride;
00263     }
00264 #else
00265     hw = ri->c_stride;
00266     pa = ri->current_frame.data[1] + (y * ri->y_stride)/4 + x/2;
00267     pb = ri->last_frame.data[1] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
00268     for(j = 0; j < 2; j++) {
00269         for(i = 0; i < 4; i++) {
00270             switch(((my & 0x01) << 1) | (mx & 0x01)) {
00271 
00272             case 0:
00273                 pa[0] = pb[0];
00274                 pa[1] = pb[1];
00275                 pa[2] = pb[2];
00276                 pa[3] = pb[3];
00277                 break;
00278 
00279             case 1:
00280                 pa[0] = avg2(pb[0], pb[1]);
00281                 pa[1] = avg2(pb[1], pb[2]);
00282                 pa[2] = avg2(pb[2], pb[3]);
00283                 pa[3] = avg2(pb[3], pb[4]);
00284                 break;
00285  
00286             case 2:
00287                 pa[0] = avg2(pb[0], pb[hw]);
00288                 pa[1] = avg2(pb[1], pb[hw+1]);
00289                 pa[2] = avg2(pb[2], pb[hw+2]);
00290                 pa[3] = avg2(pb[3], pb[hw+3]);
00291                 break;
00292 
00293             case 3:
00294                 pa[0] = avg4(pb[0], pb[1], pb[hw], pb[hw+1]);
00295                 pa[1] = avg4(pb[1], pb[2], pb[hw+1], pb[hw+2]);
00296                 pa[2] = avg4(pb[2], pb[3], pb[hw+2], pb[hw+3]);
00297                 pa[3] = avg4(pb[3], pb[4], pb[hw+3], pb[hw+4]);
00298                 break;
00299             }
00300             pa += ri->c_stride;
00301             pb += ri->c_stride;
00302         }
00303 
00304         pa = ri->current_frame.data[2] + (y * ri->y_stride)/4 + x/2;
00305         pb = ri->last_frame.data[2] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
00306     }
00307 #endif
00308 }
00309 
00310 static void roqvideo_decode_frame(RoqContext *ri)
00311 {
00312     unsigned int chunk_id = 0, chunk_arg = 0;
00313     unsigned long chunk_size = 0;
00314     int i, j, k, nv1, nv2, vqflg = 0, vqflg_pos = -1;
00315     int vqid, bpos, xpos, ypos, xp, yp, x, y;
00316     int frame_stats[2][4] = {{0},{0}};
00317     roq_qcell *qcell;
00318     unsigned char *buf = ri->buf;
00319     unsigned char *buf_end = ri->buf + ri->size;
00320 
00321     while (buf < buf_end) {
00322         chunk_id = get_word(buf);
00323         chunk_size = get_long(buf);
00324         chunk_arg = get_word(buf);
00325 
00326         if(chunk_id == RoQ_QUAD_VQ)
00327             break;
00328         if(chunk_id == RoQ_QUAD_CODEBOOK) {
00329             if((nv1 = chunk_arg >> 8) == 0)
00330                 nv1 = 256;
00331             if((nv2 = chunk_arg & 0xff) == 0 && nv1 * 6 < chunk_size)
00332                 nv2 = 256;
00333             for(i = 0; i < nv1; i++) {
00334                 ri->cells[i].y0 = get_byte(buf);
00335                 ri->cells[i].y1 = get_byte(buf);
00336                 ri->cells[i].y2 = get_byte(buf);
00337                 ri->cells[i].y3 = get_byte(buf);
00338                 ri->cells[i].u = get_byte(buf);
00339                 ri->cells[i].v = get_byte(buf);
00340             }
00341             for(i = 0; i < nv2; i++)
00342                 for(j = 0; j < 4; j++)
00343                     ri->qcells[i].idx[j] = get_byte(buf);
00344         }
00345     }
00346 
00347     bpos = xpos = ypos = 0;
00348     while(bpos < chunk_size) {
00349         for (yp = ypos; yp < ypos + 16; yp += 8)
00350             for (xp = xpos; xp < xpos + 16; xp += 8) {
00351                 if (vqflg_pos < 0) {
00352                     vqflg = buf[bpos++]; vqflg |= (buf[bpos++] << 8);
00353                     vqflg_pos = 7;
00354                 }
00355                 vqid = (vqflg >> (vqflg_pos * 2)) & 0x3;
00356                 frame_stats[0][vqid]++;
00357                 vqflg_pos--;
00358 
00359                 switch(vqid) {
00360                 case RoQ_ID_MOT:
00361                     apply_motion_8x8(ri, xp, yp, 0, 8, 8);
00362                     break;
00363                 case RoQ_ID_FCC:
00364                     apply_motion_8x8(ri, xp, yp, buf[bpos++], chunk_arg >> 8,
00365                         chunk_arg & 0xff);
00366                     break;
00367                 case RoQ_ID_SLD:
00368                     qcell = ri->qcells + buf[bpos++];
00369                     apply_vector_4x4(ri, xp, yp, ri->cells + qcell->idx[0]);
00370                     apply_vector_4x4(ri, xp+4, yp, ri->cells + qcell->idx[1]);
00371                     apply_vector_4x4(ri, xp, yp+4, ri->cells + qcell->idx[2]);
00372                     apply_vector_4x4(ri, xp+4, yp+4, ri->cells + qcell->idx[3]);
00373                     break;
00374                 case RoQ_ID_CCC:
00375                     for (k = 0; k < 4; k++) {
00376                         x = xp; y = yp;
00377                         if(k & 0x01) x += 4;
00378                         if(k & 0x02) y += 4;
00379 
00380                         if (vqflg_pos < 0) {
00381                             vqflg = buf[bpos++];
00382                             vqflg |= (buf[bpos++] << 8);
00383                             vqflg_pos = 7;
00384                         }
00385                         vqid = (vqflg >> (vqflg_pos * 2)) & 0x3;
00386                         frame_stats[1][vqid]++;
00387                         vqflg_pos--;
00388                         switch(vqid) {
00389                         case RoQ_ID_MOT:
00390                             apply_motion_4x4(ri, x, y, 0, 8, 8);
00391                             break;
00392                         case RoQ_ID_FCC:
00393                             apply_motion_4x4(ri, x, y, buf[bpos++], 
00394                                 chunk_arg >> 8, chunk_arg & 0xff);
00395                             break;
00396                         case RoQ_ID_SLD:
00397                             qcell = ri->qcells + buf[bpos++];
00398                             apply_vector_2x2(ri, x, y, ri->cells + qcell->idx[0]);
00399                             apply_vector_2x2(ri, x+2, y, ri->cells + qcell->idx[1]);
00400                             apply_vector_2x2(ri, x, y+2, ri->cells + qcell->idx[2]);
00401                             apply_vector_2x2(ri, x+2, y+2, ri->cells + qcell->idx[3]);
00402                             break;
00403                         case RoQ_ID_CCC:
00404                             apply_vector_2x2(ri, x, y, ri->cells + buf[bpos]);
00405                             apply_vector_2x2(ri, x+2, y, ri->cells + buf[bpos+1]);
00406                             apply_vector_2x2(ri, x, y+2, ri->cells + buf[bpos+2]);
00407                             apply_vector_2x2(ri, x+2, y+2, ri->cells + buf[bpos+3]);
00408                             bpos += 4;
00409                             break;
00410                         }
00411                     }
00412                     break;
00413                 default:
00414                     av_log(ri->avctx, AV_LOG_ERROR, "Unknown vq code: %d\n", vqid);
00415             }
00416         }
00417 
00418         xpos += 16;
00419         if (xpos >= ri->avctx->width) {
00420             xpos -= ri->avctx->width;
00421             ypos += 16;
00422         }
00423         if(ypos >= ri->avctx->height)
00424             break;
00425     }
00426 }
00427 
00428 
00429 static int roq_decode_init(AVCodecContext *avctx)
00430 {
00431     RoqContext *s = avctx->priv_data;
00432     int i;
00433 
00434     s->avctx = avctx;
00435     s->first_frame = 1;
00436     avctx->pix_fmt = PIX_FMT_YUV420P;
00437     avctx->has_b_frames = 0;
00438     dsputil_init(&s->dsp, avctx);
00439 
00440     uiclp = uiclip+512;
00441     for(i = -512; i < 512; i++)
00442         uiclp[i] = (i < 0 ? 0 : (i > 255 ? 255 : i));
00443 
00444     return 0;
00445 }
00446 
00447 static int roq_decode_frame(AVCodecContext *avctx,
00448                             void *data, int *data_size,
00449                             uint8_t *buf, int buf_size)
00450 {
00451     RoqContext *s = avctx->priv_data;
00452 
00453     if (avctx->get_buffer(avctx, &s->current_frame)) {
00454         av_log(avctx, AV_LOG_ERROR, "  RoQ: get_buffer() failed\n");
00455         return -1;
00456     }
00457     s->y_stride = s->current_frame.linesize[0];
00458     s->c_stride = s->current_frame.linesize[1];
00459 
00460     s->buf = buf;
00461     s->size = buf_size;
00462     roqvideo_decode_frame(s);
00463 
00464     /* release the last frame if it is allocated */
00465     if (s->first_frame)
00466         s->first_frame = 0;
00467     else
00468         avctx->release_buffer(avctx, &s->last_frame);
00469 
00470     /* shuffle frames */
00471     s->last_frame = s->current_frame;
00472 
00473     *data_size = sizeof(AVFrame);
00474     *(AVFrame*)data = s->current_frame;
00475 
00476     return buf_size;
00477 }
00478 
00479 static int roq_decode_end(AVCodecContext *avctx)
00480 {
00481     RoqContext *s = avctx->priv_data;
00482 
00483     /* release the last frame */
00484     avctx->release_buffer(avctx, &s->last_frame);
00485 
00486     return 0;
00487 }
00488 
00489 AVCodec roq_decoder = {
00490     "roqvideo",
00491     CODEC_TYPE_VIDEO,
00492     CODEC_ID_ROQ,
00493     sizeof(RoqContext),
00494     roq_decode_init,
00495     NULL,
00496     roq_decode_end,
00497     roq_decode_frame,
00498     CODEC_CAP_DR1,
00499 };