yading@11: /* yading@11: * copyright (c) Sebastien Bechet yading@11: * yading@11: * This file is part of FFmpeg. yading@11: * yading@11: * FFmpeg is free software; you can redistribute it and/or yading@11: * modify it under the terms of the GNU Lesser General Public yading@11: * License as published by the Free Software Foundation; either yading@11: * version 2.1 of the License, or (at your option) any later version. yading@11: * yading@11: * FFmpeg is distributed in the hope that it will be useful, yading@11: * but WITHOUT ANY WARRANTY; without even the implied warranty of yading@11: * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU yading@11: * Lesser General Public License for more details. yading@11: * yading@11: * You should have received a copy of the GNU Lesser General Public yading@11: * License along with FFmpeg; if not, write to the Free Software yading@11: * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA yading@11: */ yading@11: yading@11: #include yading@11: #include yading@11: #include yading@11: #include yading@11: yading@11: #define SCALEBITS 8 yading@11: #define ONE_HALF (1 << (SCALEBITS - 1)) yading@11: #define FIX(x) ((int) ((x) * (1L << SCALEBITS) + 0.5)) yading@11: yading@11: #define err_if(expr) do { \ yading@11: if (expr) { \ yading@11: fprintf(stderr, "%s\n", strerror(errno)); \ yading@11: exit(1); \ yading@11: } \ yading@11: } while (0) yading@11: yading@11: static void rgb24_to_yuv420p(unsigned char *lum, unsigned char *cb, yading@11: unsigned char *cr, unsigned char *src, yading@11: int width, int height) yading@11: { yading@11: int wrap, wrap3, x, y; yading@11: int r, g, b, r1, g1, b1; yading@11: unsigned char *p; yading@11: yading@11: wrap = width; yading@11: wrap3 = width * 3; yading@11: p = src; yading@11: for (y = 0; y < height; y += 2) { yading@11: for (x = 0; x < width; x += 2) { yading@11: r = p[0]; yading@11: g = p[1]; yading@11: b = p[2]; yading@11: r1 = r; yading@11: g1 = g; yading@11: b1 = b; yading@11: lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + yading@11: FIX(0.11400) * b + ONE_HALF) >> SCALEBITS; yading@11: r = p[3]; yading@11: g = p[4]; yading@11: b = p[5]; yading@11: r1 += r; yading@11: g1 += g; yading@11: b1 += b; yading@11: lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + yading@11: FIX(0.11400) * b + ONE_HALF) >> SCALEBITS; yading@11: p += wrap3; yading@11: lum += wrap; yading@11: yading@11: r = p[0]; yading@11: g = p[1]; yading@11: b = p[2]; yading@11: r1 += r; yading@11: g1 += g; yading@11: b1 += b; yading@11: lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + yading@11: FIX(0.11400) * b + ONE_HALF) >> SCALEBITS; yading@11: r = p[3]; yading@11: g = p[4]; yading@11: b = p[5]; yading@11: r1 += r; yading@11: g1 += g; yading@11: b1 += b; yading@11: lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + yading@11: FIX(0.11400) * b + ONE_HALF) >> SCALEBITS; yading@11: yading@11: cb[0] = ((- FIX(0.16874) * r1 - FIX(0.33126) * g1 + yading@11: FIX(0.50000) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128; yading@11: cr[0] = ((FIX(0.50000) * r1 - FIX(0.41869) * g1 - yading@11: FIX(0.08131) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128; yading@11: yading@11: cb++; yading@11: cr++; yading@11: p += -wrap3 + 2 * 3; yading@11: lum += -wrap + 2; yading@11: } yading@11: p += wrap3; yading@11: lum += wrap; yading@11: } yading@11: } yading@11: yading@11: /* cif format */ yading@11: #define DEFAULT_WIDTH 352 yading@11: #define DEFAULT_HEIGHT 288 yading@11: #define DEFAULT_NB_PICT 50 yading@11: yading@11: static void pgmyuv_save(const char *filename, int w, int h, yading@11: unsigned char *rgb_tab) yading@11: { yading@11: FILE *f; yading@11: int i, h2, w2; yading@11: unsigned char *cb, *cr; yading@11: unsigned char *lum_tab, *cb_tab, *cr_tab; yading@11: yading@11: lum_tab = malloc(w * h); yading@11: cb_tab = malloc(w * h / 4); yading@11: cr_tab = malloc(w * h / 4); yading@11: yading@11: rgb24_to_yuv420p(lum_tab, cb_tab, cr_tab, rgb_tab, w, h); yading@11: yading@11: if (filename) { yading@11: f = fopen(filename, "wb"); yading@11: fprintf(f, "P5\n%d %d\n%d\n", w, h * 3 / 2, 255); yading@11: } else { yading@11: f = stdout; yading@11: } yading@11: yading@11: err_if(fwrite(lum_tab, 1, w * h, f) != w * h); yading@11: h2 = h / 2; yading@11: w2 = w / 2; yading@11: cb = cb_tab; yading@11: cr = cr_tab; yading@11: yading@11: if (filename) { yading@11: for (i = 0; i < h2; i++) { yading@11: err_if(fwrite(cb, 1, w2, f) != w2); yading@11: err_if(fwrite(cr, 1, w2, f) != w2); yading@11: cb += w2; yading@11: cr += w2; yading@11: } yading@11: fclose(f); yading@11: } else { yading@11: for (i = 0; i < h2; i++) { yading@11: err_if(fwrite(cb, 1, w2, f) != w2); yading@11: cb += w2; yading@11: } yading@11: for (i = 0; i < h2; i++) { yading@11: err_if(fwrite(cr, 1, w2, f) != w2); yading@11: cr += w2; yading@11: } yading@11: } yading@11: yading@11: free(lum_tab); yading@11: free(cb_tab); yading@11: free(cr_tab); yading@11: } yading@11: yading@11: static unsigned char *rgb_tab; yading@11: static int width, height, wrap; yading@11: yading@11: static void put_pixel(int x, int y, int r, int g, int b) yading@11: { yading@11: unsigned char *p; yading@11: yading@11: if (x < 0 || x >= width || yading@11: y < 0 || y >= height) yading@11: return; yading@11: yading@11: p = rgb_tab + y * wrap + x * 3; yading@11: p[0] = r; yading@11: p[1] = g; yading@11: p[2] = b; yading@11: }