ControllerPriorityMixerSlerp.h

#pragma once

#include <vector>
#include <utility>
#include <algorithm>
#include <Vector.h>


#include "Controller.h"
#include "ControllerPriorityMixerSlerp.h"


template<class CntType>
class CControllerPriorityMixerSlerp : public CControllerPriorityMixer<CntType, vec4> {
protected:
        
        
public:
        CControllerPriorityMixerSlerp(const std::string& name);
        virtual ~CControllerPriorityMixerSlerp(void);

        virtual void Update(float dt);

        CNTRL_CLASS_NAME(CControllerMixer);
};

template<class CntType>
CControllerPriorityMixerSlerp<CntType>::CControllerPriorityMixerSlerp(const std::string& name) : CControllerPriorityMixer(name)
{
}

template<class CntType>
CControllerPriorityMixerSlerp<CntType>::~CControllerPriorityMixerSlerp()
{
}

/*
        Inherited
*/
template<class CntType>
void CControllerPriorityMixerSlerp<CntType>::Update(float dt)
{
        float weight_remaining = 1.0f;  // zbyvajici vaha, pokud nektery controller vypotrebuje vsechno (z 1.0f), na ostatni se jiz nedostane
        bool first = true;
        float curr_weight;
        

        for(size_t i = 0; i < m_controllers.size(); i++) {
                if(weight_remaining < 0.0f) break;

                MIX_NODE& curr = m_controllers[i];

                // celkova vaha nesmi prekrocit 1
                if(weight_remaining - *curr.weight < 0.0f) {
                        curr_weight = weight_remaining;
                } else {
                        curr_weight = *curr.weight;
                }
                weight_remaining -= *curr.weight;
                //
                
                if((*curr.weight) <= 0.0f) continue;
        
                curr.controller->Update(dt);
                
                if(first) {     
                        m_accumulated_param = (*curr.controller->GetParameter()) * (curr_weight);
                        first = false;
                } else {
                        m_accumulated_param.QuaternionSlerp(m_accumulated_param, *curr.controller->GetParameter(), curr_weight);
                }
        }
        if(!m_controllers.empty() && first == false) {
                *m_controllers[0].controller->GetParameter() = m_accumulated_param;
        }
}