37 lines
716 B
C++
37 lines
716 B
C++
|
|
|
|
#include "toonz/iknode.h"
|
|
|
|
TPointD DVAPI rotatePoint(TPointD &point, double theta);
|
|
|
|
// Compute the global position of a single node
|
|
void IKNode::computeS(void)
|
|
{
|
|
IKNode *y = this->getParent();
|
|
IKNode *w = this;
|
|
|
|
s = r; // Initialize to local (relative) position
|
|
|
|
while (y) {
|
|
s = rotatePoint(s, y->theta);
|
|
y = y->getParent();
|
|
w = w->getParent();
|
|
s += w->r;
|
|
m_pos = s;
|
|
}
|
|
}
|
|
|
|
void IKNode::setPurpose(Purpose purpose)
|
|
{
|
|
m_purpose = purpose;
|
|
}
|
|
|
|
TPointD rotatePoint(TPointD &point, double theta)
|
|
{
|
|
double costheta = cos(theta);
|
|
double sintheta = sin(theta);
|
|
double tempx = point.x * costheta - point.y * sintheta;
|
|
point.y = point.y * costheta + point.x * sintheta;
|
|
point.x = tempx;
|
|
return point;
|
|
}
|