rotozoom.c 6.41 KB
Newer Older
1 2 3 4 5 6 7
/*
 * Generates a synthetic YUV video sequence suitable for codec testing.
 * GPLv2
 * rotozoom.c -> s.bechet@av7.net
 */
#include <stdlib.h>
#include <stdio.h>
8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
#include <inttypes.h>

#define FIXP (1<<16)
#define MY_PI 205887 //(M_PI*FIX)

static int64_t int_pow(int64_t a, int p){
    int64_t v= FIXP;

    for(; p; p--){
        v*= a;
        v/= FIXP;
    }

    return v;
}

static int64_t int_sin(int64_t a){
    if(a<0) a= MY_PI-a; // 0..inf
    a %= 2*MY_PI;       // 0..2PI

    if(a>=MY_PI*3/2) a -= 2*MY_PI;  // -PI/2 .. 3PI/2
    if(a>=MY_PI/2  ) a = MY_PI - a; // -PI/2 ..  PI/2
   
    return a - int_pow(a, 3)/6 + int_pow(a, 5)/120 - int_pow(a, 7)/5040;
}
33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104

#define SCALEBITS 8
#define ONE_HALF  (1 << (SCALEBITS - 1))
#define FIX(x)		((int) ((x) * (1L<<SCALEBITS) + 0.5))
typedef unsigned char UINT8;

static void rgb24_to_yuv420p(UINT8 *lum, UINT8 *cb, UINT8 *cr,
                              UINT8 *src, int width, int height)
{
    int wrap, wrap3, x, y;
    int r, g, b, r1, g1, b1;
    UINT8 *p;

    wrap = width;
    wrap3 = width * 3;
    p = src;
    for(y=0;y<height;y+=2) {
        for(x=0;x<width;x+=2) {
            r = p[0];
            g = p[1];
            b = p[2];
            r1 = r;
            g1 = g;
            b1 = b;
            lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + 
                      FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
            r = p[3];
            g = p[4];
            b = p[5];
            r1 += r;
            g1 += g;
            b1 += b;
            lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + 
                      FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
            p += wrap3;
            lum += wrap;

            r = p[0];
            g = p[1];
            b = p[2];
            r1 += r;
            g1 += g;
            b1 += b;
            lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + 
                      FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
            r = p[3];
            g = p[4];
            b = p[5];
            r1 += r;
            g1 += g;
            b1 += b;
            lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + 
                      FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
            
            cb[0] = ((- FIX(0.16874) * r1 - FIX(0.33126) * g1 + 
                      FIX(0.50000) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;
            cr[0] = ((FIX(0.50000) * r1 - FIX(0.41869) * g1 - 
                     FIX(0.08131) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;

            cb++;
            cr++;
            p += -wrap3 + 2 * 3;
            lum += -wrap + 2;
        }
        p += wrap3;
        lum += wrap;
    }
}

/* cif format */
#define DEFAULT_WIDTH   352
#define DEFAULT_HEIGHT  288
105
#define DEFAULT_NB_PICT 50
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165

void pgmyuv_save(const char *filename, int w, int h,
                 unsigned char *rgb_tab)
{
    FILE *f;
    int i, h2, w2;
    unsigned char *cb, *cr;
    unsigned char *lum_tab, *cb_tab, *cr_tab;

    lum_tab = malloc(w * h);
    cb_tab = malloc((w * h) / 4);
    cr_tab = malloc((w * h) / 4);

    rgb24_to_yuv420p(lum_tab, cb_tab, cr_tab, rgb_tab, w, h);

    f = fopen(filename,"w");
    fprintf(f, "P5\n%d %d\n%d\n", w, (h * 3) / 2, 255);
    fwrite(lum_tab, 1, w * h, f);
    h2 = h / 2;
    w2 = w / 2;
    cb = cb_tab;
    cr = cr_tab;
    for(i=0;i<h2;i++) {
        fwrite(cb, 1, w2, f);
        fwrite(cr, 1, w2, f);
        cb += w2;
        cr += w2;
    }
    fclose(f);

    free(lum_tab);
    free(cb_tab);
    free(cr_tab);
}

unsigned char *rgb_tab;
int width, height, wrap;

void put_pixel(int x, int y, int r, int g, int b)
{
    unsigned char *p;

    if (x < 0 || x >= width ||
        y < 0 || y >= height)
        return;

    p = rgb_tab + y * wrap + x * 3;
    p[0] = r;
    p[1] = g;
    p[2] = b;
}

unsigned char tab_r[256*256];
unsigned char tab_g[256*256];
unsigned char tab_b[256*256];

int teta = 0;
int h_cos [360];
int h_sin [360];

166 167 168 169 170 171 172 173 174 175 176 177 178 179 180
static int ipol(uint8_t *src, int x, int y){
    int int_x= x>>16;
    int int_y= y>>16;
    int frac_x= x&0xFFFF;
    int frac_y= y&0xFFFF;
    int s00= src[ ( int_x   &255) + 256*( int_y   &255) ];
    int s01= src[ ((int_x+1)&255) + 256*( int_y   &255) ];
    int s10= src[ ( int_x   &255) + 256*((int_y+1)&255) ];
    int s11= src[ ((int_x+1)&255) + 256*((int_y+1)&255) ];
    int s0= (((1<<16) - frac_x)*s00 + frac_x*s01)>>8;
    int s1= (((1<<16) - frac_x)*s10 + frac_x*s11)>>8;
    
    return (((1<<16) - frac_y)*s0 + frac_y*s1)>>24;
}

181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199
void gen_image(int num, int w, int h)
{
  const int c = h_cos [teta];
  const int s = h_sin [teta];
  
  const int xi = -(w/2) * c;
  const int yi =  (w/2) * s;
  
  const int xj = -(h/2) * s;
  const int yj = -(h/2) * c;
  int i,j;
  
  int x,y;
  int xprime = xj;
  int yprime = yj;


  for (j=0;j<h;j++) {

200
    x = xprime + xi + FIXP*w/2;
201 202
    xprime += s;

203
    y = yprime + yi + FIXP*h/2;
204 205 206 207 208
    yprime += c;
      
    for ( i=0 ; i<w ; i++ ) {
      x += c;
      y -= s;
209 210 211
#if 1
      put_pixel(i, j, ipol(tab_r, x, y), ipol(tab_g, x, y), ipol(tab_b, x, y));
#else
212 213 214 215 216
      {
          unsigned dep;
          dep = ((x>>16)&255) + (((y>>16)&255)<<8);
          put_pixel(i, j, tab_r[dep], tab_g[dep], tab_b[dep]);
      }
217
#endif
218 219 220 221 222
    }
  }
  teta = (teta+1) % 360;
}

223 224 225
#define W 256
#define H 256

226
void init_demo(const char *filename) {
227
  int i,j;
228 229 230
  int h;
  int radian;
  char line[3 * W];
231 232 233

  FILE *fichier;

234 235 236 237 238 239
  fichier = fopen(filename,"r");
  if (!fichier) {
      perror(filename);
      exit(1);
  }
      
240
  fread(line, 1, 15, fichier);
241 242 243 244 245 246
  for (i=0;i<H;i++) {
    fread(line,1,3*W,fichier);
    for (j=0;j<W;j++) {
	  tab_r[W*i+j] = line[3*j    ];
	  tab_g[W*i+j] = line[3*j + 1];
	  tab_b[W*i+j] = line[3*j + 2];
247 248 249 250 251 252
    }
  }
  fclose(fichier);

  /* tables sin/cos */
  for (i=0;i<360;i++) {
253 254 255 256
    radian = 2*i*MY_PI/360;
    h = 2*FIXP + int_sin (radian);
    h_cos[i] = ( h * int_sin (radian + MY_PI/2) )/2/FIXP;
    h_sin[i] = ( h * int_sin (radian          ) )/2/FIXP;
257 258 259 260 261 262 263 264
  }
}

int main(int argc, char **argv)
{
    int w, h, i;
    char buf[1024];

265 266
    if (argc != 3) {
        printf("usage: %s directory/ image.pnm\n"
267 268 269 270 271 272 273 274 275 276 277 278
               "generate a test video stream\n", argv[0]);
        exit(1);
    }

    w = DEFAULT_WIDTH;
    h = DEFAULT_HEIGHT;

    rgb_tab = malloc(w * h * 3);
    wrap = w * 3;
    width = w;
    height = h;

279
    init_demo(argv[2]);
280 281

    for(i=0;i<DEFAULT_NB_PICT;i++) {
282
        snprintf(buf, sizeof(buf), "%s%d.pgm", argv[1], i);
283 284 285 286 287 288 289
        gen_image(i, w, h);
        pgmyuv_save(buf, w, h, rgb_tab);
    }
    
    free(rgb_tab);
    return 0;
}