interpol2d.h

Go to the documentation of this file.

#pragma once

/*
________________________________________________________________________

 (C) dGB Beheer B.V.; (LICENSE) http://opendtect.org/OpendTect_license.txt
 Author:        Bert
 Date:          Mar 2006
________________________________________________________________________

*/

#include "interpol1d.h"

namespace Interpolate
{

template <class T>
mClass(Algo) Applier2D
{
public:
    virtual             ~Applier2D()                            {}
    virtual void        set(const T*)                           = 0;
    virtual T           apply(float x,float y) const            = 0;
};


template <class T>
mClass(Algo) LinearReg2D : public Applier2D<T>
{
public:

    inline              LinearReg2D();
    inline              LinearReg2D(const T*);
    inline              LinearReg2D(T v00,T v10,T v01,T v11);

    inline void         set(const T*);
    inline void         set(T v00,T v01,T v10,T v11);
    inline T            apply(float x,float y) const;

protected:

    T                   a_[4];
};


template <class T>
inline T linearReg2D( T v00, T v01, T v10, T v11, float x, float y )
{ return LinearReg2D<T>( v00, v01, v10, v11 ).apply ( x, y ); }


template <class T>
mClass(Algo) LinearReg2DWithUdf : public Applier2D<T>
{
public:

    inline              LinearReg2DWithUdf();
    inline              LinearReg2DWithUdf(const T*);
    inline              LinearReg2DWithUdf(T v00,T v10,T v01,T v11);

    inline void         set(const T*);
    inline void         set(T v00,T v01,T v10,T v11);
    inline T            apply(float x,float y) const;

protected:

    LinearReg2D<T>      intp_;
    bool                haveudf_;
    bool                u00_;
    bool                u10_;
    bool                u01_;
    bool                u11_;
};


template <class T>
inline T linearReg2DWithUdf( T v00, T v01, T v10, T v11, float x, float y )
{
    return LinearReg2DWithUdf<T>( v00, v01, v10, v11 ).apply( x, y );
}


template <class T>
mClass(Algo) PolyReg2D : public Applier2D<T>
{
public:

    inline              PolyReg2D(float xstretch=1);
    inline              PolyReg2D(const T*,float xstretch=1);
    inline              PolyReg2D(T vm10,T vm11,
                           T v0m1,T v00, T v01,T v02,
                           T v1m1,T v10, T v11,T v12,
                                  T v20, T v21,         float xstretch=1);

    inline void         set(const T*);
    inline void         set(    T vm10,T vm11,
                         T v0m1,T v00, T v01, T v02,
                         T v1m1,T v10, T v11, T v12,
                                T v20, T v21);

    inline T            apply(float x,float y) const;

protected:

    PolyReg1D<T>        ix0_, ix1_, iy0_, iy1_;
    T                   vm10_, v0m1_, v20_, v02_;
    T                   delxm1_, delym1_, delx2_, dely2_;
    float               xs_;

};


template <class T>
inline T polyReg2D( T vm10, T vm11, T v0m1, T v00, T v01, T v02,
           T v1m1, T v10, T v11, T v12, T v20, T v21, float x, float y,
           float xs=1 )
{
    return PolyReg2D<T>(vm10,vm11,v0m1,v00,v01,v02,v1m1,v10,v11,v12,v20,v21,xs)
          .apply( x, y );
}


template <class T>
mClass(Algo) PolyReg2DWithUdf : public Applier2D<T>
{
public:

    inline              PolyReg2DWithUdf(float xstretch=1);
    inline              PolyReg2DWithUdf(const T*,float xstretch=1);
    inline              PolyReg2DWithUdf(T vm10,T vm11,T v0m1,T v00,T v01,T v02,
                                         T v1m1,T v10,T v11,T v12,T v20,T v21,
                                         float xstretch=1);

    inline void         set(const T*);
    inline void         set(    T vm10,T vm11,
                         T v0m1,T v00, T v01, T v02,
                         T v1m1,T v10, T v11, T v12,
                                T v20, T v21);

    inline T            apply(float x,float y) const;

protected:

    inline void         fillOuter2Inner(T,T,T,T,T,T,T,T,T&,T&,T&,T&);
    inline void         fillInner2Inner(T&,T&,T&,T&);
    inline void         fillInner2Outer(T,T,T,T,T&,T&,T&,T&,T&,T&,T&,T&);

    PolyReg2D<T>        intp_;
    bool                haveudf_;
    bool                u00_;
    bool                u10_;
    bool                u01_;
    bool                u11_;
    bool                um10_;
    bool                um11_;
    bool                u0m1_;
    bool                u02_;
    bool                u1m1_;
    bool                u12_;
    bool                u20_;
    bool                u21_;

};


template <class T>
inline T polyReg2DWithUdf( T vm10, T vm11, T v0m1, T v00, T v01, T v02,
           T v1m1, T v10, T v11, T v12, T v20, T v21, float x, float y )
{
    return PolyReg2DWithUdf<T>(vm10,vm11,v0m1,v00,v01,v02,v1m1,v10,v11,v12,v20,
                                v21).apply( x, y );
}

//--- LinearReg2D Implementation

template <class T> inline
LinearReg2D<T>::LinearReg2D() {}


template <class T> inline
LinearReg2D<T>::LinearReg2D( const T* v )
{
    set( v[0], v[1], v[2], v[3] );
}


template <class T> inline
LinearReg2D<T>::LinearReg2D( T v00, T v01, T v10, T v11 )
{
    set( v00, v01, v10, v11 );
}


template <class T> inline
void LinearReg2D<T>::set( const T* v )
{
    set( v[0], v[1], v[2], v[3] );
}


template <class T> inline
void LinearReg2D<T>::set( T v00, T v01, T v10, T v11 )
{
    a_[0] = v00;
    a_[1] = v10 - v00;
    a_[2] = v01 - v00;
    a_[3] = v11 + v00 - v10 - v01;
}


template <class T> inline
T LinearReg2D<T>::apply( float x, float y ) const
{
    return a_[0] + a_[1] * x + a_[2] * y + a_[3] * x * y;
}


//---  LinearReg2DWithUdf Implementation

template <class T> inline
LinearReg2DWithUdf<T>::LinearReg2DWithUdf() {}


template <class T> inline
LinearReg2DWithUdf<T>::LinearReg2DWithUdf( const T* v )
{
    set( v[0], v[1], v[2], v[3] );
}


template <class T> inline
LinearReg2DWithUdf<T>::LinearReg2DWithUdf( T v00, T v01, T v10, T v11 )
{
    set( v00, v01, v10, v11 );
}


template <class T> inline
void LinearReg2DWithUdf<T>::set( const T* v )
{
    set( v[0], v[1], v[2], v[3] );
}


#define mFillIfUdfFromSquare(nd,left,right,opp) \
    if ( u##nd##_ ) \
    { \
        if ( u##left##_ && u##right##_ ) \
            v##nd = v##opp; \
        else \
            v##nd = u##left##_ || u##right##_ ? \
                   (u##right##_ ? v##left : v##right) \
                                : (v##left + v##right) / 2; \
    }

template <class T> inline
void LinearReg2DWithUdf<T>::set( T v00, T v01, T v10, T v11 )
{
    u00_ = mIsUdf(v00);
    u10_ = mIsUdf(v10);
    u01_ = mIsUdf(v01);
    u11_ = mIsUdf(v11);
    haveudf_ = u00_ || u10_ || u01_ || u11_;

    if ( haveudf_ )
    {
        mFillIfUdfFromSquare(00,01,10,11)
        mFillIfUdfFromSquare(10,00,11,01)
        mFillIfUdfFromSquare(01,11,00,10)
        mFillIfUdfFromSquare(11,10,01,00)
    }

    intp_.set( v00, v01, v10, v11 );
}


#define mRetUdfIfNearestUdf() \
    if ( haveudf_ && ( \
         ( u00_ && x < 0.5 && y < 0.5 ) \
      || ( u10_ && x >= 0.5 && y < 0.5 ) \
      || ( u01_ && x < 0.5 && y >= 0.5 ) \
      || ( u11_ && x >= 0.5 && y >= 0.5 ) ) ) \
        return mUdf(T)



template <class T> inline
T LinearReg2DWithUdf<T>::apply( float x, float y ) const
{
    mRetUdfIfNearestUdf();

    return intp_.apply( x, y );
}


//--- PolyReg2D Implementation


template <class T> inline
PolyReg2D<T>::PolyReg2D( float xs )
    : xs_(xs)
{}


template <class T> inline
PolyReg2D<T>::PolyReg2D( const T* v, float xs )
    : xs_(xs)
{
    set( v );
}


template <class T> inline
PolyReg2D<T>::PolyReg2D( T vm10, T vm11,
                 T v0m1, T v00,  T v01, T v02,
                 T v1m1, T v10,  T v11, T v12,
                         T v20,  T v21, float xs )
    : xs_(xs)
{
    set( vm10, vm11, v0m1, v00, v01, v02, v1m1, v10, v11, v12, v20, v21 );
}


template <class T> inline
void PolyReg2D<T>::set( const T* v )
{
    if ( !mIsUdf(-v[4]) )
        set( v[4], v[5], v[6], v[0], v[1], v[7], v[8], v[2], v[3],
             v[9], v[10], v[11] );
    else
        set( v[0], v[1], v[0], v[0], v[1], v[1], v[2], v[2], v[3],
             v[3], v[2], v[3] );
}


template <class T> inline
void PolyReg2D<T>::set(  T vm10, T vm11,
                 T v0m1, T v00,  T v01, T v02,
                 T v1m1, T v10,  T v11, T v12,
                         T v20,  T v21 )
{
    vm10_ = vm10; v0m1_ = v0m1; v20_ = v20; v02_ = v02;
    delxm1_ = vm11 - vm10; delym1_ = v1m1 - v0m1;
    delx2_ = v21 - v20; dely2_ = v12 - v02;
    ix0_.set( v0m1, v00, v01, v02 ); ix1_.set( v1m1, v10, v11, v12 );
    iy0_.set( vm10, v00, v10, v20 ); iy1_.set( vm11, v01, v11, v21 );
}


template <class T> inline
T PolyReg2D<T>::apply( float x, float y ) const
{
    // Exactly on border or outside: handle now
    if ( x <= 0 ) return ix0_.apply( y );
    else if ( y <= 0 ) return iy0_.apply( x );
    else if ( x >= 1 ) return ix1_.apply( y );
    else if ( y >= 1 ) return iy1_.apply( x );

    // Values on X-line through point
    const T vxm1 = vm10_ + delxm1_ * y;
    const T vx0 = ix0_.apply( y );
    const T vx1 = ix1_.apply( y );
    const T vx2 = v20_ + delx2_ * y;

    // Values on Y-line through point
    const T vym1 = v0m1_ + delym1_ * x;
    const T vy0 = iy0_.apply( x );
    const T vy1 = iy1_.apply( x );
    const T vy2 = v02_ + dely2_ * x;

    // Result is weighted average, weight dep on distance from border
    const T estx = polyReg1D( vxm1, vx0, vx1, vx2, x );
    const T esty = polyReg1D( vym1, vy0, vy1, vy2, y );
    const float distfromedgex = x > 0.5 ? 1 - x : x;
    const float distfromedgey = y > 0.5 ? 1 - y : y;
    // wtx == distfromedgey;
    const float wty = distfromedgex * xs_;
    return (distfromedgey * estx + wty * esty) / (distfromedgey + wty);
}



//--- PolyReg2DWithUdf Implementation

template <class T> inline
PolyReg2DWithUdf<T>::PolyReg2DWithUdf( float xs )
    : intp_(xs)
{
}


template <class T> inline
PolyReg2DWithUdf<T>::PolyReg2DWithUdf( const T* v, float xs )
    : intp_(xs)
{
    set( v );
}


template <class T> inline
PolyReg2DWithUdf<T>::PolyReg2DWithUdf( T vm10,T vm11,T v0m1,T v00,T v01, T v02,
                                       T v1m1,T v10, T v11, T v12, T v20,T v21,
                                       float xs )
    : intp_(xs)
{
    set( vm10, vm11, v0m1, v00, v01, v02, v1m1, v10, v11, v12, v20, v21 );
}


template <class T> inline
void PolyReg2DWithUdf<T>::set( const T* v )
{
    if ( !mIsUdf(-v[4]) )
        set( v[4], v[5], v[6], v[0], v[1], v[7], v[8], v[2], v[3],
             v[9], v[10], v[11] );
    else
        set( v[0], v[1], v[0], v[0], v[1], v[1], v[2], v[2], v[3],
             v[3], v[2], v[3] );
}


template <class T> inline
void PolyReg2DWithUdf<T>::fillOuter2Inner( T vm10, T vm11, T v0m1, T v02,
                                           T v1m1, T v12, T v20, T v21,
                                           T& v00, T& v01, T& v10, T& v11 )
{
#define mFillWithEither(nd,cand1,cand2) \
    if ( u##nd##_ ) \
    { \
        if ( !u##cand1##_ ) v##nd = v##cand1; \
        else if ( !u##cand2##_ ) v##nd = v##cand2; \
    }

    mFillWithEither(00,m10,0m1)
    mFillWithEither(10,1m1,20)
    mFillWithEither(11,21,12)
    mFillWithEither(01,02,m11)

#undef mFillWithEither
}


template <class T> inline
void PolyReg2DWithUdf<T>::fillInner2Inner( T& v00, T& v01, T& v10, T& v11 )
{
    bool kpu00 = u00_, kpu10 = u10_, kpu01 = u01_, kpu11 = u11_;
    u00_ = mIsUdf(v00); u10_ = mIsUdf(v10);
    u01_ = mIsUdf(v01); u11_ = mIsUdf(v11);
    if ( u00_ || u10_ || u01_ || u11_ )
    {
        mFillIfUdfFromSquare(00,01,10,11)
        mFillIfUdfFromSquare(10,00,11,01)
        mFillIfUdfFromSquare(01,11,00,10)
        mFillIfUdfFromSquare(11,10,01,00)
    }
    u00_ = kpu00; u10_ = kpu10; u01_ = kpu01; u11_ = kpu11;
}


template <class T> inline
void PolyReg2DWithUdf<T>::fillInner2Outer( T v00, T v01, T v10, T v11,
                                           T& vm10, T& vm11, T& v0m1, T& v02,
                                           T& v1m1, T& v12, T& v20, T& v21 )
{
#define mFillIfUdf(nd,src) if ( mIsUdf(v##nd) ) v##nd= v##src;
    mFillIfUdf(m10,00);
    mFillIfUdf(0m1,00);
    mFillIfUdf(1m1,10);
    mFillIfUdf(20,10);
    mFillIfUdf(m11,01);
    mFillIfUdf(02,01);
    mFillIfUdf(12,11);
    mFillIfUdf(21,11);
#   undef mFillIfUdf
}


template <class T> inline
void PolyReg2DWithUdf<T>::set( T vm10, T vm11,
                       T v0m1, T v00,  T v01, T v02,
                       T v1m1, T v10,  T v11, T v12,
                               T v20,  T v21 )
{
    u00_ = mIsUdf(v00);
    u10_ = mIsUdf(v10);
    u01_ = mIsUdf(v01);
    u11_ = mIsUdf(v11);
    um10_ = mIsUdf(vm10);
    um11_ = mIsUdf(vm11);
    u0m1_ = mIsUdf(v0m1);
    u1m1_ = mIsUdf(v1m1);
    u02_ = mIsUdf(v02);
    u12_ = mIsUdf(v12);
    u20_ = mIsUdf(v20);
    u21_ = mIsUdf(v21);
    haveudf_ = u00_ || u10_ || u01_ || u11_;

    if ( haveudf_ || u02_ || u12_ || u20_ || u21_
                  || um10_ || um11_ || u0m1_ || u1m1_ )
    {
        if ( haveudf_ )
        {
            fillOuter2Inner( vm10, vm11, v0m1, v02, v1m1, v12, v20, v21,
                             v00, v01, v10, v11 );
            fillInner2Inner( v00, v01, v10, v11 );
        }
        fillInner2Outer( v00, v01, v10, v11,
                         vm10, vm11, v0m1, v02, v1m1, v12, v20, v21 );
    }

    intp_.set( vm10, vm11, v0m1, v00, v01, v02, v1m1, v10, v11, v12, v20, v21 );
}

template <class T> inline
T PolyReg2DWithUdf<T>::apply( float x, float y ) const
{
    mRetUdfIfNearestUdf();

    return intp_.apply( x, y );
}


#undef mFillIfUdfFromSquare
#undef mRetUdfIfNearestUdf


}// namespace Interpolate