本文整理汇总了C++中vpMatrix::transpose方法的典型用法代码示例。如果您正苦于以下问题:C++ vpMatrix::transpose方法的具体用法?C++ vpMatrix::transpose怎么用?C++ vpMatrix::transpose使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类vpMatrix
的用法示例。
在下文中一共展示了vpMatrix::transpose方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: computeSecondaryTaskManipulability
vpColVector computeSecondaryTaskManipulability(const vpMatrix &P, vpMatrix &J, std::vector <vpMatrix> &dJ,double & cond)
{
const unsigned int n = dJ.size();
vpColVector z(n);
double alpha = 10;
// vpMatrix v;
// vpColVector w;
// J.svd(w, v);
// //std::cout << "singular values:/n" << w << std::endl;
// cond = w[0]/w[5];
// double sqtr_detJJt = 1.0;
// for (unsigned int i = 0; i < n-1; i++)
// sqtr_detJJt *= w[i];
// std::cout << "sqtr_detJJt:/n" << sqtr_detJJt << std::endl;
// std::cout << "detJJt" << detJJt << std::endl;
double detJJt = (J * J.transpose()).det();
std::cout << "sqtr_detJJMulti" << sqrt(detJJt) << std::endl;
for (unsigned int i = 0; i < n; i++)
{
vpMatrix dJJinv = dJ[i] * J.pseudoInverse();
std::cout << dJ[i] << std::endl << dJ[i] << std::endl;
double trace = 0.0;
for (unsigned int k = 0; k < dJJinv.getCols(); k++)
trace += dJJinv[k][k];
std::cout << "trace" << i << " " << trace << std::endl;
z[i] = alpha * sqrt(detJJt) * trace;
}
return z;
}