From 731707f73b746d3b45e21c9cec87937cdd1ed362 Mon Sep 17 00:00:00 2001 From: John Cupitt Date: Tue, 22 Jan 2008 10:29:06 +0000 Subject: [PATCH] add im_cross_phase --- include/vips/proto.h | 1 + libsrc/arithmetic/Makefile.am | 1 + libsrc/arithmetic/arith_dispatch.c | 20 +++++ libsrc/arithmetic/im_cross_phase.c | 138 +++++++++++++++++++++++++++++ 4 files changed, 160 insertions(+) create mode 100644 libsrc/arithmetic/im_cross_phase.c diff --git a/include/vips/proto.h b/include/vips/proto.h index 4245b895..a5589274 100644 --- a/include/vips/proto.h +++ b/include/vips/proto.h @@ -347,6 +347,7 @@ int im_fav4( IMAGE **, IMAGE * ); int im_gadd( double, IMAGE *, double, IMAGE *, double, IMAGE *); int im_litecor( IMAGE *, IMAGE *, IMAGE *, int, double ); int im_bandmean( IMAGE *in, IMAGE *out ); +int im_cross_phase( IMAGE *a, IMAGE *b, IMAGE *out ); /* boolean */ diff --git a/libsrc/arithmetic/Makefile.am b/libsrc/arithmetic/Makefile.am index 28410b65..1c5e5181 100644 --- a/libsrc/arithmetic/Makefile.am +++ b/libsrc/arithmetic/Makefile.am @@ -9,6 +9,7 @@ libarithmetic_la_SOURCES = \ im_bandmean.c \ im_cmulnorm.c \ im_costra.c \ + im_cross_phase.c \ im_deviate.c \ im_divide.c \ im_ceil.c \ diff --git a/libsrc/arithmetic/arith_dispatch.c b/libsrc/arithmetic/arith_dispatch.c index e43e1e64..d5c8e731 100644 --- a/libsrc/arithmetic/arith_dispatch.c +++ b/libsrc/arithmetic/arith_dispatch.c @@ -1266,6 +1266,25 @@ static im_function linreg_desc = { linreg_args /* Arg list */ }; +/* Call im_cross_phase via arg vector. + */ +static int +cross_phase_vec( im_object *argv ) +{ + return( im_cross_phase( argv[0], argv[1], argv[2] ) ); +} + +/* Description of im_cross_phase. + */ +static im_function cross_phase_desc = { + "im_cross_phase", /* Name */ + N_( "phase of cross power spectrum of two complex images" ), /* Description */ + IM_FN_PIO | IM_FN_PTOP, /* Flags */ + cross_phase_vec, /* Dispatch function */ + IM_NUMBER( two_in_one_out ), /* Size of arg list */ + two_in_one_out /* Arg list */ +}; + /* Package up all these functions. */ static im_function *arith_list[] = { @@ -1280,6 +1299,7 @@ static im_function *arith_list[] = { &ceil_desc, &cmulnorm_desc, &costra_desc, + &cross_phase_desc, &deviate_desc, ÷_desc, &exp10tra_desc, diff --git a/libsrc/arithmetic/im_cross_phase.c b/libsrc/arithmetic/im_cross_phase.c new file mode 100644 index 00000000..5b421e2d --- /dev/null +++ b/libsrc/arithmetic/im_cross_phase.c @@ -0,0 +1,138 @@ +/* @(#) Find the phase of the cross power spectrum of two complex images, + * @(#) expressed as a complex image where the modulus of each pixel is + * @(#) one. + * @(#) + * @(#) I.E. find (a.b*)/|a.b*| where + * @(#) . represents complex multiplication + * @(#) * represents the complex conjugate + * @(#) || represents the complex modulus + * @(#) + * @(#) int im_cross_phase( IMAGE *a, IMAGE *b, IMAGE *out ); + * @(#) + * @(#) All functions return 0 on success and -1 on error + * @(#) + * + * Copyright: 2008, Nottingham Trent University + * + * Author: Tom Vajzovic + * Written on: 2008-01-09 + */ + +/* + + This file is part of VIPS. + + VIPS is free software; you can redistribute it and/or modify + it under the terms of the GNU Lesser 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 Lesser General Public License for more details. + + You should have received a copy of the GNU Lesser 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 + + */ + +/* + + These files are distributed with VIPS - http://www.vips.ecs.soton.ac.uk + + */ + +#ifdef HAVE_CONFIG_H +#include +#endif /*HAVE_CONFIG_H*/ +#include + +#include +#include + +#include + +#ifdef WITH_DMALLOC +#include +#endif /*WITH_DMALLOC*/ + +static void double_complex_phase( void *in1, void *in2, void *out, int n, void *im, void *unrequired ); +static void float_complex_phase( void *in1, void *in2, void *out, int n, void *im, void *unrequired ); + +int im_cross_phase( IMAGE *a, IMAGE *b, IMAGE *out ){ +#define FUNCTION_NAME "im_phase" + + if( im_pincheck( a ) || im_pincheck( b ) || im_poutcheck( out )) + return -1; + + if( a-> Xsize != b-> Xsize || a-> Ysize != b-> Ysize ){ + im_error( FUNCTION_NAME, "not same size" ); + return -1; + } + if( a-> Bands != b-> Bands ){ + im_error( FUNCTION_NAME, "numbers of bands differ" ); + return -1; + } + if( a-> Coding || b-> Coding ){ + im_error( FUNCTION_NAME, "not uncoded" ); + return -1; + } + if( a-> BandFmt != b-> BandFmt ){ + im_error( FUNCTION_NAME, "formats differ" ); + return -1; + } + if( IM_BANDFMT_COMPLEX != a-> BandFmt && IM_BANDFMT_DPCOMPLEX != a-> BandFmt ){ + im_error( FUNCTION_NAME, "not complex format" ); + return -1; + } + if( im_cp_descv( out, a, b, NULL ) + || im_wraptwo( a, b, out, + IM_BANDFMT_COMPLEX == a-> BandFmt ? float_complex_phase : double_complex_phase, a, NULL )) + return -1; + + return 0; +} + +static void double_complex_phase( void *in1, void *in2, void *out, int n, void *im, void *unrequired ){ + double *a= (double*) in1; + double *b= (double*) in2; + double *o= (double*) out; + double *o_end= o + n * ((IMAGE*)im)-> Bands; + + for( ; o < o_end; a+= 2, b+= 2 ){ + double arg= atan2( a[1], a[0] ) - atan2( b[1], b[0] ); + *o++= sin( arg ); + *o++= cos( arg ); +#if 0 + /* FIXME very prone to overflow */ + double re= a[0] * b[0] + a[1] * b[1]; + double im= a[1] * b[0] - a[0] * b[1]; + double mod= hypot( re, im ); + *o++= re / mod; + *o++= im / mod; +#endif + } +} + +static void float_complex_phase( void *in1, void *in2, void *out, int n, void *im, void *unrequired ){ + float *a= (float*) in1; + float *b= (float*) in2; + float *o= (float*) out; + float *o_end= o + n * ((IMAGE*)im)-> Bands; + + for( ; o < o_end; a+= 2, b+= 2 ){ + double arg= atan2( a[1], a[0] ) - atan2( b[1], b[0] ); + *o++= sin( arg ); + *o++= cos( arg ); +#if 0 + /* FIXME very prone to overflow */ + double re= (double)a[0] * (double)b[0] + (double)a[1] * (double)b[1]; + double im= (double)a[1] * (double)b[0] - (double)a[0] * (double)b[1]; + double mod= hypot( re, im ); + *o++= re / mod; + *o++= im / mod; +#endif + } +}