-#define SCALEBITS 8
-#define ONE_HALF (1 << (SCALEBITS - 1))
-#define FIX(x) ((int) ((x) * (1L<<SCALEBITS) + 0.5))
-typedef unsigned char uint8_t;
-
-static void rgb24_to_yuv420p(uint8_t *lum, uint8_t *cb, uint8_t *cr,
- uint8_t *src, int width, int height)
-{
- int wrap, wrap3, x, y;
- int r, g, b, r1, g1, b1;
- uint8_t *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
-#define DEFAULT_NB_PICT 50 /* 2 seconds */
-
-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,"wb");
- 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;
-}