/*---------------------------------------------------------------------------*
  Project:  NintendoWare
  File:     gfx_CalculatedTransform.cpp
  
  Copyright (C)2009-2011 Nintendo/HAL Laboratory, Inc.  All rights reserved.
  
  These coded instructions, statements, and computer programs contain proprietary
  information of Nintendo and/or its licensed developers and are protected by
  national and international copyright laws. They may not be disclosed to third
  parties or copied or duplicated in any form, in whole or in part, without the
  prior written consent of Nintendo.
  
  The content herein is highly confidential and should be handled accordingly.
  
  $Revision: 31311 $
 *---------------------------------------------------------------------------*/

#include "precompiled.h"

#include <nw/gfx/gfx_CalculatedTransform.h>
#include <nw/gfx/res/gfx_ResSkeleton.h>

namespace nw
{
namespace gfx
{

const f32 CalculatedTransform::s_VecSquareLenTol = 1.0e-6f;

//----------------------------------------
void
CalculatedTransform::Setup(const ResBone bone)
{
    bool translateZeroFlag = false;
    bool rotateZeroFlag = false;

    this->SetTransform(bone.GetTransform());
    if ( ut::CheckFlag(bone.GetFlags(), ResBoneData::FLAG_IS_IDENTITY) )
    {
        this->EnableFlags(CalculatedTransform::FLAG_IS_IDENTITY);
    }
    if ( ut::CheckFlag(bone.GetFlags(), ResBoneData::FLAG_IS_TRANSLATE_ZERO) )
    {
        this->EnableFlags(CalculatedTransform::FLAG_IS_TRANSLATE_ZERO);
        translateZeroFlag = true;
    }
    if ( ut::CheckFlag(bone.GetFlags(), ResBoneData::FLAG_IS_ROTATE_ZERO) )
    {
        this->EnableFlags(CalculatedTransform::FLAG_IS_ROTATE_ZERO);
        rotateZeroFlag = true;
    }
    if ( ut::CheckFlag(bone.GetFlags(), ResBoneData::FLAG_IS_SCALE_ONE) )
    {
        this->EnableFlags(CalculatedTransform::FLAG_IS_SCALE_ONE);
    }
    if ( ut::CheckFlag(bone.GetFlags(), ResBoneData::FLAG_IS_UNIFORM_SCALE) )
    {
        this->EnableFlags(CalculatedTransform::FLAG_IS_UNIFORM_SCALE);
    }
    if ( translateZeroFlag && rotateZeroFlag )
    {
        this->EnableFlags(CalculatedTransform::FLAG_IS_ROTATE_TRANSLATE_ZERO);
    }
}

//----------------------------------------
void
CalculatedTransform::UpdateFlagsStrictly()
{
    UpdateScaleFlags();
    UpdateRotateFlagsStrictly();
    UpdateTranslateFlags();
    UpdateCompositeFlags();
}
//----------------------------------------
void
CalculatedTransform::UpdateFlags()
{
    UpdateScaleFlags();
    UpdateRotateFlags();
    UpdateTranslateFlags();
    UpdateCompositeFlags();
}

//----------------------------------------
void
CalculatedTransform::UpdateRotateFlagsStrictly()
{
    if (this->IsEnabledFlags(FLAG_IS_IGNORE_ROTATE))
    {
        return;
    }

    const math::MTX34& mtx = this->m_TransformMatrix;
    if (mtx.f._00 == 1.0f && mtx.f._01 == 0.0f && mtx.f._02 == 0.0f &&
        mtx.f._10 == 0.0f && mtx.f._11 == 1.0f && mtx.f._12 == 0.0f &&
        mtx.f._20 == 0.0f && mtx.f._21 == 0.0f && mtx.f._22 == 1.0f)
    {
        this->EnableFlags(FLAG_IS_ROTATE_ZERO);
    }
    else
    {
        this->DisableFlags(FLAG_IS_ROTATE_ZERO);
    }
}

//----------------------------------------
void
CalculatedTransform::UpdateRotateFlags()
{
    if (this->IsEnabledFlags(FLAG_IS_IGNORE_ROTATE))
    {
        return;
    }

    const math::MTX34& mtx = this->m_TransformMatrix;
    // 回転行列はノルム 1 なので、対角要素を 2 つ判断すればよい。
    if (mtx.f._00 == 1.0f && mtx.f._11 == 1.0f)
    {
        // 回転行列の正規直交化をしても、計算誤差が ut::FloatEqualsWeak の範囲以上になることがあるため、
        // 以下の警告を無効化しています。
#if 0   
        // 回転行列にスケール成分を含むことはできないので、
        // 単位行列になっていなければ警告を出す。
        NW_WARNING(
            ut::FloatEqualsWeak(mtx.f._00, 1.0f) && ut::FloatEqualsWeak(mtx.f._01, 0.0f) && ut::FloatEqualsWeak(mtx.f._02, 0.0f) &&
            ut::FloatEqualsWeak(mtx.f._10, 0.0f) && ut::FloatEqualsWeak(mtx.f._11, 1.0f) && ut::FloatEqualsWeak(mtx.f._12, 0.0f) &&
            ut::FloatEqualsWeak(mtx.f._20, 0.0f) && ut::FloatEqualsWeak(mtx.f._21, 0.0f) && ut::FloatEqualsWeak(mtx.f._22, 1.0f),
            "The rotation matrix of CalculatedTransform must not contain scale element.\n");
#endif
        this->EnableFlags(FLAG_IS_ROTATE_ZERO);
    }
    else
    {
        this->DisableFlags(FLAG_IS_ROTATE_ZERO);
    }
}

//----------------------------------------
void
CalculatedTransform::UpdateTranslateFlags()
{
    if (this->IsEnabledFlags(FLAG_IS_IGNORE_TRANSLATE))
    {
        return;
    }

    const math::MTX34& mtx = this->m_TransformMatrix;
    if (mtx.f._03 == 0.0f && mtx.f._13 == 0.0f && mtx.f._23 == 0.0f)
    {
        this->EnableFlags(FLAG_IS_TRANSLATE_ZERO);
    }
    else
    {
        this->DisableFlags(FLAG_IS_TRANSLATE_ZERO);
    }
}

//----------------------------------------
void
CalculatedTransform::UpdateCompositeFlags()
{
    this->DisableFlags(FLAG_IS_ROTATE_TRANSLATE_ZERO | FLAG_IS_IDENTITY);

    if (this->IsEnabledFlags(FLAG_IS_ROTATE_ZERO | FLAG_IS_TRANSLATE_ZERO))
    {
        this->EnableFlags(FLAG_IS_ROTATE_TRANSLATE_ZERO);

        if (this->IsEnabledFlags(FLAG_IS_SCALE_ONE))
        {
            this->EnableFlags(FLAG_IS_IDENTITY);
        }
    }
}

} // namespace gfx
} // namespace nw