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)); }