本文整理汇总了C++中Mat3::invert方法的典型用法代码示例。如果您正苦于以下问题:C++ Mat3::invert方法的具体用法?C++ Mat3::invert怎么用?C++ Mat3::invert使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Mat3
的用法示例。
在下文中一共展示了Mat3::invert方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: inertiaInvert
void SpatialMat::inertiaInvert(const SpatialMat &I)
{
Mat3 Binv;
Mat3 M, N; /* temp storage */
Binv.invert(I._B);
Binv.negate();
M.mult(I._D, Binv);
N.mult(M, I._A);
N.add(I._C);
_B.invert(N);
M.mult(_B, I._D);
_A.mult(M, Binv);
_D.xpose(_A);
M.mult(I._A, _A);
M.xrow().x -= 1.0;
M.yrow().y -= 1.0;
M.zrow().z -= 1.0;
_C.mult(Binv, M);
//Mat3 detI;
//detI.mult(I._A, I._D);
//M.mult(I._B, I._C);
//detI.sub(M);
//detI.invert();
//_A.mult(detI, I._D);
//_B.mult(detI, I._B);
//_B.negate();
//_C.mult(detI, I._C);
//_C.negate();
//_D.mult(detI, I._A);
return;
}