CurveGraphCatmullRom.h

#pragma once

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

template<class T>
class CCurveGraphCatmullRom : public CCurveGraph<T> {
public:
        CCurveGraphCatmullRom()
        {
        }
        virtual T Interpolate(float time)
        {
                //time musi by 0, 1 !! o OOR se stara controller

                //TESTOVACI
                int i;
                for(i = 0; i < (int)m_nodes.size(); i++) {
                        //t je mezi last a next
                        if(m_nodes[i].t > time) {
                                break;
                        }
                }
                
                float local_time = (m_nodes[i].t - m_nodes[i-1].t);
                local_time =  (time -  m_nodes[i-1].t) / local_time;


                // FIXME - tento zpusob je spatny, viz FirstControllerTest = spravne reseni
        
                if(i-2 >= 0 && i+1 < (int)m_nodes.size()) {
                        return CatmulRomInterpolation(local_time, m_nodes[i - 2].value, m_nodes[i - 1].value, m_nodes[i].value, m_nodes[i + 1].value);
                } else if(i-2 < 0 && i+1<(int) m_nodes.size()){
                        return CatmulRomInterpolation(local_time, m_nodes[i - 1].value, m_nodes[i - 1].value, m_nodes[i].value, m_nodes[i+1].value);
                } else{
                        return CatmulRomInterpolation(local_time, m_nodes[i - 1].value, m_nodes[i - 1].value, m_nodes[i].value, m_nodes[i].value);
                }
                return 0;
        }

};