gtsam-develop 4.3a0.dev202508252029__cp313-cp313-macosx_11_0_arm64.whl → 4.3a0.dev202509090331__cp313-cp313-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/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 FrobeniusBetweenFactorPose2(NoiseModelFactor):
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 FrobeniusBetweenFactorPose3(NoiseModelFactor):
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 FrobeniusBetweenFactorRot2(NoiseModelFactor):
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 FrobeniusBetweenFactorRot3(NoiseModelFactor):
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 FrobeniusBetweenFactorSO3(NoiseModelFactor):
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 FrobeniusBetweenFactorSO4(NoiseModelFactor):
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 FrobeniusBetweenFactorSimilarity2(NoiseModelFactor):
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 FrobeniusBetweenFactorSimilarity3(NoiseModelFactor):
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