CurveGraphPolynom.h

#pragma once

#include "CurveGraph.h"
#include "Interpolators.h"


template<class T>
class CCurveGraphPolynom : public CCurveGraph<T> {
public:
        CCurveGraphPolynom()
        {       
        }
        virtual T Interpolate(float time)
        {
                // LAGRANGE

                
                T dd1(1.0f);
                T dd2(1.0f);
                T sum(0.0f);

                if(time > m_nodes.back().t) {
                        m_currIndex = -1;
                        return sum;
                }

                m_currIndex = 0;
                for(int i = 0; i < (int)m_nodes.size(); i++) {
                        dd1 = 1.0f; dd2 = 1.0f;
                        for(int j = 0; j < (int)m_nodes.size(); j++) {
                                if(j == i) continue;

                                dd1 *= time - m_nodes[j].t;
                                dd2 *= m_nodes[i].t - m_nodes[j].t;
                        }
                        sum += m_nodes[i].value * (dd1 / dd2); 
                }
                
                return sum;
        }

};