25 using namespace gtsam;
41 expected[0] = {none, 0, 0, none};
42 expected[1] = {none, 1, none, none};
43 expected[2] = {0, none, 1, none};
44 expected[3] = {1, none, none, none};
45 expected[5] = {none, none, none, 0};
46 expected[9] = {none, none, none, 1};
Provides additional testing facilities for common data structures.
static int runAllTests(TestResult &result)
bool assert_equal(const Matrix &expected, const Matrix &actual, double tol)
VariableSlots describes the structure of a combined factor in terms of where each block comes from in...
void push_factor(Key key)
TEST(SmartFactorBase, Pinhole)