RtabmapThread: use largest covariance instead of summation

This commit is contained in:
matlabbe
2017-07-13 11:36:55 -04:00
parent 3c758ab2f6
commit b4cfa0e844
2 changed files with 10 additions and 13 deletions
@@ -86,8 +86,6 @@ public:
return std::vector<float>();
}
const OdometryInfo & info() const {return _info;}
double rotVariance() const {return uMax3(_info.covariance.at<double>(3,3), _info.covariance.at<double>(4,4), _info.covariance.at<double>(5,5));}
double transVariance() const {return uMax3(_info.covariance.at<double>(0,0), _info.covariance.at<double>(1,1), _info.covariance.at<double>(2,2));}
private:
SensorData _data;