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