Skip to content
Snippets Groups Projects
Commit 5678edc3 authored by Joan Vallvé Navarro's avatar Joan Vallvé Navarro
Browse files

bug fixed in featureBase covariance/information/upperSquareroot..

parent 4200bd55
No related branches found
No related tags found
1 merge request!111Jet autodiff
...@@ -13,12 +13,9 @@ FeatureBase::FeatureBase(const std::string& _type, const Eigen::VectorXs& _measu ...@@ -13,12 +13,9 @@ FeatureBase::FeatureBase(const std::string& _type, const Eigen::VectorXs& _measu
feature_id_(++feature_id_count_), feature_id_(++feature_id_count_),
track_id_(0), track_id_(0),
landmark_id_(0), landmark_id_(0),
measurement_(_measurement), measurement_(_measurement)
measurement_covariance_(_meas_covariance)
{ {
assert(_meas_covariance.determinant() > 0 && "Not positive definite measurement covariance"); setMeasurementCovariance(_meas_covariance);
measurement_sqrt_information_upper_ = computeSqrtUpper(measurement_covariance_);
// std::cout << "constructed +f" << id() << std::endl; // std::cout << "constructed +f" << id() << std::endl;
} }
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment