Go to the documentation of this file.
10 using namespace gtsam;
15 const double dt = 1.0;
23 TEST( testVelocityConstraint, trapezoidal ) {
35 TEST( testEulerVelocityConstraint, euler_start ) {
47 TEST( testEulerVelocityConstraint, euler_end ) {
static int runAllTests(TestResult &result)
Array< double, 1, 3 > e(1./3., 0.5, 2.)
#define EXPECT(condition)
static const Eigen::MatrixBase< Vector3 >::ConstantReturnType Z_3x1
Vector3 Velocity3
Velocity is currently typedef'd to Vector3.
PoseRTV pose2(Point3(1.5, 0.0, 0.0), Rot3(), Velocity3(1.0, 0.0, 0.0))
Rot3 is a 3D rotation represented as a rotation matrix if the preprocessor symbol GTSAM_USE_QUATERNIO...
TEST(SmartFactorBase, Pinhole)
PoseRTV pose1(Point3(0.5, 0.0, 0.0), Rot3(), Velocity3(1.0, 0.0, 0.0))
gtsam::Vector evaluateError(const PoseRTV &x1, const PoseRTV &x2, OptionalMatrixType H1, OptionalMatrixType H2) const override
bool assert_equal(const Matrix &expected, const Matrix &actual, double tol)
Constraint enforcing the relationship between pose and velocity.
PoseRTV pose1a(Point3(0.5, 0.0, 0.0))
std::uint64_t Key
Integer nonlinear key type.
gtsam
Author(s):
autogenerated on Fri Nov 1 2024 03:42:03