added simple constructor tests for BetweenFactor
parent
85122bed95
commit
3d32b9c260
|
@ -44,6 +44,29 @@ TEST(BetweenFactor, Rot3) {
|
||||||
EXPECT(assert_equal(numericalH2,actualH2, 1E-5));
|
EXPECT(assert_equal(numericalH2,actualH2, 1E-5));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* ************************************************************************* */
|
||||||
|
|
||||||
|
// Constructor scalar
|
||||||
|
TEST(BetweenFactor, ConstructorScalar) {
|
||||||
|
SharedNoiseModel model;
|
||||||
|
double measured_value = 0.0;
|
||||||
|
BetweenFactor<double> factor(1, 2, measured_value, model);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Constructor vector3
|
||||||
|
TEST(BetweenFactor, ConstructorVector3) {
|
||||||
|
SharedNoiseModel model = noiseModel::Isotropic::Sigma(3, 1.0);
|
||||||
|
Vector3 measured_value(1, 2, 3);
|
||||||
|
BetweenFactor<Vector3> factor(1, 2, measured_value, model);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Constructor dynamic sized vector
|
||||||
|
TEST(BetweenFactor, ConstructorDynamicSizeVector) {
|
||||||
|
SharedNoiseModel model = noiseModel::Isotropic::Sigma(5, 1.0);
|
||||||
|
Vector measured_value(5); measured_value << 1, 2, 3, 4, 5;
|
||||||
|
BetweenFactor<Vector> factor(1, 2, measured_value, model);
|
||||||
|
}
|
||||||
|
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
int main() {
|
int main() {
|
||||||
TestResult tr;
|
TestResult tr;
|
||||||
|
|
Loading…
Reference in New Issue