fixed unit test
parent
08a6bff803
commit
8444680e6e
|
@ -235,7 +235,7 @@ Values computeOrientationsGradient(const NonlinearFactorGraph& pose3Graph, const
|
||||||
std::cout << "nr of gradient iterations " << it << std::endl;
|
std::cout << "nr of gradient iterations " << it << std::endl;
|
||||||
|
|
||||||
// Return correct rotations
|
// Return correct rotations
|
||||||
const Rot3& Rref = inverseRot.at<Rot3>(keyAnchor);
|
const Rot3& Rref = Rot3(); // inverseRot.at<Rot3>(keyAnchor);
|
||||||
Values estimateRot;
|
Values estimateRot;
|
||||||
BOOST_FOREACH(const Values::ConstKeyValuePair& key_value, inverseRot) {
|
BOOST_FOREACH(const Values::ConstKeyValuePair& key_value, inverseRot) {
|
||||||
Key key = key_value.key;
|
Key key = key_value.key;
|
||||||
|
|
Loading…
Reference in New Issue