view libmpcodecs/vf_2xsai.c @ 32963:ce00479b68ce

Cosmetic: Format to MPlayer coding style. Additionally: sort prototype declarations, remove useless comment at top of file, add comment to include file, group and sort includes, move assignment outside condition, group statements by adding or removing new lines to ease reading and remove needless parentheses and braces.

/*
 * 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
};

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