本文整理汇总了C++中eigen::Matrix3f::setIdentity方法的典型用法代码示例。如果您正苦于以下问题:C++ Matrix3f::setIdentity方法的具体用法?C++ Matrix3f::setIdentity怎么用?C++ Matrix3f::setIdentity使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类eigen::Matrix3f
的用法示例。
在下文中一共展示了Matrix3f::setIdentity方法的2个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: reset
/** \brief Resets the MultilevelPatch.
*
* @param idx - feature ID
* @initTime - Time at initialization.
*/
void reset(){
H_.setIdentity();
e0_ = 0;
e1_ = 0;
s_ = 0;
for(unsigned int i = 0;i<nLevels_;i++){
isValidPatch_[i] = false;
}
}
示例2: getSkewSymmetricMatrix
Eigen::Matrix3f GraspPlannerEvaluatorWindow::rodriguesFormula(Eigen::Vector3f vector, float theta) {
//Rotation vector must be of unit length
//Angle theta must be in rad
Eigen::Matrix3f mat;
mat.setIdentity();
Eigen::Matrix3f skewSym = getSkewSymmetricMatrix(vector);
mat = mat + skewSym*sin(theta) + skewSym*skewSym*(1 - cos(theta));
return mat;
}