Classes | Public Member Functions | Protected Member Functions | Private Types | Private Member Functions | Private Attributes | List of all members
cartographer::mapping::PoseGraph3D Class Referenceabstract

#include <pose_graph_3d.h>

Inheritance diagram for cartographer::mapping::PoseGraph3D:
Inheritance graph
[legend]

Classes

struct  InternalSubmapData
 
class  TrimmingHandle
 

Public Member Functions

void AddFixedFramePoseData (int trajectory_id, const sensor::FixedFramePoseData &fixed_frame_pose_data) override EXCLUDES(mutex_)
 
void AddImuData (int trajectory_id, const sensor::ImuData &imu_data) override EXCLUDES(mutex_)
 
void AddLandmarkData (int trajectory_id, const sensor::LandmarkData &landmark_data) override EXCLUDES(mutex_)
 
NodeId AddNode (std::shared_ptr< const TrajectoryNode::Data > constant_data, int trajectory_id, const std::vector< std::shared_ptr< const Submap3D >> &insertion_submaps) EXCLUDES(mutex_)
 
void AddNodeFromProto (const transform::Rigid3d &global_pose, const proto::Node &node) override
 
void AddNodeToSubmap (const NodeId &node_id, const SubmapId &submap_id) override
 
void AddOdometryData (int trajectory_id, const sensor::OdometryData &odometry_data) override EXCLUDES(mutex_)
 
void AddSerializedConstraints (const std::vector< Constraint > &constraints) override
 
void AddSubmapFromProto (const transform::Rigid3d &global_submap_pose, const proto::Submap &submap) override
 
void AddTrimmer (std::unique_ptr< PoseGraphTrimmer > trimmer) override
 
std::vector< Constraintconstraints () const override EXCLUDES(mutex_)
 
void FinishTrajectory (int trajectory_id) override
 
void FreezeTrajectory (int trajectory_id) override
 
MapById< SubmapId, SubmapDataGetAllSubmapData () const EXCLUDES(mutex_) override
 
MapById< SubmapId, SubmapPoseGetAllSubmapPoses () const EXCLUDES(mutex_) override
 
std::vector< std::vector< int > > GetConnectedTrajectories () const override
 
sensor::MapByTime< sensor::FixedFramePoseDataGetFixedFramePoseData () const override EXCLUDES(mutex_)
 
sensor::MapByTime< sensor::ImuDataGetImuData () const override EXCLUDES(mutex_)
 
transform::Rigid3d GetInterpolatedGlobalTrajectoryPose (int trajectory_id, const common::Time time) const REQUIRES(mutex_)
 
std::map< std::string, PoseGraph::LandmarkNodeGetLandmarkNodes () const override EXCLUDES(mutex_)
 
std::map< std::string, transform::Rigid3dGetLandmarkPoses () const override EXCLUDES(mutex_)
 
transform::Rigid3d GetLocalToGlobalTransform (int trajectory_id) const EXCLUDES(mutex_) override
 
sensor::MapByTime< sensor::OdometryDataGetOdometryData () const override EXCLUDES(mutex_)
 
PoseGraph::SubmapData GetSubmapData (const SubmapId &submap_id) const EXCLUDES(mutex_) override
 
std::map< int, TrajectoryDataGetTrajectoryData () const override
 
MapById< NodeId, TrajectoryNodePoseGetTrajectoryNodePoses () const override EXCLUDES(mutex_)
 
MapById< NodeId, TrajectoryNodeGetTrajectoryNodes () const override EXCLUDES(mutex_)
 
bool IsTrajectoryFinished (int trajectory_id) const override REQUIRES(mutex_)
 
bool IsTrajectoryFrozen (int trajectory_id) const override REQUIRES(mutex_)
 
PoseGraph3Doperator= (const PoseGraph3D &)=delete
 
 PoseGraph3D (const proto::PoseGraphOptions &options, std::unique_ptr< optimization::OptimizationProblem3D > optimization_problem, common::ThreadPool *thread_pool)
 
 PoseGraph3D (const PoseGraph3D &)=delete
 
void RunFinalOptimization () override
 
void SetGlobalSlamOptimizationCallback (PoseGraphInterface::GlobalSlamOptimizationCallback callback) override
 
void SetInitialTrajectoryPose (int from_trajectory_id, int to_trajectory_id, const transform::Rigid3d &pose, const common::Time time) override EXCLUDES(mutex_)
 
void SetLandmarkPose (const std::string &landmark_id, const transform::Rigid3d &global_pose) override EXCLUDES(mutex_)
 
void SetTrajectoryDataFromProto (const proto::TrajectoryData &data) override
 
 ~PoseGraph3D () override
 
- Public Member Functions inherited from cartographer::mapping::PoseGraph
PoseGraphoperator= (const PoseGraph &)=delete
 
 PoseGraph ()
 
 PoseGraph (const PoseGraph &)=delete
 
virtual void SetTrajectoryDataFromProto (const mapping::proto::TrajectoryData &data)=0
 
proto::PoseGraph ToProto () const override
 
 ~PoseGraph () override
 
- Public Member Functions inherited from cartographer::mapping::PoseGraphInterface
PoseGraphInterfaceoperator= (const PoseGraphInterface &)=delete
 
 PoseGraphInterface ()
 
 PoseGraphInterface (const PoseGraphInterface &)=delete
 
virtual ~PoseGraphInterface ()
 

Protected Member Functions

void WaitForAllComputations () EXCLUDES(mutex_)
 

Private Types

enum  SubmapState { SubmapState::kActive, SubmapState::kFinished }
 

Private Member Functions

void AddTrajectoryIfNeeded (int trajectory_id) REQUIRES(mutex_)
 
void AddWorkItem (const std::function< void()> &work_item) REQUIRES(mutex_)
 
void ComputeConstraint (const NodeId &node_id, const SubmapId &submap_id) REQUIRES(mutex_)
 
void ComputeConstraintsForNode (const NodeId &node_id, std::vector< std::shared_ptr< const Submap3D >> insertion_submaps, bool newly_finished_submap) REQUIRES(mutex_)
 
void ComputeConstraintsForOldNodes (const SubmapId &submap_id) REQUIRES(mutex_)
 
transform::Rigid3d ComputeLocalToGlobalTransform (const MapById< SubmapId, optimization::SubmapSpec3D > &global_submap_poses, int trajectory_id) const REQUIRES(mutex_)
 
void DispatchOptimization () REQUIRES(mutex_)
 
common::Time GetLatestNodeTime (const NodeId &node_id, const SubmapId &submap_id) const REQUIRES(mutex_)
 
MapById< SubmapId, SubmapDataGetSubmapDataUnderLock () const REQUIRES(mutex_)
 
PoseGraph::SubmapData GetSubmapDataUnderLock (const SubmapId &submap_id) const REQUIRES(mutex_)
 
std::unique_ptr< std::deque< std::function< void()> > > work_queue_ GUARDED_BY (mutex_)
 
std::unordered_map< int, std::unique_ptr< common::FixedRatioSampler > > global_localization_samplers_ GUARDED_BY (mutex_)
 
int num_nodes_since_last_loop_closure_ GUARDED_BY (mutex_)=0
 
bool run_loop_closure_ GUARDED_BY (mutex_)
 
constraints::ConstraintBuilder3D constraint_builder_ GUARDED_BY (mutex_)
 
std::vector< Constraint > constraints_ GUARDED_BY (mutex_)
 
MapById< SubmapId, InternalSubmapData > submap_data_ GUARDED_BY (mutex_)
 
MapById< NodeId, TrajectoryNode > trajectory_nodes_ GUARDED_BY (mutex_)
 
int num_trajectory_nodes_ GUARDED_BY (mutex_)=0
 
MapById< SubmapId, optimization::SubmapSpec3D > global_submap_poses_ GUARDED_BY (mutex_)
 
std::map< std::string, PoseGraph::LandmarkNode > landmark_nodes_ GUARDED_BY (mutex_)
 
std::vector< std::unique_ptr< PoseGraphTrimmer > > trimmers_ GUARDED_BY (mutex_)
 
std::set< int > frozen_trajectories_ GUARDED_BY (mutex_)
 
std::set< int > finished_trajectories_ GUARDED_BY (mutex_)
 
std::map< int, InitialTrajectoryPose > initial_trajectory_poses_ GUARDED_BY (mutex_)
 
void HandleWorkQueue (const constraints::ConstraintBuilder3D::Result &result) REQUIRES(mutex_)
 
std::vector< SubmapIdInitializeGlobalSubmapPoses (int trajectory_id, const common::Time time, const std::vector< std::shared_ptr< const Submap3D >> &insertion_submaps) REQUIRES(mutex_)
 
void LogResidualHistograms () const REQUIRES(mutex_)
 
void RunOptimization () EXCLUDES(mutex_)
 
void UpdateTrajectoryConnectivity (const Constraint &constraint) REQUIRES(mutex_)
 

Private Attributes

GlobalSlamOptimizationCallback global_slam_optimization_callback_
 
common::Mutex mutex_
 
std::unique_ptr< optimization::OptimizationProblem3Doptimization_problem_
 
const proto::PoseGraphOptions options_
 
TrajectoryConnectivityState trajectory_connectivity_state_
 

Additional Inherited Members

- Public Types inherited from cartographer::mapping::PoseGraphInterface
using GlobalSlamOptimizationCallback = std::function< void(const std::map< int, SubmapId > &, const std::map< int, NodeId > &)>
 

Detailed Description

Definition at line 59 of file pose_graph_3d.h.

Member Enumeration Documentation

◆ SubmapState

Enumerator
kActive 
kFinished 

Definition at line 156 of file pose_graph_3d.h.

Constructor & Destructor Documentation

◆ PoseGraph3D() [1/2]

cartographer::mapping::PoseGraph3D::PoseGraph3D ( const proto::PoseGraphOptions &  options,
std::unique_ptr< optimization::OptimizationProblem3D optimization_problem,
common::ThreadPool thread_pool 
)

Definition at line 42 of file pose_graph_3d.cc.

◆ ~PoseGraph3D()

cartographer::mapping::PoseGraph3D::~PoseGraph3D ( )
override

Definition at line 50 of file pose_graph_3d.cc.

◆ PoseGraph3D() [2/2]

cartographer::mapping::PoseGraph3D::PoseGraph3D ( const PoseGraph3D )
delete

Member Function Documentation

◆ AddFixedFramePoseData()

void cartographer::mapping::PoseGraph3D::AddFixedFramePoseData ( int  trajectory_id,
const sensor::FixedFramePoseData fixed_frame_pose_data 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 169 of file pose_graph_3d.cc.

◆ AddImuData()

void cartographer::mapping::PoseGraph3D::AddImuData ( int  trajectory_id,
const sensor::ImuData imu_data 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 153 of file pose_graph_3d.cc.

◆ AddLandmarkData()

void cartographer::mapping::PoseGraph3D::AddLandmarkData ( int  trajectory_id,
const sensor::LandmarkData landmark_data 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 179 of file pose_graph_3d.cc.

◆ AddNode()

NodeId cartographer::mapping::PoseGraph3D::AddNode ( std::shared_ptr< const TrajectoryNode::Data constant_data,
int  trajectory_id,
const std::vector< std::shared_ptr< const Submap3D >> &  insertion_submaps 
)

Definition at line 101 of file pose_graph_3d.cc.

◆ AddNodeFromProto()

void cartographer::mapping::PoseGraph3D::AddNodeFromProto ( const transform::Rigid3d global_pose,
const proto::Node &  node 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 490 of file pose_graph_3d.cc.

◆ AddNodeToSubmap()

void cartographer::mapping::PoseGraph3D::AddNodeToSubmap ( const NodeId node_id,
const SubmapId submap_id 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 529 of file pose_graph_3d.cc.

◆ AddOdometryData()

void cartographer::mapping::PoseGraph3D::AddOdometryData ( int  trajectory_id,
const sensor::OdometryData odometry_data 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 161 of file pose_graph_3d.cc.

◆ AddSerializedConstraints()

void cartographer::mapping::PoseGraph3D::AddSerializedConstraints ( const std::vector< Constraint > &  constraints)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 537 of file pose_graph_3d.cc.

◆ AddSubmapFromProto()

void cartographer::mapping::PoseGraph3D::AddSubmapFromProto ( const transform::Rigid3d global_submap_pose,
const proto::Submap &  submap 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 466 of file pose_graph_3d.cc.

◆ AddTrajectoryIfNeeded()

void cartographer::mapping::PoseGraph3D::AddTrajectoryIfNeeded ( int  trajectory_id)
private

Definition at line 143 of file pose_graph_3d.cc.

◆ AddTrimmer()

void cartographer::mapping::PoseGraph3D::AddTrimmer ( std::unique_ptr< PoseGraphTrimmer trimmer)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 562 of file pose_graph_3d.cc.

◆ AddWorkItem()

void cartographer::mapping::PoseGraph3D::AddWorkItem ( const std::function< void()> &  work_item)
private

Definition at line 135 of file pose_graph_3d.cc.

◆ ComputeConstraint()

void cartographer::mapping::PoseGraph3D::ComputeConstraint ( const NodeId node_id,
const SubmapId submap_id 
)
private

Definition at line 194 of file pose_graph_3d.cc.

◆ ComputeConstraintsForNode()

void cartographer::mapping::PoseGraph3D::ComputeConstraintsForNode ( const NodeId node_id,
std::vector< std::shared_ptr< const Submap3D >>  insertion_submaps,
bool  newly_finished_submap 
)
private

Definition at line 255 of file pose_graph_3d.cc.

◆ ComputeConstraintsForOldNodes()

void cartographer::mapping::PoseGraph3D::ComputeConstraintsForOldNodes ( const SubmapId submap_id)
private

Definition at line 245 of file pose_graph_3d.cc.

◆ ComputeLocalToGlobalTransform()

transform::Rigid3d cartographer::mapping::PoseGraph3D::ComputeLocalToGlobalTransform ( const MapById< SubmapId, optimization::SubmapSpec3D > &  global_submap_poses,
int  trajectory_id 
) const
private

Definition at line 806 of file pose_graph_3d.cc.

◆ constraints()

std::vector< PoseGraphInterface::Constraint > cartographer::mapping::PoseGraph3D::constraints ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 736 of file pose_graph_3d.cc.

◆ DispatchOptimization()

void cartographer::mapping::PoseGraph3D::DispatchOptimization ( )
private

Definition at line 313 of file pose_graph_3d.cc.

◆ FinishTrajectory()

void cartographer::mapping::PoseGraph3D::FinishTrajectory ( int  trajectory_id)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 435 of file pose_graph_3d.cc.

◆ FreezeTrajectory()

void cartographer::mapping::PoseGraph3D::FreezeTrajectory ( int  trajectory_id)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 453 of file pose_graph_3d.cc.

◆ GetAllSubmapData()

MapById< SubmapId, PoseGraphInterface::SubmapData > cartographer::mapping::PoseGraph3D::GetAllSubmapData ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 787 of file pose_graph_3d.cc.

◆ GetAllSubmapPoses()

MapById< SubmapId, PoseGraphInterface::SubmapPose > cartographer::mapping::PoseGraph3D::GetAllSubmapPoses ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 793 of file pose_graph_3d.cc.

◆ GetConnectedTrajectories()

std::vector< std::vector< int > > cartographer::mapping::PoseGraph3D::GetConnectedTrajectories ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 776 of file pose_graph_3d.cc.

◆ GetFixedFramePoseData()

sensor::MapByTime< sensor::FixedFramePoseData > cartographer::mapping::PoseGraph3D::GetFixedFramePoseData ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 719 of file pose_graph_3d.cc.

◆ GetImuData()

sensor::MapByTime< sensor::ImuData > cartographer::mapping::PoseGraph3D::GetImuData ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 708 of file pose_graph_3d.cc.

◆ GetInterpolatedGlobalTrajectoryPose()

transform::Rigid3d cartographer::mapping::PoseGraph3D::GetInterpolatedGlobalTrajectoryPose ( int  trajectory_id,
const common::Time  time 
) const

Definition at line 750 of file pose_graph_3d.cc.

◆ GetLandmarkNodes()

std::map< std::string, PoseGraphInterface::LandmarkNode > cartographer::mapping::PoseGraph3D::GetLandmarkNodes ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 725 of file pose_graph_3d.cc.

◆ GetLandmarkPoses()

std::map< std::string, transform::Rigid3d > cartographer::mapping::PoseGraph3D::GetLandmarkPoses ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 687 of file pose_graph_3d.cc.

◆ GetLatestNodeTime()

common::Time cartographer::mapping::PoseGraph3D::GetLatestNodeTime ( const NodeId node_id,
const SubmapId submap_id 
) const
private

Definition at line 323 of file pose_graph_3d.cc.

◆ GetLocalToGlobalTransform()

transform::Rigid3d cartographer::mapping::PoseGraph3D::GetLocalToGlobalTransform ( int  trajectory_id) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 770 of file pose_graph_3d.cc.

◆ GetOdometryData()

sensor::MapByTime< sensor::OdometryData > cartographer::mapping::PoseGraph3D::GetOdometryData ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 713 of file pose_graph_3d.cc.

◆ GetSubmapData()

PoseGraphInterface::SubmapData cartographer::mapping::PoseGraph3D::GetSubmapData ( const SubmapId submap_id) const
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 780 of file pose_graph_3d.cc.

◆ GetSubmapDataUnderLock() [1/2]

MapById< SubmapId, PoseGraphInterface::SubmapData > cartographer::mapping::PoseGraph3D::GetSubmapDataUnderLock ( ) const
private

Definition at line 953 of file pose_graph_3d.cc.

◆ GetSubmapDataUnderLock() [2/2]

PoseGraphInterface::SubmapData cartographer::mapping::PoseGraph3D::GetSubmapDataUnderLock ( const SubmapId submap_id) const
private

Definition at line 829 of file pose_graph_3d.cc.

◆ GetTrajectoryData()

std::map< int, PoseGraphInterface::TrajectoryData > cartographer::mapping::PoseGraph3D::GetTrajectoryData ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 731 of file pose_graph_3d.cc.

◆ GetTrajectoryNodePoses()

MapById< NodeId, TrajectoryNodePose > cartographer::mapping::PoseGraph3D::GetTrajectoryNodePoses ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 669 of file pose_graph_3d.cc.

◆ GetTrajectoryNodes()

MapById< NodeId, TrajectoryNode > cartographer::mapping::PoseGraph3D::GetTrajectoryNodes ( ) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 664 of file pose_graph_3d.cc.

◆ GUARDED_BY() [1/15]

std::unique_ptr<std::deque<std::function<void()> > > work_queue_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [2/15]

std::unordered_map<int, std::unique_ptr<common::FixedRatioSampler> > global_localization_samplers_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [3/15]

int num_nodes_since_last_loop_closure_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
privatepure virtual

◆ GUARDED_BY() [4/15]

bool run_loop_closure_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [5/15]

constraints::ConstraintBuilder3D constraint_builder_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [6/15]

std::vector<Constraint> constraints_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [7/15]

MapById<SubmapId, InternalSubmapData> submap_data_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [8/15]

MapById<NodeId, TrajectoryNode> trajectory_nodes_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [9/15]

int num_trajectory_nodes_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
privatepure virtual

◆ GUARDED_BY() [10/15]

MapById<SubmapId, optimization::SubmapSpec3D> global_submap_poses_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [11/15]

std::map<std::string , PoseGraph::LandmarkNode> landmark_nodes_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [12/15]

std::vector<std::unique_ptr<PoseGraphTrimmer> > trimmers_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [13/15]

std::set<int> frozen_trajectories_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [14/15]

std::set<int> finished_trajectories_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ GUARDED_BY() [15/15]

std::map<int, InitialTrajectoryPose> initial_trajectory_poses_ cartographer::mapping::PoseGraph3D::GUARDED_BY ( mutex_  )
private

◆ HandleWorkQueue()

void cartographer::mapping::PoseGraph3D::HandleWorkQueue ( const constraints::ConstraintBuilder3D::Result result)
private

Definition at line 345 of file pose_graph_3d.cc.

◆ InitializeGlobalSubmapPoses()

std::vector< SubmapId > cartographer::mapping::PoseGraph3D::InitializeGlobalSubmapPoses ( int  trajectory_id,
const common::Time  time,
const std::vector< std::shared_ptr< const Submap3D >> &  insertion_submaps 
)
private

Definition at line 56 of file pose_graph_3d.cc.

◆ IsTrajectoryFinished()

bool cartographer::mapping::PoseGraph3D::IsTrajectoryFinished ( int  trajectory_id) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 449 of file pose_graph_3d.cc.

◆ IsTrajectoryFrozen()

bool cartographer::mapping::PoseGraph3D::IsTrajectoryFrozen ( int  trajectory_id) const
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 462 of file pose_graph_3d.cc.

◆ LogResidualHistograms()

void cartographer::mapping::PoseGraph3D::LogResidualHistograms ( ) const
private

Definition at line 588 of file pose_graph_3d.cc.

◆ operator=()

PoseGraph3D& cartographer::mapping::PoseGraph3D::operator= ( const PoseGraph3D )
delete

◆ RunFinalOptimization()

void cartographer::mapping::PoseGraph3D::RunFinalOptimization ( )
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 570 of file pose_graph_3d.cc.

◆ RunOptimization()

void cartographer::mapping::PoseGraph3D::RunOptimization ( )
private

Definition at line 614 of file pose_graph_3d.cc.

◆ SetGlobalSlamOptimizationCallback()

void cartographer::mapping::PoseGraph3D::SetGlobalSlamOptimizationCallback ( PoseGraphInterface::GlobalSlamOptimizationCallback  callback)
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 962 of file pose_graph_3d.cc.

◆ SetInitialTrajectoryPose()

void cartographer::mapping::PoseGraph3D::SetInitialTrajectoryPose ( int  from_trajectory_id,
int  to_trajectory_id,
const transform::Rigid3d pose,
const common::Time  time 
)
overridevirtual

Implements cartographer::mapping::PoseGraph.

Definition at line 741 of file pose_graph_3d.cc.

◆ SetLandmarkPose()

void cartographer::mapping::PoseGraph3D::SetLandmarkPose ( const std::string &  landmark_id,
const transform::Rigid3d global_pose 
)
overridevirtual

Implements cartographer::mapping::PoseGraphInterface.

Definition at line 700 of file pose_graph_3d.cc.

◆ SetTrajectoryDataFromProto()

void cartographer::mapping::PoseGraph3D::SetTrajectoryDataFromProto ( const proto::TrajectoryData &  data)
override

Definition at line 510 of file pose_graph_3d.cc.

◆ UpdateTrajectoryConnectivity()

void cartographer::mapping::PoseGraph3D::UpdateTrajectoryConnectivity ( const Constraint constraint)
private

Definition at line 336 of file pose_graph_3d.cc.

◆ WaitForAllComputations()

void cartographer::mapping::PoseGraph3D::WaitForAllComputations ( )
protected

Definition at line 403 of file pose_graph_3d.cc.

Member Data Documentation

◆ global_slam_optimization_callback_

GlobalSlamOptimizationCallback cartographer::mapping::PoseGraph3D::global_slam_optimization_callback_
private

Definition at line 230 of file pose_graph_3d.h.

◆ mutex_

common::Mutex cartographer::mapping::PoseGraph3D::mutex_
mutableprivate

Definition at line 231 of file pose_graph_3d.h.

◆ optimization_problem_

std::unique_ptr<optimization::OptimizationProblem3D> cartographer::mapping::PoseGraph3D::optimization_problem_
private

Definition at line 252 of file pose_graph_3d.h.

◆ options_

const proto::PoseGraphOptions cartographer::mapping::PoseGraph3D::options_
private

Definition at line 229 of file pose_graph_3d.h.

◆ trajectory_connectivity_state_

TrajectoryConnectivityState cartographer::mapping::PoseGraph3D::trajectory_connectivity_state_
private

Definition at line 239 of file pose_graph_3d.h.


The documentation for this class was generated from the following files:


cartographer
Author(s): The Cartographer Authors
autogenerated on Mon Feb 28 2022 22:00:59