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

Revert "fix warning in FrobeniusWormholeFactor" 

This reverts commit 00a9564299.
release/4.3a0
Varun Agrawal 2020-08-06 20:56:18 -05:00
parent 00a9564299
commit 9579db73ea
1 changed files with 15 additions and 18 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
gtsam/slam/FrobeniusFactor.cpp
View File

@ -67,18 +67,15 @@ FrobeniusWormholeFactor::FrobeniusWormholeFactor(
G_ = boost::make_shared<Matrix>(); G_ = boost::make_shared<Matrix>();
*G_ = SOn::VectorizedGenerators(p); // expensive! *G_ = SOn::VectorizedGenerators(p); // expensive!
} }
if (static_cast<size_t>(G_->rows()) != pp_ || if (G_->rows() != pp_ || G_->cols() != SOn::Dimension(p))
static_cast<size_t>(G_->cols()) != SOn::Dimension(p)) throw std::invalid_argument("FrobeniusWormholeFactor: passed in generators "
throw std::invalid_argument(
"FrobeniusWormholeFactor: passed in generators "
"of incorrect dimension."); "of incorrect dimension.");
} }
//****************************************************************************** //******************************************************************************
void FrobeniusWormholeFactor::print(const std::string &s, void FrobeniusWormholeFactor::print(const std::string &s, const KeyFormatter &keyFormatter) const {
const KeyFormatter &keyFormatter) const { std::cout << s << "FrobeniusWormholeFactor<" << p_ << ">(" << keyFormatter(key1()) << ","
std::cout << s << "FrobeniusWormholeFactor<" << p_ << ">(" << keyFormatter(key2()) << ")\n";
<< keyFormatter(key1()) << "," << keyFormatter(key2()) << ")\n";
traits<Matrix>::Print(M_, " M: "); traits<Matrix>::Print(M_, " M: ");
noiseModel_->print(" noise model: "); noiseModel_->print(" noise model: ");
} }