예제 #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);
}