Go to the documentation of this file.
23 using namespace gtsam;
38 size_t w = 640,
h = 480;
47 Point2 expectedimage(1320.3, 1740);
108 d << 1, 2, 3, 4, 5, 6;
117 std::stringstream
os;
118 os <<
"fx: " <<
cal.fx() <<
", fy: " <<
cal.fy() <<
", s: " <<
cal.skew()
119 <<
", px: " <<
cal.px() <<
", py: " <<
cal.py()
120 <<
", b: " <<
cal.baseline();
static int runAllTests(TestResult &result)
Point2 calibrate(const Point2 &p, OptionalJacobian< 2, 6 > Dcal={}, OptionalJacobian< 2, 2 > Dp={}) const
Array< double, 1, 3 > e(1./3., 0.5, 2.)
static const double d[K][N]
#define GTSAM_CONCEPT_TESTABLE_INST(T)
#define EXPECT_LONGS_EQUAL(expected, actual)
Concept check for values that can be used in unit tests.
#define EXPECT(condition)
static size_t Dim()
return DOF, dimensionality of tangent space
internal::FixedSizeMatrix< Y, X2 >::type numericalDerivative22(std::function< Y(const X1 &, const X2 &)> h, const X1 &x1, const X2 &x2, double delta=1e-5)
static const Point3 pt(1.0, 2.0, 3.0)
Point2 calibrate_(const Cal3_S2Stereo &K, const Point2 &pt)
ofstream os("timeSchurFactors.csv")
Provides additional testing facilities for common data structures.
Some functions to compute numerical derivatives.
bool assert_stdout_equal(const std::string &expected, const V &actual)
Point2 uncalibrate(const Point2 &p, OptionalJacobian< 2, 6 > Dcal={}, OptionalJacobian< 2, 2 > Dp={}) const
The most common 5DOF 3D->2D calibration + Stereo baseline.
static Point2 p_uv(1320.3, 1740)
static Cal3_S2::shared_ptr K1(new Cal3_S2(fov, w, h))
TEST(SmartFactorBase, Pinhole)
The most common 5DOF 3D->2D calibration, stereo version.
internal::FixedSizeMatrix< Y, X1 >::type numericalDerivative21(const std::function< Y(const X1 &, const X2 &)> &h, const X1 &x1, const X2 &x2, double delta=1e-5)
Point2 uncalibrate_(const Cal3_S2Stereo &k, const Point2 &pt)
Vector6 localCoordinates(const Cal3_S2Stereo &T2) const
Unretraction for the calibration.
void Print(const CONTAINER &keys, const string &s, const KeyFormatter &keyFormatter)
bool assert_equal(const Matrix &expected, const Matrix &actual, double tol)
#define GTSAM_CONCEPT_MANIFOLD_INST(T)
**
Cal3_S2Stereo retract(const Vector &d) const
Given 6-dim tangent vector, create new calibration.
static Cal3_S2Stereo K(500, 500, 0.1, 640/2, 480/2, 1)
gtsam
Author(s):
autogenerated on Tue Jun 25 2024 03:05:40