Beispiel #1
0
void Quaternion3f::fromEuler(FCL_REAL a, FCL_REAL b, FCL_REAL c)
{
  Matrix3f R;
  R.setEulerYPR(a, b, c);

  fromRotation(R);
}
Beispiel #2
0
Transform3f BallEulerJoint::getLocalTransform(const JointConfig& cfg) const
{
  Matrix3f rot;
  rot.setEulerYPR(cfg[0], cfg[1], cfg[2]);
  return transform_to_parent_ * Transform3f(rot);
}
Beispiel #3
0
Transform3f BallEulerJoint::getLocalTransform() const
{
  Matrix3f rot;
  rot.setEulerYPR((*joint_cfg_)[0], (*joint_cfg_)[1], (*joint_cfg_)[2]);
  return transform_to_parent_ * Transform3f(rot);
}