Mercurial > mplayer.hg
view libmpcodecs/vf_perspective.c @ 12740:4f84d2eb55b2
ao_alsa and ao_oss documented.
author | diego |
---|---|
date | Thu, 01 Jul 2004 10:09:06 +0000 |
parents | e9a2af584986 |
children | 6ff3379a0862 |
line wrap: on
line source
/* Copyright (C) 2002 Michael Niedermayer <michaelni@gmx.at> This program 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. This program 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 this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 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" #ifdef HAVE_MALLOC_H #include <malloc.h> #endif #include "img_format.h" #include "mp_image.h" #include "vf.h" #include "../libvo/fastmemcpy.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_s* 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_s* vf){ if(!vf->priv) return; if(vf->priv->pv) 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_s* vf, mp_image_t *mpi){ 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); } //===========================================================================// static int query_format(struct vf_instance_s* 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 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; } vf_info_t vf_info_perspective = { "perspective correcture", "perspective", "Michael Niedermayer", "", open, NULL }; //===========================================================================//