PeerStreamer

/*

 * Copyright (C) 2003 Michael Niedermayer <michaelni@gmx.at>

 *

 * This file is part of Libav.

 *

 * Libav is free software; you can redistribute it and/or

 * modify it under the terms of the GNU Lesser General Public

 * License as published by the Free Software Foundation; either

 * version 2.1 of the License, or (at your option) any later version.

 *

 * Libav is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

 * Lesser General Public License for more details.

 *

 * You should have received a copy of the GNU Lesser General Public

 * License along with Libav; if not, write to the Free Software

 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA

 */

#include <stdio.h>

#include <stdlib.h>

#include <string.h>

#include <inttypes.h>

#include <stdarg.h>

#undef HAVE_AV_CONFIG_H

#include "libavutil/imgutils.h"

#include "libavutil/mem.h"

#include "libavutil/avutil.h"

#include "libavutil/crc.h"

#include "libavutil/pixdesc.h"

#include "libavutil/lfg.h"

#include "swscale.h"

/* HACK Duplicated from swscale_internal.h.

 * Should be removed when a cleaner pixel format system exists. */

#define isGray(x)       (           \

           (x)==PIX_FMT_GRAY8       \

        || (x)==PIX_FMT_GRAY16BE    \

        || (x)==PIX_FMT_GRAY16LE    \

    )

#define hasChroma(x)   (!(          \

            isGray(x)               \

        || (x)==PIX_FMT_MONOBLACK   \

        || (x)==PIX_FMT_MONOWHITE   \

    ))

#define isALPHA(x)      (           \

           (x)==PIX_FMT_BGR32       \

        || (x)==PIX_FMT_BGR32_1     \

        || (x)==PIX_FMT_RGB32       \

        || (x)==PIX_FMT_RGB32_1     \

        || (x)==PIX_FMT_YUVA420P    \

    )

static uint64_t getSSD(uint8_t *src1, uint8_t *src2, int stride1, int stride2, int w, int h)

{

    int x,y;

    uint64_t ssd=0;

//printf("%d %d\n", w, h);

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

        for (x=0; x<w; x++) {

            int d= src1[x + y*stride1] - src2[x + y*stride2];

            ssd+= d*d;

//printf("%d", abs(src1[x + y*stride1] - src2[x + y*stride2])/26 );

        }

//printf("\n");

    }

    return ssd;

}

struct Results {

    uint64_t ssdY;

    uint64_t ssdU;

    uint64_t ssdV;

    uint64_t ssdA;

    uint32_t crc;

};

// test by ref -> src -> dst -> out & compare out against ref

// ref & out are YV12

static int doTest(uint8_t *ref[4], int refStride[4], int w, int h,

                  enum PixelFormat srcFormat, enum PixelFormat dstFormat,

                  int srcW, int srcH, int dstW, int dstH, int flags,

                  struct Results *r)

{

    static enum PixelFormat cur_srcFormat;

    static int cur_srcW, cur_srcH;

    static uint8_t *src[4];

    static int srcStride[4];

    uint8_t *dst[4] = {0};

    uint8_t *out[4] = {0};

    int dstStride[4];

    int i;

    uint64_t ssdY, ssdU=0, ssdV=0, ssdA=0;

    struct SwsContext *dstContext = NULL, *outContext = NULL;

    uint32_t crc = 0;

    int res = 0;

    if (cur_srcFormat != srcFormat || cur_srcW != srcW || cur_srcH != srcH) {

        struct SwsContext *srcContext = NULL;

        int p;

        for (p = 0; p < 4; p++)

            av_freep(&src[p]);

        av_image_fill_linesizes(srcStride, srcFormat, srcW);

        for (p = 0; p < 4; p++) {

            if (srcStride[p])

                src[p] = av_mallocz(srcStride[p]*srcH+16);

            if (srcStride[p] && !src[p]) {

                perror("Malloc");

                res = -1;

                goto end;

            }

        }

        srcContext = sws_getContext(w, h, PIX_FMT_YUVA420P, srcW, srcH,

                                    srcFormat, SWS_BILINEAR, NULL, NULL, NULL);

        if (!srcContext) {

            fprintf(stderr, "Failed to get %s ---> %s\n",

                    av_pix_fmt_descriptors[PIX_FMT_YUVA420P].name,

                    av_pix_fmt_descriptors[srcFormat].name);

            res = -1;

            goto end;

        }

        sws_scale(srcContext, ref, refStride, 0, h, src, srcStride);

        sws_freeContext(srcContext);

        cur_srcFormat = srcFormat;

        cur_srcW = srcW;

        cur_srcH = srcH;

    }

    av_image_fill_linesizes(dstStride, dstFormat, dstW);

    for (i=0; i<4; i++) {

        /* Image buffers passed into libswscale can be allocated any way you

         * prefer, as long as they're aligned enough for the architecture, and

         * they're freed appropriately (such as using av_free for buffers

         * allocated with av_malloc). */

        /* An extra 16 bytes is being allocated because some scalers may write

         * out of bounds. */

        if (dstStride[i])

            dst[i]= av_mallocz(dstStride[i]*dstH+16);

        if (dstStride[i] && !dst[i]) {

            perror("Malloc");

            res = -1;

            goto end;

        }

    }

    dstContext= sws_getContext(srcW, srcH, srcFormat, dstW, dstH, dstFormat, flags, NULL, NULL, NULL);

    if (!dstContext) {

        fprintf(stderr, "Failed to get %s ---> %s\n",

                av_pix_fmt_descriptors[srcFormat].name,

                av_pix_fmt_descriptors[dstFormat].name);

        res = -1;

        goto end;

    }

//    printf("test %X %X %X -> %X %X %X\n", (int)ref[0], (int)ref[1], (int)ref[2],

//        (int)src[0], (int)src[1], (int)src[2]);

    printf(" %s %dx%d -> %s %3dx%3d flags=%2d",

           av_pix_fmt_descriptors[srcFormat].name, srcW, srcH,

           av_pix_fmt_descriptors[dstFormat].name, dstW, dstH,

           flags);

    fflush(stdout);

    sws_scale(dstContext, src, srcStride, 0, srcH, dst, dstStride);

    for (i = 0; i < 4 && dstStride[i]; i++) {

        crc = av_crc(av_crc_get_table(AV_CRC_32_IEEE), crc, dst[i], dstStride[i] * dstH);

    }

    if (r && crc == r->crc) {

        ssdY = r->ssdY;

        ssdU = r->ssdU;

        ssdV = r->ssdV;

        ssdA = r->ssdA;

    } else {

        for (i=0; i<4; i++) {

            if (refStride[i])

                out[i]= av_mallocz(refStride[i]*h);

            if (refStride[i] && !out[i]) {

                perror("Malloc");

                res = -1;

                goto end;

            }

        }

        outContext= sws_getContext(dstW, dstH, dstFormat, w, h, PIX_FMT_YUVA420P, SWS_BILINEAR, NULL, NULL, NULL);

        if (!outContext) {

            fprintf(stderr, "Failed to get %s ---> %s\n",

                    av_pix_fmt_descriptors[dstFormat].name,

                    av_pix_fmt_descriptors[PIX_FMT_YUVA420P].name);

            res = -1;

            goto end;

        }

        sws_scale(outContext, dst, dstStride, 0, dstH, out, refStride);

        ssdY= getSSD(ref[0], out[0], refStride[0], refStride[0], w, h);

        if (hasChroma(srcFormat) && hasChroma(dstFormat)) {

            //FIXME check that output is really gray

            ssdU= getSSD(ref[1], out[1], refStride[1], refStride[1], (w+1)>>1, (h+1)>>1);

            ssdV= getSSD(ref[2], out[2], refStride[2], refStride[2], (w+1)>>1, (h+1)>>1);

        }

        if (isALPHA(srcFormat) && isALPHA(dstFormat))

            ssdA= getSSD(ref[3], out[3], refStride[3], refStride[3], w, h);

        ssdY/= w*h;

        ssdU/= w*h/4;

        ssdV/= w*h/4;

        ssdA/= w*h;

        sws_freeContext(outContext);

        for (i=0; i<4; i++) {

            if (refStride[i])

                av_free(out[i]);

        }

    }

    printf(" CRC=%08x SSD=%5"PRId64",%5"PRId64",%5"PRId64",%5"PRId64"\n",

           crc, ssdY, ssdU, ssdV, ssdA);

end:

    sws_freeContext(dstContext);

    for (i=0; i<4; i++) {

        if (dstStride[i])

            av_free(dst[i]);

    }

    return res;

}

static void selfTest(uint8_t *ref[4], int refStride[4], int w, int h,

                     enum PixelFormat srcFormat_in,

                     enum PixelFormat dstFormat_in)

{

    const int flags[] = { SWS_FAST_BILINEAR,

                          SWS_BILINEAR, SWS_BICUBIC,

                          SWS_X       , SWS_POINT  , SWS_AREA, 0 };

    const int srcW = w;

    const int srcH = h;

    const int dstW[] = { srcW - srcW/3, srcW, srcW + srcW/3, 0 };

    const int dstH[] = { srcH - srcH/3, srcH, srcH + srcH/3, 0 };

    enum PixelFormat srcFormat, dstFormat;

    for (srcFormat = srcFormat_in != PIX_FMT_NONE ? srcFormat_in : 0;

         srcFormat < PIX_FMT_NB; srcFormat++) {

        if (!sws_isSupportedInput(srcFormat) || !sws_isSupportedOutput(srcFormat))

            continue;

        for (dstFormat = dstFormat_in != PIX_FMT_NONE ? dstFormat_in : 0;

             dstFormat < PIX_FMT_NB; dstFormat++) {

            int i, j, k;

            int res = 0;

            if (!sws_isSupportedInput(dstFormat) || !sws_isSupportedOutput(dstFormat))

                continue;

            printf("%s -> %s\n",

                   av_pix_fmt_descriptors[srcFormat].name,

                   av_pix_fmt_descriptors[dstFormat].name);

            fflush(stdout);

            for (k = 0; flags[k] && !res; k++) {

                for (i = 0; dstW[i] && !res; i++)

                    for (j = 0; dstH[j] && !res; j++)

                        res = doTest(ref, refStride, w, h,

                                     srcFormat, dstFormat,

                                     srcW, srcH, dstW[i], dstH[j], flags[k],

                                     NULL);

            }

            if (dstFormat_in != PIX_FMT_NONE)

                break;

        }

        if (srcFormat_in != PIX_FMT_NONE)

            break;

    }

}

static int fileTest(uint8_t *ref[4], int refStride[4], int w, int h, FILE *fp,

                    enum PixelFormat srcFormat_in,

                    enum PixelFormat dstFormat_in)

{

    char buf[256];

    while (fgets(buf, sizeof(buf), fp)) {

        struct Results r;

        enum PixelFormat srcFormat;

        char srcStr[12];

        int srcW, srcH;

        enum PixelFormat dstFormat;

        char dstStr[12];

        int dstW, dstH;

        int flags;

        int ret;

        ret = sscanf(buf, " %12s %dx%d -> %12s %dx%d flags=%d CRC=%x"

                          " SSD=%"PRId64", %"PRId64", %"PRId64", %"PRId64"\n",

                          srcStr, &srcW, &srcH, dstStr, &dstW, &dstH,

                          &flags, &r.crc, &r.ssdY, &r.ssdU, &r.ssdV, &r.ssdA);

        if (ret != 12) {

            srcStr[0] = dstStr[0] = 0;

            ret = sscanf(buf, "%12s -> %12s\n", srcStr, dstStr);

        }

        srcFormat = av_get_pix_fmt(srcStr);

        dstFormat = av_get_pix_fmt(dstStr);

        if (srcFormat == PIX_FMT_NONE || dstFormat == PIX_FMT_NONE) {

            fprintf(stderr, "malformed input file\n");

            return -1;

        }

        if ((srcFormat_in != PIX_FMT_NONE && srcFormat_in != srcFormat) ||

            (dstFormat_in != PIX_FMT_NONE && dstFormat_in != dstFormat))

            continue;

        if (ret != 12) {

            printf("%s", buf);

            continue;

        }

        doTest(ref, refStride, w, h,

               srcFormat, dstFormat,

               srcW, srcH, dstW, dstH, flags,

               &r);

    }

    return 0;

}

#define W 96

#define H 96

int main(int argc, char **argv)

{

    enum PixelFormat srcFormat = PIX_FMT_NONE;

    enum PixelFormat dstFormat = PIX_FMT_NONE;

    uint8_t *rgb_data = av_malloc (W*H*4);

    uint8_t *rgb_src[3]= {rgb_data, NULL, NULL};

    int rgb_stride[3]={4*W, 0, 0};

    uint8_t *data = av_malloc (4*W*H);

    uint8_t *src[4]= {data, data+W*H, data+W*H*2, data+W*H*3};

    int stride[4]={W, W, W, W};

    int x, y;

    struct SwsContext *sws;

    AVLFG rand;

    int res = -1;

    int i;

    if (!rgb_data || !data)

        return -1;

    sws= sws_getContext(W/12, H/12, PIX_FMT_RGB32, W, H, PIX_FMT_YUVA420P, SWS_BILINEAR, NULL, NULL, NULL);

    av_lfg_init(&rand, 1);

    for (y=0; y<H; y++) {

        for (x=0; x<W*4; x++) {

            rgb_data[ x + y*4*W]= av_lfg_get(&rand);

        }

    }

    sws_scale(sws, rgb_src, rgb_stride, 0, H, src, stride);

    sws_freeContext(sws);

    av_free(rgb_data);

    for (i = 1; i < argc; i += 2) {

        if (argv[i][0] != '-' || i+1 == argc)

            goto bad_option;

        if (!strcmp(argv[i], "-ref")) {

            FILE *fp = fopen(argv[i+1], "r");

            if (!fp) {

                fprintf(stderr, "could not open '%s'\n", argv[i+1]);

                goto error;

            }

            res = fileTest(src, stride, W, H, fp, srcFormat, dstFormat);

            fclose(fp);

            goto end;

        } else if (!strcmp(argv[i], "-src")) {

            srcFormat = av_get_pix_fmt(argv[i+1]);

            if (srcFormat == PIX_FMT_NONE) {

                fprintf(stderr, "invalid pixel format %s\n", argv[i+1]);

                return -1;

            }

        } else if (!strcmp(argv[i], "-dst")) {

            dstFormat = av_get_pix_fmt(argv[i+1]);

            if (dstFormat == PIX_FMT_NONE) {

                fprintf(stderr, "invalid pixel format %s\n", argv[i+1]);

                return -1;

            }

        } else {

bad_option:

            fprintf(stderr, "bad option or argument missing (%s)\n", argv[i]);

            goto error;

        }

    }

    selfTest(src, stride, W, H, srcFormat, dstFormat);

end:

    res = 0;

error:

    av_free(data);

    return res;

}