fixed testTSAMFactors.cpp
parent
06c3696176
commit
a6f612844f
|
@ -119,16 +119,16 @@ TEST( OdometryFactorBase, all ) {
|
|||
|
||||
// Use numerical derivatives to calculate the Jacobians
|
||||
Matrix H1Expected, H2Expected, H3Expected, H4Expected;
|
||||
H1Expected = numericalDerivative11<Vector2, Pose2>(
|
||||
H1Expected = numericalDerivative11<Vector3, Pose2>(
|
||||
boost::bind(&OdometryFactorBase::evaluateError, &factor, _1, pose1, base2,
|
||||
pose2, boost::none, boost::none, boost::none, boost::none), base1);
|
||||
H2Expected = numericalDerivative11<Vector2, Pose2>(
|
||||
H2Expected = numericalDerivative11<Vector3, Pose2>(
|
||||
boost::bind(&OdometryFactorBase::evaluateError, &factor, base1, _1, base2,
|
||||
pose2, boost::none, boost::none, boost::none, boost::none), pose1);
|
||||
H3Expected = numericalDerivative11<Vector2, Pose2>(
|
||||
H3Expected = numericalDerivative11<Vector3, Pose2>(
|
||||
boost::bind(&OdometryFactorBase::evaluateError, &factor, base1, pose1, _1,
|
||||
pose2, boost::none, boost::none, boost::none, boost::none), base2);
|
||||
H4Expected = numericalDerivative11<Vector2, Pose2>(
|
||||
H4Expected = numericalDerivative11<Vector3, Pose2>(
|
||||
boost::bind(&OdometryFactorBase::evaluateError, &factor, base1, pose1,
|
||||
base2, _1, boost::none, boost::none, boost::none, boost::none),
|
||||
pose2);
|
||||
|
|
Loading…
Reference in New Issue