AkimaInterpolation.h

Go to the documentation of this file.

//     ____   ______ __
//    / __ \ / ____// /
//   / /_/ // /    / /
//  / ____// /___ / /___   PixInsight Class Library
// /_/     \____//_____/   PCL 2.6.5
// ----------------------------------------------------------------------------
// pcl/AkimaInterpolation.h - Released 2024-01-13T15:47:58Z
// ----------------------------------------------------------------------------
// This file is part of the PixInsight Class Library (PCL).
// PCL is a multiplatform C++ framework for development of PixInsight modules.
//
// Copyright (c) 2003-2024 Pleiades Astrophoto S.L. All Rights Reserved.
//
// Redistribution and use in both source and binary forms, with or without
// modification, is permitted provided that the following conditions are met:
//
// 1. All redistributions of source code must retain the above copyright
//    notice, this list of conditions and the following disclaimer.
//
// 2. All redistributions in binary form must reproduce the above copyright
//    notice, this list of conditions and the following disclaimer in the
//    documentation and/or other materials provided with the distribution.
//
// 3. Neither the names "PixInsight" and "Pleiades Astrophoto", nor the names
//    of their contributors, may be used to endorse or promote products derived
//    from this software without specific prior written permission. For written
//    permission, please contact info@pixinsight.com.
//
// 4. All products derived from this software, in any form whatsoever, must
//    reproduce the following acknowledgment in the end-user documentation
//    and/or other materials provided with the product:
//
//    "This product is based on software from the PixInsight project, developed
//    by Pleiades Astrophoto and its contributors (https://pixinsight.com/)."
//
//    Alternatively, if that is where third-party acknowledgments normally
//    appear, this acknowledgment must be reproduced in the product itself.
//
// THIS SOFTWARE IS PROVIDED BY PLEIADES ASTROPHOTO AND ITS CONTRIBUTORS
// "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
// TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
// PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL PLEIADES ASTROPHOTO OR ITS
// CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
// EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, BUSINESS
// INTERRUPTION; PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; AND LOSS OF USE,
// DATA OR PROFITS) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
// CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
// POSSIBILITY OF SUCH DAMAGE.
// ----------------------------------------------------------------------------
 
#ifndef __PCL_AkimaInterpolation_h
#define __PCL_AkimaInterpolation_h
 
 
#include <pcl/Defs.h>
#include <pcl/Diagnostics.h>
 
#include <pcl/UnidimensionalInterpolation.h>
 
namespace pcl
{
 
// ----------------------------------------------------------------------------
 
#define m_x this->m_x
#define m_y this->m_y
 
template <typename T = double>
class PCL_CLASS AkimaInterpolation : public UnidimensionalInterpolation<T>
{
public:
 
   using vector_type = typename UnidimensionalInterpolation<T>::vector_type;
 
   using coefficient_vector = vector_type;
 
   AkimaInterpolation() = default;
 
   AkimaInterpolation( const AkimaInterpolation& ) = default;
 
   AkimaInterpolation( AkimaInterpolation&& ) = default;
 
   AkimaInterpolation& operator =( const AkimaInterpolation& ) = default;
 
   AkimaInterpolation& operator =( AkimaInterpolation&& ) = default;
 
   ~AkimaInterpolation() override
   {
   }
 
   void Initialize( const vector_type& x, const vector_type& y ) override
   {
      if ( y.Length() < 5 )
         throw Error( "AkimaInterpolation::Initialize(): Less than five data points specified." );
 
      try
      {
         Clear();
         UnidimensionalInterpolation<T>::Initialize( x, y );
 
         int n = m_y.Length();
         int N = n-1; // Number of subintervals
 
         m_b = coefficient_vector( N );
         m_c = coefficient_vector( N );
         m_d = coefficient_vector( N );
 
         // Chordal slopes
         coefficient_vector m0( N+4 ); // room for 4 additional prescribed slopes
         T* m = m0.At( 2 );            // allow negative subscripts m[-1] and m[-2]
 
         // Akima left-hand slopes to support corners
         coefficient_vector tL( n );
 
         // Calculate chordal slopes for each subinterval
         if ( m_x )
            for ( int i = 0; i < N; ++i )
            {
               T h = m_x[i+1] - m_x[i];
               if ( 1 + h*h == 1 )
                  throw Error( "AkimaInterpolation::Initialize(): Empty interpolation subinterval(s)." );
               m[i] = (m_y[i+1] - m_y[i])/h;
            }
         else
            for ( int i = 0; i < N; ++i )
               m[i] = m_y[i+1] - m_y[i];
 
         // Prescribed slopes at ending locations
         m[-2 ] = 3*m[  0] - 2*m[  1];
         m[-1 ] = 2*m[  0] -   m[  1];
         m[ N ] = 2*m[N-1] -   m[N-2];
         m[N+1] = 3*m[N-1] - 2*m[N-2];
 
         /*
          * Akima left-hand and right-hand slopes.
          * Right-hand slopes are just the interpolation coefficients bi.
          */
         for ( int i = 0; i < n; ++i )
         {
            T f = Abs( m[i-1] - m[i-2] );
            T e = Abs( m[i+1] - m[i] ) + f;
            if ( 1 + e != 1 )
            {
               tL[i] = m[i-1] + f*(m[i] - m[i-1])/e;
               if ( i < N )
                  m_b[i] = tL[i];
            }
            else
            {
               tL[i] = m[i-1];
               if ( i < N )
                  m_b[i] = m[i];
            }
         }
 
         /*
          * Interpolation coefficients m_b[i], m_c[i], m_d[i]. 'ai'
          * coefficients are the m_y[i] ordinate values.
          */
         for ( int i = 0; i < N; ++i )
         {
            m_c[i] = 3*m[i] - 2*m_b[i] - tL[i+1];
            m_d[i] = m_b[i] + tL[i+1] - 2*m[i];
 
            if ( m_x )
            {
               T h = m_x[i+1] - m_x[i];
               m_c[i] /= h;
               m_d[i] /= h*h;
            }
         }
      }
      catch ( ... )
      {
         Clear();
         throw;
      }
   }
 
   PCL_HOT_FUNCTION
   double operator()( double x ) const override
   {
      PCL_PRECONDITION( IsValid() )
 
      /*
       * Find the subinterval i0 such that m_x[i0] <= x < m_x[i0+1].
       * Find the distance dx = x - m_x[i], or dx = x - i for implicit x = {0,1,...n-1}.
       */
      int i0;
      double dx;
      if ( m_x )
      {
         i0 = 0;
         int i1 = m_x.Length() - 1;
         // if trying to extrapolate, return zero.
         if ( unlikely( x < m_x[0] || x > m_x[i1] ) )
            return 0;
         while ( i1-i0 > 1 )
         {
            int im = (i0 + i1) >> 1;
            if ( x < m_x[im] )
               i1 = im;
            else
               i0 = im;
         }
         dx = x - double( m_x[i0] );
      }
      else
      {
         if ( x <= 0 )
            return m_y[0];
         if ( x >= m_y.Length()-1 )
            return m_y[m_y.Length()-1];
         i0 = TruncInt( x );
         dx = x - i0;
      }
 
      /*
       * Use a Horner scheme to calculate b[i]*dx + c[i]*dx^2 + d[i]*dx^3.
       */
      return m_y[i0] + dx*(m_b[i0] + dx*(m_c[i0] + dx*m_d[i0]));
   }
 
   void Clear() override
   {
      m_b.Clear();
      m_c.Clear();
      m_d.Clear();
      UnidimensionalInterpolation<T>::Clear();
   }
 
   bool IsValid() const override
   {
      return m_b && m_c && m_d;
   }
 
protected:
 
   /*
    * Interpolating coefficients for each subinterval.
    * The coefficients for dx^0 are the input ordinate values in the m_y vector.
    */
   coefficient_vector m_b; // coefficients for dx^1
   coefficient_vector m_c; // coefficients for dx^2
   coefficient_vector m_d; // coefficients for dx^3
};
 
#undef m_x
#undef m_y
 
// ----------------------------------------------------------------------------
 
} // pcl
 
#endif  // __PCL_AkimaInterpolation_h
 
// ----------------------------------------------------------------------------
// EOF pcl/AkimaInterpolation.h - Released 2024-01-13T15:47:58Z