|
gtsam
|
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) const | gtsam::Interpolator< PoseType > | protected |
| computeConditionalCov(const TimestampedPoseVel &pvk, const TimestampedPoseVel &pvkp1, const TimestampedPoseVel &pvtau, OptionalMatrixType Lambda=nullptr, OptionalMatrixType Psi=nullptr) const | gtsam::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) const | gtsam::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) const | gtsam::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) const | gtsam::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) const | gtsam::Interpolator< PoseType > | protected |
| getLambdaPsi(double t_k, double t_kp1, double t_tau) const | gtsam::Interpolator< PoseType > | |
| getLambdaPsiGeneral(double t_k, double t_kp1, double t_tau) const | gtsam::Interpolator< PoseType > | |
| interpolateBoundaryLeft(const PoseVelocity< PoseType > &poseVel_k, OptionalMatrixVecType H=nullptr, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix=nullptr, Matrix *covarianceOut=nullptr) const | gtsam::Interpolator< PoseType > | protected |
| interpolateBoundaryRight(const PoseVelocity< PoseType > &poseVel_kp1, OptionalMatrixVecType H=nullptr, const std::shared_ptr< Matrix > &mainSolveMarginalMatrix=nullptr, Matrix *covarianceOut=nullptr) const | gtsam::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) const | gtsam::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) const | gtsam::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) const | gtsam::Interpolator< PoseType > | protected |
| interpolatePosesAndVelocities(const NonlinearFactorGraph &mainSolveGraph, const Values &mainSolveSolution, const StateDataSet &mainSolveStates, const StateDataSet &interpolatedStates, std::shared_ptr< InterpCovarianceMap > covarianceMapOut=nullptr) const | gtsam::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) const | gtsam::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 |