mirror of https://github.com/AxioDL/metaforce.git
62 lines
2.2 KiB
C++
62 lines
2.2 KiB
C++
#include "CPoseAsTransforms.hpp"
|
|
#include "CCharLayoutInfo.hpp"
|
|
|
|
namespace urde {
|
|
|
|
CPoseAsTransforms::CPoseAsTransforms(u8 boneCount) : x1_count(boneCount), xd0_transformArr(new Transform[boneCount]) {}
|
|
|
|
bool CPoseAsTransforms::ContainsDataFor(const CSegId& id) const {
|
|
const std::pair<CSegId, CSegId>& link = x8_links[id];
|
|
return link.first.IsValid() || link.second.IsValid();
|
|
}
|
|
|
|
void CPoseAsTransforms::Clear() {
|
|
for (u32 i = 0; i < 100; ++i)
|
|
x8_links[i] = std::make_pair(CSegId(), CSegId());
|
|
xd4_lastInserted = 0;
|
|
x0_nextId = 0;
|
|
}
|
|
|
|
void CPoseAsTransforms::AccumulateScaledTransform(const CSegId& id, zeus::CMatrix3f& rotation, float scale) const {
|
|
rotation.addScaledMatrix(GetRotation(id), scale);
|
|
}
|
|
|
|
const zeus::CTransform& CPoseAsTransforms::GetTransform(const CSegId& id) const {
|
|
const std::pair<CSegId, CSegId>& link = x8_links[id];
|
|
assert(link.second.IsValid());
|
|
return xd0_transformArr[link.second].m_originToAccum;
|
|
}
|
|
|
|
const zeus::CTransform& CPoseAsTransforms::GetRestToAccumTransform(const CSegId& id) const {
|
|
const std::pair<CSegId, CSegId>& link = x8_links[id];
|
|
assert(link.second.IsValid());
|
|
return xd0_transformArr[link.second].m_restPoseToAccum;
|
|
}
|
|
|
|
const zeus::CVector3f& CPoseAsTransforms::GetOffset(const CSegId& id) const {
|
|
const std::pair<CSegId, CSegId>& link = x8_links[id];
|
|
assert(link.second.IsValid());
|
|
return xd0_transformArr[link.second].m_originToAccum.origin;
|
|
}
|
|
|
|
const zeus::CMatrix3f& CPoseAsTransforms::GetRotation(const CSegId& id) const {
|
|
const std::pair<CSegId, CSegId>& link = x8_links[id];
|
|
assert(link.second.IsValid());
|
|
return xd0_transformArr[link.second].m_originToAccum.basis;
|
|
}
|
|
|
|
void CPoseAsTransforms::Insert(const CSegId& id, const zeus::CMatrix3f& rotation, const zeus::CVector3f& offset,
|
|
const zeus::CVector3f& restOffset) {
|
|
Transform& xfOut = xd0_transformArr[x0_nextId];
|
|
xfOut.m_originToAccum = zeus::CTransform(rotation, offset);
|
|
xfOut.m_restPoseToAccum = xfOut.m_originToAccum * zeus::CTransform::Translate(-restOffset);
|
|
|
|
std::pair<CSegId, CSegId>& link = x8_links[id];
|
|
link.first = xd4_lastInserted;
|
|
link.second = x0_nextId;
|
|
xd4_lastInserted = id;
|
|
++x0_nextId;
|
|
}
|
|
|
|
} // namespace urde
|