cubicpiecewisefunction.h

Go to the documentation of this file.

/********************************************************************************
 * Copyright (C) 2017-2020 German Aerospace Center (DLR). 
 * Eclipse ADORe, Automated Driving Open Research https://eclipse.org/adore
 *
 * This program and the accompanying materials are made available under the 
 * terms of the Eclipse Public License 2.0 which is available at
 * http://www.eclipse.org/legal/epl-2.0.
 *
 * SPDX-License-Identifier: EPL-2.0 
 *
 * Contributors: 
 *   Reza Dariani - initial API and implementation
 ********************************************************************************/
 
#pragma once
#include <iostream>
#include <fstream>
#include <string>
#include <valarray>
#include <math.h>
#include <stdio.h>
#include <iomanip>
#include "dlib/matrix/matrix.h"
#include "dlib/matrix.h"
#include <adore/mad/arraymatrixtools.h>
#include <vector>
namespace adore
{
    namespace mad
    {
        class CubicPiecewiseFunction
        {
        private:
            static inline void repeatedValueInterpolation(double *output_x, double *output_y, double *output_weight,int *outputLength,double *input_x, double *input_y, double *input_weight,int inputLength);  
 
            struct LocalCoordination
            {
                std::vector<double> lc_breaks;
                std::vector<int> lc_index;
            };          
        
        public:
            /***
             Pieceweise Polynomial structure
             */
            struct PieceweisePolynomial  
            {
                double *breaks; 
                double *coef_1; 
                double *coef_2; 
                double *coef_3; 
                double *coef_4; 
                int dimension ; 
            };
            static void BreaksGenerator(double *Userbreaks,int UserbreaksLength,double start, double resolution);
            static std::vector<double> BreaksGenerator(double start, double end, int NumberOfPoints);
            static void BreaksGeneratorExp(double *Userbreaks, int NumOfPoints, double start, double end);
            static void smoothingSpline(PieceweisePolynomial* pp, double* input_x, double* input_y, double* input_w, int inputLength,double smoothingFactor);
            static void fit(PieceweisePolynomial* pp, double* input_x, double* input_y, double* input_w, int inputLength,double smoothingFactor);
            static LocalCoordination localCoordination(double *Userbreaks, int UserbreaksLength, PieceweisePolynomial &pp);
            static void CubicSplineEvaluation( double *interpolatedSpline,double *d_interpolatedSpline,double *dd_interpolatedSpline,double *ddd_interpolatedSpline, double *Userbreaks,int UserbreaksLength,PieceweisePolynomial &pp);
            static void CubicSplineEvaluation( double *interpolatedSpline,double *d_interpolatedSpline,double *dd_interpolatedSpline, double *Userbreaks,int UserbreaksLength, PieceweisePolynomial &pp);
            static void CubicSplineEvaluation( double *interpolatedSpline,double *d_interpolatedSpline, double *Userbreaks,int UserbreaksLength, PieceweisePolynomial &pp);
            static void CubicSplineEvaluation( double *interpolatedSpline, double *Userbreaks,int UserbreaksLength, PieceweisePolynomial &pp);
            static void toPolynomialFrom(PieceweisePolynomial* pp,double *input_breaks,double *input_coef1,double *input_coef2,double *input_coef3,double *input_coef4,int inputLength);    
            static int findIndex (double point, PieceweisePolynomial &pp);
            static double splineEvaluation(int index, double point, PieceweisePolynomial &pp );
            static void deleteCubicSplinepp(PieceweisePolynomial& pp);
            static void deleteCubicSplinepp1(PieceweisePolynomial* pp);
            
 
            
        };
    }
}