本文整理汇总了C++中vpColVector::getCols方法的典型用法代码示例。如果您正苦于以下问题：C++ vpColVector::getCols方法的具体用法？C++ vpColVector::getCols怎么用？C++ vpColVector::getCols使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类vpColVector的用法示例。
在下文中一共展示了vpColVector::getCols方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1:
void KalmanFilter<DataTypes, DepthTypes>::estimate(vpColVector& f,vpColVector& p)
{
K = PPred*H.transpose()*((H*PPred*H.transpose() + R).pseudoInverse());
//Kv = PvPred*((PvPred + R).pseudoInverse());
//Kv = PvPred*((PvPred + covMes).pseudoInverse());
std::cout << " Kalman gain " << K << std::endl;
//vEst = vPred + (Kv)*(vMes-vPred);
measuredState = p;
measuredState.stack(f);
estimatedState = predictedState + K*(measuredState - predictedState);
PEst = (I-K*H)*PPred;
estimatedPositions = estimatedState.rows(0, f.getCols()-1);
estimatedForces = estimatedState.rows(f.getCols(), 2*f.getCols()-1);
//PvEst = (Iv-Kv)*PvPred;
}