23 using namespace gtsam;
37 const std::vector<double> pmf{0.4, 0.6};
67 std::vector<double>
expected{0.4, 0.6};
Matrix< SCALARB, Dynamic, Dynamic, opt_B > B
static int runAllTests(TestResult &result)
signatures for conditional densities
Point2 prior(const Point2 &x)
Prior on a single pose.
bool assert_equal(const Matrix &expected, const Matrix &actual, double tol)
size_t nrFrontals() const
Matrix< SCALARA, Dynamic, Dynamic, opt_A > A
size_t sample(const DiscreteValues &parentsValues) const
#define EXPECT_DOUBLES_EQUAL(expected, actual, threshold)
std::vector< double > pmf() const
We also want to keep the Base version, taking DiscreteValues:
static const DiscreteKey X(0, 2)
#define EXPECT(condition)
Point2(* f)(const Point3 &, OptionalJacobian< 2, 3 >)
Array< double, 1, 3 > e(1./3., 0.5, 2.)
#define EXPECT_LONGS_EQUAL(expected, actual)
size_t argmax() const
Return assignment that maximizes distribution.
std::pair< Key, size_t > DiscreteKey
TEST(SmartFactorBase, Pinhole)