代码拉取完成，页面将自动刷新
The dynamic_robot_localization is a ROS package that offers 3 DOF and 6 DOF localization using PCL and allows dynamic map update using OctoMap. It's a modular localization pipeline, that can be configured using yaml files (detailed configuration layout available in drl_configs.yaml and examples of configurations available in guardian_config and dynamic_robot_localization_tests)
Figure 1: Localization system processing pipeline
Video 1: 3 DoF localization and navigation tests with the Guardian platform in the CROB lab
Video 2: 3 DoF localization and navigation tests with the Guardian platform in ship interior
Video 3: 3 DoF localization, navigation and welding tests with the Guardian platform in ship interior
Video 4: 3 DoF localization system tests with the Jarvis platform in the CROB lab
Video 5: 3 DoF localization system tests with the Pioneer platform in the TUM RGB-D dataset
Video 6: Free fly test with Kinect in the ETHZ RGB-D dataset using the 6 DoF localization system
Video 7: Rotations test with Kinect in the ETHZ RGB-D dataset using the 6 DoF localization system
Video 8: 3 DoF localization system tests with the Guardian platform in Labiomep dataset
Video 9: Mapping with the Guardian robot in simulated ship interior using the 3 DoF localization system
Video 10: Free fly mapping test with Kinect in the ETHZ RGB-D dataset using the 6 DoF localization system
The localization system can operate with any type of sensors that provide point clouds. As such, it can use any number of laser sensors (by using the laserscan_to_pointcloud package) or RGB-D / ToF cameras.
The reference map can be provided to the localization system from CAD ( .ply | .stl | .obj | .vtk ), pointcloud file (.pcd) / topic (sensor_msgs::PointCloud2) or using a 2D costmap (nav_msgs::OccupancyGrid). To avoid unnecessary overhead it should be provided has pointcloud (.pcd).
To convert CAD files to .pcd there are two options:
The localization system has two different localization methods to tackle different scenarios.
For initial pose estimation and pose recovery it can use feature matching with several keypoint detectors (such as Scale Invariant Feature Transform (SIFT) and Intrinsic Shape Signatures (ISS3D)) and several keypoint descriptors (such as Point Feature Histogram (PFH), Fast Point Feature Histogram (FPFH), Signature of Histograms of Orientations (SHOT), Shape Context 3D (SC3D), Unique Shape Context (USC) and Ensemble of Shape Functions (ESF)).
For pose tracking it can use several variants of the Iterative Closest Point algorithm and also the Normal Distributions Transform (NDT). Moreover, pose tracking can have two configurations. One tuned for the expected operation conditions of the robot and another able to recover from odometry estimation problems (the system can operate without odometry).
This gives the possibility to have a configuration that can perform pose tracking with the minimum amount of computational resources required (such as point-to-point ICP) and a more robust (and computational expensive) configuration to handle temporary tracking problems (such as point-to-point non linear ICP, point-to-plane ICP, generalized ICP). Examples of the localization pipeline are available at dynamic_robot_localization/yaml/configs
The localization pipeline allows the attachment of transformation validators before publishing pose estimations.
They can be used to suppress estimations that are not plausible for a given robot operation conditions.
These validators can suppress localization estimations in which the pose correction has a [ outlier percentage | inliers root mean square error | inliers / outliers angular distribution | translation / rotation corrections ] outside acceptable thresholds.
If the tracking methods can't recover after a given amount of sensor updates / time, the initial pose estimation (using features) can be activated.
Dynamic map update can be performed with / without surface reconstruction and can also be coupled with the OctoMap package in order to perform probabilistic point cloud integration (useful for dynamic environments in which large objects may appear / disappear),
This can be by setting the reference_pointclouds/reference_pointcloud_update_mode parameter to one of the available integration modes (NoIntegration | FullIntegration | InliersIntegration | OutliersIntegration) and configuring OctoMap to use the registered cloud or the inlier / outlier cloud as input (and the output of OctoMap as the reference cloud for the localization system).
The localization system can be started with dynamic_robot_localization_system.launch
This launch file starts the nodes:
The localization is integrated with other ROS nodes by publishing TF transforms between map and odom frames (configurable frame names) using the pose_to_tf_publisher node.
The initial pose can be given in yaml / roslaunch files or dynamically using geometry_msgs::PoseStamped / geometry_msgs::PoseWithCovarianceStamped topics / rviz.
The dynamic_robot_localization node publishes geometry_msgs::PoseStamped / geometry_msgs::PoseWithCovarianceStamped that are received by pose_to_tf_publisher and converted to TF messages.
The TF is published in a separate ROS node to ensure that the system remains operational and with constant TF publish rate even if the localization node has variable computational time.
Moreover, in the remote case that the localization system crashes (by lack of system resources, programming error in the localization node or in one of its external libraries), the system can remain operational using only odometry for a given amount of time (i.e. TF messages can be published continuously, with a timeout counted after the last valid pose estimation or one message for each pose estimation) and the localization node can be automatically restarted (has node respawn activated) without any impact in the rest of the system.
The dynamic_robot_localization node publishes in latched topics (if required, as the publish of these messages can be disabled to reduce consumption of system resources):
The main tests performed using the dynamic_robot_localization package are available in dynamic_robot_localization_tests.
Installation scripts can be found in the install folder.
此处可能存在不合适展示的内容，页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容，可点击提交进行申诉，我们将尽快为您处理。
马建仓 AI 助手
