/*
* All or portions of this file Copyright (c) Amazon.com, Inc. or its affiliates or
* its licensors.
*
* For complete copyright and license terms please see the LICENSE at the root of this
* distribution (the "License"). All use of this software is governed by the License,
* or, if provided, by the license below or the license accompanying this file. Do not
* remove or modify any license notices. This file is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
*
*/
// Original file Copyright Crytek GMBH or its affiliates, used under license.

#include "CryLegacy_precompiled.h"
#include <I3DEngine.h>
#include <IRenderAuxGeom.h>
#include "../CharacterInstance.h"
#include "../Model.h"
#include "../CharacterManager.h"


#include "PoseModifierHelper.h"
#include "LimbIk.h"

/*
CLimbIk
*/

CRYREGISTER_CLASS(CLimbIk)

//

CLimbIk::CLimbIk()
{
    m_pSetups = m_setupsBuffer[0];
    m_setupCount = 0;

    m_pSetupsExecute = m_setupsBuffer[1];
    m_setupCountExecute = 0;
}

CLimbIk::~CLimbIk()
{
}

//

void CLimbIk::AddSetup(LimbIKDefinitionHandle setup, const Vec3& targetPositionLocal)
{
    if (m_setupCount >= sizeof(m_setupsBuffer[0]) / sizeof(m_setupsBuffer[0][0]))
    {
        return;
    }

    for (uint32 i = 0; i < m_setupCount; ++i)
    {
        if (m_pSetups[i].setup != setup)
        {
            continue;
        }

        m_pSetups[i].targetPositionLocal = targetPositionLocal;
        return;
    }

    m_pSetups[m_setupCount].setup = setup;
    m_pSetups[m_setupCount].targetPositionLocal = targetPositionLocal;
    m_setupCount++;
}

// IAnimationPoseModifier

bool CLimbIk::Prepare(const SAnimationPoseModifierParams& params)
{
    std::swap(m_pSetups, m_pSetupsExecute);
    m_setupCountExecute = m_setupCount;
    m_setupCount = 0;
    return true;
}

bool CLimbIk::Execute(const SAnimationPoseModifierParams& params)
{
    Skeleton::CPoseData* pPoseData = Skeleton::CPoseData::GetPoseData(params.pPoseData);
    if (!pPoseData)
    {
        return false;
    }

    const CDefaultSkeleton& defaultSkeleton = PoseModifierHelper::GetDefaultSkeleton(params);
    for (uint32 i = 0; i < m_setupCountExecute; ++i)
    {
        PoseModifierHelper::IK_Solver(
            defaultSkeleton, m_pSetupsExecute[i].setup, m_pSetupsExecute[i].targetPositionLocal,
            *pPoseData);
    }
    return true;
}

void CLimbIk::Synchronize()
{
}