PeerStreamer

/*

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

 *

 * 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 <assert.h>

#include <math.h>

#include "config.h"

#include "mp_msg.h"

#if HAVE_MALLOC_H

#include <malloc.h>

#endif

#include "img_format.h"

#include "mp_image.h"

#include "vf.h"

#define SUB_PIXEL_BITS 8

#define SUB_PIXELS (1<<SUB_PIXEL_BITS)

#define COEFF_BITS 11

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

struct vf_priv_s {

    double ref[4][2];

    int32_t coeff[1<<SUB_PIXEL_BITS][4];

    int32_t (*pv)[2];

    int pvStride;

    int cubic;

};

/***************************************************************************/

static void initPv(struct vf_priv_s *priv, int W, int H){

    double a,b,c,d,e,f,g,h,D;

    double (*ref)[2]= priv->ref;

    int x,y;

    g= (  (ref[0][0] - ref[1][0] - ref[2][0] + ref[3][0])*(ref[2][1] - ref[3][1])

        - (ref[0][1] - ref[1][1] - ref[2][1] + ref[3][1])*(ref[2][0] - ref[3][0]))*H;

    h= (  (ref[0][1] - ref[1][1] - ref[2][1] + ref[3][1])*(ref[1][0] - ref[3][0])

        - (ref[0][0] - ref[1][0] - ref[2][0] + ref[3][0])*(ref[1][1] - ref[3][1]))*W;

    D=   (ref[1][0] - ref[3][0])*(ref[2][1] - ref[3][1])

       - (ref[2][0] - ref[3][0])*(ref[1][1] - ref[3][1]);

    a= D*(ref[1][0] - ref[0][0])*H + g*ref[1][0];

    b= D*(ref[2][0] - ref[0][0])*W + h*ref[2][0];

    c= D*ref[0][0]*W*H;

    d= D*(ref[1][1] - ref[0][1])*H + g*ref[1][1];

    e= D*(ref[2][1] - ref[0][1])*W + h*ref[2][1];

    f= D*ref[0][1]*W*H;

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

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

            int u, v;

            u= (int)floor( SUB_PIXELS*(a*x + b*y + c)/(g*x + h*y + D*W*H) + 0.5);

            v= (int)floor( SUB_PIXELS*(d*x + e*y + f)/(g*x + h*y + D*W*H) + 0.5);

            priv->pv[x + y*W][0]= u;

            priv->pv[x + y*W][1]= v;

        }

    }

}

static double getCoeff(double d){

    double A= -0.60;

    double coeff;

    d= fabs(d);

    // Equation is from VirtualDub

    if(d<1.0)

        coeff = (1.0 - (A+3.0)*d*d + (A+2.0)*d*d*d);

    else if(d<2.0)

        coeff = (-4.0*A + 8.0*A*d - 5.0*A*d*d + A*d*d*d);

    else

        coeff=0.0;

    return coeff;

}

static int config(struct vf_instance *vf,

    int width, int height, int d_width, int d_height,

    unsigned int flags, unsigned int outfmt){

    int i, j;

    vf->priv->pvStride= width;

    vf->priv->pv= (void*)memalign(8, width*height*2*sizeof(int32_t));

    initPv(vf->priv, width, height);

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

        double d= i/(double)SUB_PIXELS;

        double temp[4];

        double sum=0;

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

            temp[j]= getCoeff(j - d - 1);

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

            sum+= temp[j];

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

            vf->priv->coeff[i][j]= (int)floor((1<<COEFF_BITS)*temp[j]/sum + 0.5);

    }

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

}

static void uninit(struct vf_instance *vf){

    if(!vf->priv) return;

    free(vf->priv->pv);

    vf->priv->pv= NULL;

    free(vf->priv);

    vf->priv=NULL;

}

static inline void resampleCubic(uint8_t *dst, uint8_t *src, int w, int h, int dstStride, int srcStride, struct vf_priv_s *privParam, int xShift, int yShift){

    int x, y;

    struct vf_priv_s priv= *privParam;

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

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

            int u, v, subU, subV, sum, sx, sy;

            sx= x << xShift;

            sy= y << yShift;

            u= priv.pv[sx + sy*priv.pvStride][0]>>xShift;

            v= priv.pv[sx + sy*priv.pvStride][1]>>yShift;

            subU= u & (SUB_PIXELS-1);

            subV= v & (SUB_PIXELS-1);

            u >>= SUB_PIXEL_BITS;

            v >>= SUB_PIXEL_BITS;

            if(u>0 && v>0 && u<w-2 && v<h-2){

                const int index= u + v*srcStride;

                const int a= priv.coeff[subU][0];

                const int b= priv.coeff[subU][1];

                const int c= priv.coeff[subU][2];

                const int d= priv.coeff[subU][3];

                sum=

                 priv.coeff[subV][0]*(  a*src[index - 1 - srcStride] + b*src[index - 0 - srcStride]

                                      + c*src[index + 1 - srcStride] + d*src[index + 2 - srcStride])

                +priv.coeff[subV][1]*(  a*src[index - 1            ] + b*src[index - 0            ]

                                      + c*src[index + 1            ] + d*src[index + 2            ])

                +priv.coeff[subV][2]*(  a*src[index - 1 + srcStride] + b*src[index - 0 + srcStride]

                                      + c*src[index + 1 + srcStride] + d*src[index + 2 + srcStride])

                +priv.coeff[subV][3]*(  a*src[index - 1+2*srcStride] + b*src[index - 0+2*srcStride]

                                      + c*src[index + 1+2*srcStride] + d*src[index + 2+2*srcStride]);

            }else{

                int dx, dy;

                sum=0;

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

                    int iy= v + dy - 1;

                    if     (iy< 0) iy=0;

                    else if(iy>=h) iy=h-1;

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

                        int ix= u + dx - 1;

                        if     (ix< 0) ix=0;

                        else if(ix>=w) ix=w-1;

                        sum+=  priv.coeff[subU][dx]*priv.coeff[subV][dy]

                              *src[ ix + iy*srcStride];

                    }

                }

            }

            sum= (sum + (1<<(COEFF_BITS*2-1)) ) >> (COEFF_BITS*2);

            if(sum&~255){

                if(sum<0) sum=0;

                else      sum=255;

            }

            dst[ x + y*dstStride]= sum;

        }

    }

}

static inline void resampleLinear(uint8_t *dst, uint8_t *src, int w, int h, int dstStride, int srcStride,

                  struct vf_priv_s *privParam, int xShift, int yShift){

    int x, y;

    struct vf_priv_s priv= *privParam;

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

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

            int u, v, subU, subV, sum, sx, sy, index, subUI, subVI;

            sx= x << xShift;

            sy= y << yShift;

            u= priv.pv[sx + sy*priv.pvStride][0]>>xShift;

            v= priv.pv[sx + sy*priv.pvStride][1]>>yShift;

            subU= u & (SUB_PIXELS-1);

            subV= v & (SUB_PIXELS-1);

            u >>= SUB_PIXEL_BITS;

            v >>= SUB_PIXEL_BITS;

            index= u + v*srcStride;

            subUI= SUB_PIXELS - subU;

            subVI= SUB_PIXELS - subV;

            if((unsigned)u < (unsigned)(w - 1)){

                if((unsigned)v < (unsigned)(h - 1)){

                    sum= subVI*(subUI*src[index          ] + subU*src[index          +1])

                        +subV *(subUI*src[index+srcStride] + subU*src[index+srcStride+1]);

                    sum= (sum + (1<<(SUB_PIXEL_BITS*2-1)) ) >> (SUB_PIXEL_BITS*2);

                }else{

                    if(v<0) v= 0;

                    else    v= h-1;

                    index= u + v*srcStride;

                    sum= subUI*src[index] + subU*src[index+1];

                    sum= (sum + (1<<(SUB_PIXEL_BITS-1)) ) >> SUB_PIXEL_BITS;

                }

            }else{

                if((unsigned)v < (unsigned)(h - 1)){

                    if(u<0) u= 0;

                    else    u= w-1;

                    index= u + v*srcStride;

                    sum= subVI*src[index] + subV*src[index+srcStride];

                    sum= (sum + (1<<(SUB_PIXEL_BITS-1)) ) >> SUB_PIXEL_BITS;

                }else{

                    if(u<0) u= 0;

                    else    u= w-1;

                    if(v<0) v= 0;

                    else    v= h-1;

                    index= u + v*srcStride;

                    sum= src[index];

                }

            }

            if(sum&~255){

                if(sum<0) sum=0;

                else      sum=255;

            }

            dst[ x + y*dstStride]= sum;

        }

    }

}

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

    int cw= mpi->w >> mpi->chroma_x_shift;

    int ch= mpi->h >> mpi->chroma_y_shift;

    mp_image_t *dmpi=vf_get_image(vf->next,mpi->imgfmt,

        MP_IMGTYPE_TEMP, MP_IMGFLAG_ACCEPT_STRIDE,

        mpi->w,mpi->h);

    assert(mpi->flags&MP_IMGFLAG_PLANAR);

    if(vf->priv->cubic){

        resampleCubic(dmpi->planes[0], mpi->planes[0], mpi->w,mpi->h, dmpi->stride[0], mpi->stride[0],

                vf->priv, 0, 0);

        resampleCubic(dmpi->planes[1], mpi->planes[1], cw    , ch   , dmpi->stride[1], mpi->stride[1],

                vf->priv, mpi->chroma_x_shift, mpi->chroma_y_shift);

        resampleCubic(dmpi->planes[2], mpi->planes[2], cw    , ch   , dmpi->stride[2], mpi->stride[2],

                vf->priv, mpi->chroma_x_shift, mpi->chroma_y_shift);

    }else{

        resampleLinear(dmpi->planes[0], mpi->planes[0], mpi->w,mpi->h, dmpi->stride[0], mpi->stride[0],

                vf->priv, 0, 0);

        resampleLinear(dmpi->planes[1], mpi->planes[1], cw    , ch   , dmpi->stride[1], mpi->stride[1],

                vf->priv, mpi->chroma_x_shift, mpi->chroma_y_shift);

        resampleLinear(dmpi->planes[2], mpi->planes[2], cw    , ch   , dmpi->stride[2], mpi->stride[2],

                vf->priv, mpi->chroma_x_shift, mpi->chroma_y_shift);

    }

    return vf_next_put_image(vf,dmpi, pts);

}

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

static int query_format(struct vf_instance *vf, unsigned int fmt){

    switch(fmt)

    {

    case IMGFMT_YV12:

    case IMGFMT_I420:

    case IMGFMT_IYUV:

    case IMGFMT_YVU9:

    case IMGFMT_444P:

    case IMGFMT_422P:

    case IMGFMT_411P:

        return vf_next_query_format(vf, fmt);

    }

    return 0;

}

static int vf_open(vf_instance_t *vf, char *args){

    int e;

    vf->config=config;

    vf->put_image=put_image;

//  vf->get_image=get_image;

    vf->query_format=query_format;

    vf->uninit=uninit;

    vf->priv=malloc(sizeof(struct vf_priv_s));

    memset(vf->priv, 0, sizeof(struct vf_priv_s));

    if(args==NULL) return 0;

    e=sscanf(args, "%lf:%lf:%lf:%lf:%lf:%lf:%lf:%lf:%d",

        &vf->priv->ref[0][0], &vf->priv->ref[0][1],

        &vf->priv->ref[1][0], &vf->priv->ref[1][1],

        &vf->priv->ref[2][0], &vf->priv->ref[2][1],

        &vf->priv->ref[3][0], &vf->priv->ref[3][1],

        &vf->priv->cubic

        );

    if(e!=9)

        return 0;

    return 1;

}

const vf_info_t vf_info_perspective = {

    "perspective correcture",

    "perspective",

    "Michael Niedermayer",

    "",

    vf_open,

    NULL

};

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