mirror of https://github.com/mpv-player/mpv
343 lines
9.5 KiB
C
343 lines
9.5 KiB
C
/*
|
|
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
|
|
};
|
|
|
|
//===========================================================================//
|