void Quaternion3f::fromEuler(FCL_REAL a, FCL_REAL b, FCL_REAL c) { Matrix3f R; R.setEulerYPR(a, b, c); fromRotation(R); }
Transform3f BallEulerJoint::getLocalTransform(const JointConfig& cfg) const { Matrix3f rot; rot.setEulerYPR(cfg[0], cfg[1], cfg[2]); return transform_to_parent_ * Transform3f(rot); }
Transform3f BallEulerJoint::getLocalTransform() const { Matrix3f rot; rot.setEulerYPR((*joint_cfg_)[0], (*joint_cfg_)[1], (*joint_cfg_)[2]); return transform_to_parent_ * Transform3f(rot); }