示例#1
0
文件: transform.cpp 项目: orthez/fcl
void Quaternion3f::fromEuler(FCL_REAL a, FCL_REAL b, FCL_REAL c)
{
  Matrix3f R;
  R.setEulerYPR(a, b, c);

  fromRotation(R);
}
示例#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);
}
示例#3
0
文件: joint.cpp 项目: Sosi/fcl
Transform3f BallEulerJoint::getLocalTransform() const
{
  Matrix3f rot;
  rot.setEulerYPR((*joint_cfg_)[0], (*joint_cfg_)[1], (*joint_cfg_)[2]);
  return transform_to_parent_ * Transform3f(rot);
}