本文整理汇总了C++中MatrixXf::conservativeResize方法的典型用法代码示例。如果您正苦于以下问题:C++ MatrixXf::conservativeResize方法的具体用法?C++ MatrixXf::conservativeResize怎么用?C++ MatrixXf::conservativeResize使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类MatrixXf
的用法示例。
在下文中一共展示了MatrixXf::conservativeResize方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: rodrigues
Matrix4f Arm::rodrigues(Vector3f rot) {
Vector3f R; R << rot(0), rot(1), rot(2);
if(R.norm() > 0.0f) {
R.normalize();
}
Matrix3f identity;
identity << Matrix3f::Identity();
Matrix3f crossProd(3,3);
crossProd(0,0) = 0.0f; crossProd(0, 1) = -(R(0)); crossProd(0,2) = R(1);
crossProd(1,0) = R(2); crossProd(1, 1) = 0.0; crossProd(1,2) = -(R(0));
crossProd(2,0) = -(R(1)); crossProd(2, 1) = R(0); crossProd(2,2) = 0.0;
Matrix3f crossProd_squ(3,3);
crossProd_squ = crossProd * crossProd;
float theta = rot.norm();
MatrixXf result = identity + sin(theta) * crossProd + (1-cos(theta))*crossProd_squ;
result.conservativeResize(4,4);
result(0, 3) = 0.0f; result(1, 3) = 0.0f; result(2,3) = 0.0f; result(3,3) = 1.0f;
result(3, 0) = 0.0f; result(3, 1) = 0.0f; result(3,2) = 0.0f;
return result;
}