void SO3CSpace::SetRotation(const Math3D::Matrix3& R,Config& x)
{
  MomentRotation m;
  m.setMatrix(R);
  x.resize(3);
  m.get(x(0),x(1),x(2));
}
Exemple #2
0
  virtual void Eval(Real t,Vector& v)
  {
    Matrix3 Ra,ARaB;
    AngleAxisRotation aa;
    aa.angle=t;
    aa.axis=a;
    aa.getMatrix(Ra);
    ARaB = A*Ra*B;
    MomentRotation m;
    m.setMatrix(ARaB);

    v.resize(3);
    m.get(&v(0));
  }