Exemplo n.º 1
0
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]);
}
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));
}