|
string | _defaultKeyFormatter (Key key) |
|
def | _init () |
|
string | _multirobotKeyFormatter (Key key) |
|
static bool | _truePredicate (const T &) |
|
static GaussianFactorGraphTree | addGaussian (const GaussianFactorGraphTree &gfgTree, const GaussianFactor::shared_ptr &factor) |
|
std::unique_ptr< internal::ExecutionTraceStorage[]> | allocAligned (size_t size) |
|
DecisionTree< L, Y > | apply (const DecisionTree< L, Y > &f, const DecisionTree< L, Y > &g, const typename DecisionTree< L, Y >::Binary &op) |
|
DecisionTree< L, Y > | apply (const DecisionTree< L, Y > &f, const typename DecisionTree< L, Y >::Unary &op) |
|
DecisionTree< L, Y > | apply (const DecisionTree< L, Y > &f, const typename DecisionTree< L, Y >::UnaryAssignment &op) |
|
bool | assert_container_equal (const std::map< size_t, V2 > &expected, const std::map< size_t, V2 > &actual, double tol=1e-9) |
|
bool | assert_container_equal (const std::map< V1, V2 > &expected, const std::map< V1, V2 > &actual, double tol=1e-9) |
|
bool | assert_container_equal (const std::vector< std::pair< V1, V2 > > &expected, const std::vector< std::pair< V1, V2 > > &actual, double tol=1e-9) |
|
bool | assert_container_equal (const V &expected, const V &actual, double tol=1e-9) |
|
bool | assert_container_equality (const std::map< size_t, V2 > &expected, const std::map< size_t, V2 > &actual) |
|
bool | assert_container_equality (const V &expected, const V &actual) |
|
bool | assert_equal (const ConstSubVector &expected, const ConstSubVector &actual, double tol) |
|
bool | assert_equal (const Key &expected, const Key &actual, double tol=0.0) |
|
bool | assert_equal (const Matrix &expected, const Matrix &actual, double tol) |
|
bool | assert_equal (const std::list< Matrix > &As, const std::list< Matrix > &Bs, double tol) |
|
bool | assert_equal (const std::optional< V > &expected, const std::optional< V > &actual, double tol=1e-9) |
|
bool | assert_equal (const std::string &expected, const std::string &actual) |
|
bool | assert_equal (const SubVector &expected, const SubVector &actual, double tol) |
|
bool | assert_equal (const V &expected, const std::optional< std::reference_wrapper< const V >> &actual, double tol=1e-9) |
|
bool | assert_equal (const V &expected, const std::optional< V > &actual, double tol=1e-9) |
|
bool | assert_equal (const V &expected, const V &actual, double tol=1e-9) |
|
bool | assert_equal (const Vector &expected, const Vector &actual, double tol) |
|
bool | assert_inequal (const Matrix &A, const Matrix &B, double tol) |
|
bool | assert_inequal (const V &expected, const V &actual, double tol=1e-9) |
|
bool | assert_inequal (const Vector &expected, const Vector &actual, double tol) |
|
bool | assert_print_equal (const std::string &expected, const V &actual, const std::string &s="") |
|
bool | assert_stdout_equal (const std::string &expected, const V &actual) |
|
Rot3_ | attitude (const NavState_ &X) |
|
void | axpy (double alpha, const Errors &x, Errors &y) |
|
Vector | backSubstituteLower (const Matrix &L, const Vector &b, bool unit) |
|
Vector | backSubstituteUpper (const Matrix &U, const Vector &b, bool unit) |
|
Vector | backSubstituteUpper (const Vector &b, const Matrix &U, bool unit) |
|
T | BCH (const T &X, const T &Y) |
|
Expression< T > | between (const Expression< T > &t1, const Expression< T > &t2) |
|
Class | between_default (const Class &l1, const Class &l2) |
|
double | bound (double a, double min, double max) |
|
GaussianFactorGraph | buildFactorSubgraph (const GaussianFactorGraph &gfg, const Subgraph &subgraph, const bool clone) |
|
VectorValues | buildVectorValues (const Vector &v, const KeyInfo &keyInfo) |
|
VectorValues | buildVectorValues (const Vector &v, const Ordering &ordering, const map< Key, size_t > &dimensions) |
|
VectorValues | buildVectorValues (const Vector &v, const Ordering &ordering, const std::map< Key, size_t > &dimensions) |
|
static Point3 | CalculateBestAxis (const Point3 &n) |
|
void | calibrateJacobians (const Cal &calibration, const Point2 &pn, OptionalJacobian< 2, Dim > Dcal={}, OptionalJacobian< 2, 2 > Dp={}) |
|
Point3Vector | calibrateMeasurements (const CameraSet< CAMERA > &cameras, const typename CAMERA::MeasurementVector &measurements) |
|
Point3Vector | calibrateMeasurements (const CameraSet< SphericalCamera > &cameras, const SphericalCamera::MeasurementVector &measurements) |
|
Point3Vector | calibrateMeasurementsShared (const CALIBRATION &cal, const Point2Vector &measurements) |
|
std::vector< DiscreteValues > | cartesianProduct (const DiscreteKeys &keys) |
|
static void | check (const SharedNoiseModel &noiseModel, size_t m) |
|
bool | check_sharedCliques (const std::pair< Key, typename BayesTree< CLIQUE >::sharedClique > &v1, const std::pair< Key, typename BayesTree< CLIQUE >::sharedClique > &v2) |
|
GTSAM_EXPORT bool | checkConvergence (const NonlinearOptimizerParams ¶ms, double currentError, double newError) |
|
bool | checkConvergence (double relativeErrorTreshold, double absoluteErrorTreshold, double errorThreshold, double currentError, double newError, NonlinearOptimizerParams::Verbosity verbosity) |
|
static double | Chi2inv (const double alpha, const size_t dofs) |
|
Matrix | cholesky_inverse (const Matrix &A) |
|
pair< size_t, bool > | choleskyCareful (Matrix &ATA, int order) |
|
bool | choleskyPartial (Matrix &ABC, size_t nFrontal, size_t topleft) |
|
static int | choleskyStep (Matrix &ATA, size_t k, size_t order) |
|
std::optional< Point2 > | circleCircleIntersection (double R_d, double r_d, double tol) |
|
list< Point2 > | circleCircleIntersection (Point2 c1, double r1, Point2 c2, double r2, double tol=1e-9) |
|
list< Point2 > | circleCircleIntersection (Point2 c1, Point2 c2, std::optional< Point2 > fh) |
|
Matrix | collect (const std::vector< const Matrix * > &matrices, size_t m, size_t n) |
|
Matrix | collect (size_t nrMatrices,...) |
|
DiscreteKeys | CollectDiscreteKeys (const DiscreteKeys &key1, const DiscreteKeys &key2) |
|
KeyDimMap | collectKeyDim (const LinearGraph &linearGraph) |
|
KeyVector | CollectKeys (const KeyVector &continuousKeys, const DiscreteKeys &discreteKeys) |
|
KeyVector | CollectKeys (const KeyVector &keys1, const KeyVector &keys2) |
|
const MATRIX::ConstColXpr | column (const MATRIX &A, size_t j) |
|
Vector | columnNormSquare (const Matrix &A) |
|
Expression< T > | compose (const Expression< T > &t1, const Expression< T > &t2) |
|
std::shared_ptr< Values > | composePoses (const G &graph, const PredecessorMap< KEY > &tree, const POSE &rootPose) |
|
std::vector< double > | ComputeLeafOrdering (const DiscreteKeys &dkeys, const DecisionTreeFactor &dt) |
|
Vector | concatVectors (const std::list< Vector > &vs) |
|
Vector | concatVectors (size_t nrVectors,...) |
|
VectorValues | conjugateGradientDescent (const GaussianFactorGraph &fg, const VectorValues &x, const ConjugateGradientParameters ¶meters) |
|
Vector | conjugateGradientDescent (const Matrix &A, const Vector &b, const Vector &x, const ConjugateGradientParameters ¶meters) |
|
Vector | conjugateGradientDescent (const System &Ab, const Vector &x, const ConjugateGradientParameters ¶meters) |
|
V | conjugateGradients (const S &Ab, V x, const ConjugateGradientParameters ¶meters, bool steepest) |
|
static void | ConnectVariableFactor (Key key, const KeyFormatter &keyFormatter, size_t i, ostream *os) |
|
static void | ConnectVariables (Key key1, Key key2, const KeyFormatter &keyFormatter, ostream *os) |
|
static std::pair< HybridConditional::shared_ptr, std::shared_ptr< Factor > > | continuousElimination (const HybridGaussianFactorGraph &factors, const Ordering &frontalKeys) |
|
static BinaryMeasurement< Rot3 > | convert (const BetweenFactor< Pose3 >::shared_ptr &f) |
|
static BinaryMeasurement< Rot2 > | convert (const BinaryMeasurement< Pose2 > &p) |
|
static BinaryMeasurement< Rot3 > | convert (const BinaryMeasurement< Pose3 > &p) |
|
SharedNoiseModel | ConvertNoiseModel (const SharedNoiseModel &model, size_t d, bool defaultToUnit) |
|
static BinaryMeasurement< Rot2 > | convertPose2ToBinaryMeasurementRot2 (const BetweenFactor< Pose2 >::shared_ptr &f) |
|
static GaussianFactorGraph | convertToJacobianFactors (const GaussianFactorGraph &gfg) |
|
static std::shared_ptr< Factor > | createDiscreteFactor (const DecisionTree< Key, Result > &eliminationResults, const DiscreteKeys &discreteSeparator) |
|
Errors | createErrors (const VectorValues &V) |
|
static std::shared_ptr< Factor > | createGaussianMixtureFactor (const DecisionTree< Key, Result > &eliminationResults, const KeyVector &continuousSeparator, const DiscreteKeys &discreteSeparator) |
|
static SharedNoiseModel | createNoiseModel (const Vector6 &v, bool smart, NoiseFormat noiseFormat, KernelFunctionType kernelFunctionType) |
|
Cal3_S2 | createPinholeCalibration (const CALIBRATION &cal) |
|
std::shared_ptr< Preconditioner > | createPreconditioner (const std::shared_ptr< PreconditionerParameters > params) |
|
GTSAM_EXPORT std::string | createRewrittenFileName (const std::string &name) |
|
std::shared_ptr< Sampler > | createSampler (const SharedNoiseModel &model) |
|
std::vector< Expression< T > > | createUnknowns (size_t n, char c, size_t start) |
|
Point3 | cross (const Point3 &p, const Point3 &q, OptionalJacobian< 3, 3 > H_p={}, OptionalJacobian< 3, 3 > H_q={}) |
|
Point3_ | cross (const Point3_ &a, const Point3_ &b) |
|
static Matrix29 | D2dcalibration (double x, double y, double xx, double yy, double xy, double rr, double r4, double pnx, double pny, const Matrix2 &DK) |
|
static Matrix2 | D2dintrinsic (double x, double y, double rr, double g, double k1, double k2, double p1, double p2, const Matrix2 &DK) |
|
std::string | demangle (const char *name) |
|
NonlinearFactorGraph::shared_ptr | deserializeGraph (const std::string &serialized_graph) |
|
NonlinearFactorGraph::shared_ptr | deserializeGraphFromFile (const std::string &fname) |
|
NonlinearFactorGraph::shared_ptr | deserializeGraphFromXMLFile (const std::string &fname, const std::string &name="graph") |
|
NonlinearFactorGraph::shared_ptr | deserializeGraphXML (const std::string &serialized_graph, const std::string &name="graph") |
|
Values::shared_ptr | deserializeValues (const std::string &serialized_values) |
|
Values::shared_ptr | deserializeValuesFromFile (const std::string &fname) |
|
Values::shared_ptr | deserializeValuesFromXMLFile (const std::string &fname, const std::string &name="values") |
|
Values::shared_ptr | deserializeValuesXML (const std::string &serialized_values, const std::string &name="values") |
|
Matrix | diag (const std::vector< Matrix > &Hs) |
|
static noiseModel::Diagonal::shared_ptr | Diagonal (const Matrix &covariance) |
|
static std::pair< HybridConditional::shared_ptr, std::shared_ptr< Factor > > | discreteElimination (const HybridGaussianFactorGraph &factors, const Ordering &frontalKeys) |
|
std::set< DiscreteKey > | DiscreteKeysAsSet (const DiscreteKeys &discreteKeys) |
|
Double_ | distance (const OrientedPlane3_ &p) |
|
double | distance2 (const Point2 &p1, const Point2 &q, OptionalJacobian< 1, 2 > H1={}, OptionalJacobian< 1, 2 > H2={}) |
|
double | distance3 (const Point3 &p1, const Point3 &q, OptionalJacobian< 1, 3 > H1={}, OptionalJacobian< 1, 3 > H2={}) |
|
std::tuple< int, double, Vector > | DLT (const Matrix &A, double rank_tol) |
|
double | dot (const Errors &a, const Errors &b) |
|
double | dot (const Point3 &p, const Point3 &q, OptionalJacobian< 1, 3 > H_p={}, OptionalJacobian< 1, 3 > H_q={}) |
|
Double_ | dot (const Point3_ &a, const Point3_ &b) |
|
double | dot (const V1 &a, const V2 &b) |
|
Vector | ediv_ (const Vector &a, const Vector &b) |
|
std::pair< std::shared_ptr< GaussianConditional >, std::shared_ptr< HessianFactor > > | EliminateCholesky (const GaussianFactorGraph &factors, const Ordering &keys) |
|
std::pair< DiscreteConditional::shared_ptr, DecisionTreeFactor::shared_ptr > | EliminateDiscrete (const DiscreteFactorGraph &factors, const Ordering &frontalKeys) |
|
std::pair< DiscreteConditional::shared_ptr, DecisionTreeFactor::shared_ptr > | EliminateForMPE (const DiscreteFactorGraph &factors, const Ordering &frontalKeys) |
|
std::pair< HybridConditional::shared_ptr, std::shared_ptr< Factor > > | EliminateHybrid (const HybridGaussianFactorGraph &factors, const Ordering &keys) |
|
std::pair< std::shared_ptr< GaussianConditional >, std::shared_ptr< GaussianFactor > > | EliminatePreferCholesky (const GaussianFactorGraph &factors, const Ordering &keys) |
|
std::pair< GaussianConditional::shared_ptr, JacobianFactor::shared_ptr > | EliminateQR (const GaussianFactorGraph &factors, const Ordering &keys) |
|
std::pair< std::shared_ptr< SymbolicConditional >, std::shared_ptr< SymbolicFactor > > | EliminateSymbolic (const SymbolicFactorGraph &factors, const Ordering &keys) |
|
bool | equal (const T &obj1, const T &obj2) |
|
bool | equal (const T &obj1, const T &obj2, double tol) |
|
bool | equal (const Vector &vec1, const Vector &vec2) |
|
bool | equal (const Vector &vec1, const Vector &vec2, double tol) |
|
bool | equal_with_abs_tol (const Eigen::DenseBase< MATRIX > &A, const Eigen::DenseBase< MATRIX > &B, double tol=1e-9) |
|
bool | equal_with_abs_tol (const SubVector &vec1, const SubVector &vec2, double tol) |
|
bool | equal_with_abs_tol (const Vector &vec1, const Vector &vec2, double tol) |
|
bool | equality (const Errors &actual, const Errors &expected, double tol) |
|
Matrix | expm (const Matrix &A, size_t K) |
|
T | expm (const Vector &x, int K=7) |
|
Class | expmap_default (const Class &t, const Vector &d) |
|
std::vector< double > | expNormalize (const std::vector< double > &logProbs) |
|
static ShonanAveraging2::Measurements | extractRot2Measurements (const BetweenFactorPose2s &factors) |
|
static ShonanAveraging3::Measurements | extractRot3Measurements (const BetweenFactorPose3s &factors) |
|
GTSAM_EXPORT std::string | findExampleDataFile (const std::string &name) |
|
T | FindKarcherMean (const std::vector< T > &rotations) |
|
T | FindKarcherMean (const std::vector< T, Eigen::aligned_allocator< T >> &rotations) |
|
T | FindKarcherMean (std::initializer_list< T > &&rotations) |
|
T | FindKarcherMeanImpl (const vector< T, ALLOC > &rotations) |
|
PredecessorMap< KEY > | findMinimumSpanningTree (const G &fg) |
|
std::string | formatMatrixIndented (const std::string &label, const Matrix &matrix, bool makeVectorHorizontal) |
|
bool | fpEqual (double a, double b, double tol, bool check_relative_also) |
|
static std::vector< Matrix3 > | G3 ({SO3::Hat(Vector3::Unit(0)), SO3::Hat(Vector3::Unit(1)), SO3::Hat(Vector3::Unit(2))}) |
|
static std::vector< Matrix4, Eigen::aligned_allocator< Matrix4 > > | G4 ({SO4::Hat(Vector6::Unit(0)), SO4::Hat(Vector6::Unit(1)), SO4::Hat(Vector6::Unit(2)), SO4::Hat(Vector6::Unit(3)), SO4::Hat(Vector6::Unit(4)), SO4::Hat(Vector6::Unit(5))}) |
|
GenericValue< T > | genericValue (const T &v) |
|
Pose3_ | getPose (const Expression< PinholeCamera< CALIBRATION > > &cam) |
|
static Vector | getSubvector (const Vector &src, const KeyInfo &keyInfo, const KeyVector &keys) |
|
static VectorValues | gradientInPlace (const NonlinearFactorGraph &nfg, const Values &values) |
|
bool | greaterThanOrEqual (const Vector &vec1, const Vector &vec2) |
|
Pose3 | gtsam2openGL (const Pose3 &PoseGTSAM) |
|
Pose3 | gtsam2openGL (const Rot3 &R, double tx, double ty, double tz) |
|
| GTSAM_CONCEPT_REQUIRES (IsGroup< G >, bool) check_group_invariants(const G &a |
|
| GTSAM_CONCEPT_REQUIRES (IsTestable< T >, bool) check_manifold_invariants(const T &a |
|
bool | guardedIsDebug (const std::string &s) |
|
void | guardedSetDebug (const std::string &s, const bool v) |
|
bool | hasConstraints (const GaussianFactorGraph &factors) |
|
pair< double, Vector > | house (const Vector &x) |
|
void | householder (Matrix &A, size_t k) |
|
void | householder_ (Matrix &A, size_t k, bool copy_vectors) |
|
double | houseInPlace (Vector &v) |
|
string | html (const DiscreteValues &values, const KeyFormatter &keyFormatter=DefaultKeyFormatter, const DiscreteValues::Names &names={}) |
|
static std::pair< HybridConditional::shared_ptr, std::shared_ptr< Factor > > | hybridElimination (const HybridGaussianFactorGraph &factors, const Ordering &frontalKeys, const KeyVector &continuousSeparator, const std::set< DiscreteKey > &discreteSeparatorSet) |
|
const Ordering | HybridOrdering (const HybridGaussianFactorGraph &graph) |
|
IndexPairVector | IndexPairSetAsArray (IndexPairSet &set) |
|
Values | initialCamerasAndPointsEstimate (const SfmData &db) |
|
Values | initialCamerasEstimate (const SfmData &db) |
|
double | inner_prod (const V1 &a, const V2 &b) |
|
void | inplace_QR (Matrix &A) |
|
void | insertSub (Eigen::MatrixBase< Derived1 > &fullMatrix, const Eigen::MatrixBase< Derived2 > &subMatrix, size_t i, size_t j) |
|
T | interpolate (const T &X, const T &Y, double t, typename MakeOptionalJacobian< T, T >::type Hx={}, typename MakeOptionalJacobian< T, T >::type Hy={}) |
|
Matrix | inverse_square_root (const Matrix &A) |
|
static bool | is_linear_dependent (const Matrix &A, const Matrix &B, double tol) |
|
bool | isDebugVersion () |
|
static double | Kappa (const BinaryMeasurement< T > &measurement, const ShonanAveragingParameters< d > ¶meters) |
|
static std::mt19937 | kRandomNumberGenerator (42) |
|
Matrix | kroneckerProductIdentity (size_t M, const Weights &w) |
|
bool | linear_dependent (const Matrix &A, const Matrix &B, double tol) |
|
bool | linear_dependent (const Vector &vec1, const Vector &vec2, double tol) |
|
bool | linear_independent (const Matrix &A, const Matrix &B, double tol) |
|
Expression< T > | linearExpression (const std::function< T(A)> &f, const Expression< A > &expression, const Eigen::Matrix< double, traits< T >::dimension, traits< A >::dimension > &dTdA) |
|
JacobianFactor | linearizeNumerically (const NoiseModelFactor &factor, const Values &values, double delta=1e-5) |
|
double | lineSearch (const S &system, const V currentValues, const W &gradient) |
|
Matrix | LLt (const Matrix &A) |
|
GraphAndValues | load2D (const std::string &filename, SharedNoiseModel model, size_t maxIndex, bool addNoise, bool smart, NoiseFormat noiseFormat, KernelFunctionType kernelFunctionType) |
|
GraphAndValues | load2D (std::pair< std::string, SharedNoiseModel > dataset, size_t maxIndex, bool addNoise, bool smart, NoiseFormat noiseFormat, KernelFunctionType kernelFunctionType) |
|
GraphAndValues | load2D_robust (const std::string &filename, const noiseModel::Base::shared_ptr &model, size_t maxIndex) |
|
GraphAndValues | load3D (const std::string &filename) |
|
gtsam::Expression< typename gtsam::traits< T >::TangentVector > | logmap (const gtsam::Expression< T > &x1, const gtsam::Expression< T > &x2) |
|
Vector | logmap_default (const Class &l0, const Class &lp) |
|
static Symbol | make (gtsam::Key key) |
|
gtsam::enable_if_t< needs_eigen_aligned_allocator< T >::value, std::shared_ptr< T > > | make_shared (Args &&... args) |
|
std::pair< KeyVector, std::vector< int > > | makeBinaryOrdering (std::vector< Key > &input) |
|
FunctorizedFactor< R, T > | MakeFunctorizedFactor (Key key, const R &z, const SharedNoiseModel &model, const FUNC func) |
|
FunctorizedFactor2< R, T1, T2 > | MakeFunctorizedFactor2 (Key key1, Key key2, const R &z, const SharedNoiseModel &model, const FUNC func) |
|
HybridGaussianFactorGraph::shared_ptr | makeSwitchingChain (size_t n, std::function< Key(int)> keyFunc=X, std::function< Key(int)> dKeyFunc=M) |
|
string | markdown (const DiscreteValues &values, const KeyFormatter &keyFormatter=DefaultKeyFormatter, const DiscreteValues::Names &names={}) |
|
const Eigen::IOFormat & | matlabFormat () |
|
Key | maxKey (const PROBLEM &problem) |
|
Point3 | mean (const CONTAINER &points) |
|
Point2Pair | means (const std::vector< Point2Pair > &abPointPairs) |
|
Point3Pair | means (const std::vector< Point3Pair > &abPointPairs) |
|
std::pair< Pose2, bool > | moveWithBounce (const Pose2 &cur_pose, double step_size, const std::vector< SimWall2D > walls, Sampler &angle_drift, Sampler &reflect_noise, const Rot2 &bias) |
|
Key | mrsymbol (unsigned char c, unsigned char label, size_t j) |
|
unsigned char | mrsymbolChr (Key key) |
|
size_t | mrsymbolIndex (Key key) |
|
unsigned char | mrsymbolLabel (Key key) |
|
std::tuple< V, int > | nonlinearConjugateGradient (const S &system, const V &initial, const NonlinearOptimizerParams ¶ms, const bool singleIteration, const bool gradientDescent=false) |
|
double | norm2 (const Point2 &p, OptionalJacobian< 1, 2 > H={}) |
|
double | norm3 (const Point3 &p, OptionalJacobian< 1, 3 > H={}) |
|
Unit3_ | normal (const OrientedPlane3_ &p) |
|
Point3 | normalize (const Point3 &p, OptionalJacobian< 3, 3 > H={}) |
|
Point3_ | normalize (const Point3_ &a) |
|
static void | normalize (Signature::Row &row) |
|
static size_t | NrUnknowns (const typename ShonanAveraging< d >::Measurements &measurements) |
|
internal::FixedSizeMatrix< Y, X >::type | numericalDerivative11 (std::function< Y(const X &)> h, const X &x, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X >::type | numericalDerivative11 (Y(*h)(const X &), const X &x, double delta=1e-5) |
|
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) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative21 (Y(*h)(const X1 &, const X2 &), const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative22 (std::function< Y(const X1 &, const X2 &)> h, const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative22 (Y(*h)(const X1 &, const X2 &), const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative31 (std::function< Y(const X1 &, const X2 &, const X3 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative31 (Y(*h)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative32 (std::function< Y(const X1 &, const X2 &, const X3 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative32 (Y(*h)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative33 (std::function< Y(const X1 &, const X2 &, const X3 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative33 (Y(*h)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative41 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative41 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative42 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative42 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative43 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative43 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X4 >::type | numericalDerivative44 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X4 >::type | numericalDerivative44 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative51 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative51 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative52 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative52 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative53 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative53 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X4 >::type | numericalDerivative54 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X4 >::type | numericalDerivative54 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X5 >::type | numericalDerivative55 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X5 >::type | numericalDerivative55 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative61 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X1 >::type | numericalDerivative61 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative62 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X2 >::type | numericalDerivative62 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative63 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X3 >::type | numericalDerivative63 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X4 >::type | numericalDerivative64 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X4 >::type | numericalDerivative64 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X5 >::type | numericalDerivative65 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X5 >::type | numericalDerivative65 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X6 >::type | numericalDerivative66 (std::function< Y(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &)> h, const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
internal::FixedSizeMatrix< Y, X6 >::type | numericalDerivative66 (Y(*h)(const X1 &, const X2 &, const X3 &, const X4 &, const X5 &, const X6 &), const X1 &x1, const X2 &x2, const X3 &x3, const X4 &x4, const X5 &x5, const X6 &x6, double delta=1e-5) |
|
Eigen::Matrix< double, N, 1 > | numericalGradient (std::function< double(const X &)> h, const X &x, double delta=1e-5) |
|
internal::FixedSizeMatrix< X, X >::type | numericalHessian (double(*f)(const X &), const X &x, double delta=1e-5) |
|
internal::FixedSizeMatrix< X, X >::type | numericalHessian (std::function< double(const X &)> f, const X &x, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X1 >::type | numericalHessian211 (double(*f)(const X1 &, const X2 &), const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X1 >::type | numericalHessian211 (std::function< double(const X1 &, const X2 &)> f, const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X2 >::type | numericalHessian212 (double(*f)(const X1 &, const X2 &), const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X2 >::type | numericalHessian212 (std::function< double(const X1 &, const X2 &)> f, const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< X2, X2 >::type | numericalHessian222 (double(*f)(const X1 &, const X2 &), const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< X2, X2 >::type | numericalHessian222 (std::function< double(const X1 &, const X2 &)> f, const X1 &x1, const X2 &x2, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X1 >::type | numericalHessian311 (double(*f)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X1 >::type | numericalHessian311 (std::function< double(const X1 &, const X2 &, const X3 &)> f, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X2 >::type | numericalHessian312 (double(*f)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X2 >::type | numericalHessian312 (std::function< double(const X1 &, const X2 &, const X3 &)> f, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X3 >::type | numericalHessian313 (double(*f)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X1, X3 >::type | numericalHessian313 (std::function< double(const X1 &, const X2 &, const X3 &)> f, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X2, X2 >::type | numericalHessian322 (double(*f)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X2, X2 >::type | numericalHessian322 (std::function< double(const X1 &, const X2 &, const X3 &)> f, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X2, X3 >::type | numericalHessian323 (double(*f)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X2, X3 >::type | numericalHessian323 (std::function< double(const X1 &, const X2 &, const X3 &)> f, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X3, X3 >::type | numericalHessian333 (double(*f)(const X1 &, const X2 &, const X3 &), const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
internal::FixedSizeMatrix< X3, X3 >::type | numericalHessian333 (std::function< double(const X1 &, const X2 &, const X3 &)> f, const X1 &x1, const X2 &x2, const X3 &x3, double delta=1e-5) |
|
Pose3 | openGL2gtsam (const Rot3 &R, double tx, double ty, double tz) |
|
Rot3 | openGLFixedRotation () |
|
bool | operator!= (const Matrix &A, const Matrix &B) |
|
Signature | operator% (const DiscreteKey &key, const Signature::Table &parent) |
|
GTSAM_EXPORT Signature | operator% (const DiscreteKey &key, const std::string &parent) |
|
DiscreteKeys | operator& (const DiscreteKey &key1, const DiscreteKey &key2) |
|
VectorValues | operator* (const double a, const VectorValues &c) |
|
Expression< T > | operator* (const Expression< T > &expression1, const Expression< T > &expression2) |
|
ScalarMultiplyExpression< T > | operator* (double s, const Expression< T > &e) |
|
Point2 | operator* (double s, const Point2 &p) |
|
Errors | operator+ (const Errors &a, const Errors &b) |
|
BinarySumExpression< T > | operator+ (const Expression< T > &e1, const Expression< T > &e2) |
|
Errors | operator- (const Errors &a) |
|
Errors | operator- (const Errors &a, const Errors &b) |
|
BinarySumExpression< T > | operator- (const Expression< T > &e1, const Expression< T > &e2) |
|
ostream & | operator<< (ostream &os, const EssentialMatrix &E) |
|
ostream & | operator<< (ostream &os, const gtsam::Point2Pair &p) |
|
ostream & | operator<< (ostream &os, const gtsam::Point3Pair &p) |
|
ostream & | operator<< (ostream &os, const IterativeOptimizationParameters &p) |
|
ostream & | operator<< (ostream &os, const key_formatter &m) |
|
ostream & | operator<< (ostream &os, const PreconditionerParameters &p) |
|
ostream & | operator<< (ostream &os, const PreintegrationBase &pim) |
|
ostream & | operator<< (ostream &os, const Rot3 &R) |
|
ostream & | operator<< (ostream &os, const Signature &s) |
|
ostream & | operator<< (ostream &os, const Signature::Row &row) |
|
ostream & | operator<< (ostream &os, const Signature::Table &table) |
|
ostream & | operator<< (ostream &os, const StereoPoint2 &p) |
|
ostream & | operator<< (ostream &os, const StreamedKey &streamedKey) |
|
ostream & | operator<< (ostream &os, const Subgraph &subgraph) |
|
ostream & | operator<< (ostream &os, const Subgraph::Edge &edge) |
|
ostream & | operator<< (ostream &os, const SubgraphBuilderParameters &p) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3 &cal) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3_S2 &cal) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3_S2Stereo &cal) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3Bundler &cal) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3DS2 &cal) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3DS2_Base &cal) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3Fisheye &cal) |
|
std::ostream & | operator<< (std::ostream &os, const Cal3Unified &cal) |
|
std::ostream & | operator<< (std::ostream &os, const CombinedImuFactor &f) |
|
std::ostream & | operator<< (std::ostream &os, const Dih6 &m) |
|
GTSAM_EXPORT std::ostream & | operator<< (std::ostream &os, const gtsam::Point2Pair &p) |
|
GTSAM_EXPORT std::ostream & | operator<< (std::ostream &os, const gtsam::Point3Pair &p) |
|
std::ostream & | operator<< (std::ostream &os, const ImuFactor &f) |
|
std::ostream & | operator<< (std::ostream &os, const ImuFactor2 &f) |
|
GTSAM_EXPORT std::ostream & | operator<< (std::ostream &os, const LabeledSymbol &symbol) |
|
std::ostream & | operator<< (std::ostream &os, const NavState &state) |
|
std::ostream & | operator<< (std::ostream &os, const Pose2 &pose) |
|
std::ostream & | operator<< (std::ostream &os, const Pose3 &pose) |
|
std::ostream & | operator<< (std::ostream &os, const Similarity2 &p) |
|
std::ostream & | operator<< (std::ostream &os, const Similarity3 &p) |
|
GTSAM_EXPORT std::ostream & | operator<< (std::ostream &os, const Symbol &symbol) |
|
std::ostream & | operator<< (std::ostream &os, const Unit3 &pair) |
|
GTSAM_EXPORT std::ostream & | operator<< (std::ostream &os, const VectorValues &v) |
|
std::ostream & | operator<< (std::ostream &stream, const ImuMeasurement &meas) |
|
bool | operator== (const Matrix &A, const Matrix &B) |
|
bool | operator== (const Vector &vec1, const Vector &vec2) |
|
istream & | operator>> (istream &inputStream, Matrix &destinationMatrix) |
|
istream & | operator>> (istream &is, EssentialMatrix &E) |
|
GTSAM_EXPORT std::istream & | operator>> (std::istream &inputStream, Matrix &destinationMatrix) |
|
std::istream & | operator>> (std::istream &is, Matrix6 &m) |
|
std::istream & | operator>> (std::istream &is, Quaternion &q) |
|
std::istream & | operator>> (std::istream &is, Rot3 &R) |
|
Vector | operator^ (const Matrix &A, const Vector &v) |
|
Signature | operator| (const DiscreteKey &key, const DiscreteKey &parent) |
|
Point3 | optimize (const NonlinearFactorGraph &graph, const Values &values, Key landmarkKey) |
|
size_t | optimizeWildfire (const ISAM2Clique::shared_ptr &root, double threshold, const KeySet &keys, VectorValues *delta) |
|
size_t | optimizeWildfireNonRecursive (const ISAM2Clique::shared_ptr &root, double threshold, const KeySet &keys, VectorValues *delta) |
|
FastVector< VariableSlots::const_iterator > | orderedSlotsHelper (const Ordering &ordering, const VariableSlots &variableSlots) |
|
BetweenFactorPose2s | parse2DFactors (const std::string &filename, const noiseModel::Diagonal::shared_ptr &model, size_t maxIndex) |
|
BetweenFactorPose3s | parse3DFactors (const std::string &filename, const noiseModel::Diagonal::shared_ptr &model, size_t maxIndex) |
|
static Table | ParseAnd () |
|
static std::optional< Row > | ParseConditional (const std::string &token) |
|
static std::optional< Table > | ParseConditionalTable (const std::vector< std::string > &tokens) |
|
std::optional< IndexedEdge > | parseEdge (std::istream &is, const std::string &tag) |
|
GTSAM_EXPORT std::vector< typename BetweenFactor< T >::shared_ptr > | parseFactors (const std::string &filename, const noiseModel::Diagonal::shared_ptr &model=nullptr, size_t maxIndex=0) |
|
GTSAM_EXPORT std::vector< BetweenFactor< Pose2 >::shared_ptr > | parseFactors< Pose2 > (const std::string &filename, const noiseModel::Diagonal::shared_ptr &model, size_t maxIndex) |
|
GTSAM_EXPORT std::vector< BetweenFactor< Pose3 >::shared_ptr > | parseFactors< Pose3 > (const std::string &filename, const noiseModel::Diagonal::shared_ptr &model, size_t maxIndex) |
|
static Row | ParseFalseRow () |
|
static void | parseLines (const std::string &filename, Parser< T > parse) |
|
GTSAM_EXPORT std::vector< BinaryMeasurement< Pose2 > > | parseMeasurements (const std::string &filename, const noiseModel::Diagonal::shared_ptr &model, size_t maxIndex) |
|
static Table | ParseOr () |
|
std::map< size_t, T > | parseToMap (const std::string &filename, Parser< std::pair< size_t, T >> parse, size_t maxIndex) |
|
static std::vector< T > | parseToVector (const std::string &filename, Parser< T > parse) |
|
static Row | ParseTrueRow () |
|
GTSAM_EXPORT std::map< size_t, T > | parseVariables (const std::string &filename, size_t maxIndex=0) |
|
GTSAM_EXPORT std::map< size_t, Point2 > | parseVariables< Point2 > (const std::string &filename, size_t maxIndex) |
|
GTSAM_EXPORT std::map< size_t, Point3 > | parseVariables< Point3 > (const std::string &filename, size_t maxIndex) |
|
GTSAM_EXPORT std::map< size_t, Pose2 > | parseVariables< Pose2 > (const std::string &filename, size_t maxIndex) |
|
GTSAM_EXPORT std::map< size_t, Pose3 > | parseVariables< Pose3 > (const std::string &filename, size_t maxIndex) |
|
std::optional< IndexedLandmark > | parseVertexLandmark (std::istream &is, const std::string &tag) |
|
std::optional< std::pair< size_t, Point3 > > | parseVertexPoint3 (std::istream &is, const std::string &tag) |
|
std::optional< IndexedPose > | parseVertexPose (std::istream &is, const std::string &tag) |
|
std::optional< std::pair< size_t, Pose3 > > | parseVertexPose3 (std::istream &is, const std::string &tag) |
|
static Vector | perturb (const Vector &initialVector) |
|
Point3_ | point3 (const Unit3_ &v) |
|
Point3_ | position (const NavState_ &X) |
|
static bool | PowerMinimumEigenValue (const Sparse &A, const Matrix &S, double &minEigenValue, Vector *minEigenVector=0, size_t *numIterations=0, size_t maxIterations=1000, double minEigenvalueNonnegativityTolerance=10e-4) |
|
V | preconditionedConjugateGradient (const S &system, const V &initial, const ConjugateGradientParameters ¶meters) |
|
std::tuple< G, V, std::map< KEY, V > > | predecessorMap2Graph (const PredecessorMap< KEY > &p_map) |
|
std::list< KEY > | predecessorMap2Keys (const PredecessorMap< KEY > &p_map) |
|
void | Print (const CONTAINER &keys, const string &s, const KeyFormatter &keyFormatter) |
|
GTSAM_EXPORT void | print (const Errors &e, const std::string &s="Errors") |
|
GTSAM_EXPORT void | print (const Matrix &A, const std::string &s, std::ostream &stream) |
|
GTSAM_EXPORT void | print (const Matrix &A, const std::string &s="") |
|
void | print (const Matrix &A, const string &s, ostream &stream) |
|
GTSAM_EXPORT void | print (const Vector &v, const std::string &s, std::ostream &stream) |
|
GTSAM_EXPORT void | print (const Vector &v, const std::string &s="") |
|
void | print (const Vector &v, const string &s, ostream &stream) |
|
void | print (double v, const std::string &s="") |
|
void | print (float v, const std::string &s="") |
|
GTSAM_EXPORT void | PrintKey (Key key, const std::string &s="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) |
|
GTSAM_EXPORT void | PrintKeyList (const KeyList &keys, const std::string &s="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) |
|
GTSAM_EXPORT void | PrintKeySet (const KeySet &keys, const std::string &s="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) |
|
GTSAM_EXPORT void | PrintKeyVector (const KeyVector &keys, const std::string &s="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) |
|
MATRIX | prod (const MATRIX &A, const MATRIX &B) |
|
Point2_ | project (const Point3_ &p_cam) |
|
Point2_ | project (const Unit3_ &p_cam) |
|
Point2_ | project2 (const Expression< CAMERA > &camera_, const Expression< POINT > &p_) |
|
Point2_ | project3 (const Pose3_ &x, const Expression< POINT > &p, const Expression< CALIBRATION > &K) |
|
std::vector< Matrix34, Eigen::aligned_allocator< Matrix34 > > | projectionMatricesFromCameras (const CameraSet< CAMERA > &cameras) |
|
std::vector< Matrix34, Eigen::aligned_allocator< Matrix34 > > | projectionMatricesFromPoses (const std::vector< Pose3 > &poses, std::shared_ptr< CALIBRATION > sharedCal) |
|
std::function< double(const Assignment< Key > &, double)> | prunerFunc (const DecisionTreeFactor &prunedDiscreteProbs, const HybridConditional &conditional) |
|
pair< Matrix, Matrix > | qr (const Matrix &A) |
|
Double_ | range (const Point2_ &p, const Point2_ &q) |
|
SfmData | readBal (const std::string &filename) |
|
GraphAndValues | readG2o (const std::string &g2oFile, const bool is3D=false, KernelFunctionType kernelFunctionType=KernelFunctionTypeNONE) |
|
void | recursiveMarkAffectedKeys (const Key &key, const ISAM2Clique::shared_ptr &clique, std::set< Key > &additionalKeys) |
|
GaussianFactorGraphTree | removeEmpty (const GaussianFactorGraphTree &sum) |
|
Reshape< OutM, OutN, OutOptions, InM, InN, InOptions >::ReshapedType | reshape (const Eigen::Matrix< double, InM, InN, InOptions > &m) |
|
Point3_ | rotate (const Rot3_ &x, const Point3_ &p) |
|
Unit3_ | rotate (const Rot3_ &x, const Unit3_ &p) |
|
Rot3_ | rotation (const Pose3_ &pose) |
|
static Matrix | RoundSolutionS (const Matrix &S) |
|
const MATRIX::ConstRowXpr | row (const MATRIX &A, size_t j) |
|
pair< Matrix3, Vector3 > | RQ (const Matrix3 &A, OptionalJacobian< 3, 9 > H) |
|
Matrix | RtR (const Matrix &A) |
|
GTSAM_EXPORT void | save (const Matrix &A, const std::string &s, const std::string &filename) |
|
GTSAM_EXPORT void | save (const Vector &A, const std::string &s, const std::string &filename) |
|
void | save2D (const NonlinearFactorGraph &graph, const Values &config, const noiseModel::Diagonal::shared_ptr model, const std::string &filename) |
|
static double | scale (double x, double a, double b, double t1, double t2) |
|
static Scatter | scatterFromValues (const Values &values) |
|
static Scatter | scatterFromValues (const Values &values, const Ordering &ordering) |
|
std::string | serializeGraph (const NonlinearFactorGraph &graph) |
|
bool | serializeGraphToFile (const NonlinearFactorGraph &graph, const std::string &fname) |
|
bool | serializeGraphToXMLFile (const NonlinearFactorGraph &graph, const std::string &fname, const std::string &name="graph") |
|
std::string | serializeGraphXML (const NonlinearFactorGraph &graph, const std::string &name="graph") |
|
std::string | serializeValues (const Values &values) |
|
bool | serializeValuesToFile (const Values &values, const std::string &fname) |
|
bool | serializeValuesToXMLFile (const Values &values, const std::string &fname, const std::string &name="values") |
|
std::string | serializeValuesXML (const Values &values, const std::string &name="values") |
|
static void | setSubvector (const Vector &src, const KeyInfo &keyInfo, const KeyVector &keys, Vector &dst) |
|
Matrix3 | skewSymmetric (const Eigen::MatrixBase< Derived > &w) |
|
Matrix3 | skewSymmetric (double wx, double wy, double wz) |
|
SparseEigen | sparseJacobianEigen (const GaussianFactorGraph &gfg) |
|
SparseEigen | sparseJacobianEigen (const GaussianFactorGraph &gfg, const Ordering &ordering) |
|
static bool | SparseMinimumEigenValue (const Sparse &A, const Matrix &S, double *minEigenValue, Vector *minEigenVector=0, size_t *numIterations=0, size_t maxIterations=1000, double minEigenvalueNonnegativityTolerance=10e-4, Eigen::Index numLanczosVectors=20) |
|
void | split (const G &g, const PredecessorMap< KEY > &tree, G &Ab1, G &Ab2) |
|
std::pair< GaussianFactorGraph, GaussianFactorGraph > | splitFactorGraph (const GaussianFactorGraph &factorGraph, const Subgraph &subgraph) |
|
Matrix | stack (const std::vector< Matrix > &blocks) |
|
Matrix | stack (size_t nrMatrices,...) |
|
VectorValues | steepestDescent (const GaussianFactorGraph &fg, const VectorValues &x, const ConjugateGradientParameters ¶meters) |
|
Vector | steepestDescent (const Matrix &A, const Vector &b, const Vector &x, const ConjugateGradientParameters ¶meters) |
|
Vector | steepestDescent (const System &Ab, const Vector &x, const ConjugateGradientParameters ¶meters) |
|
GTSAM_EXPORT Vector | steepestDescent (const System &Ab, const Vector &x, const IterativeOptimizationParameters ¶meters) |
|
GTSAM_EXPORT Matrix43 | stiefel (const SO4 &Q, OptionalJacobian< 12, 6 > H) |
|
static void | streamSignature (const DiscreteConditional &conditional, const KeyFormatter &keyFormatter, stringstream *ss) |
|
Eigen::Block< const MATRIX > | sub (const MATRIX &A, size_t i1, size_t i2, size_t j1, size_t j2) |
|
void | svd (const Matrix &A, Matrix &U, Vector &S, Matrix &V) |
|
Key | symbol (unsigned char c, std::uint64_t j) |
|
unsigned char | symbolChr (Key key) |
|
std::uint64_t | symbolIndex (Key key) |
|
void | synchronize (ConcurrentFilter &filter, ConcurrentSmoother &smoother) |
|
| TEST (LPInitSolver, InfiniteLoopMultiVar) |
|
| TEST (LPInitSolver, InfiniteLoopSingleVar) |
|
| TEST (LPInitSolver, Initialization) |
|
| TEST (SmartFactorBase, Pinhole) |
|
| TEST (SmartFactorBase, PinholeWithSensor) |
|
| TEST (SmartFactorBase, Stereo) |
|
void | testChartDerivatives (TestResult &result_, const std::string &name_, const G &t1, const G &t2) |
|
void | testDefaultChart (TestResult &result_, const std::string &name_, const T &value) |
|
void | testLieGroupDerivatives (TestResult &result_, const std::string &name_, const G &t1, const G &t2) |
|
static void | throwRuntimeError (const std::string &s, const std::shared_ptr< Factor > &f) |
|
void | tictoc_finishedIteration_ () |
|
void | tictoc_print2_ () |
|
void | tictoc_print_ () |
|
void | tictoc_reset_ () |
|
SDGraph< KEY > | toBoostGraph (const G &graph) |
|
static std::vector< std::string > | Tokenize (const std::string &str) |
|
GTSAM_EXPORT Matrix3 | topLeft (const SO4 &Q, OptionalJacobian< 9, 6 > H) |
|
Matrix | trans (const Matrix &A) |
|
P | transform_point (const T &trans, const P &global, OptionalMatrixType Dtrans, OptionalMatrixType Dglobal) |
|
Point3_ | transformFrom (const Pose3_ &x, const Point3_ &p) |
|
Pose3_ | transformPoseTo (const Pose3_ &p, const Pose3_ &q) |
|
Point2_ | transformTo (const Pose2_ &x, const Point2_ &p) |
|
Line3 | transformTo (const Pose3 &wTc, const Line3 &wL, OptionalJacobian< 4, 6 > Dpose, OptionalJacobian< 4, 4 > Dline) |
|
Line3_ | transformTo (const Pose3_ &wTc, const Line3_ &wL) |
|
Point3_ | transformTo (const Pose3_ &x, const Point3_ &p) |
|
Point3_ | translation (const Pose3_ &pose) |
|
Point3 | triangulateDLT (const std::vector< Matrix34, Eigen::aligned_allocator< Matrix34 >> &projection_matrices, const Point2Vector &measurements, double rank_tol) |
|
Point3 | triangulateDLT (const std::vector< Matrix34, Eigen::aligned_allocator< Matrix34 >> &projection_matrices, const std::vector< Unit3 > &measurements, double rank_tol) |
|
Vector4 | triangulateHomogeneousDLT (const std::vector< Matrix34, Eigen::aligned_allocator< Matrix34 >> &projection_matrices, const Point2Vector &measurements, double rank_tol) |
|
Vector4 | triangulateHomogeneousDLT (const std::vector< Matrix34, Eigen::aligned_allocator< Matrix34 >> &projection_matrices, const std::vector< Unit3 > &measurements, double rank_tol) |
|
Point3 | triangulateLOST (const std::vector< Pose3 > &poses, const Point3Vector &calibratedMeasurements, const SharedIsotropic &measurementNoise, double rank_tol=1e-9) |
|
Point3 | triangulateNonlinear (const CameraSet< CAMERA > &cameras, const typename CAMERA::MeasurementVector &measurements, const Point3 &initialEstimate, const SharedNoiseModel &model=nullptr) |
|
Point3 | triangulateNonlinear (const std::vector< Pose3 > &poses, std::shared_ptr< CALIBRATION > sharedCal, const Point2Vector &measurements, const Point3 &initialEstimate, const SharedNoiseModel &model=nullptr) |
|
Point3 | triangulatePoint3 (const CameraSet< CAMERA > &cameras, const typename CAMERA::MeasurementVector &measurements, double rank_tol=1e-9, bool optimize=false, const SharedNoiseModel &model=nullptr, const bool useLOST=false) |
|
Point3 | triangulatePoint3 (const CameraSet< PinholeCamera< CALIBRATION >> &cameras, const Point2Vector &measurements, double rank_tol=1e-9, bool optimize=false, const SharedNoiseModel &model=nullptr, const bool useLOST=false) |
|
Point3 | triangulatePoint3 (const std::vector< Pose3 > &poses, std::shared_ptr< CALIBRATION > sharedCal, const Point2Vector &measurements, double rank_tol=1e-9, bool optimize=false, const SharedNoiseModel &model=nullptr, const bool useLOST=false) |
|
TriangulationResult | triangulateSafe (const CameraSet< CAMERA > &cameras, const typename CAMERA::MeasurementVector &measured, const TriangulationParameters ¶ms) |
|
std::pair< NonlinearFactorGraph, Values > | triangulationGraph (const CameraSet< CAMERA > &cameras, const typename CAMERA::MeasurementVector &measurements, Key landmarkKey, const Point3 &initialEstimate, const SharedNoiseModel &model=nullptr) |
|
std::pair< NonlinearFactorGraph, Values > | triangulationGraph (const std::vector< Pose3 > &poses, std::shared_ptr< CALIBRATION > sharedCal, const Point2Vector &measurements, Key landmarkKey, const Point3 &initialEstimate, const SharedNoiseModel &model=noiseModel::Unit::Create(2)) |
|
Point2_ | uncalibrate (const Expression< CALIBRATION > &K, const Point2_ &xy_hat) |
|
MEASUREMENT | undistortMeasurementInternal (const CALIBRATION &cal, const MEASUREMENT &measurement, std::optional< Cal3_S2 > pinholeCal={}) |
|
Point2Vector | undistortMeasurements (const Cal3_S2 &cal, const Point2Vector &measurements) |
|
Point2Vector | undistortMeasurements (const CALIBRATION &cal, const Point2Vector &measurements) |
|
CAMERA::MeasurementVector | undistortMeasurements (const CameraSet< CAMERA > &cameras, const typename CAMERA::MeasurementVector &measurements) |
|
PinholeCamera< Cal3_S2 >::MeasurementVector | undistortMeasurements (const CameraSet< PinholeCamera< Cal3_S2 >> &cameras, const PinholeCamera< Cal3_S2 >::MeasurementVector &measurements) |
|
SphericalCamera::MeasurementVector | undistortMeasurements (const CameraSet< SphericalCamera > &cameras, const SphericalCamera::MeasurementVector &measurements) |
|
Point3_ | unrotate (const Rot3_ &x, const Point3_ &p) |
|
Unit3_ | unrotate (const Rot3_ &x, const Unit3_ &p) |
|
std::pair< DecisionTree< L, T1 >, DecisionTree< L, T2 > > | unzip (const DecisionTree< L, std::pair< T1, T2 > > &input) |
|
static std::string | valueFormatter (const double &v) |
|
static Vector9 | vec3 (const Matrix3 &R) |
|
static SO4::VectorN2 | vec4 (const Matrix4 &Q) |
|
Matrix | vector_scale (const Matrix &A, const Vector &v, bool inf_mask) |
|
Matrix | vector_scale (const Vector &v, const Matrix &A, bool inf_mask) |
|
void | vector_scale_inplace (const Vector &v, Matrix &A, bool inf_mask) |
|
Velocity3_ | velocity (const NavState_ &X) |
|
Matrix | wedge (const Vector &x) |
|
Matrix | wedge< Pose2 > (const Vector &xi) |
|
Matrix | wedge< Pose3 > (const Vector &xi) |
|
Matrix | wedge< Similarity3 > (const Vector &xi) |
|
list< std::tuple< Vector, double, double > > | weighted_eliminate (Matrix &A, Vector &b, const Vector &sigmas) |
|
pair< Vector, double > | weightedPseudoinverse (const Vector &a, const Vector &weights) |
|
double | weightedPseudoinverse (const Vector &a, const Vector &weights, Vector &pseudo) |
|
bool | writeBAL (const std::string &filename, const SfmData &data) |
|
bool | writeBALfromValues (const std::string &filename, const SfmData &data, const Values &values) |
|
void | writeG2o (const NonlinearFactorGraph &graph, const Values &estimate, const std::string &filename) |
|
void | zeroBelowDiagonal (MATRIX &A, size_t cols=0) |
|