gtsam
Loading...
Searching...
No Matches
gtsam::Interpolator< PoseType > Member List

This is the complete list of members for gtsam::Interpolator< PoseType >, including all inherited members.

computeCompleteJacobians_(const Matrix2N &Lambda, const Matrix2N &Psi, const VectorN &xidot_tau, const MatrixN &right_jac_tau, const MatrixN &dTtau_dTk, const MatrixN &dTtau_dxitau, const StateJacobians &jacs, OptionalMatrixVecType H) constgtsam::Interpolator< PoseType >protected
computeConditionalCov(const TimestampedPoseVel &pvk, const TimestampedPoseVel &pvkp1, const TimestampedPoseVel &pvtau, OptionalMatrixType Lambda=nullptr, OptionalMatrixType Psi=nullptr) constgtsam::Interpolator< PoseType >
computeInterpolationCovariance_(const TimestampedPoseVel &tPoseVel_k, const TimestampedPoseVel &tPoseVel_kp1, const PoseVel &poseVel_tau, double t_tau, const Matrix2N &Lambda, const Matrix2N &Psi, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix, Matrix *covarianceOut) constgtsam::Interpolator< PoseType >protected
computeJacobianNext_ (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
computeJacobianPrev_ (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
ComputeJointMarginals(const std::map< StateDataInterval, std::vector< StateData > > &queryBuckets, const std::unique_ptr< Marginals > &marginals)gtsam::Interpolator< PoseType >protectedstatic
computeLocalStateVecs(const TimestampedPoseVel &pvk, const TimestampedPoseVel &pvkp1, StateJacobians *jacs=nullptr) constgtsam::Interpolator< PoseType >
ConstructMatrixFromJointMarginal(const JointMarginal &blockMatrix, const KeyVector &keyVector, size_t blockSize)gtsam::Interpolator< PoseType >protectedstatic
covarianceFunction_ (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
dim (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protectedstatic
extrapolatePoseAndVelocity(const PoseVelocity< PoseType > &poseVel, double t_diff, OptionalMatrixVecType H=nullptr, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix=nullptr, Matrix *covarianceOut=nullptr) constgtsam::Interpolator< PoseType >protected
formLocalStateAndJacobians_(const TimestampedPoseVel &tPoseVel_k, const TimestampedPoseVel &tPoseVel_kp1, const std::shared_ptr< const LocalStateVecs > &localStateVecsPreComp, const std::shared_ptr< const StateJacobians > &stateJacobiansPreComp, VectorN *xi_dot_k, VectorN *xi_kp1, VectorN *xi_dot_kp1, StateJacobians *jacs=nullptr) constgtsam::Interpolator< PoseType >protected
getLambdaPsi(double t_k, double t_kp1, double t_tau) constgtsam::Interpolator< PoseType >
getLambdaPsiGeneral(double t_k, double t_kp1, double t_tau) constgtsam::Interpolator< PoseType >
interpolateBoundaryLeft(const PoseVelocity< PoseType > &poseVel_k, OptionalMatrixVecType H=nullptr, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix=nullptr, Matrix *covarianceOut=nullptr) constgtsam::Interpolator< PoseType >protected
interpolateBoundaryRight(const PoseVelocity< PoseType > &poseVel_kp1, OptionalMatrixVecType H=nullptr, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix=nullptr, Matrix *covarianceOut=nullptr) constgtsam::Interpolator< PoseType >protected
interpolateLocalState_(double t_k, double t_kp1, double t_tau, const VectorN &xi_dot_k, const VectorN &xi_kp1, const VectorN &xi_dot_kp1, const std::shared_ptr< const LambdaPsiMats > &LambdaPsiPreComp, Matrix2N *Lambda, Matrix2N *Psi, VectorN *xi_tau, VectorN *xidot_tau) constgtsam::Interpolator< PoseType >protected
interpolatePoseAndVelocity(const std::optional< TimestampedPoseVel > &Tvarpi_k, const std::optional< TimestampedPoseVel > &Tvarpi_kp1, double t_tau, OptionalMatrixVecType H=nullptr, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix=nullptr, Matrix *covarianceOut=nullptr, const std::shared_ptr< const LambdaPsiMats > &LambdaPsiPreComp=nullptr, const std::shared_ptr< const LocalStateVecs > &localStateVecsPreComp=nullptr, const std::shared_ptr< const StateJacobians > &stateJacobiansPreComp=nullptr) constgtsam::Interpolator< PoseType >
interpolatePoseAndVelocity_(const TimestampedPoseVel &tPoseVel_k, const TimestampedPoseVel &tPoseVel_kp1, double t_tau, OptionalMatrixVecType H=nullptr, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix=nullptr, Matrix *covarianceOut=nullptr, const std::shared_ptr< const LambdaPsiMats > &LambdaPsiPreComp=nullptr, const std::shared_ptr< const LocalStateVecs > &localStateVecsPreComp=nullptr, const std::shared_ptr< const StateJacobians > &stateJacobiansPreComp=nullptr) constgtsam::Interpolator< PoseType >protected
interpolatePosesAndVelocities(const NonlinearFactorGraph &mainSolveGraph, const Values &mainSolveSolution, const StateDataSet &mainSolveStates, const StateDataSet &interpolatedStates, std::shared_ptr< InterpCovarianceMap > covarianceMapOut=nullptr) constgtsam::Interpolator< PoseType >
Interpolator()=delete (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >
Interpolator(const VectorN &q_psd_diag, std::function< Matrix(double dt)> transitionFunction, std::function< Matrix(double dt, const VectorN &q_psd_diag)> covarianceFunction, std::function< Matrix(double dt, const VectorN &q_psd_diag)> inverseCovarianceFunction, std::function< Matrix(const std::pair< PoseType, VelocityType > &, const std::pair< PoseType, VelocityType > &, double)> computeJacobianPrev, std::function< Matrix(const std::pair< PoseType, VelocityType > &, const std::pair< PoseType, VelocityType > &, double)> computeJacobianNext)gtsam::Interpolator< PoseType >
Interpolator(const VectorN &q_psd_diag)gtsam::Interpolator< PoseType >
inverseCovarianceFunction_ (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
LambdaPsiMats typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >
LocalStateVecs typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >
mapLocalStateToManifold_(const PoseType &T_k, const VectorN &xi_tau, const VectorN &xidot_tau, MatrixN *right_jac_tau, MatrixN *dTtau_dTk=nullptr, MatrixN *dTtau_dxitau=nullptr) constgtsam::Interpolator< PoseType >protected
Matrix2N typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
MatrixN typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
MatrixNx2N typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
PoseVel typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >
q_psd_diag_ (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
StateDataSet typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >
TimestampedPoseVel typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >
transitionFunction_ (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
Vector2N typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
VectorN typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected
VelocityType typedef (defined in gtsam::Interpolator< PoseType >)gtsam::Interpolator< PoseType >protected