本文整理汇总了C++中eigen::Matrix3d::isIdentity方法的典型用法代码示例。如果您正苦于以下问题：C++ Matrix3d::isIdentity方法的具体用法？C++ Matrix3d::isIdentity怎么用？C++ Matrix3d::isIdentity使用的例子？那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类eigen::Matrix3d的用法示例。
在下文中一共展示了Matrix3d::isIdentity方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: fabs
bool kinematic_constraints::OrientationConstraint::equal(const KinematicConstraint &other, double margin) const
{
if (other.getType() != type_)
return false;
const OrientationConstraint &o = static_cast<const OrientationConstraint&>(other);
if (o.link_model_ == link_model_ && desired_rotation_frame_id_ == o.desired_rotation_frame_id_)
{
Eigen::Matrix3d diff = desired_rotation_matrix_.inverse() * o.desired_rotation_matrix_;
if (!diff.isIdentity(margin))
return false;
return fabs(absolute_x_axis_tolerance_ - o.absolute_x_axis_tolerance_) <= margin &&
fabs(absolute_y_axis_tolerance_ - o.absolute_y_axis_tolerance_) <= margin &&
fabs(absolute_z_axis_tolerance_ - o.absolute_z_axis_tolerance_) <= margin;
}
return false;
}