61 lines
1.2 KiB
C++
61 lines
1.2 KiB
C++
#include <QGuiApplication>
|
|
#include "skeletonikmover.h"
|
|
#include "ccdikresolver.h"
|
|
|
|
SkeletonIkMover::SkeletonIkMover() :
|
|
m_updateVersion(0)
|
|
{
|
|
}
|
|
|
|
SkeletonIkMover::~SkeletonIkMover()
|
|
{
|
|
}
|
|
|
|
void SkeletonIkMover::setTarget(const QVector3D &target)
|
|
{
|
|
m_target = target;
|
|
}
|
|
|
|
void SkeletonIkMover::setUpdateVersion(unsigned long long version)
|
|
{
|
|
m_updateVersion = version;
|
|
}
|
|
|
|
unsigned long long SkeletonIkMover::getUpdateVersion()
|
|
{
|
|
return m_updateVersion;
|
|
}
|
|
|
|
void SkeletonIkMover::addNode(QUuid id, QVector3D position)
|
|
{
|
|
SkeletonIkNode ikNode;
|
|
ikNode.id = id;
|
|
ikNode.position = ikNode.newPosition = position;
|
|
m_ikNodes.push_back(ikNode);
|
|
}
|
|
|
|
const std::vector<SkeletonIkNode> &SkeletonIkMover::ikNodes()
|
|
{
|
|
return m_ikNodes;
|
|
}
|
|
|
|
void SkeletonIkMover::process()
|
|
{
|
|
resolve();
|
|
|
|
this->moveToThread(QGuiApplication::instance()->thread());
|
|
emit finished();
|
|
}
|
|
|
|
void SkeletonIkMover::resolve()
|
|
{
|
|
CCDIKSolver solver;
|
|
for (auto i = 0u; i < m_ikNodes.size(); i++) {
|
|
solver.addNodeInOrder(m_ikNodes[i].position);
|
|
}
|
|
solver.solveTo(m_target);
|
|
for (auto i = 0u; i < m_ikNodes.size(); i++) {
|
|
m_ikNodes[i].newPosition = solver.getNodeSolvedPosition(i);
|
|
}
|
|
}
|