#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;
}