gtsam-develop 4.3a0.dev202508252029__cp310-cp310-macosx_11_0_arm64.whl → 4.3a0.dev202509090331__cp310-cp310-macosx_11_0_arm64.whl
This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.
Potentially problematic release.
This version of gtsam-develop might be problematic. Click here for more details.
- gtsam/.dylibs/{libgtsam.4.3a0.dev202508252029.dylib → libgtsam.4.3a0.dev202509090331.dylib} +0 -0
- gtsam/.dylibs/{libgtsam_unstable.4.3a0.dev202508252029.dylib → libgtsam_unstable.4.3a0.dev202509090331.dylib} +0 -0
- gtsam/Data/gazebo_ASV.csv +990 -0
- gtsam/__init__.pyi +56 -16
- gtsam/gtsam/__init__.pyi +377 -9
- gtsam/gtsam.cpython-310-darwin.so +0 -0
- gtsam/tests/test_FrobeniusFactor.py +43 -11
- {gtsam_develop-4.3a0.dev202508252029.dist-info → gtsam_develop-4.3a0.dev202509090331.dist-info}/METADATA +2 -2
- {gtsam_develop-4.3a0.dev202508252029.dist-info → gtsam_develop-4.3a0.dev202509090331.dist-info}/RECORD +12 -11
- gtsam_unstable/gtsam_unstable.cpython-310-darwin.so +0 -0
- {gtsam_develop-4.3a0.dev202508252029.dist-info → gtsam_develop-4.3a0.dev202509090331.dist-info}/WHEEL +0 -0
- {gtsam_develop-4.3a0.dev202508252029.dist-info → gtsam_develop-4.3a0.dev202509090331.dist-info}/top_level.txt +0 -0
gtsam/gtsam/__init__.pyi
CHANGED
|
@@ -11,7 +11,7 @@ from . import noiseModel
|
|
|
11
11
|
from . import so3
|
|
12
12
|
from . import symbol_shorthand
|
|
13
13
|
from . import utilities
|
|
14
|
-
__all__: list[str] = ['AHRSFactor', 'AcceleratingScenario', 'AlgebraicDecisionTreeKey', 'AssignmentKey', 'BarometricFactor', 'BatchFixedLagSmoother', 'BearingFactor2D', 'BearingFactor3D', 'BearingFactorPose2', 'BearingRange2D', 'BearingRange3D', 'BearingRangeFactor2D', 'BearingRangeFactor3D', 'BearingRangeFactorPose2', 'BearingRangeFactorPose3', 'BearingRangePose2', 'BearingRangePose3', 'BetweenFactorConstantBias', 'BetweenFactorDouble', 'BetweenFactorPoint2', 'BetweenFactorPoint3', 'BetweenFactorPose2', 'BetweenFactorPose3', 'BetweenFactorRot2', 'BetweenFactorRot3', 'BetweenFactorSL4', 'BetweenFactorSO3', 'BetweenFactorSO4', 'BetweenFactorSimilarity2', 'BetweenFactorSimilarity3', 'BetweenFactorVector', 'BinaryMeasurementPoint3', 'BinaryMeasurementRot3', 'BinaryMeasurementUnit3', 'BlockJacobiPreconditionerParameters', 'Cal3', 'Cal3Bundler', 'Cal3DS2', 'Cal3DS2_Base', 'Cal3Fisheye', 'Cal3Unified', 'Cal3_S2', 'Cal3_S2Stereo', 'Cal3f', 'CalibratedCamera', 'CameraSetCal3Bundler', 'CameraSetCal3DS2', 'CameraSetCal3Fisheye', 'CameraSetCal3Unified', 'CameraSetCal3_S2', 'CameraSetPinholePoseCal3_S2', 'Chebyshev1Basis', 'Chebyshev2', 'Chebyshev2Basis', 'CombinedImuFactor', 'ComponentDerivativeFactorChebyshev1Basis', 'ComponentDerivativeFactorChebyshev2', 'ComponentDerivativeFactorChebyshev2Basis', 'ComponentDerivativeFactorFourierBasis', 'ConjugateGradientParameters', 'ConstantTwistScenario', 'ConstantVelocityFactor', 'ConvertNoiseModel', 'CustomFactor', 'DSFMapIndexPair', 'DecisionTreeFactor', 'DegeneracyMode', 'DerivativeFactorChebyshev1Basis', 'DerivativeFactorChebyshev2', 'DerivativeFactorChebyshev2Basis', 'DerivativeFactorFourierBasis', 'DiscreteBayesNet', 'DiscreteBayesTree', 'DiscreteBayesTreeClique', 'DiscreteCluster', 'DiscreteConditional', 'DiscreteDistribution', 'DiscreteEliminationTree', 'DiscreteFactor', 'DiscreteFactorGraph', 'DiscreteJunctionTree', 'DiscreteKeys', 'DiscreteLookupDAG', 'DiscreteLookupTable', 'DiscreteMarginals', 'DiscreteScenario', 'DiscreteSearch', 'DiscreteSearchSolution', 'DiscreteValues', 'DoglegOptimizer', 'DoglegParams', 'DotWriter', 'DummyPreconditionerParameters', 'EdgeKey', 'EliminateDiscrete', 'EliminateForMPE', 'EliminateQR', 'EpipolarTransfer', 'EssentialMatrix', 'EssentialMatrixConstraint', 'EssentialMatrixFactor', 'EssentialMatrixFactor2', 'EssentialMatrixFactor3', 'EssentialMatrixFactor4Cal3Bundler', 'EssentialMatrixFactor4Cal3DS2', 'EssentialMatrixFactor4Cal3Fisheye', 'EssentialMatrixFactor4Cal3Unified', 'EssentialMatrixFactor4Cal3_S2', 'EssentialMatrixFactor4Cal3f', 'EssentialMatrixFactor5Cal3Bundler', 'EssentialMatrixFactor5Cal3DS2', 'EssentialMatrixFactor5Cal3Fisheye', 'EssentialMatrixFactor5Cal3Unified', 'EssentialMatrixFactor5Cal3_S2', 'EssentialMatrixFactor5Cal3f', 'EssentialTransferFactorCal3Bundler', 'EssentialTransferFactorCal3_S2', 'EssentialTransferFactorCal3f', 'EssentialTransferFactorKCal3Bundler', 'EssentialTransferFactorKCal3_S2', 'EssentialTransferFactorKCal3f', 'EvaluationFactorChebyshev1Basis', 'EvaluationFactorChebyshev2', 'EvaluationFactorChebyshev2Basis', 'EvaluationFactorFourierBasis', 'Event', 'ExtendedKalmanFilterConstantBias', 'ExtendedKalmanFilterNavState', 'ExtendedKalmanFilterPoint2', 'ExtendedKalmanFilterPoint3', 'ExtendedKalmanFilterPose2', 'ExtendedKalmanFilterPose3', 'ExtendedKalmanFilterRot2', 'ExtendedKalmanFilterRot3', 'ExtendedKalmanFilterSL4', 'ExtendedKalmanFilterSimilarity2', 'ExtendedKalmanFilterSimilarity3', 'Factor', 'FindKarcherMeanPoint2', 'FindKarcherMeanPoint3', 'FindKarcherMeanPose2', 'FindKarcherMeanPose3', 'FindKarcherMeanRot2', 'FindKarcherMeanRot3', 'FindKarcherMeanSO3', 'FindKarcherMeanSO4', 'FitBasisChebyshev1Basis', 'FitBasisChebyshev2', 'FitBasisChebyshev2Basis', 'FitBasisFourierBasis', 'FixedLagSmoother', 'FixedLagSmootherResult', 'FourierBasis', 'FrobeniusBetweenFactorGal3', 'FrobeniusBetweenFactorPose2', 'FrobeniusBetweenFactorPose3', 'FrobeniusBetweenFactorRot2', 'FrobeniusBetweenFactorRot3', 'FrobeniusBetweenFactorSO3', 'FrobeniusBetweenFactorSO4', 'FrobeniusBetweenFactorSimilarity2', 'FrobeniusBetweenFactorSimilarity3', 'FrobeniusFactorGal3', 'FrobeniusFactorPose2', 'FrobeniusFactorPose3', 'FrobeniusFactorRot2', 'FrobeniusFactorRot3', 'FrobeniusFactorSO3', 'FrobeniusFactorSO4', 'FrobeniusFactorSimilarity2', 'FrobeniusFactorSimilarity3', 'FrobeniusPriorGal3', 'FrobeniusPriorPose2', 'FrobeniusPriorPose3', 'FrobeniusPriorRot2', 'FrobeniusPriorRot3', 'FrobeniusPriorSO3', 'FrobeniusPriorSO4', 'FrobeniusPriorSimilarity2', 'FrobeniusPriorSimilarity3', 'FundamentalMatrix', 'GPSFactor', 'GPSFactor2', 'GPSFactor2Arm', 'GPSFactor2ArmCalib', 'GPSFactorArm', 'GPSFactorArmCalib', 'Gal3', 'GaussNewtonOptimizer', 'GaussNewtonParams', 'GaussianBayesNet', 'GaussianBayesTree', 'GaussianBayesTreeClique', 'GaussianConditional', 'GaussianDensity', 'GaussianEliminationTree', 'GaussianFactor', 'GaussianFactorGraph', 'GaussianISAM', 'GeneralSFMFactor2Cal3Bundler', 'GeneralSFMFactor2Cal3DS2', 'GeneralSFMFactor2Cal3Fisheye', 'GeneralSFMFactor2Cal3Unified', 'GeneralSFMFactor2Cal3_S2', 'GeneralSFMFactor2Cal3f', 'GeneralSFMFactorCal3Bundler', 'GeneralSFMFactorCal3DS2', 'GeneralSFMFactorCal3Fisheye', 'GeneralSFMFactorCal3Unified', 'GeneralSFMFactorCal3_S2', 'GeneralSFMFactorPoseCal3Bundler', 'GeneralSFMFactorPoseCal3DS2', 'GeneralSFMFactorPoseCal3Fisheye', 'GeneralSFMFactorPoseCal3Unified', 'GeneralSFMFactorPoseCal3_S2', 'GenericProjectionFactorCal3DS2', 'GenericProjectionFactorCal3Fisheye', 'GenericProjectionFactorCal3Unified', 'GenericProjectionFactorCal3_S2', 'GenericStereoFactor3D', 'GenericValueCal3Bundler', 'GenericValueCal3DS2', 'GenericValueCal3Fisheye', 'GenericValueCal3Unified', 'GenericValueCal3_S2', 'GenericValueCalibratedCamera', 'GenericValueConstantBias', 'GenericValueEssentialMatrix', 'GenericValueMatrix', 'GenericValuePoint2', 'GenericValuePoint3', 'GenericValuePose2', 'GenericValuePose3', 'GenericValueRot2', 'GenericValueRot3', 'GenericValueStereoPoint2', 'GenericValueVector', 'GncGaussNewtonOptimizer', 'GncGaussNewtonParams', 'GncLMOptimizer', 'GncLMParams', 'GncLossType', 'GraphvizFormatting', 'HessianFactor', 'HybridBayesNet', 'HybridBayesTree', 'HybridBayesTreeClique', 'HybridConditional', 'HybridFactor', 'HybridGaussianConditional', 'HybridGaussianFactor', 'HybridGaussianFactorGraph', 'HybridNonlinearFactor', 'HybridNonlinearFactorGraph', 'HybridOrdering', 'HybridSmoother', 'HybridValues', 'ISAM2', 'ISAM2Clique', 'ISAM2DoglegParams', 'ISAM2GaussNewtonParams', 'ISAM2Params', 'ISAM2Result', 'ISAM2ThresholdMap', 'ImuFactor', 'ImuFactor2', 'IncrementalFixedLagSmoother', 'IndexPair', 'IndexPairSetAsArray', 'InitializePose3', 'IterativeOptimizationParameters', 'JacobianFactor', 'JacobianVector', 'JointMarginal', 'KalmanFilter', 'KarcherMeanFactorPoint2', 'KarcherMeanFactorPoint3', 'KarcherMeanFactorPose2', 'KarcherMeanFactorPose3', 'KarcherMeanFactorRot2', 'KarcherMeanFactorRot3', 'KarcherMeanFactorSO3', 'KarcherMeanFactorSO4', 'KernelFunctionType', 'KeyGroupMap', 'KeyList', 'KeySet', 'LabeledSymbol', 'LevenbergMarquardtOptimizer', 'LevenbergMarquardtParams', 'LinearContainerFactor', 'LinearizationMode', 'MFAS', 'MT19937', 'MagFactor', 'MagFactor1', 'MagPoseFactorPose2', 'MagPoseFactorPose3', 'ManifoldEvaluationFactorChebyshev1BasisPose2', 'ManifoldEvaluationFactorChebyshev1BasisPose3', 'ManifoldEvaluationFactorChebyshev1BasisRot2', 'ManifoldEvaluationFactorChebyshev1BasisRot3', 'ManifoldEvaluationFactorChebyshev2BasisPose2', 'ManifoldEvaluationFactorChebyshev2BasisPose3', 'ManifoldEvaluationFactorChebyshev2BasisRot2', 'ManifoldEvaluationFactorChebyshev2BasisRot3', 'ManifoldEvaluationFactorChebyshev2Pose2', 'ManifoldEvaluationFactorChebyshev2Pose3', 'ManifoldEvaluationFactorChebyshev2Rot2', 'ManifoldEvaluationFactorChebyshev2Rot3', 'ManifoldEvaluationFactorFourierBasisPose2', 'ManifoldEvaluationFactorFourierBasisPose3', 'ManifoldEvaluationFactorFourierBasisRot2', 'ManifoldEvaluationFactorFourierBasisRot3', 'Marginals', 'NavState', 'NoiseFormat', 'NoiseModelFactor', 'NonlinearEquality2Cal3_S2', 'NonlinearEquality2CalibratedCamera', 'NonlinearEquality2ConstantBias', 'NonlinearEquality2PinholeCameraCal3Bundler', 'NonlinearEquality2PinholeCameraCal3Fisheye', 'NonlinearEquality2PinholeCameraCal3Unified', 'NonlinearEquality2PinholeCameraCal3_S2', 'NonlinearEquality2Point2', 'NonlinearEquality2Point3', 'NonlinearEquality2Pose2', 'NonlinearEquality2Pose3', 'NonlinearEquality2Rot2', 'NonlinearEquality2Rot3', 'NonlinearEquality2SL4', 'NonlinearEquality2SO3', 'NonlinearEquality2SO4', 'NonlinearEquality2SOn', 'NonlinearEquality2Similarity2', 'NonlinearEquality2Similarity3', 'NonlinearEquality2StereoPoint2', 'NonlinearEqualityCal3_S2', 'NonlinearEqualityCalibratedCamera', 'NonlinearEqualityConstantBias', 'NonlinearEqualityPinholeCameraCal3Bundler', 'NonlinearEqualityPinholeCameraCal3Fisheye', 'NonlinearEqualityPinholeCameraCal3Unified', 'NonlinearEqualityPinholeCameraCal3_S2', 'NonlinearEqualityPoint2', 'NonlinearEqualityPoint3', 'NonlinearEqualityPose2', 'NonlinearEqualityPose3', 'NonlinearEqualityRot2', 'NonlinearEqualityRot3', 'NonlinearEqualitySL4', 'NonlinearEqualitySO3', 'NonlinearEqualitySO4', 'NonlinearEqualitySOn', 'NonlinearEqualitySimilarity2', 'NonlinearEqualitySimilarity3', 'NonlinearEqualityStereoPoint2', 'NonlinearFactor', 'NonlinearFactorGraph', 'NonlinearISAM', 'NonlinearOptimizer', 'NonlinearOptimizerParams', 'Ordering', 'OrientedPlane3', 'OrientedPlane3DirectionPrior', 'OrientedPlane3Factor', 'PCGSolverParameters', 'PinholeCameraCal3Bundler', 'PinholeCameraCal3DS2', 'PinholeCameraCal3Fisheye', 'PinholeCameraCal3Unified', 'PinholeCameraCal3_S2', 'PinholeCameraCal3f', 'PinholePoseCal3Bundler', 'PinholePoseCal3DS2', 'PinholePoseCal3Fisheye', 'PinholePoseCal3Unified', 'PinholePoseCal3_S2', 'PlanarProjectionFactor1', 'PlanarProjectionFactor2', 'PlanarProjectionFactor3', 'Pose2', 'Pose3', 'Pose3AttitudeFactor', 'PoseRotationPrior2D', 'PoseRotationPrior3D', 'PoseTranslationPrior2D', 'PoseTranslationPrior3D', 'PreconditionerParameters', 'PreintegratedAhrsMeasurements', 'PreintegratedCombinedMeasurements', 'PreintegratedImuMeasurements', 'PreintegratedRotation', 'PreintegratedRotationParams', 'PreintegrationCombinedParams', 'PreintegrationParams', 'PrintDiscreteValues', 'PrintKeyList', 'PrintKeySet', 'PrintKeyVector', 'PriorFactorCal3Bundler', 'PriorFactorCal3DS2', 'PriorFactorCal3Fisheye', 'PriorFactorCal3Unified', 'PriorFactorCal3_S2', 'PriorFactorCalibratedCamera', 'PriorFactorConstantBias', 'PriorFactorDouble', 'PriorFactorNavState', 'PriorFactorPinholeCameraCal3Bundler', 'PriorFactorPinholeCameraCal3Fisheye', 'PriorFactorPinholeCameraCal3Unified', 'PriorFactorPinholeCameraCal3_S2', 'PriorFactorPoint2', 'PriorFactorPoint3', 'PriorFactorPose2', 'PriorFactorPose3', 'PriorFactorRot2', 'PriorFactorRot3', 'PriorFactorSL4', 'PriorFactorSO3', 'PriorFactorSO4', 'PriorFactorSOn', 'PriorFactorSimilarity2', 'PriorFactorSimilarity3', 'PriorFactorStereoPoint2', 'PriorFactorUnit3', 'PriorFactorVector', 'Quaternion', 'RangeFactor2', 'RangeFactor2D', 'RangeFactor3', 'RangeFactor3D', 'RangeFactorCalibratedCamera', 'RangeFactorCalibratedCameraPoint', 'RangeFactorPose2', 'RangeFactorPose3', 'RangeFactorSimpleCamera', 'RangeFactorSimpleCameraPoint', 'RangeFactorWithTransform2D', 'RangeFactorWithTransform3D', 'RangeFactorWithTransformPose2', 'RangeFactorWithTransformPose3', 'RedirectCout', 'ReferenceFrameFactorPoint3Pose3', 'Rot2', 'Rot3', 'Rot3AttitudeFactor', 'RotateDirectionsFactor', 'RotateFactor', 'SL4', 'SO3', 'SO4', 'SOn', 'Sampler', 'Scenario', 'ScenarioRunner', 'SfmData', 'SfmTrack', 'SfmTrack2d', 'ShonanAveraging2', 'ShonanAveraging3', 'ShonanAveragingParameters2', 'ShonanAveragingParameters3', 'ShonanFactor3', 'Similarity2', 'Similarity3', 'SimpleFundamentalMatrix', 'SmartFactorBasePinholeCameraCal3Bundler', 'SmartFactorBasePinholeCameraCal3DS2', 'SmartFactorBasePinholeCameraCal3Fisheye', 'SmartFactorBasePinholeCameraCal3Unified', 'SmartFactorBasePinholeCameraCal3_S2', 'SmartFactorBasePinholePoseCal3Bundler', 'SmartFactorBasePinholePoseCal3DS2', 'SmartFactorBasePinholePoseCal3Fisheye', 'SmartFactorBasePinholePoseCal3Unified', 'SmartFactorBasePinholePoseCal3_S2', 'SmartProjectionFactorPinholeCameraCal3Bundler', 'SmartProjectionFactorPinholeCameraCal3DS2', 'SmartProjectionFactorPinholeCameraCal3Fisheye', 'SmartProjectionFactorPinholeCameraCal3Unified', 'SmartProjectionFactorPinholeCameraCal3_S2', 'SmartProjectionFactorPinholePoseCal3Bundler', 'SmartProjectionFactorPinholePoseCal3DS2', 'SmartProjectionFactorPinholePoseCal3Fisheye', 'SmartProjectionFactorPinholePoseCal3Unified', 'SmartProjectionFactorPinholePoseCal3_S2', 'SmartProjectionParams', 'SmartProjectionPoseFactorCal3Bundler', 'SmartProjectionPoseFactorCal3DS2', 'SmartProjectionPoseFactorCal3Fisheye', 'SmartProjectionPoseFactorCal3Unified', 'SmartProjectionPoseFactorCal3_S2', 'SmartProjectionRigFactorPinholePoseCal3Bundler', 'SmartProjectionRigFactorPinholePoseCal3DS2', 'SmartProjectionRigFactorPinholePoseCal3Fisheye', 'SmartProjectionRigFactorPinholePoseCal3Unified', 'SmartProjectionRigFactorPinholePoseCal3_S2', 'StereoCamera', 'StereoPoint2', 'SubgraphSolver', 'SubgraphSolverParameters', 'Symbol', 'SymbolicBayesNet', 'SymbolicBayesTree', 'SymbolicBayesTreeClique', 'SymbolicCluster', 'SymbolicConditional', 'SymbolicEliminationTree', 'SymbolicFactor', 'SymbolicFactorGraph', 'SymbolicJunctionTree', 'TableDistribution', 'TableFactor', 'TransferFactorFundamentalMatrix', 'TransferFactorSimpleFundamentalMatrix', 'TranslationRecovery', 'TriangulationFactorCal3Bundler', 'TriangulationFactorCal3DS2', 'TriangulationFactorCal3Fisheye', 'TriangulationFactorCal3Unified', 'TriangulationFactorCal3_S2', 'TriangulationFactorPoseCal3Bundler', 'TriangulationFactorPoseCal3DS2', 'TriangulationFactorPoseCal3Fisheye', 'TriangulationFactorPoseCal3Unified', 'TriangulationFactorPoseCal3_S2', 'TriangulationParameters', 'TriangulationResult', 'Unit3', 'Value', 'Values', 'VariableIndex', 'VectorComponentFactorChebyshev1Basis', 'VectorComponentFactorChebyshev2', 'VectorComponentFactorChebyshev2Basis', 'VectorComponentFactorFourierBasis', 'VectorDerivativeFactorChebyshev1Basis', 'VectorDerivativeFactorChebyshev2', 'VectorDerivativeFactorChebyshev2Basis', 'VectorDerivativeFactorFourierBasis', 'VectorEvaluationFactorChebyshev1Basis', 'VectorEvaluationFactorChebyshev2', 'VectorEvaluationFactorChebyshev2Basis', 'VectorEvaluationFactorFourierBasis', 'VectorValues', 'cartesianProduct', 'checkConvergence', 'gtsfm', 'html', 'imuBias', 'initialCamerasAndPointsEstimate', 'initialCamerasEstimate', 'isDebugVersion', 'lago', 'linear_independent', 'load2D', 'load3D', 'markdown', 'mrsymbol', 'mrsymbolChr', 'mrsymbolIndex', 'mrsymbolLabel', 'noiseModel', 'parse2DFactors', 'parse3DFactors', 'readBal', 'readG2o', 'save2D', 'so3', 'symbol', 'symbolChr', 'symbolIndex', 'symbol_shorthand', 'triangulateNonlinear', 'triangulatePoint3', 'triangulateSafe', 'utilities', 'writeBAL', 'writeG2o']
|
|
14
|
+
__all__: list[str] = ['AHRSFactor', 'AcceleratingScenario', 'AlgebraicDecisionTreeKey', 'AssignmentKey', 'BarometricFactor', 'BatchFixedLagSmoother', 'BearingFactor2D', 'BearingFactor3D', 'BearingFactorPose2', 'BearingRange2D', 'BearingRange3D', 'BearingRangeFactor2D', 'BearingRangeFactor3D', 'BearingRangeFactorPose2', 'BearingRangeFactorPose3', 'BearingRangePose2', 'BearingRangePose3', 'BetweenFactorConstantBias', 'BetweenFactorDouble', 'BetweenFactorPoint2', 'BetweenFactorPoint3', 'BetweenFactorPose2', 'BetweenFactorPose3', 'BetweenFactorRot2', 'BetweenFactorRot3', 'BetweenFactorSL4', 'BetweenFactorSO3', 'BetweenFactorSO4', 'BetweenFactorSimilarity2', 'BetweenFactorSimilarity3', 'BetweenFactorVector', 'BinaryMeasurementPoint3', 'BinaryMeasurementRot3', 'BinaryMeasurementUnit3', 'BlockJacobiPreconditionerParameters', 'Cal3', 'Cal3Bundler', 'Cal3DS2', 'Cal3DS2_Base', 'Cal3Fisheye', 'Cal3Unified', 'Cal3_S2', 'Cal3_S2Stereo', 'Cal3f', 'CalibratedCamera', 'CameraSetCal3Bundler', 'CameraSetCal3DS2', 'CameraSetCal3Fisheye', 'CameraSetCal3Unified', 'CameraSetCal3_S2', 'CameraSetPinholePoseCal3_S2', 'Chebyshev1Basis', 'Chebyshev2', 'Chebyshev2Basis', 'CombinedImuFactor', 'ComponentDerivativeFactorChebyshev1Basis', 'ComponentDerivativeFactorChebyshev2', 'ComponentDerivativeFactorChebyshev2Basis', 'ComponentDerivativeFactorFourierBasis', 'ConjugateGradientParameters', 'ConstantTwistScenario', 'ConstantVelocityFactor', 'ConvertNoiseModel', 'CustomFactor', 'DSFMapIndexPair', 'DecisionTreeFactor', 'DegeneracyMode', 'DerivativeFactorChebyshev1Basis', 'DerivativeFactorChebyshev2', 'DerivativeFactorChebyshev2Basis', 'DerivativeFactorFourierBasis', 'DiscreteBayesNet', 'DiscreteBayesTree', 'DiscreteBayesTreeClique', 'DiscreteCluster', 'DiscreteConditional', 'DiscreteDistribution', 'DiscreteEliminationTree', 'DiscreteFactor', 'DiscreteFactorGraph', 'DiscreteJunctionTree', 'DiscreteKeys', 'DiscreteLookupDAG', 'DiscreteLookupTable', 'DiscreteMarginals', 'DiscreteScenario', 'DiscreteSearch', 'DiscreteSearchSolution', 'DiscreteValues', 'DoglegOptimizer', 'DoglegParams', 'DotWriter', 'DummyPreconditionerParameters', 'EdgeKey', 'EliminateDiscrete', 'EliminateForMPE', 'EliminateQR', 'EpipolarTransfer', 'EssentialMatrix', 'EssentialMatrixConstraint', 'EssentialMatrixFactor', 'EssentialMatrixFactor2', 'EssentialMatrixFactor3', 'EssentialMatrixFactor4Cal3Bundler', 'EssentialMatrixFactor4Cal3DS2', 'EssentialMatrixFactor4Cal3Fisheye', 'EssentialMatrixFactor4Cal3Unified', 'EssentialMatrixFactor4Cal3_S2', 'EssentialMatrixFactor4Cal3f', 'EssentialMatrixFactor5Cal3Bundler', 'EssentialMatrixFactor5Cal3DS2', 'EssentialMatrixFactor5Cal3Fisheye', 'EssentialMatrixFactor5Cal3Unified', 'EssentialMatrixFactor5Cal3_S2', 'EssentialMatrixFactor5Cal3f', 'EssentialTransferFactorCal3Bundler', 'EssentialTransferFactorCal3_S2', 'EssentialTransferFactorCal3f', 'EssentialTransferFactorKCal3Bundler', 'EssentialTransferFactorKCal3_S2', 'EssentialTransferFactorKCal3f', 'EvaluationFactorChebyshev1Basis', 'EvaluationFactorChebyshev2', 'EvaluationFactorChebyshev2Basis', 'EvaluationFactorFourierBasis', 'Event', 'ExtendedKalmanFilterConstantBias', 'ExtendedKalmanFilterGal3', 'ExtendedKalmanFilterNavState', 'ExtendedKalmanFilterPoint2', 'ExtendedKalmanFilterPoint3', 'ExtendedKalmanFilterPose2', 'ExtendedKalmanFilterPose3', 'ExtendedKalmanFilterRot2', 'ExtendedKalmanFilterRot3', 'ExtendedKalmanFilterSL4', 'ExtendedKalmanFilterSimilarity2', 'ExtendedKalmanFilterSimilarity3', 'Factor', 'FindKarcherMeanPoint2', 'FindKarcherMeanPoint3', 'FindKarcherMeanPose2', 'FindKarcherMeanPose3', 'FindKarcherMeanRot2', 'FindKarcherMeanRot3', 'FindKarcherMeanSO3', 'FindKarcherMeanSO4', 'FitBasisChebyshev1Basis', 'FitBasisChebyshev2', 'FitBasisChebyshev2Basis', 'FitBasisFourierBasis', 'FixedLagSmoother', 'FixedLagSmootherResult', 'FourierBasis', 'FrobeniusBetweenFactorGal3', 'FrobeniusBetweenFactorNLGal3', 'FrobeniusBetweenFactorNLPose2', 'FrobeniusBetweenFactorNLPose3', 'FrobeniusBetweenFactorNLRot2', 'FrobeniusBetweenFactorNLRot3', 'FrobeniusBetweenFactorNLSL4', 'FrobeniusBetweenFactorNLSO3', 'FrobeniusBetweenFactorNLSO4', 'FrobeniusBetweenFactorNLSimilarity2', 'FrobeniusBetweenFactorNLSimilarity3', 'FrobeniusBetweenFactorPose2', 'FrobeniusBetweenFactorPose3', 'FrobeniusBetweenFactorRot2', 'FrobeniusBetweenFactorRot3', 'FrobeniusBetweenFactorSO3', 'FrobeniusBetweenFactorSO4', 'FrobeniusFactorGal3', 'FrobeniusFactorPose2', 'FrobeniusFactorPose3', 'FrobeniusFactorRot2', 'FrobeniusFactorRot3', 'FrobeniusFactorSL4', 'FrobeniusFactorSO3', 'FrobeniusFactorSO4', 'FrobeniusFactorSimilarity2', 'FrobeniusFactorSimilarity3', 'FrobeniusPriorGal3', 'FrobeniusPriorPose2', 'FrobeniusPriorPose3', 'FrobeniusPriorRot2', 'FrobeniusPriorRot3', 'FrobeniusPriorSL4', 'FrobeniusPriorSO3', 'FrobeniusPriorSO4', 'FrobeniusPriorSimilarity2', 'FrobeniusPriorSimilarity3', 'FundamentalMatrix', 'GPSFactor', 'GPSFactor2', 'GPSFactor2Arm', 'GPSFactor2ArmCalib', 'GPSFactorArm', 'GPSFactorArmCalib', 'Gal3', 'GaussNewtonOptimizer', 'GaussNewtonParams', 'GaussianBayesNet', 'GaussianBayesTree', 'GaussianBayesTreeClique', 'GaussianConditional', 'GaussianDensity', 'GaussianEliminationTree', 'GaussianFactor', 'GaussianFactorGraph', 'GaussianISAM', 'GeneralSFMFactor2Cal3Bundler', 'GeneralSFMFactor2Cal3DS2', 'GeneralSFMFactor2Cal3Fisheye', 'GeneralSFMFactor2Cal3Unified', 'GeneralSFMFactor2Cal3_S2', 'GeneralSFMFactor2Cal3f', 'GeneralSFMFactorCal3Bundler', 'GeneralSFMFactorCal3DS2', 'GeneralSFMFactorCal3Fisheye', 'GeneralSFMFactorCal3Unified', 'GeneralSFMFactorCal3_S2', 'GeneralSFMFactorPoseCal3Bundler', 'GeneralSFMFactorPoseCal3DS2', 'GeneralSFMFactorPoseCal3Fisheye', 'GeneralSFMFactorPoseCal3Unified', 'GeneralSFMFactorPoseCal3_S2', 'GenericProjectionFactorCal3DS2', 'GenericProjectionFactorCal3Fisheye', 'GenericProjectionFactorCal3Unified', 'GenericProjectionFactorCal3_S2', 'GenericStereoFactor3D', 'GenericValueCal3Bundler', 'GenericValueCal3DS2', 'GenericValueCal3Fisheye', 'GenericValueCal3Unified', 'GenericValueCal3_S2', 'GenericValueCalibratedCamera', 'GenericValueConstantBias', 'GenericValueEssentialMatrix', 'GenericValueMatrix', 'GenericValuePoint2', 'GenericValuePoint3', 'GenericValuePose2', 'GenericValuePose3', 'GenericValueRot2', 'GenericValueRot3', 'GenericValueStereoPoint2', 'GenericValueVector', 'GncGaussNewtonOptimizer', 'GncGaussNewtonParams', 'GncLMOptimizer', 'GncLMParams', 'GncLossType', 'GraphvizFormatting', 'HessianFactor', 'HybridBayesNet', 'HybridBayesTree', 'HybridBayesTreeClique', 'HybridConditional', 'HybridFactor', 'HybridGaussianConditional', 'HybridGaussianFactor', 'HybridGaussianFactorGraph', 'HybridNonlinearFactor', 'HybridNonlinearFactorGraph', 'HybridOrdering', 'HybridSmoother', 'HybridValues', 'ISAM2', 'ISAM2Clique', 'ISAM2DoglegParams', 'ISAM2GaussNewtonParams', 'ISAM2Params', 'ISAM2Result', 'ISAM2ThresholdMap', 'ImuFactor', 'ImuFactor2', 'IncrementalFixedLagSmoother', 'IndexPair', 'IndexPairSetAsArray', 'InitializePose3', 'InvariantEKFGal3', 'InvariantEKFNavState', 'InvariantEKFPose2', 'InvariantEKFPose3', 'InvariantEKFRot3', 'IterativeOptimizationParameters', 'JacobianFactor', 'JacobianVector', 'JointMarginal', 'KalmanFilter', 'KarcherMeanFactorGal3', 'KarcherMeanFactorPoint2', 'KarcherMeanFactorPoint3', 'KarcherMeanFactorPose2', 'KarcherMeanFactorPose3', 'KarcherMeanFactorRot2', 'KarcherMeanFactorRot3', 'KarcherMeanFactorSL4', 'KarcherMeanFactorSO3', 'KarcherMeanFactorSO4', 'KarcherMeanFactorSimilarity2', 'KarcherMeanFactorSimilarity3', 'KernelFunctionType', 'KeyGroupMap', 'KeyList', 'KeySet', 'LabeledSymbol', 'LeftLinearEKFGal3', 'LeftLinearEKFNavState', 'LeftLinearEKFPose2', 'LeftLinearEKFPose3', 'LeftLinearEKFRot3', 'LevenbergMarquardtOptimizer', 'LevenbergMarquardtParams', 'LieGroupEKFGal3', 'LieGroupEKFNavState', 'LieGroupEKFPose2', 'LieGroupEKFPose3', 'LieGroupEKFRot3', 'LinearContainerFactor', 'LinearizationMode', 'MFAS', 'MT19937', 'MagFactor', 'MagFactor1', 'MagPoseFactorPose2', 'MagPoseFactorPose3', 'ManifoldEKFGal3', 'ManifoldEKFNavState', 'ManifoldEKFPose2', 'ManifoldEKFPose3', 'ManifoldEKFRot3', 'ManifoldEKFUnit3', 'ManifoldEvaluationFactorChebyshev1BasisPose2', 'ManifoldEvaluationFactorChebyshev1BasisPose3', 'ManifoldEvaluationFactorChebyshev1BasisRot2', 'ManifoldEvaluationFactorChebyshev1BasisRot3', 'ManifoldEvaluationFactorChebyshev2BasisPose2', 'ManifoldEvaluationFactorChebyshev2BasisPose3', 'ManifoldEvaluationFactorChebyshev2BasisRot2', 'ManifoldEvaluationFactorChebyshev2BasisRot3', 'ManifoldEvaluationFactorChebyshev2Pose2', 'ManifoldEvaluationFactorChebyshev2Pose3', 'ManifoldEvaluationFactorChebyshev2Rot2', 'ManifoldEvaluationFactorChebyshev2Rot3', 'ManifoldEvaluationFactorFourierBasisPose2', 'ManifoldEvaluationFactorFourierBasisPose3', 'ManifoldEvaluationFactorFourierBasisRot2', 'ManifoldEvaluationFactorFourierBasisRot3', 'Marginals', 'NavState', 'NavStateImuEKF', 'NoiseFormat', 'NoiseModelFactor', 'NonlinearEquality2Cal3_S2', 'NonlinearEquality2CalibratedCamera', 'NonlinearEquality2ConstantBias', 'NonlinearEquality2Gal3', 'NonlinearEquality2PinholeCameraCal3Bundler', 'NonlinearEquality2PinholeCameraCal3Fisheye', 'NonlinearEquality2PinholeCameraCal3Unified', 'NonlinearEquality2PinholeCameraCal3_S2', 'NonlinearEquality2Point2', 'NonlinearEquality2Point3', 'NonlinearEquality2Pose2', 'NonlinearEquality2Pose3', 'NonlinearEquality2Rot2', 'NonlinearEquality2Rot3', 'NonlinearEquality2SL4', 'NonlinearEquality2SO3', 'NonlinearEquality2SO4', 'NonlinearEquality2SOn', 'NonlinearEquality2Similarity2', 'NonlinearEquality2Similarity3', 'NonlinearEquality2StereoPoint2', 'NonlinearEqualityCal3_S2', 'NonlinearEqualityCalibratedCamera', 'NonlinearEqualityConstantBias', 'NonlinearEqualityGal3', 'NonlinearEqualityPinholeCameraCal3Bundler', 'NonlinearEqualityPinholeCameraCal3Fisheye', 'NonlinearEqualityPinholeCameraCal3Unified', 'NonlinearEqualityPinholeCameraCal3_S2', 'NonlinearEqualityPoint2', 'NonlinearEqualityPoint3', 'NonlinearEqualityPose2', 'NonlinearEqualityPose3', 'NonlinearEqualityRot2', 'NonlinearEqualityRot3', 'NonlinearEqualitySL4', 'NonlinearEqualitySO3', 'NonlinearEqualitySO4', 'NonlinearEqualitySOn', 'NonlinearEqualitySimilarity2', 'NonlinearEqualitySimilarity3', 'NonlinearEqualityStereoPoint2', 'NonlinearFactor', 'NonlinearFactorGraph', 'NonlinearISAM', 'NonlinearOptimizer', 'NonlinearOptimizerParams', 'Ordering', 'OrientedPlane3', 'OrientedPlane3DirectionPrior', 'OrientedPlane3Factor', 'PCGSolverParameters', 'PinholeCameraCal3Bundler', 'PinholeCameraCal3DS2', 'PinholeCameraCal3Fisheye', 'PinholeCameraCal3Unified', 'PinholeCameraCal3_S2', 'PinholeCameraCal3f', 'PinholePoseCal3Bundler', 'PinholePoseCal3DS2', 'PinholePoseCal3Fisheye', 'PinholePoseCal3Unified', 'PinholePoseCal3_S2', 'PlanarProjectionFactor1', 'PlanarProjectionFactor2', 'PlanarProjectionFactor3', 'Pose2', 'Pose3', 'Pose3AttitudeFactor', 'PoseRotationPrior2D', 'PoseRotationPrior3D', 'PoseTranslationPrior2D', 'PoseTranslationPrior3D', 'PreconditionerParameters', 'PreintegratedAhrsMeasurements', 'PreintegratedCombinedMeasurements', 'PreintegratedImuMeasurements', 'PreintegratedRotation', 'PreintegratedRotationParams', 'PreintegrationCombinedParams', 'PreintegrationParams', 'PrintDiscreteValues', 'PrintKeyList', 'PrintKeySet', 'PrintKeyVector', 'PriorFactorCal3Bundler', 'PriorFactorCal3DS2', 'PriorFactorCal3Fisheye', 'PriorFactorCal3Unified', 'PriorFactorCal3_S2', 'PriorFactorCalibratedCamera', 'PriorFactorConstantBias', 'PriorFactorDouble', 'PriorFactorGal3', 'PriorFactorNavState', 'PriorFactorPinholeCameraCal3Bundler', 'PriorFactorPinholeCameraCal3Fisheye', 'PriorFactorPinholeCameraCal3Unified', 'PriorFactorPinholeCameraCal3_S2', 'PriorFactorPoint2', 'PriorFactorPoint3', 'PriorFactorPose2', 'PriorFactorPose3', 'PriorFactorRot2', 'PriorFactorRot3', 'PriorFactorSL4', 'PriorFactorSO3', 'PriorFactorSO4', 'PriorFactorSOn', 'PriorFactorSimilarity2', 'PriorFactorSimilarity3', 'PriorFactorStereoPoint2', 'PriorFactorUnit3', 'PriorFactorVector', 'Quaternion', 'RangeFactor2', 'RangeFactor2D', 'RangeFactor3', 'RangeFactor3D', 'RangeFactorCalibratedCamera', 'RangeFactorCalibratedCameraPoint', 'RangeFactorPose2', 'RangeFactorPose3', 'RangeFactorSimpleCamera', 'RangeFactorSimpleCameraPoint', 'RangeFactorWithTransform2D', 'RangeFactorWithTransform3D', 'RangeFactorWithTransformPose2', 'RangeFactorWithTransformPose3', 'RedirectCout', 'ReferenceFrameFactorPoint3Pose3', 'Rot2', 'Rot3', 'Rot3AttitudeFactor', 'RotateDirectionsFactor', 'RotateFactor', 'SL4', 'SO3', 'SO4', 'SOn', 'Sampler', 'Scenario', 'ScenarioRunner', 'SfmData', 'SfmTrack', 'SfmTrack2d', 'ShonanAveraging2', 'ShonanAveraging3', 'ShonanAveragingParameters2', 'ShonanAveragingParameters3', 'ShonanFactor3', 'Similarity2', 'Similarity3', 'SimpleFundamentalMatrix', 'SmartFactorBasePinholeCameraCal3Bundler', 'SmartFactorBasePinholeCameraCal3DS2', 'SmartFactorBasePinholeCameraCal3Fisheye', 'SmartFactorBasePinholeCameraCal3Unified', 'SmartFactorBasePinholeCameraCal3_S2', 'SmartFactorBasePinholePoseCal3Bundler', 'SmartFactorBasePinholePoseCal3DS2', 'SmartFactorBasePinholePoseCal3Fisheye', 'SmartFactorBasePinholePoseCal3Unified', 'SmartFactorBasePinholePoseCal3_S2', 'SmartProjectionFactorPinholeCameraCal3Bundler', 'SmartProjectionFactorPinholeCameraCal3DS2', 'SmartProjectionFactorPinholeCameraCal3Fisheye', 'SmartProjectionFactorPinholeCameraCal3Unified', 'SmartProjectionFactorPinholeCameraCal3_S2', 'SmartProjectionFactorPinholePoseCal3Bundler', 'SmartProjectionFactorPinholePoseCal3DS2', 'SmartProjectionFactorPinholePoseCal3Fisheye', 'SmartProjectionFactorPinholePoseCal3Unified', 'SmartProjectionFactorPinholePoseCal3_S2', 'SmartProjectionParams', 'SmartProjectionPoseFactorCal3Bundler', 'SmartProjectionPoseFactorCal3DS2', 'SmartProjectionPoseFactorCal3Fisheye', 'SmartProjectionPoseFactorCal3Unified', 'SmartProjectionPoseFactorCal3_S2', 'SmartProjectionRigFactorPinholePoseCal3Bundler', 'SmartProjectionRigFactorPinholePoseCal3DS2', 'SmartProjectionRigFactorPinholePoseCal3Fisheye', 'SmartProjectionRigFactorPinholePoseCal3Unified', 'SmartProjectionRigFactorPinholePoseCal3_S2', 'StereoCamera', 'StereoPoint2', 'SubgraphSolver', 'SubgraphSolverParameters', 'Symbol', 'SymbolicBayesNet', 'SymbolicBayesTree', 'SymbolicBayesTreeClique', 'SymbolicCluster', 'SymbolicConditional', 'SymbolicEliminationTree', 'SymbolicFactor', 'SymbolicFactorGraph', 'SymbolicJunctionTree', 'TableDistribution', 'TableFactor', 'TransferFactorFundamentalMatrix', 'TransferFactorSimpleFundamentalMatrix', 'TranslationRecovery', 'TriangulationFactorCal3Bundler', 'TriangulationFactorCal3DS2', 'TriangulationFactorCal3Fisheye', 'TriangulationFactorCal3Unified', 'TriangulationFactorCal3_S2', 'TriangulationFactorPoseCal3Bundler', 'TriangulationFactorPoseCal3DS2', 'TriangulationFactorPoseCal3Fisheye', 'TriangulationFactorPoseCal3Unified', 'TriangulationFactorPoseCal3_S2', 'TriangulationParameters', 'TriangulationResult', 'Unit3', 'Value', 'Values', 'VariableIndex', 'VectorComponentFactorChebyshev1Basis', 'VectorComponentFactorChebyshev2', 'VectorComponentFactorChebyshev2Basis', 'VectorComponentFactorFourierBasis', 'VectorDerivativeFactorChebyshev1Basis', 'VectorDerivativeFactorChebyshev2', 'VectorDerivativeFactorChebyshev2Basis', 'VectorDerivativeFactorFourierBasis', 'VectorEvaluationFactorChebyshev1Basis', 'VectorEvaluationFactorChebyshev2', 'VectorEvaluationFactorChebyshev2Basis', 'VectorEvaluationFactorFourierBasis', 'VectorValues', 'cartesianProduct', 'checkConvergence', 'gtsfm', 'html', 'imuBias', 'initialCamerasAndPointsEstimate', 'initialCamerasEstimate', 'isDebugVersion', 'lago', 'linear_independent', 'load2D', 'load3D', 'markdown', 'mrsymbol', 'mrsymbolChr', 'mrsymbolIndex', 'mrsymbolLabel', 'noiseModel', 'parse2DFactors', 'parse3DFactors', 'readBal', 'readG2o', 'save2D', 'so3', 'symbol', 'symbolChr', 'symbolIndex', 'symbol_shorthand', 'triangulateNonlinear', 'triangulatePoint3', 'triangulateSafe', 'utilities', 'writeBAL', 'writeG2o']
|
|
15
15
|
class AHRSFactor(NonlinearFactor):
|
|
16
16
|
def __getstate__(self) -> tuple:
|
|
17
17
|
...
|
|
@@ -3453,6 +3453,15 @@ class ExtendedKalmanFilterConstantBias:
|
|
|
3453
3453
|
...
|
|
3454
3454
|
def update(self, measurementFactor: NoiseModelFactor) -> ...:
|
|
3455
3455
|
...
|
|
3456
|
+
class ExtendedKalmanFilterGal3:
|
|
3457
|
+
def Density(self) -> JacobianFactor:
|
|
3458
|
+
...
|
|
3459
|
+
def __init__(self, key_initial: int, x_initial: Gal3, P_initial: noiseModel.Gaussian) -> None:
|
|
3460
|
+
...
|
|
3461
|
+
def predict(self, motionFactor: NoiseModelFactor) -> Gal3:
|
|
3462
|
+
...
|
|
3463
|
+
def update(self, measurementFactor: NoiseModelFactor) -> Gal3:
|
|
3464
|
+
...
|
|
3456
3465
|
class ExtendedKalmanFilterNavState:
|
|
3457
3466
|
def Density(self) -> JacobianFactor:
|
|
3458
3467
|
...
|
|
@@ -3694,7 +3703,16 @@ class FrobeniusBetweenFactorGal3(NoiseModelFactor):
|
|
|
3694
3703
|
...
|
|
3695
3704
|
def evaluateError(self, T1: Gal3, T2: Gal3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3696
3705
|
...
|
|
3697
|
-
class
|
|
3706
|
+
class FrobeniusBetweenFactorNLGal3(NoiseModelFactor):
|
|
3707
|
+
@typing.overload
|
|
3708
|
+
def __init__(self, j1: int, j2: int, T12: Gal3) -> None:
|
|
3709
|
+
...
|
|
3710
|
+
@typing.overload
|
|
3711
|
+
def __init__(self, key1: int, key2: int, T12: Gal3, model: noiseModel.Base) -> None:
|
|
3712
|
+
...
|
|
3713
|
+
def evaluateError(self, T1: Gal3, T2: Gal3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3714
|
+
...
|
|
3715
|
+
class FrobeniusBetweenFactorNLPose2(NoiseModelFactor):
|
|
3698
3716
|
@typing.overload
|
|
3699
3717
|
def __init__(self, j1: int, j2: int, T12: Pose2) -> None:
|
|
3700
3718
|
...
|
|
@@ -3703,7 +3721,7 @@ class FrobeniusBetweenFactorPose2(NoiseModelFactor):
|
|
|
3703
3721
|
...
|
|
3704
3722
|
def evaluateError(self, T1: Pose2, T2: Pose2) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3705
3723
|
...
|
|
3706
|
-
class
|
|
3724
|
+
class FrobeniusBetweenFactorNLPose3(NoiseModelFactor):
|
|
3707
3725
|
@typing.overload
|
|
3708
3726
|
def __init__(self, j1: int, j2: int, T12: Pose3) -> None:
|
|
3709
3727
|
...
|
|
@@ -3712,7 +3730,7 @@ class FrobeniusBetweenFactorPose3(NoiseModelFactor):
|
|
|
3712
3730
|
...
|
|
3713
3731
|
def evaluateError(self, T1: Pose3, T2: Pose3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3714
3732
|
...
|
|
3715
|
-
class
|
|
3733
|
+
class FrobeniusBetweenFactorNLRot2(NoiseModelFactor):
|
|
3716
3734
|
@typing.overload
|
|
3717
3735
|
def __init__(self, j1: int, j2: int, T12: Rot2) -> None:
|
|
3718
3736
|
...
|
|
@@ -3721,7 +3739,7 @@ class FrobeniusBetweenFactorRot2(NoiseModelFactor):
|
|
|
3721
3739
|
...
|
|
3722
3740
|
def evaluateError(self, T1: Rot2, T2: Rot2) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3723
3741
|
...
|
|
3724
|
-
class
|
|
3742
|
+
class FrobeniusBetweenFactorNLRot3(NoiseModelFactor):
|
|
3725
3743
|
@typing.overload
|
|
3726
3744
|
def __init__(self, j1: int, j2: int, T12: Rot3) -> None:
|
|
3727
3745
|
...
|
|
@@ -3730,7 +3748,16 @@ class FrobeniusBetweenFactorRot3(NoiseModelFactor):
|
|
|
3730
3748
|
...
|
|
3731
3749
|
def evaluateError(self, T1: Rot3, T2: Rot3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3732
3750
|
...
|
|
3733
|
-
class
|
|
3751
|
+
class FrobeniusBetweenFactorNLSL4(NoiseModelFactor):
|
|
3752
|
+
@typing.overload
|
|
3753
|
+
def __init__(self, j1: int, j2: int, T12: SL4) -> None:
|
|
3754
|
+
...
|
|
3755
|
+
@typing.overload
|
|
3756
|
+
def __init__(self, key1: int, key2: int, T12: SL4, model: noiseModel.Base) -> None:
|
|
3757
|
+
...
|
|
3758
|
+
def evaluateError(self, T1: SL4, T2: SL4) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3759
|
+
...
|
|
3760
|
+
class FrobeniusBetweenFactorNLSO3(NoiseModelFactor):
|
|
3734
3761
|
@typing.overload
|
|
3735
3762
|
def __init__(self, j1: int, j2: int, T12: SO3) -> None:
|
|
3736
3763
|
...
|
|
@@ -3739,7 +3766,7 @@ class FrobeniusBetweenFactorSO3(NoiseModelFactor):
|
|
|
3739
3766
|
...
|
|
3740
3767
|
def evaluateError(self, T1: SO3, T2: SO3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3741
3768
|
...
|
|
3742
|
-
class
|
|
3769
|
+
class FrobeniusBetweenFactorNLSO4(NoiseModelFactor):
|
|
3743
3770
|
@typing.overload
|
|
3744
3771
|
def __init__(self, j1: int, j2: int, T12: SO4) -> None:
|
|
3745
3772
|
...
|
|
@@ -3748,7 +3775,7 @@ class FrobeniusBetweenFactorSO4(NoiseModelFactor):
|
|
|
3748
3775
|
...
|
|
3749
3776
|
def evaluateError(self, T1: SO4, T2: SO4) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3750
3777
|
...
|
|
3751
|
-
class
|
|
3778
|
+
class FrobeniusBetweenFactorNLSimilarity2(NoiseModelFactor):
|
|
3752
3779
|
@typing.overload
|
|
3753
3780
|
def __init__(self, j1: int, j2: int, T12: Similarity2) -> None:
|
|
3754
3781
|
...
|
|
@@ -3757,7 +3784,7 @@ class FrobeniusBetweenFactorSimilarity2(NoiseModelFactor):
|
|
|
3757
3784
|
...
|
|
3758
3785
|
def evaluateError(self, T1: Similarity2, T2: Similarity2) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3759
3786
|
...
|
|
3760
|
-
class
|
|
3787
|
+
class FrobeniusBetweenFactorNLSimilarity3(NoiseModelFactor):
|
|
3761
3788
|
@typing.overload
|
|
3762
3789
|
def __init__(self, j1: int, j2: int, T12: Similarity3) -> None:
|
|
3763
3790
|
...
|
|
@@ -3766,6 +3793,60 @@ class FrobeniusBetweenFactorSimilarity3(NoiseModelFactor):
|
|
|
3766
3793
|
...
|
|
3767
3794
|
def evaluateError(self, T1: Similarity3, T2: Similarity3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3768
3795
|
...
|
|
3796
|
+
class FrobeniusBetweenFactorPose2(NoiseModelFactor):
|
|
3797
|
+
@typing.overload
|
|
3798
|
+
def __init__(self, j1: int, j2: int, T12: Pose2) -> None:
|
|
3799
|
+
...
|
|
3800
|
+
@typing.overload
|
|
3801
|
+
def __init__(self, key1: int, key2: int, T12: Pose2, model: noiseModel.Base) -> None:
|
|
3802
|
+
...
|
|
3803
|
+
def evaluateError(self, T1: Pose2, T2: Pose2) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3804
|
+
...
|
|
3805
|
+
class FrobeniusBetweenFactorPose3(NoiseModelFactor):
|
|
3806
|
+
@typing.overload
|
|
3807
|
+
def __init__(self, j1: int, j2: int, T12: Pose3) -> None:
|
|
3808
|
+
...
|
|
3809
|
+
@typing.overload
|
|
3810
|
+
def __init__(self, key1: int, key2: int, T12: Pose3, model: noiseModel.Base) -> None:
|
|
3811
|
+
...
|
|
3812
|
+
def evaluateError(self, T1: Pose3, T2: Pose3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3813
|
+
...
|
|
3814
|
+
class FrobeniusBetweenFactorRot2(NoiseModelFactor):
|
|
3815
|
+
@typing.overload
|
|
3816
|
+
def __init__(self, j1: int, j2: int, T12: Rot2) -> None:
|
|
3817
|
+
...
|
|
3818
|
+
@typing.overload
|
|
3819
|
+
def __init__(self, key1: int, key2: int, T12: Rot2, model: noiseModel.Base) -> None:
|
|
3820
|
+
...
|
|
3821
|
+
def evaluateError(self, T1: Rot2, T2: Rot2) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3822
|
+
...
|
|
3823
|
+
class FrobeniusBetweenFactorRot3(NoiseModelFactor):
|
|
3824
|
+
@typing.overload
|
|
3825
|
+
def __init__(self, j1: int, j2: int, T12: Rot3) -> None:
|
|
3826
|
+
...
|
|
3827
|
+
@typing.overload
|
|
3828
|
+
def __init__(self, key1: int, key2: int, T12: Rot3, model: noiseModel.Base) -> None:
|
|
3829
|
+
...
|
|
3830
|
+
def evaluateError(self, T1: Rot3, T2: Rot3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3831
|
+
...
|
|
3832
|
+
class FrobeniusBetweenFactorSO3(NoiseModelFactor):
|
|
3833
|
+
@typing.overload
|
|
3834
|
+
def __init__(self, j1: int, j2: int, T12: SO3) -> None:
|
|
3835
|
+
...
|
|
3836
|
+
@typing.overload
|
|
3837
|
+
def __init__(self, key1: int, key2: int, T12: SO3, model: noiseModel.Base) -> None:
|
|
3838
|
+
...
|
|
3839
|
+
def evaluateError(self, T1: SO3, T2: SO3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3840
|
+
...
|
|
3841
|
+
class FrobeniusBetweenFactorSO4(NoiseModelFactor):
|
|
3842
|
+
@typing.overload
|
|
3843
|
+
def __init__(self, j1: int, j2: int, T12: SO4) -> None:
|
|
3844
|
+
...
|
|
3845
|
+
@typing.overload
|
|
3846
|
+
def __init__(self, key1: int, key2: int, T12: SO4, model: noiseModel.Base) -> None:
|
|
3847
|
+
...
|
|
3848
|
+
def evaluateError(self, T1: SO4, T2: SO4) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3849
|
+
...
|
|
3769
3850
|
class FrobeniusFactorGal3(NoiseModelFactor):
|
|
3770
3851
|
@typing.overload
|
|
3771
3852
|
def __init__(self, key1: int, key2: int) -> None:
|
|
@@ -3811,6 +3892,15 @@ class FrobeniusFactorRot3(NoiseModelFactor):
|
|
|
3811
3892
|
...
|
|
3812
3893
|
def evaluateError(self, T1: Rot3, T2: Rot3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3813
3894
|
...
|
|
3895
|
+
class FrobeniusFactorSL4(NoiseModelFactor):
|
|
3896
|
+
@typing.overload
|
|
3897
|
+
def __init__(self, key1: int, key2: int) -> None:
|
|
3898
|
+
...
|
|
3899
|
+
@typing.overload
|
|
3900
|
+
def __init__(self, j1: int, j2: int, model: noiseModel.Base) -> None:
|
|
3901
|
+
...
|
|
3902
|
+
def evaluateError(self, T1: SL4, T2: SL4) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3903
|
+
...
|
|
3814
3904
|
class FrobeniusFactorSO3(NoiseModelFactor):
|
|
3815
3905
|
@typing.overload
|
|
3816
3906
|
def __init__(self, key1: int, key2: int) -> None:
|
|
@@ -3872,6 +3962,11 @@ class FrobeniusPriorRot3(NoiseModelFactor):
|
|
|
3872
3962
|
...
|
|
3873
3963
|
def evaluateError(self, g: Rot3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3874
3964
|
...
|
|
3965
|
+
class FrobeniusPriorSL4(NoiseModelFactor):
|
|
3966
|
+
def __init__(self, j: int, M: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], model: noiseModel.Base) -> None:
|
|
3967
|
+
...
|
|
3968
|
+
def evaluateError(self, g: SL4) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
3969
|
+
...
|
|
3875
3970
|
class FrobeniusPriorSO3(NoiseModelFactor):
|
|
3876
3971
|
def __init__(self, j: int, M: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], model: noiseModel.Base) -> None:
|
|
3877
3972
|
...
|
|
@@ -7018,6 +7113,8 @@ class ISAM2:
|
|
|
7018
7113
|
...
|
|
7019
7114
|
def calculateEstimateFundamentalMatrix(self, key: int) -> FundamentalMatrix:
|
|
7020
7115
|
...
|
|
7116
|
+
def calculateEstimateGal3(self, key: int) -> Gal3:
|
|
7117
|
+
...
|
|
7021
7118
|
def calculateEstimateMatrix(self, key: int) -> numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]:
|
|
7022
7119
|
...
|
|
7023
7120
|
def calculateEstimatePinholeCameraCal3Bundler(self, key: int) -> PinholeCameraCal3Bundler:
|
|
@@ -7449,6 +7546,51 @@ class InitializePose3:
|
|
|
7449
7546
|
"""
|
|
7450
7547
|
"extract" thePose3subgraph of the original graph, get orientations from relative orientation measurements using chordal method.
|
|
7451
7548
|
"""
|
|
7549
|
+
class InvariantEKFGal3(LeftLinearEKFGal3):
|
|
7550
|
+
def __init__(self, X0: Gal3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7551
|
+
...
|
|
7552
|
+
@typing.overload
|
|
7553
|
+
def predict(self, U: Gal3, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7554
|
+
...
|
|
7555
|
+
@typing.overload
|
|
7556
|
+
def predict(self, u: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7557
|
+
...
|
|
7558
|
+
class InvariantEKFNavState(LeftLinearEKFNavState):
|
|
7559
|
+
def __init__(self, X0: NavState, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7560
|
+
...
|
|
7561
|
+
@typing.overload
|
|
7562
|
+
def predict(self, U: NavState, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7563
|
+
...
|
|
7564
|
+
@typing.overload
|
|
7565
|
+
def predict(self, u: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7566
|
+
...
|
|
7567
|
+
class InvariantEKFPose2(LeftLinearEKFPose2):
|
|
7568
|
+
def __init__(self, X0: Pose2, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7569
|
+
...
|
|
7570
|
+
@typing.overload
|
|
7571
|
+
def predict(self, U: Pose2, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7572
|
+
...
|
|
7573
|
+
@typing.overload
|
|
7574
|
+
def predict(self, u: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7575
|
+
...
|
|
7576
|
+
class InvariantEKFPose3(LeftLinearEKFPose3):
|
|
7577
|
+
def __init__(self, X0: Pose3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7578
|
+
...
|
|
7579
|
+
@typing.overload
|
|
7580
|
+
def predict(self, U: Pose3, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7581
|
+
...
|
|
7582
|
+
@typing.overload
|
|
7583
|
+
def predict(self, u: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7584
|
+
...
|
|
7585
|
+
class InvariantEKFRot3(LeftLinearEKFRot3):
|
|
7586
|
+
def __init__(self, X0: Rot3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7587
|
+
...
|
|
7588
|
+
@typing.overload
|
|
7589
|
+
def predict(self, U: Rot3, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7590
|
+
...
|
|
7591
|
+
@typing.overload
|
|
7592
|
+
def predict(self, u: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float, Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
7593
|
+
...
|
|
7452
7594
|
class IterativeOptimizationParameters:
|
|
7453
7595
|
def getVerbosity(self) -> str:
|
|
7454
7596
|
...
|
|
@@ -7770,6 +7912,13 @@ class KalmanFilter:
|
|
|
7770
7912
|
"""
|
|
7771
7913
|
def updateQ(self, p: GaussianDensity, H: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], z: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> GaussianDensity:
|
|
7772
7914
|
...
|
|
7915
|
+
class KarcherMeanFactorGal3(NonlinearFactor):
|
|
7916
|
+
@typing.overload
|
|
7917
|
+
def __init__(self, keys: list[int]) -> None:
|
|
7918
|
+
...
|
|
7919
|
+
@typing.overload
|
|
7920
|
+
def __init__(self, keys: list[int], d: int, beta: float) -> None:
|
|
7921
|
+
...
|
|
7773
7922
|
class KarcherMeanFactorPoint2(NonlinearFactor):
|
|
7774
7923
|
@typing.overload
|
|
7775
7924
|
def __init__(self, keys: list[int]) -> None:
|
|
@@ -7812,6 +7961,13 @@ class KarcherMeanFactorRot3(NonlinearFactor):
|
|
|
7812
7961
|
@typing.overload
|
|
7813
7962
|
def __init__(self, keys: list[int], d: int, beta: float) -> None:
|
|
7814
7963
|
...
|
|
7964
|
+
class KarcherMeanFactorSL4(NonlinearFactor):
|
|
7965
|
+
@typing.overload
|
|
7966
|
+
def __init__(self, keys: list[int]) -> None:
|
|
7967
|
+
...
|
|
7968
|
+
@typing.overload
|
|
7969
|
+
def __init__(self, keys: list[int], d: int, beta: float) -> None:
|
|
7970
|
+
...
|
|
7815
7971
|
class KarcherMeanFactorSO3(NonlinearFactor):
|
|
7816
7972
|
@typing.overload
|
|
7817
7973
|
def __init__(self, keys: list[int]) -> None:
|
|
@@ -7826,6 +7982,20 @@ class KarcherMeanFactorSO4(NonlinearFactor):
|
|
|
7826
7982
|
@typing.overload
|
|
7827
7983
|
def __init__(self, keys: list[int], d: int, beta: float) -> None:
|
|
7828
7984
|
...
|
|
7985
|
+
class KarcherMeanFactorSimilarity2(NonlinearFactor):
|
|
7986
|
+
@typing.overload
|
|
7987
|
+
def __init__(self, keys: list[int]) -> None:
|
|
7988
|
+
...
|
|
7989
|
+
@typing.overload
|
|
7990
|
+
def __init__(self, keys: list[int], d: int, beta: float) -> None:
|
|
7991
|
+
...
|
|
7992
|
+
class KarcherMeanFactorSimilarity3(NonlinearFactor):
|
|
7993
|
+
@typing.overload
|
|
7994
|
+
def __init__(self, keys: list[int]) -> None:
|
|
7995
|
+
...
|
|
7996
|
+
@typing.overload
|
|
7997
|
+
def __init__(self, keys: list[int], d: int, beta: float) -> None:
|
|
7998
|
+
...
|
|
7829
7999
|
class KernelFunctionType:
|
|
7830
8000
|
"""
|
|
7831
8001
|
Members:
|
|
@@ -8039,6 +8209,21 @@ class LabeledSymbol:
|
|
|
8039
8209
|
"""
|
|
8040
8210
|
Converts to upper/lower versions of labels.
|
|
8041
8211
|
"""
|
|
8212
|
+
class LeftLinearEKFGal3(LieGroupEKFGal3):
|
|
8213
|
+
def __init__(self, X0: Gal3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8214
|
+
...
|
|
8215
|
+
class LeftLinearEKFNavState(LieGroupEKFNavState):
|
|
8216
|
+
def __init__(self, X0: NavState, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8217
|
+
...
|
|
8218
|
+
class LeftLinearEKFPose2(LieGroupEKFPose2):
|
|
8219
|
+
def __init__(self, X0: Pose2, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8220
|
+
...
|
|
8221
|
+
class LeftLinearEKFPose3(LieGroupEKFPose3):
|
|
8222
|
+
def __init__(self, X0: Pose3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8223
|
+
...
|
|
8224
|
+
class LeftLinearEKFRot3(LieGroupEKFRot3):
|
|
8225
|
+
def __init__(self, X0: Rot3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8226
|
+
...
|
|
8042
8227
|
class LevenbergMarquardtOptimizer(NonlinearOptimizer):
|
|
8043
8228
|
@typing.overload
|
|
8044
8229
|
def __init__(self, graph: NonlinearFactorGraph, initialValues: ..., params: LevenbergMarquardtParams = ...) -> None:
|
|
@@ -8103,6 +8288,31 @@ class LevenbergMarquardtParams(NonlinearOptimizerParams):
|
|
|
8103
8288
|
...
|
|
8104
8289
|
def setlambdaUpperBound(self, value: float) -> None:
|
|
8105
8290
|
...
|
|
8291
|
+
class LieGroupEKFGal3(ManifoldEKFGal3):
|
|
8292
|
+
def __init__(self, X0: Gal3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8293
|
+
...
|
|
8294
|
+
def predictWithCompose(self, U: Gal3, J_UX: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8295
|
+
...
|
|
8296
|
+
class LieGroupEKFNavState(ManifoldEKFNavState):
|
|
8297
|
+
def __init__(self, X0: NavState, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8298
|
+
...
|
|
8299
|
+
def predictWithCompose(self, U: NavState, J_UX: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8300
|
+
...
|
|
8301
|
+
class LieGroupEKFPose2(ManifoldEKFPose2):
|
|
8302
|
+
def __init__(self, X0: Pose2, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8303
|
+
...
|
|
8304
|
+
def predictWithCompose(self, U: Pose2, J_UX: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8305
|
+
...
|
|
8306
|
+
class LieGroupEKFPose3(ManifoldEKFPose3):
|
|
8307
|
+
def __init__(self, X0: Pose3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8308
|
+
...
|
|
8309
|
+
def predictWithCompose(self, U: Pose3, J_UX: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8310
|
+
...
|
|
8311
|
+
class LieGroupEKFRot3(ManifoldEKFRot3):
|
|
8312
|
+
def __init__(self, X0: Rot3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8313
|
+
...
|
|
8314
|
+
def predictWithCompose(self, U: Rot3, J_UX: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8315
|
+
...
|
|
8106
8316
|
class LinearContainerFactor(NonlinearFactor):
|
|
8107
8317
|
@staticmethod
|
|
8108
8318
|
@typing.overload
|
|
@@ -8261,6 +8471,84 @@ class MagPoseFactorPose3(NoiseModelFactor):
|
|
|
8261
8471
|
...
|
|
8262
8472
|
def evaluateError(self, nRb: Pose3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
8263
8473
|
...
|
|
8474
|
+
class ManifoldEKFGal3:
|
|
8475
|
+
def __init__(self, X0: Gal3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8476
|
+
...
|
|
8477
|
+
def covariance(self) -> numpy.ndarray[tuple[typing.Literal[10], typing.Literal[10]], numpy.dtype[numpy.float64]]:
|
|
8478
|
+
...
|
|
8479
|
+
def dimension(self) -> int:
|
|
8480
|
+
...
|
|
8481
|
+
def predict(self, X_next: Gal3, F: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8482
|
+
...
|
|
8483
|
+
def state(self) -> Gal3:
|
|
8484
|
+
...
|
|
8485
|
+
def updateWithVector(self, prediction: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], H: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], z: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], R: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8486
|
+
...
|
|
8487
|
+
class ManifoldEKFNavState:
|
|
8488
|
+
def __init__(self, X0: NavState, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8489
|
+
...
|
|
8490
|
+
def covariance(self) -> numpy.ndarray[tuple[typing.Literal[9], typing.Literal[9]], numpy.dtype[numpy.float64]]:
|
|
8491
|
+
...
|
|
8492
|
+
def dimension(self) -> int:
|
|
8493
|
+
...
|
|
8494
|
+
def predict(self, X_next: NavState, F: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8495
|
+
...
|
|
8496
|
+
def state(self) -> NavState:
|
|
8497
|
+
...
|
|
8498
|
+
def updateWithVector(self, prediction: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], H: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], z: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], R: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8499
|
+
...
|
|
8500
|
+
class ManifoldEKFPose2:
|
|
8501
|
+
def __init__(self, X0: Pose2, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8502
|
+
...
|
|
8503
|
+
def covariance(self) -> numpy.ndarray[tuple[typing.Literal[3], typing.Literal[3]], numpy.dtype[numpy.float64]]:
|
|
8504
|
+
...
|
|
8505
|
+
def dimension(self) -> int:
|
|
8506
|
+
...
|
|
8507
|
+
def predict(self, X_next: Pose2, F: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8508
|
+
...
|
|
8509
|
+
def state(self) -> Pose2:
|
|
8510
|
+
...
|
|
8511
|
+
def updateWithVector(self, prediction: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], H: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], z: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], R: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8512
|
+
...
|
|
8513
|
+
class ManifoldEKFPose3:
|
|
8514
|
+
def __init__(self, X0: Pose3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8515
|
+
...
|
|
8516
|
+
def covariance(self) -> numpy.ndarray[tuple[typing.Literal[6], typing.Literal[6]], numpy.dtype[numpy.float64]]:
|
|
8517
|
+
...
|
|
8518
|
+
def dimension(self) -> int:
|
|
8519
|
+
...
|
|
8520
|
+
def predict(self, X_next: Pose3, F: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8521
|
+
...
|
|
8522
|
+
def state(self) -> Pose3:
|
|
8523
|
+
...
|
|
8524
|
+
def updateWithVector(self, prediction: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], H: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], z: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], R: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8525
|
+
...
|
|
8526
|
+
class ManifoldEKFRot3:
|
|
8527
|
+
def __init__(self, X0: Rot3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8528
|
+
...
|
|
8529
|
+
def covariance(self) -> numpy.ndarray[tuple[typing.Literal[3], typing.Literal[3]], numpy.dtype[numpy.float64]]:
|
|
8530
|
+
...
|
|
8531
|
+
def dimension(self) -> int:
|
|
8532
|
+
...
|
|
8533
|
+
def predict(self, X_next: Rot3, F: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8534
|
+
...
|
|
8535
|
+
def state(self) -> Rot3:
|
|
8536
|
+
...
|
|
8537
|
+
def updateWithVector(self, prediction: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], H: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], z: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], R: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8538
|
+
...
|
|
8539
|
+
class ManifoldEKFUnit3:
|
|
8540
|
+
def __init__(self, X0: Unit3, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8541
|
+
...
|
|
8542
|
+
def covariance(self) -> numpy.ndarray[tuple[typing.Literal[2], typing.Literal[2]], numpy.dtype[numpy.float64]]:
|
|
8543
|
+
...
|
|
8544
|
+
def dimension(self) -> int:
|
|
8545
|
+
...
|
|
8546
|
+
def predict(self, X_next: Unit3, F: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], Q: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8547
|
+
...
|
|
8548
|
+
def state(self) -> Unit3:
|
|
8549
|
+
...
|
|
8550
|
+
def updateWithVector(self, prediction: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], H: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], z: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], R: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]]) -> None:
|
|
8551
|
+
...
|
|
8264
8552
|
class ManifoldEvaluationFactorChebyshev1BasisPose2(NoiseModelFactor):
|
|
8265
8553
|
@typing.overload
|
|
8266
8554
|
def __init__(self) -> None:
|
|
@@ -8553,6 +8841,51 @@ class NavState:
|
|
|
8553
8841
|
...
|
|
8554
8842
|
def velocity(self) -> numpy.ndarray[tuple[typing.Literal[3], typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
8555
8843
|
...
|
|
8844
|
+
class NavStateImuEKF(LeftLinearEKFNavState):
|
|
8845
|
+
def Dynamics(self, n_gravity: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], X: NavState, omega_b: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], f_b: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float) -> NavState:
|
|
8846
|
+
"""
|
|
8847
|
+
Compute the dynamics of the system.
|
|
8848
|
+
|
|
8849
|
+
This function computes the next state of the system based on the current state, gravity, body angular velocity, body specific force, and time step. The dynamics are defined as: X_{k+1} = f(X_k; g, omega_b, f_b, dt) = W(g, dt) \\phi_dt(X_k) U(omega_b, f_b, dt) where W, \\phi, and U are the gravity, (autonomous) position update, and IMU increment functions, respectively.
|
|
8850
|
+
|
|
8851
|
+
Args:
|
|
8852
|
+
n_gravity: Gravity vector in the navigation frame.
|
|
8853
|
+
X: Current NavState.
|
|
8854
|
+
omega_b: Body angular velocity measurement (rad/s).
|
|
8855
|
+
f_b: Body specific force measurement (m/s^2).
|
|
8856
|
+
dt: Time step in seconds.
|
|
8857
|
+
|
|
8858
|
+
Returns: The next NavState after applying the dynamics.
|
|
8859
|
+
"""
|
|
8860
|
+
def Gravity(self, n_gravity: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float) -> NavState:
|
|
8861
|
+
"""
|
|
8862
|
+
Calculate W (gravity-only left composition, world-frame increments)
|
|
8863
|
+
"""
|
|
8864
|
+
def IMU(self, omega_b: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], f_b: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float) -> NavState:
|
|
8865
|
+
"""
|
|
8866
|
+
Calculate U from raw IMU (no gravity): body-frame increments.
|
|
8867
|
+
"""
|
|
8868
|
+
def __init__(self, X0: NavState, P0: numpy.ndarray[tuple[M, N], numpy.dtype[numpy.float64]], params: PreintegrationParams) -> None:
|
|
8869
|
+
...
|
|
8870
|
+
def gravity(self) -> numpy.ndarray[tuple[typing.Literal[3], typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
8871
|
+
...
|
|
8872
|
+
def params(self) -> PreintegrationParams:
|
|
8873
|
+
"""
|
|
8874
|
+
Accessors.
|
|
8875
|
+
"""
|
|
8876
|
+
def predict(self, omega_b: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], f_b: numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]], dt: float) -> None:
|
|
8877
|
+
"""
|
|
8878
|
+
Predict the next state using gyro and accelerometer measurements.
|
|
8879
|
+
|
|
8880
|
+
This method updates the state of the system based on the provided body angular velocity (omega_b) and body specific force (f_b) measurements over a given time step.
|
|
8881
|
+
|
|
8882
|
+
Args:
|
|
8883
|
+
omega_b: Body angular velocity measurement (rad/s).
|
|
8884
|
+
f_b: Body specific force measurement (m/s^2).
|
|
8885
|
+
dt: Time step in seconds.
|
|
8886
|
+
"""
|
|
8887
|
+
def processNoise(self) -> numpy.ndarray[tuple[typing.Literal[9], typing.Literal[9]], numpy.dtype[numpy.float64]]:
|
|
8888
|
+
...
|
|
8556
8889
|
class NoiseFormat:
|
|
8557
8890
|
"""
|
|
8558
8891
|
Members:
|
|
@@ -8661,6 +8994,11 @@ class NonlinearEquality2ConstantBias(NoiseModelFactor):
|
|
|
8661
8994
|
...
|
|
8662
8995
|
def evaluateError(self, x1: ..., x2: ...) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
8663
8996
|
...
|
|
8997
|
+
class NonlinearEquality2Gal3(NoiseModelFactor):
|
|
8998
|
+
def __init__(self, key1: int, key2: int, mu: float = 10000.0) -> None:
|
|
8999
|
+
...
|
|
9000
|
+
def evaluateError(self, x1: Gal3, x2: Gal3) -> numpy.ndarray[tuple[M, typing.Literal[1]], numpy.dtype[numpy.float64]]:
|
|
9001
|
+
...
|
|
8664
9002
|
class NonlinearEquality2PinholeCameraCal3Bundler(NoiseModelFactor):
|
|
8665
9003
|
def __init__(self, key1: int, key2: int, mu: float = 10000.0) -> None:
|
|
8666
9004
|
...
|
|
@@ -8791,6 +9129,21 @@ class NonlinearEqualityConstantBias(NoiseModelFactor):
|
|
|
8791
9129
|
...
|
|
8792
9130
|
def serialize(self) -> str:
|
|
8793
9131
|
...
|
|
9132
|
+
class NonlinearEqualityGal3(NoiseModelFactor):
|
|
9133
|
+
def __getstate__(self) -> tuple:
|
|
9134
|
+
...
|
|
9135
|
+
@typing.overload
|
|
9136
|
+
def __init__(self, j: int, feasible: Gal3) -> None:
|
|
9137
|
+
...
|
|
9138
|
+
@typing.overload
|
|
9139
|
+
def __init__(self, j: int, feasible: Gal3, error_gain: float) -> None:
|
|
9140
|
+
...
|
|
9141
|
+
def __setstate__(self, arg0: tuple) -> None:
|
|
9142
|
+
...
|
|
9143
|
+
def deserialize(self, serialized: str) -> None:
|
|
9144
|
+
...
|
|
9145
|
+
def serialize(self) -> str:
|
|
9146
|
+
...
|
|
8794
9147
|
class NonlinearEqualityPinholeCameraCal3Bundler(NoiseModelFactor):
|
|
8795
9148
|
def __getstate__(self) -> tuple:
|
|
8796
9149
|
...
|
|
@@ -9128,6 +9481,8 @@ class NonlinearFactorGraph:
|
|
|
9128
9481
|
...
|
|
9129
9482
|
def addPriorFundamentalMatrix(self, key: int, prior: FundamentalMatrix, noiseModel: noiseModel.Base) -> None:
|
|
9130
9483
|
...
|
|
9484
|
+
def addPriorGal3(self, key: int, prior: Gal3, noiseModel: noiseModel.Base) -> None:
|
|
9485
|
+
...
|
|
9131
9486
|
def addPriorPinholeCameraCal3Bundler(self, key: int, prior: PinholeCameraCal3Bundler, noiseModel: noiseModel.Base) -> None:
|
|
9132
9487
|
...
|
|
9133
9488
|
def addPriorPinholeCameraCal3Fisheye(self, key: int, prior: PinholeCameraCal3Fisheye, noiseModel: noiseModel.Base) -> None:
|
|
@@ -11826,6 +12181,19 @@ class PriorFactorDouble(NoiseModelFactor):
|
|
|
11826
12181
|
...
|
|
11827
12182
|
def serialize(self) -> str:
|
|
11828
12183
|
...
|
|
12184
|
+
class PriorFactorGal3(NoiseModelFactor):
|
|
12185
|
+
def __getstate__(self) -> tuple:
|
|
12186
|
+
...
|
|
12187
|
+
def __init__(self, key: int, prior: Gal3, noiseModel: noiseModel.Base) -> None:
|
|
12188
|
+
...
|
|
12189
|
+
def __setstate__(self, arg0: tuple) -> None:
|
|
12190
|
+
...
|
|
12191
|
+
def deserialize(self, serialized: str) -> None:
|
|
12192
|
+
...
|
|
12193
|
+
def prior(self) -> Gal3:
|
|
12194
|
+
...
|
|
12195
|
+
def serialize(self) -> str:
|
|
12196
|
+
...
|
|
11829
12197
|
class PriorFactorNavState(NoiseModelFactor):
|
|
11830
12198
|
def __getstate__(self) -> tuple:
|
|
11831
12199
|
...
|
|
Binary file
|