예제 #1
0
Transform3f RevoluteJoint::getLocalTransform(const JointConfig& cfg) const
{
  Quaternion3f quat;
  quat.fromAxisAngle(axis_, cfg[0]);
  return Transform3f(transform_to_parent_.getQuatRotation() * quat, transform_to_parent_.getTranslation());
}
예제 #2
0
파일: motion.cpp 프로젝트: Karsten1987/fcl
Quaternion3f InterpMotion::deltaRotation(FCL_REAL dt) const
{
  Quaternion3f res;
  res.fromAxisAngle(angular_axis, (FCL_REAL)(dt * angular_vel));
  return res;
}