12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

update PreintegratedCombinedMeasurements constructor to take default preintMeasCov

release/4.3a0
Varun Agrawal 2022-11-15 19:23:55 -05:00
parent dc83c6f618
commit 41d0606816
1 changed files with 6 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
gtsam/navigation/CombinedImuFactor.h
View File

@ -97,13 +97,14 @@ public:
* Default constructor, initializes the class with no measurements * Default constructor, initializes the class with no measurements
* @param p Parameters, typically fixed in a single application * @param p Parameters, typically fixed in a single application
* @param biasHat Current estimate of acceleration and rotation rate biases * @param biasHat Current estimate of acceleration and rotation rate biases
* @param preintMeasCov Covariance matrix used in noise model.
*/ */
PreintegratedCombinedMeasurements( PreintegratedCombinedMeasurements(
const boost::shared_ptr<Params>& p, const boost::shared_ptr<Params>& p,
const imuBias::ConstantBias& biasHat = imuBias::ConstantBias()) const imuBias::ConstantBias& biasHat = imuBias::ConstantBias(),
: PreintegrationType(p, biasHat) { const Eigen::Matrix<double, 15, 15>& preintMeasCov =
preintMeasCov_.setZero(); Eigen::Matrix<double, 15, 15>::Zero())
} : PreintegrationType(p, biasHat), preintMeasCov_(preintMeasCov) {}
/** /**
* Construct preintegrated directly from members: base class and preintMeasCov * Construct preintegrated directly from members: base class and preintMeasCov