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