C++ (Cpp) cholOfCov示例

示例#1

文件： InertiaSensorFilter.cpp 项目： MisterSquishy/nbites

void InertiaSensorFilter::generateSigmaPoints()
{
  cholOfCov();
  sigmaPoints[0] = x;
  sigmaPoints[1] = x + l.c[0];
  sigmaPoints[2] = x + l.c[1];
  sigmaPoints[3] = x + (-l.c[0]);
  sigmaPoints[4] = x + (-l.c[1]);
}

示例#2

文件： InertialDataFilter.cpp 项目： Yanzqing/BHumanCodeRelease

void InertialDataFilter::generateSigmaPoints()
{
  cholOfCov();
  sigmaPoints[0] = mean;
  sigmaPoints[1] = mean + l.col(0);
  sigmaPoints[2] = mean + l.col(1);
  sigmaPoints[3] = mean + (-l.col(0));
  sigmaPoints[4] = mean + (-l.col(1));
}