view libmpcodecs/vf_2xsai.c @ 32860:77dd2bb3fd02

Make sure we don't store the same stats twice by nulling the first byte of the stats_out string once we have written it. I've verified that this is necessary, without it at normally at least the last stats line is duplicated, it could also happen when we call encode_video more often due to encoder delay as Reimar noted. Sample encode was with default -ovc lavc -lavcopts vpass=1: --- pass1stats.log 2011-02-21 15:44:42.314259000 +0100 +++ pass1stats.log.dedup_patch 2011-02-21 15:41:51.262778000 +0100 @@ -6421,4 +6421,3 @@ in:6420 out:6420 type:2 q:239 itex:0 ptex:15905 mv:441 misc:1911 fcode:1 bcode:1 mc-var:989 var:350603 icount:0 skipcount:373 hbits:55; in:6421 out:6421 type:2 q:247 itex:0 ptex:13020 mv:422 misc:1863 fcode:1 bcode:1 mc-var:953 var:352607 icount:0 skipcount:379 hbits:55; in:6422 out:6422 type:2 q:252 itex:0 ptex:3162 mv:258 misc:1293 fcode:1 bcode:1 mc-var:837 var:352872 icount:0 skipcount:449 hbits:55; -in:6422 out:6422 type:2 q:252 itex:0 ptex:3162 mv:258 misc:1293 fcode:1 bcode:1 mc-var:837 var:352872 icount:0 skipcount:449 hbits:55;

/*
 * This file is part of MPlayer.
 *
 * MPlayer is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * MPlayer 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 General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with MPlayer; 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 "config.h"
#include "mp_msg.h"

#include "img_format.h"
#include "mp_image.h"
#include "vf.h"

//===========================================================================//

/* FIXME: these all belong in the context, not as globals! */

static uint32_t colorMask = 0xF7DEF7DE;
static uint32_t lowPixelMask = 0x08210821;
static uint32_t qcolorMask = 0xE79CE79C;
static uint32_t qlowpixelMask = 0x18631863;
static uint32_t redblueMask = 0xF81F;
static uint32_t greenMask = 0x7E0;
static int PixelsPerMask = 2;

#define makecol(r,g,b) (r+(g<<8)+(b<<16))
#define makecol_depth(d,r,g,b) (r+(g<<8)+(b<<16))

static int Init_2xSaI(int d)
{

        int minr = 0, ming = 0, minb = 0;
        int i;

//        if (d != 15 && d != 16 && d != 24 && d != 32)
//                return -1;

        /* Get lowest color bit */
        for (i = 0; i < 255; i++) {
                if (!minr)
                        minr = makecol(i, 0, 0);
                if (!ming)
                        ming = makecol(0, i, 0);
                if (!minb)
                        minb = makecol(0, 0, i);
        }

        colorMask = (makecol_depth(d, 255, 0, 0) - minr) | (makecol_depth(d, 0, 255, 0) - ming) | (makecol_depth(d, 0, 0, 255) - minb);
        lowPixelMask = minr | ming | minb;
        qcolorMask = (makecol_depth(d, 255, 0, 0) - 3 * minr) | (makecol_depth(d, 0, 255, 0) - 3 * ming) | (makecol_depth(d, 0, 0, 255) - 3 * minb);
        qlowpixelMask = (minr * 3) | (ming * 3) | (minb * 3);
        redblueMask = makecol_depth(d, 255, 0, 255);
        greenMask = makecol_depth(d, 0, 255, 0);

        PixelsPerMask = (d <= 16) ? 2 : 1;

        if (PixelsPerMask == 2) {
                colorMask |= (colorMask << 16);
                qcolorMask |= (qcolorMask << 16);
                lowPixelMask |= (lowPixelMask << 16);
                qlowpixelMask |= (qlowpixelMask << 16);
        }

//        TRACE("Color Mask:       0x%lX\n", colorMask);
//        TRACE("Low Pixel Mask:   0x%lX\n", lowPixelMask);
//        TRACE("QColor Mask:      0x%lX\n", qcolorMask);
//        TRACE("QLow Pixel Mask:  0x%lX\n", qlowpixelMask);

        return 0;
}


#define GET_RESULT(A, B, C, D) ((A != C || A != D) - (B != C || B != D))

#define INTERPOLATE(A, B) (((A & colorMask) >> 1) + ((B & colorMask) >> 1) + (A & B & lowPixelMask))

#define Q_INTERPOLATE(A, B, C, D) ((A & qcolorMask) >> 2) + ((B & qcolorMask) >> 2) + ((C & qcolorMask) >> 2) + ((D & qcolorMask) >> 2) \
        + ((((A & qlowpixelMask) + (B & qlowpixelMask) + (C & qlowpixelMask) + (D & qlowpixelMask)) >> 2) & qlowpixelMask)


static void Super2xSaI_ex(uint8_t *src, uint32_t src_pitch,
                          uint8_t *dst, uint32_t dst_pitch,
                          uint32_t width, uint32_t height, int sbpp)
{

        unsigned int x, y;
        uint32_t color[16];
        unsigned char *src_line[4];

        /* Point to the first 3 lines. */
        src_line[0] = src;
        src_line[1] = src;
        src_line[2] = src + src_pitch;
        src_line[3] = src + src_pitch * 2;

        x = 0, y = 0;

        if (PixelsPerMask == 2) {
                unsigned short *sbp;
                sbp = (unsigned short*)src_line[0];
                color[0] = *sbp;       color[1] = color[0];   color[2] = color[0];    color[3] = color[0];
                color[4] = color[0];   color[5] = color[0];   color[6] = *(sbp + 1);  color[7] = *(sbp + 2);
                sbp = (unsigned short*)src_line[2];
                color[8] = *sbp;     color[9] = color[8];     color[10] = *(sbp + 1); color[11] = *(sbp + 2);
                sbp = (unsigned short*)src_line[3];
                color[12] = *sbp;    color[13] = color[12];   color[14] = *(sbp + 1); color[15] = *(sbp + 2);
        }
        else {
                uint32_t *lbp;
                lbp = (uint32_t*)src_line[0];
                color[0] = *lbp;       color[1] = color[0];   color[2] = color[0];    color[3] = color[0];
                color[4] = color[0];   color[5] = color[0];   color[6] = *(lbp + 1);  color[7] = *(lbp + 2);
                lbp = (uint32_t*)src_line[2];
                color[8] = *lbp;     color[9] = color[8];     color[10] = *(lbp + 1); color[11] = *(lbp + 2);
                lbp = (uint32_t*)src_line[3];
                color[12] = *lbp;    color[13] = color[12];   color[14] = *(lbp + 1); color[15] = *(lbp + 2);
        }

        for (y = 0; y < height; y++) {
                unsigned char *dst_line[2];

                dst_line[0] = dst + dst_pitch*2*y;
                dst_line[1] = dst + dst_pitch*(2*y+1);

                /* Todo: x = width - 2, x = width - 1 */

                for (x = 0; x < width; x++) {
                        uint32_t product1a, product1b, product2a, product2b;

//---------------------------------------  B0 B1 B2 B3    0  1  2  3
//                                         4  5* 6  S2 -> 4  5* 6  7
//                                         1  2  3  S1    8  9 10 11
//                                         A0 A1 A2 A3   12 13 14 15
//--------------------------------------
                        if (color[9] == color[6] && color[5] != color[10]) {
                                product2b = color[9];
                                product1b = product2b;
                        }
                        else if (color[5] == color[10] && color[9] != color[6]) {
                                product2b = color[5];
                                product1b = product2b;
                        }
                        else if (color[5] == color[10] && color[9] == color[6]) {
                                int r = 0;

                                r += GET_RESULT(color[6], color[5], color[8], color[13]);
                                r += GET_RESULT(color[6], color[5], color[4], color[1]);
                                r += GET_RESULT(color[6], color[5], color[14], color[11]);
                                r += GET_RESULT(color[6], color[5], color[2], color[7]);

                                if (r > 0)
                                        product1b = color[6];
                                else if (r < 0)
                                        product1b = color[5];
                                else
                                        product1b = INTERPOLATE(color[5], color[6]);

                                product2b = product1b;

                        }
                        else {
                                if (color[6] == color[10] && color[10] == color[13] && color[9] != color[14] && color[10] != color[12])
                                        product2b = Q_INTERPOLATE(color[10], color[10], color[10], color[9]);
                                else if (color[5] == color[9] && color[9] == color[14] && color[13] != color[10] && color[9] != color[15])
                                        product2b = Q_INTERPOLATE(color[9], color[9], color[9], color[10]);
                                else
                                        product2b = INTERPOLATE(color[9], color[10]);

                                if (color[6] == color[10] && color[6] == color[1] && color[5] != color[2] && color[6] != color[0])
                                        product1b = Q_INTERPOLATE(color[6], color[6], color[6], color[5]);
                                else if (color[5] == color[9] && color[5] == color[2] && color[1] != color[6] && color[5] != color[3])
                                        product1b = Q_INTERPOLATE(color[6], color[5], color[5], color[5]);
                                else
                                        product1b = INTERPOLATE(color[5], color[6]);
                        }

                        if (color[5] == color[10] && color[9] != color[6] && color[4] == color[5] && color[5] != color[14])
                                product2a = INTERPOLATE(color[9], color[5]);
                        else if (color[5] == color[8] && color[6] == color[5] && color[4] != color[9] && color[5] != color[12])
                                product2a = INTERPOLATE(color[9], color[5]);
                        else
                                product2a = color[9];

                        if (color[9] == color[6] && color[5] != color[10] && color[8] == color[9] && color[9] != color[2])
                                product1a = INTERPOLATE(color[9], color[5]);
                        else if (color[4] == color[9] && color[10] == color[9] && color[8] != color[5] && color[9] != color[0])
                                product1a = INTERPOLATE(color[9], color[5]);
                        else
                                product1a = color[5];

                        if (PixelsPerMask == 2) {
                                *((uint32_t *) (&dst_line[0][x * 4])) = product1a | (product1b << 16);
                                *((uint32_t *) (&dst_line[1][x * 4])) = product2a | (product2b << 16);
                        }
                        else {
                                *((uint32_t *) (&dst_line[0][x * 8])) = product1a;
                                *((uint32_t *) (&dst_line[0][x * 8 + 4])) = product1b;
                                *((uint32_t *) (&dst_line[1][x * 8])) = product2a;
                                *((uint32_t *) (&dst_line[1][x * 8 + 4])) = product2b;
                        }

                        /* Move color matrix forward */
                        color[0] = color[1]; color[4] = color[5]; color[8] = color[9];   color[12] = color[13];
                        color[1] = color[2]; color[5] = color[6]; color[9] = color[10];  color[13] = color[14];
                        color[2] = color[3]; color[6] = color[7]; color[10] = color[11]; color[14] = color[15];

                        if (x < width - 3) {
                                x += 3;
                                if (PixelsPerMask == 2) {
                                        color[3] = *(((unsigned short*)src_line[0]) + x);
                                        color[7] = *(((unsigned short*)src_line[1]) + x);
                                        color[11] = *(((unsigned short*)src_line[2]) + x);
                                        color[15] = *(((unsigned short*)src_line[3]) + x);
                                }
                                else {
                                        color[3] = *(((uint32_t*)src_line[0]) + x);
                                        color[7] = *(((uint32_t*)src_line[1]) + x);
                                        color[11] = *(((uint32_t*)src_line[2]) + x);
                                        color[15] = *(((uint32_t*)src_line[3]) + x);
                                }
                                x -= 3;
                        }
                }

                /* We're done with one line, so we shift the source lines up */
                src_line[0] = src_line[1];
                src_line[1] = src_line[2];
                src_line[2] = src_line[3];

                /* Read next line */
                if (y + 3 >= height)
                        src_line[3] = src_line[2];
                else
                        src_line[3] = src_line[2] + src_pitch;

                /* Then shift the color matrix up */
                if (PixelsPerMask == 2) {
                        unsigned short *sbp;
                        sbp = (unsigned short*)src_line[0];
                        color[0] = *sbp;     color[1] = color[0];    color[2] = *(sbp + 1);  color[3] = *(sbp + 2);
                        sbp = (unsigned short*)src_line[1];
                        color[4] = *sbp;     color[5] = color[4];    color[6] = *(sbp + 1);  color[7] = *(sbp + 2);
                        sbp = (unsigned short*)src_line[2];
                        color[8] = *sbp;     color[9] = color[9];    color[10] = *(sbp + 1); color[11] = *(sbp + 2);
                        sbp = (unsigned short*)src_line[3];
                        color[12] = *sbp;    color[13] = color[12];  color[14] = *(sbp + 1); color[15] = *(sbp + 2);
                }
                else {
                        uint32_t *lbp;
                        lbp = (uint32_t*)src_line[0];
                        color[0] = *lbp;     color[1] = color[0];    color[2] = *(lbp + 1);  color[3] = *(lbp + 2);
                        lbp = (uint32_t*)src_line[1];
                        color[4] = *lbp;     color[5] = color[4];    color[6] = *(lbp + 1);  color[7] = *(lbp + 2);
                        lbp = (uint32_t*)src_line[2];
                        color[8] = *lbp;     color[9] = color[9];    color[10] = *(lbp + 1); color[11] = *(lbp + 2);
                        lbp = (uint32_t*)src_line[3];
                        color[12] = *lbp;    color[13] = color[12];  color[14] = *(lbp + 1); color[15] = *(lbp + 2);
                }

        } // y loop

}


//===========================================================================//

static int config(struct vf_instance *vf,
        int width, int height, int d_width, int d_height,
        unsigned int flags, unsigned int outfmt){

    Init_2xSaI(outfmt&255);

    return vf_next_config(vf,2*width,2*height,2*d_width,2*d_height,flags,outfmt);
}

static int put_image(struct vf_instance *vf, mp_image_t *mpi, double pts){
    mp_image_t *dmpi;

    // hope we'll get DR buffer:
    dmpi=vf_get_image(vf->next,mpi->imgfmt,
        MP_IMGTYPE_TEMP, MP_IMGFLAG_ACCEPT_STRIDE,
        2*mpi->w, 2*mpi->h);

    Super2xSaI_ex(mpi->planes[0], mpi->stride[0],
                  dmpi->planes[0], dmpi->stride[0],
                  mpi->w, mpi->h, mpi->bpp/8);

    return vf_next_put_image(vf,dmpi, pts);
}

//===========================================================================//

static int query_format(struct vf_instance *vf, unsigned int fmt){
    switch(fmt){
//    case IMGFMT_BGR15:
//    case IMGFMT_BGR16:
    case IMGFMT_BGR32:
        return vf_next_query_format(vf,fmt);
    }
    return 0;
}

static int vf_open(vf_instance_t *vf, char *args){
    vf->config=config;
    vf->put_image=put_image;
    vf->query_format=query_format;
    return 1;
}

const vf_info_t vf_info_2xsai = {
    "2xSai BGR bitmap 2x scaler",
    "2xsai",
    "A'rpi",
    "http://elektron.its.tudelft.nl/~dalikifa/",
    vf_open,
    NULL
};

//===========================================================================//